#include <sys/param.h>
#include <sys/malloc.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/systm.h>
#include <sys/queue.h>
#include <sys/syslog.h>
#include <sys/mcache.h>
#include <net/route.h>
#include <net/if.h>
#include <netinet/in.h>
#include <netinet6/in6_var.h>
#include <netinet6/scope6_var.h>
#ifdef ENABLE_DEFAULT_SCOPE
int ip6_use_defzone = 1;
#else
int ip6_use_defzone = 0;
#endif
decl_lck_mtx_data(static, scope6_lock);
static struct scope6_id sid_default;
#define SID(ifp) &IN6_IFEXTRA(ifp)->scope6_id
void
scope6_init(lck_grp_t *grp, lck_attr_t *attr)
{
bzero(&sid_default, sizeof(sid_default));
lck_mtx_init(&scope6_lock, grp, attr);
}
void
scope6_ifattach(struct ifnet *ifp)
{
struct scope6_id *sid;
VERIFY(IN6_IFEXTRA(ifp) != NULL);
if_inet6data_lock_exclusive(ifp);
sid = SID(ifp);
sid->s6id_list[IPV6_ADDR_SCOPE_INTFACELOCAL] = ifp->if_index;
sid->s6id_list[IPV6_ADDR_SCOPE_LINKLOCAL] = ifp->if_index;
#if MULTI_SCOPE
sid->s6id_list[IPV6_ADDR_SCOPE_SITELOCAL] = 1;
sid->s6id_list[IPV6_ADDR_SCOPE_ORGLOCAL] = 1;
#endif
if_inet6data_lock_done(ifp);
}
int
in6_addrscope(struct in6_addr *addr)
{
int scope;
if (addr->s6_addr8[0] == 0xfe) {
scope = addr->s6_addr8[1] & 0xc0;
switch (scope) {
case 0x80:
return IPV6_ADDR_SCOPE_LINKLOCAL;
case 0xc0:
return IPV6_ADDR_SCOPE_SITELOCAL;
default:
return IPV6_ADDR_SCOPE_GLOBAL;
}
}
if (addr->s6_addr8[0] == 0xff) {
scope = addr->s6_addr8[1] & 0x0f;
switch (scope) {
case IPV6_ADDR_SCOPE_INTFACELOCAL:
return IPV6_ADDR_SCOPE_INTFACELOCAL;
case IPV6_ADDR_SCOPE_LINKLOCAL:
return IPV6_ADDR_SCOPE_LINKLOCAL;
case IPV6_ADDR_SCOPE_SITELOCAL:
return IPV6_ADDR_SCOPE_SITELOCAL;
default:
return IPV6_ADDR_SCOPE_GLOBAL;
}
}
if (bcmp(&in6addr_loopback, addr, sizeof(*addr) - 1) == 0) {
if (addr->s6_addr8[15] == 1) {
return IPV6_ADDR_SCOPE_LINKLOCAL;
}
if (addr->s6_addr8[15] == 0) {
return IPV6_ADDR_SCOPE_GLOBAL;
}
}
return IPV6_ADDR_SCOPE_GLOBAL;
}
int
in6_addr2scopeid(struct ifnet *ifp, struct in6_addr *addr)
{
int scope = in6_addrscope(addr);
int retid = 0;
struct scope6_id *sid;
if_inet6data_lock_shared(ifp);
if (IN6_IFEXTRA(ifp) == NULL) {
goto err;
}
sid = SID(ifp);
switch (scope) {
case IPV6_ADDR_SCOPE_NODELOCAL:
retid = -1;
break;
case IPV6_ADDR_SCOPE_LINKLOCAL:
retid = sid->s6id_list[IPV6_ADDR_SCOPE_LINKLOCAL];
break;
case IPV6_ADDR_SCOPE_SITELOCAL:
retid = sid->s6id_list[IPV6_ADDR_SCOPE_SITELOCAL];
break;
case IPV6_ADDR_SCOPE_ORGLOCAL:
retid = sid->s6id_list[IPV6_ADDR_SCOPE_ORGLOCAL];
break;
default:
break;
}
err:
if_inet6data_lock_done(ifp);
return retid;
}
int
sa6_embedscope(struct sockaddr_in6 *sin6, int defaultok)
{
struct ifnet *ifp;
u_int32_t zoneid;
if ((zoneid = sin6->sin6_scope_id) == 0 && defaultok) {
zoneid = scope6_addr2default(&sin6->sin6_addr);
}
if (zoneid != 0 &&
(IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr) ||
IN6_IS_ADDR_MC_INTFACELOCAL(&sin6->sin6_addr))) {
if (if_index < zoneid) {
return ENXIO;
}
ifnet_head_lock_shared();
ifp = ifindex2ifnet[zoneid];
if (ifp == NULL) {
ifnet_head_done();
return ENXIO;
}
ifnet_head_done();
sin6->sin6_addr.s6_addr16[1] = htons(zoneid & 0xffff);
sin6->sin6_scope_id = 0;
}
return 0;
}
void
rtkey_to_sa6(struct rtentry *rt, struct sockaddr_in6 *sin6)
{
VERIFY(rt_key(rt)->sa_family == AF_INET6);
*sin6 = *((struct sockaddr_in6 *)(void *)rt_key(rt));
sin6->sin6_scope_id = 0;
}
void
rtgw_to_sa6(struct rtentry *rt, struct sockaddr_in6 *sin6)
{
VERIFY(rt->rt_flags & RTF_GATEWAY);
*sin6 = *((struct sockaddr_in6 *)(void *)rt->rt_gateway);
sin6->sin6_scope_id = 0;
}
int
sa6_recoverscope(struct sockaddr_in6 *sin6, boolean_t attachcheck)
{
u_int32_t zoneid;
if (sin6->sin6_scope_id != 0) {
log(LOG_NOTICE,
"sa6_recoverscope: assumption failure (non 0 ID): %s%%%d\n",
ip6_sprintf(&sin6->sin6_addr), sin6->sin6_scope_id);
}
if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr) ||
IN6_IS_ADDR_MC_INTFACELOCAL(&sin6->sin6_addr)) {
zoneid = ntohs(sin6->sin6_addr.s6_addr16[1]);
if (zoneid) {
if (if_index < zoneid) {
return ENXIO;
}
if (attachcheck) {
ifnet_head_lock_shared();
if (ifindex2ifnet[zoneid] == NULL) {
ifnet_head_done();
return ENXIO;
}
ifnet_head_done();
}
sin6->sin6_addr.s6_addr16[1] = 0;
sin6->sin6_scope_id = zoneid;
}
}
return 0;
}
void
scope6_setdefault(struct ifnet *ifp)
{
lck_mtx_lock(&scope6_lock);
if (ifp != NULL) {
sid_default.s6id_list[IPV6_ADDR_SCOPE_INTFACELOCAL] =
ifp->if_index;
sid_default.s6id_list[IPV6_ADDR_SCOPE_LINKLOCAL] =
ifp->if_index;
} else {
sid_default.s6id_list[IPV6_ADDR_SCOPE_INTFACELOCAL] = 0;
sid_default.s6id_list[IPV6_ADDR_SCOPE_LINKLOCAL] = 0;
}
lck_mtx_unlock(&scope6_lock);
}
u_int32_t
scope6_addr2default(struct in6_addr *addr)
{
u_int32_t id = 0;
int index = in6_addrscope(addr);
if (IN6_IS_ADDR_LOOPBACK(addr)) {
return 0;
}
lck_mtx_lock(&scope6_lock);
id = sid_default.s6id_list[index];
lck_mtx_unlock(&scope6_lock);
return id;
}
int
in6_setscope(struct in6_addr *in6, struct ifnet *ifp, u_int32_t *ret_id)
{
int scope;
u_int32_t zoneid = 0;
struct scope6_id *sid;
if (IN6_IS_ADDR_LOOPBACK(in6)) {
if (!(ifp->if_flags & IFF_LOOPBACK)) {
return EINVAL;
} else {
if (ret_id != NULL) {
*ret_id = 0;
}
return 0;
}
}
scope = in6_addrscope(in6);
if_inet6data_lock_shared(ifp);
if (IN6_IFEXTRA(ifp) == NULL) {
if_inet6data_lock_done(ifp);
if (ret_id) {
*ret_id = 0;
}
return EINVAL;
}
sid = SID(ifp);
switch (scope) {
case IPV6_ADDR_SCOPE_INTFACELOCAL:
zoneid = sid->s6id_list[IPV6_ADDR_SCOPE_INTFACELOCAL];
break;
case IPV6_ADDR_SCOPE_LINKLOCAL:
zoneid = sid->s6id_list[IPV6_ADDR_SCOPE_LINKLOCAL];
break;
case IPV6_ADDR_SCOPE_SITELOCAL:
zoneid = sid->s6id_list[IPV6_ADDR_SCOPE_SITELOCAL];
break;
case IPV6_ADDR_SCOPE_ORGLOCAL:
zoneid = sid->s6id_list[IPV6_ADDR_SCOPE_ORGLOCAL];
break;
default:
zoneid = 0;
break;
}
if_inet6data_lock_done(ifp);
if (ret_id != NULL) {
*ret_id = zoneid;
}
if (IN6_IS_SCOPE_LINKLOCAL(in6) || IN6_IS_ADDR_MC_INTFACELOCAL(in6)) {
in6->s6_addr16[1] = htons(zoneid & 0xffff);
}
return 0;
}
int
in6_clearscope(struct in6_addr *in6)
{
int modified = 0;
if (IN6_IS_SCOPE_LINKLOCAL(in6) || IN6_IS_ADDR_MC_INTFACELOCAL(in6)) {
if (in6->s6_addr16[1] != 0) {
modified = 1;
}
in6->s6_addr16[1] = 0;
}
return modified;
}