aef8f3445b
initialize / release netgraph related state in iattach() / idetach() functions called via the vnet module registration / initialization framework, instead of initialization / cleanups being done in mod_event handlers. While here, introduce a crude hack aimed at preventing ng_ether to autoattach to ng_eiface ifnets, which are also netgraph nodes already. Reviewed by: bz Approved by: julian (mentor)
643 lines
14 KiB
C
643 lines
14 KiB
C
/*-
|
|
*
|
|
* Copyright (c) 1999-2001, Vitaly V Belekhov
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice unmodified, this list of conditions, and the following
|
|
* disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*
|
|
* $FreeBSD$
|
|
*/
|
|
|
|
#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 <sys/sockio.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/syslog.h>
|
|
#include <sys/vimage.h>
|
|
|
|
#include <net/if.h>
|
|
#include <net/if_types.h>
|
|
#include <net/netisr.h>
|
|
#include <net/route.h>
|
|
|
|
#include <netgraph/ng_message.h>
|
|
#include <netgraph/netgraph.h>
|
|
#include <netgraph/ng_parse.h>
|
|
#include <netgraph/ng_eiface.h>
|
|
|
|
#include <net/bpf.h>
|
|
#include <net/ethernet.h>
|
|
#include <net/if_arp.h>
|
|
|
|
static const struct ng_cmdlist ng_eiface_cmdlist[] = {
|
|
{
|
|
NGM_EIFACE_COOKIE,
|
|
NGM_EIFACE_GET_IFNAME,
|
|
"getifname",
|
|
NULL,
|
|
&ng_parse_string_type
|
|
},
|
|
{
|
|
NGM_EIFACE_COOKIE,
|
|
NGM_EIFACE_SET,
|
|
"set",
|
|
&ng_parse_enaddr_type,
|
|
NULL
|
|
},
|
|
{ 0 }
|
|
};
|
|
|
|
/* Node private data */
|
|
struct ng_eiface_private {
|
|
struct ifnet *ifp; /* per-interface network data */
|
|
int unit; /* Interface unit number */
|
|
node_p node; /* Our netgraph node */
|
|
hook_p ether; /* Hook for ethernet stream */
|
|
};
|
|
typedef struct ng_eiface_private *priv_p;
|
|
|
|
/* Interface methods */
|
|
static void ng_eiface_init(void *xsc);
|
|
static void ng_eiface_start(struct ifnet *ifp);
|
|
static int ng_eiface_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data);
|
|
#ifdef DEBUG
|
|
static void ng_eiface_print_ioctl(struct ifnet *ifp, int cmd, caddr_t data);
|
|
#endif
|
|
|
|
/* Netgraph methods */
|
|
static int ng_eiface_mod_event(module_t, int, void *);
|
|
static ng_constructor_t ng_eiface_constructor;
|
|
static ng_rcvmsg_t ng_eiface_rcvmsg;
|
|
static ng_shutdown_t ng_eiface_rmnode;
|
|
static ng_newhook_t ng_eiface_newhook;
|
|
static ng_rcvdata_t ng_eiface_rcvdata;
|
|
static ng_disconnect_t ng_eiface_disconnect;
|
|
|
|
/* Node type descriptor */
|
|
static struct ng_type typestruct = {
|
|
.version = NG_ABI_VERSION,
|
|
.name = NG_EIFACE_NODE_TYPE,
|
|
.mod_event = ng_eiface_mod_event,
|
|
.constructor = ng_eiface_constructor,
|
|
.rcvmsg = ng_eiface_rcvmsg,
|
|
.shutdown = ng_eiface_rmnode,
|
|
.newhook = ng_eiface_newhook,
|
|
.rcvdata = ng_eiface_rcvdata,
|
|
.disconnect = ng_eiface_disconnect,
|
|
.cmdlist = ng_eiface_cmdlist
|
|
};
|
|
NETGRAPH_INIT(eiface, &typestruct);
|
|
|
|
static vnet_attach_fn ng_eiface_iattach;
|
|
static vnet_detach_fn ng_eiface_idetach;
|
|
|
|
#ifdef VIMAGE_GLOBALS
|
|
static struct unrhdr *ng_eiface_unit;
|
|
#endif
|
|
|
|
#ifndef VIMAGE_GLOBALS
|
|
static vnet_modinfo_t vnet_ng_eiface_modinfo = {
|
|
.vmi_id = VNET_MOD_NG_EIFACE,
|
|
.vmi_name = "ng_eiface",
|
|
.vmi_dependson = VNET_MOD_NETGRAPH,
|
|
.vmi_iattach = ng_eiface_iattach,
|
|
.vmi_idetach = ng_eiface_idetach
|
|
};
|
|
#endif
|
|
|
|
/************************************************************************
|
|
INTERFACE STUFF
|
|
************************************************************************/
|
|
|
|
/*
|
|
* Process an ioctl for the virtual interface
|
|
*/
|
|
static int
|
|
ng_eiface_ioctl(struct ifnet *ifp, u_long command, caddr_t data)
|
|
{
|
|
struct ifreq *const ifr = (struct ifreq *)data;
|
|
int s, error = 0;
|
|
|
|
#ifdef DEBUG
|
|
ng_eiface_print_ioctl(ifp, command, data);
|
|
#endif
|
|
s = splimp();
|
|
switch (command) {
|
|
|
|
/* These two are mostly handled at a higher layer */
|
|
case SIOCSIFADDR:
|
|
error = ether_ioctl(ifp, command, data);
|
|
break;
|
|
case SIOCGIFADDR:
|
|
break;
|
|
|
|
/* Set flags */
|
|
case SIOCSIFFLAGS:
|
|
/*
|
|
* If the interface is marked up and stopped, then start it.
|
|
* If it is marked down and running, then stop it.
|
|
*/
|
|
if (ifp->if_flags & IFF_UP) {
|
|
if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
|
|
ifp->if_drv_flags &= ~(IFF_DRV_OACTIVE);
|
|
ifp->if_drv_flags |= IFF_DRV_RUNNING;
|
|
}
|
|
} else {
|
|
if (ifp->if_drv_flags & IFF_DRV_RUNNING)
|
|
ifp->if_drv_flags &= ~(IFF_DRV_RUNNING |
|
|
IFF_DRV_OACTIVE);
|
|
}
|
|
break;
|
|
|
|
/* Set the interface MTU */
|
|
case SIOCSIFMTU:
|
|
if (ifr->ifr_mtu > NG_EIFACE_MTU_MAX ||
|
|
ifr->ifr_mtu < NG_EIFACE_MTU_MIN)
|
|
error = EINVAL;
|
|
else
|
|
ifp->if_mtu = ifr->ifr_mtu;
|
|
break;
|
|
|
|
/* Stuff that's not supported */
|
|
case SIOCADDMULTI:
|
|
case SIOCDELMULTI:
|
|
error = 0;
|
|
break;
|
|
case SIOCSIFPHYS:
|
|
error = EOPNOTSUPP;
|
|
break;
|
|
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
splx(s);
|
|
return (error);
|
|
}
|
|
|
|
static void
|
|
ng_eiface_init(void *xsc)
|
|
{
|
|
priv_p sc = xsc;
|
|
struct ifnet *ifp = sc->ifp;
|
|
int s;
|
|
|
|
s = splimp();
|
|
|
|
ifp->if_drv_flags |= IFF_DRV_RUNNING;
|
|
ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
|
|
|
|
splx(s);
|
|
}
|
|
|
|
/*
|
|
* We simply relay the packet to the "ether" hook, if it is connected.
|
|
* We have been through the netgraph locking and are guaranteed to
|
|
* be the only code running in this node at this time.
|
|
*/
|
|
static void
|
|
ng_eiface_start2(node_p node, hook_p hook, void *arg1, int arg2)
|
|
{
|
|
struct ifnet *ifp = arg1;
|
|
const priv_p priv = (priv_p)ifp->if_softc;
|
|
int error = 0;
|
|
struct mbuf *m;
|
|
|
|
/* Check interface flags */
|
|
|
|
if (!((ifp->if_flags & IFF_UP) &&
|
|
(ifp->if_drv_flags & IFF_DRV_RUNNING)))
|
|
return;
|
|
|
|
for (;;) {
|
|
/*
|
|
* Grab a packet to transmit.
|
|
*/
|
|
IF_DEQUEUE(&ifp->if_snd, m);
|
|
|
|
/* If there's nothing to send, break. */
|
|
if (m == NULL)
|
|
break;
|
|
|
|
/*
|
|
* Berkeley packet filter.
|
|
* Pass packet to bpf if there is a listener.
|
|
* XXX is this safe? locking?
|
|
*/
|
|
BPF_MTAP(ifp, m);
|
|
|
|
if (ifp->if_flags & IFF_MONITOR) {
|
|
ifp->if_ipackets++;
|
|
m_freem(m);
|
|
continue;
|
|
}
|
|
|
|
/*
|
|
* Send packet; if hook is not connected, mbuf will get
|
|
* freed.
|
|
*/
|
|
NG_SEND_DATA_ONLY(error, priv->ether, m);
|
|
|
|
/* Update stats */
|
|
if (error == 0)
|
|
ifp->if_opackets++;
|
|
else
|
|
ifp->if_oerrors++;
|
|
}
|
|
|
|
ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
|
|
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* This routine is called to deliver a packet out the interface.
|
|
* We simply queue the netgraph version to be called when netgraph locking
|
|
* allows it to happen.
|
|
* Until we know what the rest of the networking code is doing for
|
|
* locking, we don't know how we will interact with it.
|
|
* Take comfort from the fact that the ifnet struct is part of our
|
|
* private info and can't go away while we are queued.
|
|
* [Though we don't know it is still there now....]
|
|
* it is possible we don't gain anything from this because
|
|
* we would like to get the mbuf and queue it as data
|
|
* somehow, but we can't and if we did would we solve anything?
|
|
*/
|
|
static void
|
|
ng_eiface_start(struct ifnet *ifp)
|
|
{
|
|
|
|
const priv_p priv = (priv_p)ifp->if_softc;
|
|
|
|
/* Don't do anything if output is active */
|
|
if (ifp->if_drv_flags & IFF_DRV_OACTIVE)
|
|
return;
|
|
|
|
ifp->if_drv_flags |= IFF_DRV_OACTIVE;
|
|
|
|
if (ng_send_fn(priv->node, NULL, &ng_eiface_start2, ifp, 0) != 0)
|
|
ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
|
|
}
|
|
|
|
#ifdef DEBUG
|
|
/*
|
|
* Display an ioctl to the virtual interface
|
|
*/
|
|
|
|
static void
|
|
ng_eiface_print_ioctl(struct ifnet *ifp, int command, caddr_t data)
|
|
{
|
|
char *str;
|
|
|
|
switch (command & IOC_DIRMASK) {
|
|
case IOC_VOID:
|
|
str = "IO";
|
|
break;
|
|
case IOC_OUT:
|
|
str = "IOR";
|
|
break;
|
|
case IOC_IN:
|
|
str = "IOW";
|
|
break;
|
|
case IOC_INOUT:
|
|
str = "IORW";
|
|
break;
|
|
default:
|
|
str = "IO??";
|
|
}
|
|
log(LOG_DEBUG, "%s: %s('%c', %d, char[%d])\n",
|
|
ifp->if_xname,
|
|
str,
|
|
IOCGROUP(command),
|
|
command & 0xff,
|
|
IOCPARM_LEN(command));
|
|
}
|
|
#endif /* DEBUG */
|
|
|
|
/************************************************************************
|
|
NETGRAPH NODE STUFF
|
|
************************************************************************/
|
|
|
|
/*
|
|
* Constructor for a node
|
|
*/
|
|
static int
|
|
ng_eiface_constructor(node_p node)
|
|
{
|
|
INIT_VNET_NETGRAPH(curvnet);
|
|
struct ifnet *ifp;
|
|
priv_p priv;
|
|
u_char eaddr[6] = {0,0,0,0,0,0};
|
|
|
|
/* Allocate node and interface private structures */
|
|
priv = malloc(sizeof(*priv), M_NETGRAPH, M_NOWAIT | M_ZERO);
|
|
if (priv == NULL)
|
|
return (ENOMEM);
|
|
|
|
ifp = priv->ifp = if_alloc(IFT_ETHER);
|
|
if (ifp == NULL) {
|
|
free(priv, M_NETGRAPH);
|
|
return (ENOSPC);
|
|
}
|
|
|
|
/* Link them together */
|
|
ifp->if_softc = priv;
|
|
|
|
/* Get an interface unit number */
|
|
priv->unit = alloc_unr(V_ng_eiface_unit);
|
|
|
|
/* Link together node and private info */
|
|
NG_NODE_SET_PRIVATE(node, priv);
|
|
priv->node = node;
|
|
|
|
/* Initialize interface structure */
|
|
if_initname(ifp, NG_EIFACE_EIFACE_NAME, priv->unit);
|
|
ifp->if_init = ng_eiface_init;
|
|
ifp->if_output = ether_output;
|
|
ifp->if_start = ng_eiface_start;
|
|
ifp->if_ioctl = ng_eiface_ioctl;
|
|
ifp->if_watchdog = NULL;
|
|
ifp->if_snd.ifq_maxlen = IFQ_MAXLEN;
|
|
ifp->if_flags = (IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST);
|
|
|
|
#if 0
|
|
/* Give this node name */
|
|
bzero(ifname, sizeof(ifname));
|
|
sprintf(ifname, "if%s", ifp->if_xname);
|
|
(void)ng_name_node(node, ifname);
|
|
#endif
|
|
|
|
/* Attach the interface */
|
|
ether_ifattach(ifp, eaddr);
|
|
|
|
/* Done */
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Give our ok for a hook to be added
|
|
*/
|
|
static int
|
|
ng_eiface_newhook(node_p node, hook_p hook, const char *name)
|
|
{
|
|
priv_p priv = NG_NODE_PRIVATE(node);
|
|
struct ifnet *ifp = priv->ifp;
|
|
|
|
if (strcmp(name, NG_EIFACE_HOOK_ETHER))
|
|
return (EPFNOSUPPORT);
|
|
if (priv->ether != NULL)
|
|
return (EISCONN);
|
|
priv->ether = hook;
|
|
NG_HOOK_SET_PRIVATE(hook, &priv->ether);
|
|
|
|
if_link_state_change(ifp, LINK_STATE_UP);
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Receive a control message
|
|
*/
|
|
static int
|
|
ng_eiface_rcvmsg(node_p node, item_p item, hook_p lasthook)
|
|
{
|
|
const priv_p priv = NG_NODE_PRIVATE(node);
|
|
struct ifnet *const ifp = priv->ifp;
|
|
struct ng_mesg *resp = NULL;
|
|
int error = 0;
|
|
struct ng_mesg *msg;
|
|
|
|
NGI_GET_MSG(item, msg);
|
|
switch (msg->header.typecookie) {
|
|
case NGM_EIFACE_COOKIE:
|
|
switch (msg->header.cmd) {
|
|
|
|
case NGM_EIFACE_SET:
|
|
{
|
|
if (msg->header.arglen != ETHER_ADDR_LEN) {
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
error = if_setlladdr(priv->ifp,
|
|
(u_char *)msg->data, ETHER_ADDR_LEN);
|
|
break;
|
|
}
|
|
|
|
case NGM_EIFACE_GET_IFNAME:
|
|
NG_MKRESPONSE(resp, msg, IFNAMSIZ, M_NOWAIT);
|
|
if (resp == NULL) {
|
|
error = ENOMEM;
|
|
break;
|
|
}
|
|
strlcpy(resp->data, ifp->if_xname, IFNAMSIZ);
|
|
break;
|
|
|
|
case NGM_EIFACE_GET_IFADDRS:
|
|
{
|
|
struct ifaddr *ifa;
|
|
caddr_t ptr;
|
|
int buflen;
|
|
|
|
/* Determine size of response and allocate it */
|
|
buflen = 0;
|
|
IF_ADDR_LOCK(ifp);
|
|
TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link)
|
|
buflen += SA_SIZE(ifa->ifa_addr);
|
|
NG_MKRESPONSE(resp, msg, buflen, M_NOWAIT);
|
|
if (resp == NULL) {
|
|
IF_ADDR_UNLOCK(ifp);
|
|
error = ENOMEM;
|
|
break;
|
|
}
|
|
|
|
/* Add addresses */
|
|
ptr = resp->data;
|
|
TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
|
|
const int len = SA_SIZE(ifa->ifa_addr);
|
|
|
|
if (buflen < len) {
|
|
log(LOG_ERR, "%s: len changed?\n",
|
|
ifp->if_xname);
|
|
break;
|
|
}
|
|
bcopy(ifa->ifa_addr, ptr, len);
|
|
ptr += len;
|
|
buflen -= len;
|
|
}
|
|
IF_ADDR_UNLOCK(ifp);
|
|
break;
|
|
}
|
|
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
} /* end of inner switch() */
|
|
break;
|
|
case NGM_FLOW_COOKIE:
|
|
switch (msg->header.cmd) {
|
|
case NGM_LINK_IS_UP:
|
|
if_link_state_change(ifp, LINK_STATE_UP);
|
|
break;
|
|
case NGM_LINK_IS_DOWN:
|
|
if_link_state_change(ifp, LINK_STATE_DOWN);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
break;
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
NG_RESPOND_MSG(error, node, item, resp);
|
|
NG_FREE_MSG(msg);
|
|
return (error);
|
|
}
|
|
|
|
/*
|
|
* Receive data from a hook. Pass the packet to the ether_input routine.
|
|
*/
|
|
static int
|
|
ng_eiface_rcvdata(hook_p hook, item_p item)
|
|
{
|
|
const priv_p priv = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
|
|
struct ifnet *const ifp = priv->ifp;
|
|
struct mbuf *m;
|
|
|
|
NGI_GET_M(item, m);
|
|
NG_FREE_ITEM(item);
|
|
|
|
if (!((ifp->if_flags & IFF_UP) &&
|
|
(ifp->if_drv_flags & IFF_DRV_RUNNING))) {
|
|
NG_FREE_M(m);
|
|
return (ENETDOWN);
|
|
}
|
|
|
|
if (m->m_len < ETHER_HDR_LEN) {
|
|
m = m_pullup(m, ETHER_HDR_LEN);
|
|
if (m == NULL)
|
|
return (EINVAL);
|
|
}
|
|
|
|
/* Note receiving interface */
|
|
m->m_pkthdr.rcvif = ifp;
|
|
|
|
/* Update interface stats */
|
|
ifp->if_ipackets++;
|
|
|
|
(*ifp->if_input)(ifp, m);
|
|
|
|
/* Done */
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Shutdown processing.
|
|
*/
|
|
static int
|
|
ng_eiface_rmnode(node_p node)
|
|
{
|
|
INIT_VNET_NETGRAPH(curvnet);
|
|
const priv_p priv = NG_NODE_PRIVATE(node);
|
|
struct ifnet *const ifp = priv->ifp;
|
|
|
|
/*
|
|
* the ifnet may be in a different vnet than the netgraph node,
|
|
* hence we have to change the current vnet context here.
|
|
*/
|
|
CURVNET_SET_QUIET(ifp->if_vnet);
|
|
ether_ifdetach(ifp);
|
|
if_free(ifp);
|
|
CURVNET_RESTORE();
|
|
free_unr(V_ng_eiface_unit, priv->unit);
|
|
free(priv, M_NETGRAPH);
|
|
NG_NODE_SET_PRIVATE(node, NULL);
|
|
NG_NODE_UNREF(node);
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Hook disconnection
|
|
*/
|
|
static int
|
|
ng_eiface_disconnect(hook_p hook)
|
|
{
|
|
const priv_p priv = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
|
|
|
|
priv->ether = NULL;
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Handle loading and unloading for this node type.
|
|
*/
|
|
static int
|
|
ng_eiface_mod_event(module_t mod, int event, void *data)
|
|
{
|
|
int error = 0;
|
|
|
|
switch (event) {
|
|
case MOD_LOAD:
|
|
#ifndef VIMAGE_GLOBALS
|
|
vnet_mod_register(&vnet_ng_eiface_modinfo);
|
|
#else
|
|
ng_eiface_iattach(NULL);
|
|
#endif
|
|
break;
|
|
case MOD_UNLOAD:
|
|
#ifndef VIMAGE_GLOBALS
|
|
vnet_mod_deregister(&vnet_ng_eiface_modinfo);
|
|
#else
|
|
ng_eiface_idetach(NULL);
|
|
#endif
|
|
break;
|
|
default:
|
|
error = EOPNOTSUPP;
|
|
break;
|
|
}
|
|
return (error);
|
|
}
|
|
|
|
static int ng_eiface_iattach(const void *unused)
|
|
{
|
|
INIT_VNET_NETGRAPH(curvnet);
|
|
|
|
V_ng_eiface_unit = new_unrhdr(0, 0xffff, NULL);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int ng_eiface_idetach(const void *unused)
|
|
{
|
|
INIT_VNET_NETGRAPH(curvnet);
|
|
|
|
delete_unrhdr(V_ng_eiface_unit);
|
|
|
|
return (0);
|
|
}
|