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 <net/dlil.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>
#include <netinet6/ip6_var.h>
#endif
#if NVLAN > 0
#include <net/if_vlan_var.h>
#endif
#include <net/ether_if_module.h>
static const u_char etherip6allnodes[ETHER_ADDR_LEN] =
{ 0x33, 0x33, 0, 0, 0, 1 };
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 *)(void *)header;
u_int16_t ether_type;
bcopy(&eh->ether_type, ðer_type, sizeof(ether_type));
if (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 (!bcmp(eh->ether_dhost, etherip6allnodes, ETHER_ADDR_LEN)) {
struct ip6aux *ip6a;
ip6a = ip6_addaux(packet);
if (ip6a) {
ip6a->ip6a_flags |= IP6A_HASEEN;
bcopy(eh->ether_shost, ip6a->ip6a_ehsrc,
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 *)
(uintptr_t)(size_t)dst_netaddr, &sdl, sizeof(sdl), route, *m0);
if (result == 0) {
u_int16_t ethertype_ipv6 = htons(ETHERTYPE_IPV6);
bcopy(ðertype_ipv6, type, sizeof(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 *)(uintptr_t)(size_t)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)
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: {
struct ifreq *ifr = (struct ifreq *)(void *)data;
(void) ifnet_guarded_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\n", __func__,
if_name(ifp));
}
return error;
}
void
ether_detach_inet6(struct ifnet *ifp, protocol_family_t protocol_family)
{
(void) ifnet_detach_protocol(ifp, protocol_family);
}