#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 <net/route.h>
#include <net/if.h>
#include <netinet/in.h>
#include <netinet6/in6_var.h>
#include <netinet6/scope6_var.h>
extern lck_mtx_t *scope6_mutex;
struct scope6_id {
u_int32_t s6id_list[16];
};
static size_t if_scope_indexlim = 8;
struct scope6_id *scope6_ids = NULL;
int
scope6_ifattach(
struct ifnet *ifp)
{
lck_mtx_lock(scope6_mutex);
if (scope6_ids == NULL || if_index >= if_scope_indexlim) {
size_t n;
caddr_t q;
int newlim = if_scope_indexlim;
while (if_index >= newlim)
newlim <<= 1;
n = newlim * sizeof(struct scope6_id);
q = (caddr_t)_MALLOC(n, M_IFADDR, M_WAITOK);
if (q == NULL) {
lck_mtx_unlock(scope6_mutex);
return ENOBUFS;
}
if_scope_indexlim = newlim;
bzero(q, n);
if (scope6_ids) {
bcopy((caddr_t)scope6_ids, q, n/2);
FREE((caddr_t)scope6_ids, M_IFADDR);
}
scope6_ids = (struct scope6_id *)q;
}
#define SID scope6_ids[ifp->if_index]
if (SID.s6id_list[IPV6_ADDR_SCOPE_LINKLOCAL]) {
lck_mtx_unlock(scope6_mutex);
return 0;
}
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
#undef SID
lck_mtx_unlock(scope6_mutex);
return 0;
}
int
scope6_set(
struct ifnet *ifp,
u_int32_t *idlist)
{
int i;
int error = 0;
if (scope6_ids == NULL)
return(EINVAL);
lck_mtx_lock(scope6_mutex);
for (i = 0; i < 16; i++) {
if (idlist[i] &&
idlist[i] != scope6_ids[ifp->if_index].s6id_list[i]) {
if (i == IPV6_ADDR_SCOPE_LINKLOCAL &&
idlist[i] > if_index) {
lck_mtx_unlock(scope6_mutex);
return(EINVAL);
}
scope6_ids[ifp->if_index].s6id_list[i] = idlist[i];
}
}
lck_mtx_unlock(scope6_mutex);
return(error);
}
int
scope6_get(
struct ifnet *ifp,
u_int32_t *idlist)
{
if (scope6_ids == NULL)
return(EINVAL);
lck_mtx_lock(scope6_mutex);
bcopy(scope6_ids[ifp->if_index].s6id_list, idlist,
sizeof(scope6_ids[ifp->if_index].s6id_list));
lck_mtx_unlock(scope6_mutex);
return(0);
}
int
in6_addrscope(addr)
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;
break;
case 0xc0:
return IPV6_ADDR_SCOPE_SITELOCAL;
break;
default:
return IPV6_ADDR_SCOPE_GLOBAL;
break;
}
}
if (addr->s6_addr8[0] == 0xff) {
scope = addr->s6_addr8[1] & 0x0f;
switch (scope) {
case IPV6_ADDR_SCOPE_NODELOCAL:
return IPV6_ADDR_SCOPE_NODELOCAL;
break;
case IPV6_ADDR_SCOPE_LINKLOCAL:
return IPV6_ADDR_SCOPE_LINKLOCAL;
break;
case IPV6_ADDR_SCOPE_SITELOCAL:
return IPV6_ADDR_SCOPE_SITELOCAL;
break;
default:
return IPV6_ADDR_SCOPE_GLOBAL;
break;
}
}
if (bcmp(&in6addr_loopback, addr, sizeof(*addr) - 1) == 0) {
if (addr->s6_addr8[15] == 1)
return IPV6_ADDR_SCOPE_NODELOCAL;
if (addr->s6_addr8[15] == 0)
return IPV6_ADDR_SCOPE_LINKLOCAL;
}
return IPV6_ADDR_SCOPE_GLOBAL;
}
int
in6_addr2scopeid(
struct ifnet *ifp,
struct in6_addr *addr)
{
int scope = in6_addrscope(addr);
int index = ifp->if_index;
int retid = 0;
if (scope6_ids == NULL)
return(0);
lck_mtx_lock(scope6_mutex);
if (index >= if_scope_indexlim) {
lck_mtx_unlock(scope6_mutex);
return(0);
}
#define SID scope6_ids[index]
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;
}
#undef SID
lck_mtx_unlock(scope6_mutex);
return retid;
}
void
scope6_setdefault(
struct ifnet *ifp)
{
lck_mtx_lock(scope6_mutex);
if (ifp) {
scope6_ids[0].s6id_list[IPV6_ADDR_SCOPE_LINKLOCAL] =
ifp->if_index;
}
else
scope6_ids[0].s6id_list[IPV6_ADDR_SCOPE_LINKLOCAL] = 0;
lck_mtx_unlock(scope6_mutex);
}
int
scope6_get_default(
u_int32_t *idlist)
{
if (scope6_ids == NULL)
return(EINVAL);
lck_mtx_lock(scope6_mutex);
bcopy(scope6_ids[0].s6id_list, idlist,
sizeof(scope6_ids[0].s6id_list));
lck_mtx_unlock(scope6_mutex);
return(0);
}
u_int32_t
scope6_addr2default(
struct in6_addr *addr)
{
u_int32_t id = 0;
int index = in6_addrscope(addr);
lck_mtx_lock(scope6_mutex);
id = scope6_ids[0].s6id_list[index];
lck_mtx_unlock(scope6_mutex);
return (id);
}