#include <sys/param.h>
#include <sys/systm.h>
#include <sys/errno.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/mbuf.h>
#include <sys/errno.h>
#include <netgraph/ng_message.h>
#include <netgraph/netgraph.h>
#include <netgraph/ng_UI.h>
#define HDLC_UI 0x03
struct ng_UI_private {
hook_p downlink;
hook_p uplink;
};
typedef struct ng_UI_private *priv_p;
static ng_constructor_t ng_UI_constructor;
static ng_rcvmsg_t ng_UI_rcvmsg;
static ng_shutdown_t ng_UI_shutdown;
static ng_newhook_t ng_UI_newhook;
static ng_rcvdata_t ng_UI_rcvdata;
static ng_disconnect_t ng_UI_disconnect;
static struct ng_type typestruct = {
.version = NG_ABI_VERSION,
.name = NG_UI_NODE_TYPE,
.constructor = ng_UI_constructor,
.rcvmsg = ng_UI_rcvmsg,
.shutdown = ng_UI_shutdown,
.newhook = ng_UI_newhook,
.rcvdata = ng_UI_rcvdata,
.disconnect = ng_UI_disconnect,
};
NETGRAPH_INIT(UI, &typestruct);
static int
ng_UI_constructor(node_p node)
{
priv_p priv;
priv = malloc(sizeof(*priv), M_NETGRAPH, M_WAITOK | M_ZERO);
NG_NODE_SET_PRIVATE(node, priv);
return (0);
}
static int
ng_UI_newhook(node_p node, hook_p hook, const char *name)
{
const priv_p priv = NG_NODE_PRIVATE(node);
if (!strcmp(name, NG_UI_HOOK_DOWNSTREAM)) {
if (priv->downlink)
return (EISCONN);
priv->downlink = hook;
} else if (!strcmp(name, NG_UI_HOOK_UPSTREAM)) {
if (priv->uplink)
return (EISCONN);
priv->uplink = hook;
} else
return (EINVAL);
return (0);
}
static int
ng_UI_rcvmsg(node_p node, item_p item, hook_p lasthook)
{
int error;
const priv_p priv = NG_NODE_PRIVATE(node);
struct ng_mesg *msg;
msg = NGI_MSG(item);
if ((msg->header.typecookie == NGM_FLOW_COOKIE) && lasthook) {
if (lasthook == priv->downlink) {
if (priv->uplink) {
NG_FWD_ITEM_HOOK(error, item, priv->uplink);
return (error);
}
} else {
if (priv->downlink) {
NG_FWD_ITEM_HOOK(error, item, priv->downlink);
return (error);
}
}
}
NG_FREE_ITEM(item);
return (EINVAL);
}
#define MAX_ENCAPS_HDR 1
#define ERROUT(x) do { error = (x); goto done; } while (0)
static int
ng_UI_rcvdata(hook_p hook, item_p item)
{
const node_p node = NG_HOOK_NODE(hook);
const priv_p priv = NG_NODE_PRIVATE(node);
struct mbuf *m;
int error = 0;
NGI_GET_M(item, m);
if (hook == priv->downlink) {
u_char *start, *ptr;
if (m->m_len < MAX_ENCAPS_HDR
&& !(m = m_pullup(m, MAX_ENCAPS_HDR)))
ERROUT(ENOBUFS);
ptr = start = mtod(m, u_char *);
if (*ptr++ != HDLC_UI)
ERROUT(0);
m_adj(m, ptr - start);
NG_FWD_NEW_DATA(error, item, priv->uplink, m);
} else if (hook == priv->uplink) {
M_PREPEND(m, 1, M_NOWAIT);
if (!m)
ERROUT(ENOBUFS);
mtod(m, u_char *)[0] = HDLC_UI;
NG_FWD_NEW_DATA(error, item, priv->downlink, m);
} else
panic("%s", __func__);
done:
NG_FREE_M(m);
if (item)
NG_FREE_ITEM(item);
return (error);
}
static int
ng_UI_shutdown(node_p node)
{
const priv_p priv = NG_NODE_PRIVATE(node);
free(priv, M_NETGRAPH);
NG_NODE_SET_PRIVATE(node, NULL);
NG_NODE_UNREF(node);
return (0);
}
static int
ng_UI_disconnect(hook_p hook)
{
const priv_p priv = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
if (hook == priv->downlink)
priv->downlink = NULL;
else if (hook == priv->uplink)
priv->uplink = NULL;
else
panic("%s", __func__);
if ((NG_NODE_NUMHOOKS(NG_HOOK_NODE(hook)) == 0)
&& (NG_NODE_IS_VALID(NG_HOOK_NODE(hook)))) {
ng_rmnode_self(NG_HOOK_NODE(hook));
}
return (0);
}