#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>
struct scope6_id {
u_int32_t s6id_list[16];
};
static size_t if_indexlim = 8;
struct scope6_id *scope6_ids = NULL;
void
scope6_ifattach(ifp)
struct ifnet *ifp;
{
int s = splnet();
if (scope6_ids == NULL || if_index >= if_indexlim) {
size_t n;
caddr_t q;
while (if_index >= if_indexlim)
if_indexlim <<= 1;
n = if_indexlim * sizeof(struct scope6_id);
q = (caddr_t)_MALLOC(n, M_IFADDR, M_WAITOK);
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]) {
splx(s);
return;
}
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
splx(s);
}
int
scope6_set(ifp, idlist)
struct ifnet *ifp;
u_int32_t *idlist;
{
int i, s;
int error = 0;
if (scope6_ids == NULL)
return(EINVAL);
s = splnet();
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) {
splx(s);
return(EINVAL);
}
scope6_ids[ifp->if_index].s6id_list[i] = idlist[i];
}
}
splx(s);
return(error);
}
int
scope6_get(ifp, idlist)
struct ifnet *ifp;
u_int32_t *idlist;
{
if (scope6_ids == NULL)
return(EINVAL);
bcopy(scope6_ids[ifp->if_index].s6id_list, idlist,
sizeof(scope6_ids[ifp->if_index].s6id_list));
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(ifp, addr)
struct ifnet *ifp;
struct in6_addr *addr;
{
int scope = in6_addrscope(addr);
if (scope6_ids == NULL)
return(0);
if (ifp->if_index >= if_indexlim)
return(0);
#define SID scope6_ids[ifp->if_index]
switch(scope) {
case IPV6_ADDR_SCOPE_NODELOCAL:
return(-1);
case IPV6_ADDR_SCOPE_LINKLOCAL:
return(SID.s6id_list[IPV6_ADDR_SCOPE_LINKLOCAL]);
case IPV6_ADDR_SCOPE_SITELOCAL:
return(SID.s6id_list[IPV6_ADDR_SCOPE_SITELOCAL]);
case IPV6_ADDR_SCOPE_ORGLOCAL:
return(SID.s6id_list[IPV6_ADDR_SCOPE_ORGLOCAL]);
default:
return(0);
}
#undef SID
}
void
scope6_setdefault(ifp)
struct ifnet *ifp;
{
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;
}
int
scope6_get_default(idlist)
u_int32_t *idlist;
{
if (scope6_ids == NULL)
return(EINVAL);
bcopy(scope6_ids[0].s6id_list, idlist,
sizeof(scope6_ids[0].s6id_list));
return(0);
}
u_int32_t
scope6_addr2default(addr)
struct in6_addr *addr;
{
return(scope6_ids[0].s6id_list[in6_addrscope(addr)]);
}