ether_inet6_pr_module.c [plain text]
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/sockio.h>
#include <sys/sysctl.h>
#include <kern/lock.h>
#include <net/if.h>
#include <net/route.h>
#include <net/if_llc.h>
#include <net/if_dl.h>
#include <net/if_types.h>
#include <net/ndrv.h>
#include <net/kpi_protocol.h>
#include <netinet/in.h>
#include <netinet/in_var.h>
#include <netinet/if_ether.h>
#include <netinet/in_systm.h>
#include <netinet/ip.h>
#if INET6
#include <netinet6/nd6.h>
#include <netinet6/in6_ifattach.h>
#endif
#include <sys/socketvar.h>
#include <net/dlil.h>
#if LLC && CCITT
extern struct ifqueue pkintrq;
#endif
#if BRIDGE
#include <net/bridge.h>
#endif
#if NVLAN > 0
#include <net/if_vlan_var.h>
#endif
int ether_attach_inet6(struct ifnet *ifp, u_long protocol_family);
int ether_detach_inet6(struct ifnet *ifp, u_long protocol_family);
static errno_t
inet6_ether_input(
__unused ifnet_t ifp,
protocol_family_t protocol,
mbuf_t packet,
__unused char *header)
{
proto_input(protocol, packet);
return 0;
}
static errno_t
inet6_ether_pre_output(
ifnet_t ifp,
__unused protocol_family_t protocol_family,
mbuf_t *m0,
const struct sockaddr *dst_netaddr,
void *route,
char *type,
char *edst)
{
errno_t result;
struct sockaddr_dl sdl;
register struct mbuf *m = *m0;
m->m_flags |= M_LOOP;
result = nd6_lookup_ipv6(ifp, (const struct sockaddr_in6*)dst_netaddr,
&sdl, sizeof(sdl), route, *m0);
if (result == 0) {
*(u_int16_t*)type = htons(ETHERTYPE_IPV6);
bcopy(LLADDR(&sdl), edst, sdl.sdl_alen);
}
return result;
}
static int
ether_inet6_resolve_multi(
ifnet_t ifp,
const struct sockaddr *proto_addr,
struct sockaddr_dl *out_ll,
size_t ll_len)
{
static const size_t minsize = offsetof(struct sockaddr_dl, sdl_data[0]) + ETHER_ADDR_LEN;
const struct sockaddr_in6 *sin6 = (const struct sockaddr_in6*)proto_addr;
if (proto_addr->sa_family != AF_INET6)
return EAFNOSUPPORT;
if (proto_addr->sa_len < sizeof(struct sockaddr_in6))
return EINVAL;
if (ll_len < minsize)
return EMSGSIZE;
bzero(out_ll, minsize);
out_ll->sdl_len = minsize;
out_ll->sdl_family = AF_LINK;
out_ll->sdl_index = ifp->if_index;
out_ll->sdl_type = IFT_ETHER;
out_ll->sdl_nlen = 0;
out_ll->sdl_alen = ETHER_ADDR_LEN;
out_ll->sdl_slen = 0;
ETHER_MAP_IPV6_MULTICAST(&sin6->sin6_addr, LLADDR(out_ll));
return 0;
}
static errno_t
ether_inet6_prmod_ioctl(
ifnet_t ifp,
__unused protocol_family_t protocol_family,
u_int32_t command,
void* data)
{
struct ifreq *ifr = (struct ifreq *) data;
int error = 0;
switch (command) {
case SIOCSIFADDR:
if ((ifp->if_flags & IFF_RUNNING) == 0) {
ifnet_set_flags(ifp, IFF_UP, IFF_UP);
dlil_ioctl(0, ifp, SIOCSIFFLAGS, (caddr_t) 0);
}
break;
case SIOCGIFADDR:
ifnet_lladdr_copy_bytes(ifp, ifr->ifr_addr.sa_data, ETHER_ADDR_LEN);
break;
case SIOCSIFMTU:
return (0);
default:
return EOPNOTSUPP;
}
return (error);
}
int
ether_attach_inet6(
struct ifnet *ifp,
__unused u_long protocol_family)
{
struct ifnet_attach_proto_param proto;
struct ifnet_demux_desc demux[1];
u_short en_6native=htons(ETHERTYPE_IPV6);
errno_t error;
bzero(&proto, sizeof(proto));
demux[0].type = DLIL_DESC_ETYPE2;
demux[0].data = &en_6native;
demux[0].datalen = sizeof(en_6native);
proto.demux_list = demux;
proto.demux_count = 1;
proto.input = inet6_ether_input;
proto.pre_output = inet6_ether_pre_output;
proto.ioctl = ether_inet6_prmod_ioctl;
proto.resolve = ether_inet6_resolve_multi;
error = ifnet_attach_protocol(ifp, protocol_family, &proto);
if (error && error != EEXIST) {
printf("WARNING: ether_attach_inet6 can't attach ipv6 to %s%d\n",
ifp->if_name, ifp->if_unit);
}
return error;
}
int
ether_detach_inet6(
struct ifnet *ifp,
u_long protocol_family)
{
errno_t error;
error = ifnet_detach_protocol(ifp, protocol_family);
if (error && error != ENOENT) {
printf("WARNING: ether_detach_inet6 can't detach ipv6 from %s%d\n",
ifp->if_name, ifp->if_unit);
}
return error;
}