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 <sys/socketvar.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 <net/dlil.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
#if LLC && CCITT
extern struct ifqueue pkintrq;
#endif
#if NVLAN > 0
#include <net/if_vlan_var.h>
#endif
#include <net/ether_if_module.h>
static errno_t
ether_inet6_input(ifnet_t ifp, protocol_family_t protocol,
mbuf_t packet, char *header)
{
#pragma unused(ifp, protocol)
struct ether_header *eh = (struct ether_header *)header;
if (eh->ether_type == htons(ETHERTYPE_IPV6)) {
struct ifnet *mifp;
mifp = mbuf_pkthdr_rcvif(packet);
if (bcmp(eh->ether_shost, etherbroadcastaddr,
ETHER_ADDR_LEN) != 0) {
nd6_llreach_set_reachable(mifp, eh->ether_shost,
ETHER_ADDR_LEN);
}
if (proto_input(protocol, packet) != 0)
m_freem(packet);
} else {
m_freem(packet);
}
return (EJUSTRETURN);
}
static errno_t
ether_inet6_pre_output(ifnet_t ifp, protocol_family_t protocol_family,
mbuf_t *m0, const struct sockaddr *dst_netaddr, void *route,
char *type, char *edst)
{
#pragma unused(protocol_family)
errno_t result;
struct sockaddr_dl sdl;
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, protocol_family_t protocol_family,
u_long command, void *data)
{
#pragma unused(protocol_family)
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);
ifnet_ioctl(ifp, 0, SIOCSIFFLAGS, NULL);
}
break;
case SIOCGIFADDR:
(void) ifnet_lladdr_copy_bytes(ifp, ifr->ifr_addr.sa_data,
ETHER_ADDR_LEN);
break;
default:
error = EOPNOTSUPP;
break;
}
return (error);
}
errno_t
ether_attach_inet6(struct ifnet *ifp, protocol_family_t protocol_family)
{
#pragma unused(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 = ether_inet6_input;
proto.pre_output = ether_inet6_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: %s can't attach ipv6 to %s%d\n", __func__,
ifp->if_name, ifp->if_unit);
}
return (error);
}
void
ether_detach_inet6(struct ifnet *ifp, protocol_family_t protocol_family)
{
(void) ifnet_detach_protocol(ifp, protocol_family);
}