#include "defs.h"
#include <netinet/in_systm.h>
#include <netinet/ip.h>
#include <netinet/ip_icmp.h>
#include <fcntl.h>
#include <strings.h>
#define CONTROL_BUFSIZE 1024
struct icmp_ad {
uint8_t icmp_type;
uint8_t icmp_code;
uint16_t icmp_cksum;
uint8_t icmp_ad_num;
uint8_t icmp_ad_asize;
uint16_t icmp_ad_life;
struct icmp_ad_info {
in_addr_t icmp_ad_addr;
uint32_t icmp_ad_pref;
} icmp_ad_info[1];
};
struct icmp_so {
uint8_t icmp_type;
uint8_t icmp_code;
uint16_t icmp_cksum;
uint32_t icmp_so_rsvd;
};
union ad_u {
struct icmp icmp;
struct icmp_ad ad;
struct icmp_so so;
};
int rdisc_sock = -1;
int rdisc_mib_sock = -1;
static struct interface *rdisc_sock_interface;
struct timeval rdisc_timer;
boolean_t rdisc_ok;
#define MAX_ADS 16
int max_ads;
static struct dr *cur_drp;
struct dr *drs;
#define PREF(p, ifp) ((p) <= (uint32_t)(ifp)->int_metric ? ((p) != 0 ? 1 : 0) \
: (p) - ((ifp)->int_metric))
static void rdisc_sort(void);
typedef enum { unicast, bcast, mcast } dstaddr_t;
static void
trace_rdisc(const char *act,
uint32_t from,
uint32_t to,
struct interface *ifp,
union ad_u *p,
uint_t len)
{
int i;
n_long *wp, *lim;
if (!TRACEPACKETS || ftrace == 0)
return;
lastlog();
if (p->icmp.icmp_type == ICMP_ROUTERADVERT) {
(void) fprintf(ftrace, "%s Router Ad"
" from %s to %s via %s life=%d\n",
act, naddr_ntoa(from), naddr_ntoa(to),
ifp ? ifp->int_name : "?",
ntohs(p->ad.icmp_ad_life));
if (!TRACECONTENTS)
return;
wp = &p->ad.icmp_ad_info[0].icmp_ad_addr;
lim = &wp[(len - sizeof (p->ad)) / sizeof (*wp)];
for (i = 0; i < p->ad.icmp_ad_num && wp <= lim; i++) {
(void) fprintf(ftrace, "\t%s preference=%ld",
naddr_ntoa(wp[0]), (long)ntohl(wp[1]));
wp += p->ad.icmp_ad_asize;
}
(void) fputc('\n', ftrace);
} else {
trace_act("%s Router Solic. from %s to %s via %s rsvd=%#x",
act, naddr_ntoa(from), naddr_ntoa(to),
ifp ? ifp->int_name : "?",
ntohl(p->so.icmp_so_rsvd));
}
}
static void
get_rdisc_sock(void)
{
int on = 1;
unsigned char ttl = 1;
struct sockaddr_un laddr;
int len;
if (rdisc_sock < 0) {
max_ads = MAX_ADS;
drs = rtmalloc(max_ads * sizeof (struct dr), "get_rdisc_sock");
(void) memset(drs, 0, max_ads * sizeof (struct dr));
rdisc_sock = socket(PF_INET, SOCK_RAW, IPPROTO_ICMP);
if (rdisc_sock < 0)
BADERR(_B_TRUE, "rdisc_sock = socket()");
fix_sock(rdisc_sock, "rdisc_sock");
if (setsockopt(rdisc_sock, IPPROTO_IP, IP_RECVIF, &on,
sizeof (on)))
BADERR(_B_FALSE, "setsockopt(IP_RECVIF)");
if (setsockopt(rdisc_sock, IPPROTO_IP, IP_MULTICAST_TTL,
&ttl, sizeof (ttl)) < 0)
DBGERR(_B_TRUE,
"rdisc_sock setsockopt(IP_MULTICAST_TTL)");
rdisc_mib_sock = socket(AF_UNIX, SOCK_DGRAM, 0);
if (rdisc_mib_sock < 0) {
BADERR(_B_TRUE, "rdisc_mib_sock = socket()");
}
bzero(&laddr, sizeof (laddr));
laddr.sun_family = AF_UNIX;
(void) strncpy(laddr.sun_path, RDISC_SNMP_SOCKET,
sizeof (laddr.sun_path));
len = sizeof (struct sockaddr_un);
(void) unlink(RDISC_SNMP_SOCKET);
if (bind(rdisc_mib_sock, (struct sockaddr *)&laddr, len) < 0) {
BADERR(_B_TRUE, "bind(rdisc_mib_sock)");
}
if (fcntl(rdisc_mib_sock, F_SETFL, O_NONBLOCK) < 0) {
BADERR(_B_TRUE, "rdisc_mib_sock fcntl O_NONBLOCK");
}
fix_select();
}
}
void
set_rdisc_mg(struct interface *ifp,
int on)
{
struct ip_mreq m;
boolean_t dosupply;
if (rdisc_sock < 0) {
if ((ifp->int_state & IS_NO_RDISC) == IS_NO_RDISC ||
!on)
return;
get_rdisc_sock();
}
if (!(ifp->int_if_flags & IFF_MULTICAST)) {
ifp->int_state &= ~(IS_ALL_HOSTS | IS_ALL_ROUTERS);
return;
}
dosupply = should_supply(ifp);
(void) memset(&m, 0, sizeof (m));
m.imr_interface.s_addr = ((ifp->int_if_flags & IFF_POINTOPOINT) &&
(ifp->int_dstaddr != 0) ? ifp->int_dstaddr : ifp->int_addr);
if (dosupply || (ifp->int_state & IS_NO_ADV_IN) || !on) {
if (ifp->int_state & IS_ALL_HOSTS) {
m.imr_multiaddr.s_addr = htonl(INADDR_ALLHOSTS_GROUP);
if (setsockopt(rdisc_sock, IPPROTO_IP,
IP_DROP_MEMBERSHIP, &m, sizeof (m)) < 0 &&
errno != EADDRNOTAVAIL && errno != ENOENT)
LOGERR("IP_DROP_MEMBERSHIP ALLHOSTS");
ifp->int_state &= ~IS_ALL_HOSTS;
}
} else if (!(ifp->int_state & IS_ALL_HOSTS)) {
m.imr_multiaddr.s_addr = htonl(INADDR_ALLHOSTS_GROUP);
if (setsockopt(rdisc_sock, IPPROTO_IP, IP_ADD_MEMBERSHIP,
&m, sizeof (m)) < 0) {
LOGERR("IP_ADD_MEMBERSHIP ALLHOSTS");
} else {
ifp->int_state |= IS_ALL_HOSTS;
}
}
if (!dosupply || (ifp->int_state & IS_NO_ADV_OUT) ||
!IS_IFF_ROUTING(ifp->int_if_flags) || !on) {
if (ifp->int_state & IS_ALL_ROUTERS) {
m.imr_multiaddr.s_addr = htonl(INADDR_ALLRTRS_GROUP);
if (setsockopt(rdisc_sock, IPPROTO_IP,
IP_DROP_MEMBERSHIP, &m, sizeof (m)) < 0 &&
errno != EADDRNOTAVAIL && errno != ENOENT)
LOGERR("IP_DROP_MEMBERSHIP ALLROUTERS");
ifp->int_state &= ~IS_ALL_ROUTERS;
}
} else if (!(ifp->int_state & IS_ALL_ROUTERS)) {
m.imr_multiaddr.s_addr = htonl(INADDR_ALLRTRS_GROUP);
if (setsockopt(rdisc_sock, IPPROTO_IP, IP_ADD_MEMBERSHIP,
&m, sizeof (m)) < 0) {
LOGERR("IP_ADD_MEMBERSHIP ALLROUTERS");
} else {
ifp->int_state |= IS_ALL_ROUTERS;
}
}
}
void
set_supplier(void)
{
struct interface *ifp;
struct dr *drp;
static boolean_t supplystate = _B_FALSE;
if (supplystate == (fwd_interfaces > 1))
return;
supplystate = fwd_interfaces > 1;
trace_act("%d forwarding interfaces present; becoming %ssupplier",
fwd_interfaces, supplystate ? "" : "non-");
if (supplystate) {
for (drp = drs; drp < &drs[max_ads]; drp++) {
drp->dr_recv_pref = DEF_PREFERENCELEVEL;
drp->dr_life = 0;
}
rdisc_age(0);
LIM_SEC(rdisc_timer, now.tv_sec+MIN_WAITTIME);
del_redirects(0, 0);
} else {
rdisc_adv(_B_TRUE);
}
for (ifp = ifnet; ifp; ifp = ifp->int_next) {
if (ifp->int_state & IS_BROKE)
continue;
ifp->int_rdisc_cnt = 0;
ifp->int_rdisc_timer.tv_usec = rdisc_timer.tv_usec;
ifp->int_rdisc_timer.tv_sec = now.tv_sec+MIN_WAITTIME;
set_rdisc_mg(ifp, 1);
}
}
void
rdisc_age(in_addr_t bad_gate)
{
time_t sec;
struct dr *drp;
struct rt_spare new;
struct rt_entry *rt;
if (bad_gate != 0) {
for (drp = drs; drp < &drs[max_ads]; drp++) {
if (drp->dr_ts == 0)
continue;
if (drp->dr_gate == bad_gate) {
sec = (now.tv_sec - drp->dr_life +
SUPPLY_INTERVAL);
if (drp->dr_ts > sec) {
trace_act("age 0.0.0.0 --> %s via %s",
naddr_ntoa(drp->dr_gate),
drp->dr_ifp->int_name);
drp->dr_ts = sec;
}
break;
}
}
} else if (should_supply(NULL)) {
if (cur_drp != NULL) {
rt = rtget(RIP_DEFAULT, 0);
if (rt == NULL) {
(void) memset(&new, 0, sizeof (new));
new.rts_ifp = cur_drp->dr_ifp;
new.rts_gate = cur_drp->dr_gate;
new.rts_router = cur_drp->dr_gate;
new.rts_metric = HOPCNT_INFINITY-1;
new.rts_time = now.tv_sec;
new.rts_origin = RO_RDISC;
rtadd(RIP_DEFAULT, 0, RS_NOPROPAGATE, &new);
}
rdisc_sort();
}
rdisc_adv(_B_FALSE);
}
rdisc_sol();
if (cur_drp != NULL) {
rt = rtget(RIP_DEFAULT, 0);
if (rt == NULL) {
(void) memset(&new, 0, sizeof (new));
new.rts_ifp = cur_drp->dr_ifp;
new.rts_gate = cur_drp->dr_gate;
new.rts_router = cur_drp->dr_gate;
new.rts_metric = HOPCNT_INFINITY-1;
new.rts_time = now.tv_sec;
new.rts_origin = RO_RDISC;
rtadd(RIP_DEFAULT, 0, RS_NOPROPAGATE, &new);
}
}
rdisc_sort();
if (rip_sock < 0 && bad_gate == 0)
age(0);
}
void
if_bad_rdisc(struct interface *ifp)
{
struct dr *drp;
for (drp = drs; drp < &drs[max_ads]; drp++) {
if (drp->dr_ifp != ifp)
continue;
(void) memset(drp, 0, sizeof (*drp));
}
rdisc_timer.tv_sec = 0;
}
void
if_rewire_rdisc(struct interface *oldifp, struct interface *newifp)
{
struct dr *drp;
for (drp = drs; drp < &drs[max_ads]; drp++) {
if (drp->dr_ifp != oldifp)
continue;
drp->dr_ifp = newifp;
drp->dr_pref += (newifp->int_metric - oldifp->int_metric);
drp->dr_flags |= DR_CHANGED;
}
rdisc_timer.tv_sec = 0;
}
void
if_ok_rdisc(struct interface *ifp)
{
set_rdisc_mg(ifp, 1);
ifp->int_rdisc_cnt = 0;
ifp->int_rdisc_timer.tv_sec = now.tv_sec +
((ifp->int_state & IS_NO_ADV_OUT) ?
MAX_SOLICITATION_DELAY : MIN_WAITTIME);
if (timercmp(&rdisc_timer, &ifp->int_rdisc_timer, > ))
rdisc_timer = ifp->int_rdisc_timer;
}
static void
del_rdisc(struct dr *drp)
{
struct interface *ifp;
uint32_t gate;
int i;
struct rt_entry *rt;
struct rt_spare *rts = NULL;
del_redirects(gate = drp->dr_gate, 0);
drp->dr_ts = 0;
drp->dr_life = 0;
rt = rtget(RIP_DEFAULT, 0);
if (rt == NULL) {
trace_act("could not find default route in table");
} else {
for (i = 0; i < rt->rt_num_spares; i++) {
if ((rt->rt_spares[i].rts_gate == drp->dr_gate) &&
(rt->rt_spares[i].rts_origin == RO_RDISC)) {
rts = &rt->rt_spares[i];
break;
}
}
if (rts != NULL)
rts_delete(rt, rts);
else
trace_act("could not find default route "
"through %s in table", naddr_ntoa(drp->dr_gate));
}
i = 0;
ifp = drp->dr_ifp;
for (drp = drs; drp < &drs[max_ads]; drp++) {
if (drp->dr_ts != 0 && drp->dr_ifp == ifp)
i++;
}
if (i != 0) {
trace_act("discovered router %s via %s"
" is bad--have %d remaining",
naddr_ntoa(gate), ifp->int_name, i);
} else if (ifp->int_rdisc_cnt >= MAX_SOLICITATIONS) {
trace_act("last discovered router %s via %s"
" is bad--re-solicit",
naddr_ntoa(gate), ifp->int_name);
ifp->int_rdisc_cnt = 0;
ifp->int_rdisc_timer.tv_sec = 0;
rdisc_sol();
} else {
trace_act("last discovered router %s via %s"
" is bad--wait to solicit",
naddr_ntoa(gate), ifp->int_name);
}
}
static void
rdisc_sort(void)
{
struct dr *drp, *new_drp;
struct rt_entry *rt;
struct rt_spare new, *rts;
struct interface *ifp;
uint_t new_st = 0;
uint32_t new_pref = DEF_PREFERENCELEVEL;
int first_rdisc_slot = 0;
int j;
boolean_t spares_avail;
void *ptr;
size_t ptrsize;
rt = rtget(RIP_DEFAULT, 0);
if (rt != NULL) {
spares_avail = _B_FALSE;
for (j = 0; j < rt->rt_num_spares; j++) {
rts = &rt->rt_spares[j];
if (rts->rts_gate == 0 || rts->rts_origin != RO_RIP ||
rts->rts_ifp == &dummy_ifp) {
spares_avail = _B_TRUE;
break;
}
}
if (!spares_avail) {
ptrsize = (rt->rt_num_spares + SPARE_INC) *
sizeof (struct rt_spare);
ptr = realloc(rt->rt_spares, ptrsize);
if (ptr != NULL) {
struct rt_spare *tmprts;
rt->rt_spares = ptr;
rts = &rt->rt_spares[rt->rt_num_spares];
(void) memset(rts, 0,
(SPARE_INC * sizeof (struct rt_spare)));
rt->rt_num_spares += SPARE_INC;
for (tmprts = rts, j = SPARE_INC;
j != 0; j--, tmprts++)
tmprts->rts_metric = HOPCNT_INFINITY;
spares_avail = _B_TRUE;
} else {
return;
}
}
}
rt = NULL;
new_drp = NULL;
for (drp = drs; drp < &drs[max_ads]; drp++) {
if (drp->dr_ts == 0)
continue;
ifp = drp->dr_ifp;
if (drp->dr_ts + drp->dr_life <= now.tv_sec) {
del_rdisc(drp);
continue;
}
LIM_SEC(rdisc_timer, drp->dr_ts+drp->dr_life);
drp->dr_pref = PREF(drp->dr_recv_pref, ifp);
if (new_drp == NULL ||
(!((new_st ^ drp->dr_ifp->int_state) & IS_SICK) &&
(new_pref < drp->dr_pref ||
(new_pref == drp->dr_pref && (drp == cur_drp ||
(new_drp != cur_drp &&
new_drp->dr_life > drp->dr_life))))) ||
((new_st & IS_SICK) &&
!(drp->dr_ifp->int_state & IS_SICK))) {
new_drp = drp;
new_st = drp->dr_ifp->int_state;
new_pref = drp->dr_pref;
}
}
if ((new_drp != cur_drp) || (rt == NULL)) {
rt = rtget(RIP_DEFAULT, 0);
if (rt != NULL) {
int i;
for (i = 0; i < rt->rt_num_spares; i++) {
rts = &rt->rt_spares[i];
if ((rts->rts_gate == 0 ||
rts->rts_ifp == &dummy_ifp) &&
first_rdisc_slot == 0)
first_rdisc_slot = i;
if (rts->rts_origin == RO_RDISC) {
rts_delete(rt, rts);
if (first_rdisc_slot == 0) {
first_rdisc_slot = i;
}
}
}
}
if (new_drp == NULL) {
trace_act("turn off Router Discovery client");
rdisc_ok = _B_FALSE;
} else {
if (cur_drp == NULL) {
trace_act("turn on Router Discovery client"
" using %s via %s",
naddr_ntoa(new_drp->dr_gate),
new_drp->dr_ifp->int_name);
rdisc_ok = _B_TRUE;
}
(void) memset(&new, 0, sizeof (new));
new.rts_ifp = new_drp->dr_ifp;
new.rts_gate = new_drp->dr_gate;
new.rts_router = new_drp->dr_gate;
new.rts_metric = HOPCNT_INFINITY-1;
new.rts_time = now.tv_sec;
new.rts_origin = RO_RDISC;
if (rt == NULL) {
rtadd(RIP_DEFAULT, 0, RS_NOPROPAGATE, &new);
} else {
trace_act("Switching to "
"default router with better "
"preference %s via %s ",
naddr_ntoa(new_drp->dr_gate),
new_drp->dr_ifp->int_name);
rt->rt_spares[first_rdisc_slot] = new;
rt = NULL;
}
}
cur_drp = new_drp;
}
if (rdisc_ok && rt == NULL) {
int i;
rt = rtget(RIP_DEFAULT, 0);
for (drp = drs; drp < &drs[max_ads]; drp++) {
boolean_t dr_done = _B_FALSE;
int slot = -1;
if (drp->dr_ts == 0)
continue;
if (drp->dr_pref != cur_drp->dr_pref &&
((drp->dr_flags & DR_CHANGED) == 0))
continue;
for (i = 0; i < rt->rt_num_spares; i++) {
if (rt->rt_spares[i].rts_gate == 0) {
if (slot < 0)
slot = i;
continue;
}
if ((rt->rt_spares[i].rts_gate ==
drp->dr_gate) &&
(rt->rt_spares[i].rts_origin ==
RO_RDISC)) {
dr_done = _B_TRUE;
break;
}
}
drp->dr_flags &= ~DR_CHANGED;
if (drp->dr_pref != cur_drp->dr_pref) {
if (dr_done) {
rts_delete(rt, &rt->rt_spares[i]);
}
continue;
}
if (slot < 0 && !dr_done) {
ptrsize = (rt->rt_num_spares + SPARE_INC) *
sizeof (struct rt_spare);
ptr = realloc(rt->rt_spares, ptrsize);
if (ptr != NULL) {
struct rt_spare *tmprts;
rt->rt_spares = ptr;
slot = rt->rt_num_spares;
rts = &rt->rt_spares[rt->rt_num_spares];
(void) memset(rts, 0, (SPARE_INC *
sizeof (struct rt_spare)));
rt->rt_num_spares += SPARE_INC;
for (tmprts = rts, i = SPARE_INC;
i != 0; i--, tmprts++)
tmprts->rts_metric =
HOPCNT_INFINITY;
}
}
if (slot >= 0 && (dr_done != _B_TRUE)) {
(void) memset(&new, 0, sizeof (new));
new.rts_ifp = drp->dr_ifp;
new.rts_gate = drp->dr_gate;
new.rts_router = drp->dr_gate;
new.rts_metric = HOPCNT_INFINITY-1;
new.rts_time = now.tv_sec;
new.rts_origin = RO_RDISC;
rt->rt_spares[slot] = new;
trace_act("spare default %s via %s",
naddr_ntoa(drp->dr_gate),
drp->dr_ifp->int_name);
}
}
}
if (!rdisc_ok || rip_interfaces > 1) {
rip_on(0);
} else {
rip_off();
}
}
static void
parse_ad(uint32_t from,
in_addr_t gate,
uint32_t pref,
ushort_t life,
struct interface *ifp)
{
static struct msg_limit bad_gate;
struct dr *drp, *new_drp;
void *ptr;
size_t ptrsize;
if (gate == RIP_DEFAULT || !check_dst(gate)) {
msglim(&bad_gate, from, "router %s advertising bad gateway %s",
naddr_ntoa(from), naddr_ntoa(gate));
return;
}
if (ifwithaddr(gate, _B_TRUE, _B_FALSE) != 0) {
trace_pkt(" discard Router Discovery Ad pointing at us");
return;
}
if (!on_net(gate, ifp->int_net, ifp->int_mask)) {
trace_pkt(" discard Router Discovery Ad"
" toward unreachable net");
return;
}
pref = UNSIGN_PREF(ntohl(pref));
if (pref == DEF_PREFERENCELEVEL || life < MIN_MAXADVERTISEINTERVAL) {
pref = DEF_PREFERENCELEVEL;
life = 0;
}
for (new_drp = NULL, drp = drs; drp < &drs[max_ads]; drp++) {
if ((drp->dr_gate == gate) && (drp->dr_ifp == ifp)) {
new_drp = drp;
drp->dr_flags |= DR_CHANGED;
break;
}
if (life == 0)
continue;
if (drp->dr_ts == 0) {
new_drp = drp;
} else if (new_drp == NULL) {
if ((!(ifp->int_state & IS_SICK) &&
(drp->dr_ifp->int_state & IS_SICK)) ||
(pref > drp->dr_pref &&
!((ifp->int_state ^ drp->dr_ifp->int_state) &
IS_SICK)))
new_drp = drp;
} else if (new_drp->dr_ts != 0) {
if ((!(new_drp->dr_ifp->int_state & IS_SICK) &&
(drp->dr_ifp->int_state & IS_SICK)) ||
(new_drp->dr_pref > drp->dr_pref &&
!((new_drp->dr_ifp->int_state ^
drp->dr_ifp->int_state) & IS_SICK)))
new_drp = drp;
}
}
if (new_drp == NULL) {
ptrsize = (max_ads + MAX_ADS) * sizeof (struct dr);
ptr = realloc(drs, ptrsize);
if (ptr == NULL)
return;
drs = ptr;
(void) memset(&drs[max_ads], 0, MAX_ADS * sizeof (struct dr));
new_drp = &drs[max_ads];
max_ads += MAX_ADS;
}
new_drp->dr_ifp = ifp;
new_drp->dr_gate = gate;
new_drp->dr_ts = now.tv_sec;
new_drp->dr_life = life;
new_drp->dr_recv_pref = pref;
new_drp->dr_pref = PREF(pref, ifp);
if (!(ifp->int_state & IS_SICK))
ifp->int_rdisc_cnt = MAX_SOLICITATIONS;
}
static uint16_t
in_cksum(uint16_t *p, uint_t len)
{
uint32_t sum = 0;
int nwords = len >> 1;
while (nwords-- != 0)
sum += *p++;
if (len & 1)
sum += *(uchar_t *)p;
sum = (sum >> 16) + (sum & 0xffff);
sum += (sum >> 16);
return (~sum);
}
static void
send_rdisc(union ad_u *p,
uint_t p_size,
struct interface *ifp,
in_addr_t dst,
dstaddr_t type)
{
struct sockaddr_in sin;
int flags = 0;
const char *msg;
int ifindex = 0;
struct in_addr addr;
if (ifp->int_state & IS_DUP)
return;
(void) memset(&sin, 0, sizeof (sin));
sin.sin_addr.s_addr = dst;
sin.sin_family = AF_INET;
switch (type) {
case unicast:
default:
flags = MSG_DONTROUTE;
msg = "Send";
break;
case bcast:
if (ifp->int_if_flags & IFF_POINTOPOINT) {
msg = "Send pt-to-pt";
if (ifp->int_dstaddr == 0)
sin.sin_addr.s_addr = htonl(INADDR_BROADCAST);
else
sin.sin_addr.s_addr = ifp->int_dstaddr;
} else {
msg = "Send broadcast";
sin.sin_addr.s_addr = ifp->int_brdaddr;
}
break;
case mcast:
msg = "Send multicast";
break;
}
if (rdisc_sock < 0)
get_rdisc_sock();
ifindex = (type != mcast && ifp->int_phys != NULL) ?
ifp->int_phys->phyi_index : 0;
if (rdisc_sock_interface != ifp) {
addr.s_addr = (ifp->int_if_flags & IFF_POINTOPOINT) ?
ifp->int_dstaddr : ifp->int_addr;
if (type == mcast &&
setsockopt(rdisc_sock, IPPROTO_IP, IP_MULTICAST_IF, &addr,
sizeof (addr)) == -1) {
LOGERR("setsockopt(rdisc_sock, IP_MULTICAST_IF)");
return;
}
rdisc_sock_interface = ifp;
}
trace_rdisc(msg, ifp->int_addr, sin.sin_addr.s_addr, ifp, p, p_size);
if (0 > sendtoif(rdisc_sock, p, p_size, flags, &sin, ifindex)) {
if (!(ifp->int_state & IS_BROKE))
writelog(LOG_WARNING, "sendto(%s%s%s): %s",
ifp->int_name, ", ",
inet_ntoa(sin.sin_addr),
rip_strerror(errno));
if (ifp != NULL)
if_sick(ifp, _B_FALSE);
}
}
static void
send_adv(struct interface *ifp,
in_addr_t dst,
dstaddr_t type)
{
union ad_u u;
if ((ifp->int_state & (IS_SUPPRESS_RDISC|IS_FLUSH_RDISC)) ==
IS_SUPPRESS_RDISC)
return;
(void) memset(&u, 0, sizeof (u.ad));
u.ad.icmp_type = ICMP_ROUTERADVERT;
u.ad.icmp_code = ICMP_ROUTERADVERT_COMMON;
u.ad.icmp_ad_num = 1;
u.ad.icmp_ad_asize = sizeof (u.ad.icmp_ad_info[0])/4;
u.ad.icmp_ad_life = (stopint || !should_supply(ifp) ||
(ifp->int_state & IS_SUPPRESS_RDISC)) ? 0 :
htons(ifp->int_rdisc_int*3);
u.ad.icmp_ad_info[0].icmp_ad_pref = htonl(ifp->int_rdisc_pref);
u.ad.icmp_ad_info[0].icmp_ad_addr = ifp->int_addr;
u.ad.icmp_cksum = in_cksum((uint16_t *)&u.ad, sizeof (u.ad));
send_rdisc(&u, sizeof (u.ad), ifp, dst, type);
if (ifp->int_state & IS_SUPPRESS_RDISC)
ifp->int_state &= ~IS_FLUSH_RDISC;
}
void
rdisc_adv(boolean_t forceadv)
{
struct interface *ifp;
if (!forceadv && !should_supply(NULL))
return;
rdisc_timer.tv_sec = now.tv_sec + NEVER;
for (ifp = ifnet; ifp; ifp = ifp->int_next) {
if ((ifp->int_state & (IS_NO_ADV_OUT | IS_BROKE)) ||
(!forceadv && !IS_IFF_ROUTING(ifp->int_if_flags)))
continue;
if (IS_IFF_QUIET(ifp->int_if_flags))
continue;
if (!timercmp(&ifp->int_rdisc_timer, &now, > ) ||
stopint != 0 || forceadv) {
send_adv(ifp, htonl(INADDR_ALLHOSTS_GROUP),
(ifp->int_state & IS_BCAST_RDISC) ? 1 : 2);
ifp->int_rdisc_cnt++;
intvl_random(&ifp->int_rdisc_timer,
(ifp->int_rdisc_int*3)/4, ifp->int_rdisc_int);
if (ifp->int_rdisc_cnt < MAX_INITIAL_ADVERTS &&
(ifp->int_rdisc_timer.tv_sec >
MAX_INITIAL_ADVERT_INTERVAL)) {
ifp->int_rdisc_timer.tv_sec =
MAX_INITIAL_ADVERT_INTERVAL;
}
timevaladd(&ifp->int_rdisc_timer, &now);
}
if (timercmp(&rdisc_timer, &ifp->int_rdisc_timer,
> ))
rdisc_timer = ifp->int_rdisc_timer;
}
}
void
rdisc_sol(void)
{
struct interface *ifp;
union ad_u u;
if (should_supply(NULL))
return;
rdisc_timer.tv_sec = now.tv_sec + NEVER;
for (ifp = ifnet; ifp; ifp = ifp->int_next) {
if (0 != (ifp->int_state & (IS_NO_SOL_OUT | IS_BROKE)) ||
ifp->int_rdisc_cnt >= MAX_SOLICITATIONS)
continue;
if (IS_IFF_QUIET(ifp->int_if_flags))
continue;
if (!timercmp(&ifp->int_rdisc_timer, &now, > )) {
(void) memset(&u, 0, sizeof (u.so));
u.so.icmp_type = ICMP_ROUTERSOLICIT;
u.so.icmp_cksum = in_cksum((uint16_t *)&u.so,
sizeof (u.so));
send_rdisc(&u, sizeof (u.so), ifp,
htonl(INADDR_ALLRTRS_GROUP),
((ifp->int_state&IS_BCAST_RDISC) ? bcast : mcast));
if (++ifp->int_rdisc_cnt >= MAX_SOLICITATIONS)
continue;
ifp->int_rdisc_timer.tv_sec = SOLICITATION_INTERVAL;
ifp->int_rdisc_timer.tv_usec = 0;
timevaladd(&ifp->int_rdisc_timer, &now);
}
if (timercmp(&rdisc_timer, &ifp->int_rdisc_timer,
> ))
rdisc_timer = ifp->int_rdisc_timer;
}
}
static struct interface *
ck_icmp(const char *act,
in_addr_t from,
struct interface *ifp,
in_addr_t to,
union ad_u *p,
uint_t len)
{
const char *type;
if (p->icmp.icmp_type == ICMP_ROUTERADVERT) {
type = "advertisement";
if (p->icmp.icmp_code == ICMP_ROUTERADVERT_NOCOMMON)
return (NULL);
} else if (p->icmp.icmp_type == ICMP_ROUTERSOLICIT) {
type = "solicitation";
} else {
return (NULL);
}
if (p->icmp.icmp_code != ICMP_ROUTERADVERT_COMMON) {
trace_pkt("unrecognized ICMP Router %s code=%d from %s to %s",
type, p->icmp.icmp_code, naddr_ntoa(from), naddr_ntoa(to));
return (NULL);
}
trace_rdisc(act, from, to, ifp, p, len);
if (ifp == NULL)
trace_pkt("unknown interface for router-discovery %s from %s "
"to %s", type, naddr_ntoa(from), naddr_ntoa(to));
return (ifp);
}
void
read_d(void)
{
#define PKTLEN 512
static struct msg_limit bad_asize, bad_len;
struct sockaddr_in from;
int n, cc, hlen;
struct {
union {
struct ip ip;
uint16_t s[PKTLEN/sizeof (uint16_t)];
uint8_t b[PKTLEN/sizeof (uint8_t)];
} pkt;
} buf;
union ad_u *p;
n_long *wp;
struct interface *ifp;
boolean_t needsort = _B_FALSE;
struct msghdr msg;
struct iovec iov;
uint8_t ancillary_data[CONTROL_BUFSIZE];
iov.iov_base = &buf;
iov.iov_len = sizeof (buf);
msg.msg_iov = &iov;
msg.msg_iovlen = 1;
msg.msg_name = &from;
msg.msg_control = &ancillary_data;
for (;;) {
msg.msg_namelen = sizeof (from);
msg.msg_controllen = sizeof (ancillary_data);
cc = recvmsg(rdisc_sock, &msg, 0);
if (cc <= 0) {
if (cc < 0 && errno != EWOULDBLOCK)
LOGERR("recvmsg(rdisc_sock)");
break;
}
hlen = buf.pkt.ip.ip_hl << 2;
if (cc < hlen + ICMP_MINLEN)
continue;
p = (union ad_u *)&buf.pkt.b[hlen];
cc -= hlen;
ifp = receiving_interface(&msg, _B_FALSE);
ifp = ck_icmp("Recv", from.sin_addr.s_addr, ifp,
buf.pkt.ip.ip_dst.s_addr, p, cc);
if (ifp == NULL)
continue;
if (IS_IFF_QUIET(ifp->int_if_flags)) {
trace_misc("discard RDISC packet received over %s, %X",
ifp->int_name, ifp->int_if_flags);
continue;
}
if (from.sin_addr.s_addr != 0 &&
ifwithaddr(from.sin_addr.s_addr, _B_FALSE, _B_FALSE)) {
trace_pkt(" "
"discard our own Router Discovery message");
continue;
}
if (!remote_address_ok(ifp, from.sin_addr.s_addr)) {
trace_misc("discard rdisc message; source %s not on "
"interface %s", naddr_ntoa(from.sin_addr.s_addr),
ifp->int_name);
continue;
}
switch (p->icmp.icmp_type) {
case ICMP_ROUTERADVERT:
if (ifp->int_state & IS_NO_ADV_IN)
continue;
if (p->ad.icmp_ad_asize*2*sizeof (wp[0]) <
sizeof (p->ad.icmp_ad_info[0])) {
msglim(&bad_asize, from.sin_addr.s_addr,
"intolerable rdisc address size=%d",
p->ad.icmp_ad_asize);
continue;
}
if (p->ad.icmp_ad_num == 0) {
trace_pkt(" empty?");
continue;
}
if (cc < (sizeof (p->ad) -
sizeof (p->ad.icmp_ad_info) +
(p->ad.icmp_ad_num *
sizeof (p->ad.icmp_ad_info[0])))) {
msglim(&bad_len, from.sin_addr.s_addr,
"rdisc length %d does not match ad_num"
" %d", cc, p->ad.icmp_ad_num);
continue;
}
needsort = _B_TRUE;
wp = &p->ad.icmp_ad_info[0].icmp_ad_addr;
for (n = 0; n < p->ad.icmp_ad_num; n++) {
parse_ad(from.sin_addr.s_addr,
wp[0], wp[1],
ntohs(p->ad.icmp_ad_life), ifp);
wp += p->ad.icmp_ad_asize;
}
break;
case ICMP_ROUTERSOLICIT:
if (!should_supply(ifp))
continue;
if ((ifp->int_state & IS_NO_ADV_OUT) ||
!IS_IFF_ROUTING(ifp->int_if_flags))
continue;
if (stopint != 0)
continue;
send_adv(ifp, from.sin_addr.s_addr, 0);
break;
}
}
if (needsort)
rdisc_sort();
}
void
rdisc_dump(void)
{
struct dr *drp;
for (drp = drs; drp < &drs[max_ads]; drp++)
if (drp->dr_ts != 0)
trace_dr(drp);
}
void
rdisc_suppress(struct interface *ifp)
{
if (ifp->int_state & IS_ADV_OUT) {
msglog("%s \"rdisc_adv\" specified, will not "
"suppress rdisc adv", ifp->int_name);
} else {
if (ifp->int_state & IS_SUPPRESS_RDISC)
return;
ifp->int_state |= (IS_SUPPRESS_RDISC|IS_FLUSH_RDISC);
trace_misc("suppress rdisc adv on %s", ifp->int_name);
rdisc_timer.tv_sec = 0;
}
}
void
rdisc_restore(struct interface *ifp)
{
if ((ifp->int_state & IS_SUPPRESS_RDISC) == 0)
return;
ifp->int_state &= ~(IS_SUPPRESS_RDISC|IS_FLUSH_RDISC);
trace_misc("restoring rdisc adv on %s", ifp->int_name);
rdisc_timer.tv_sec = 0;
}
void
process_d_mib_sock(void)
{
socklen_t fromlen;
struct sockaddr_un from;
ssize_t len;
int command;
struct dr *drp;
rdisc_info_t rdisc_info;
defr_t def_router;
extern int max_ads;
int num = 0;
fromlen = (socklen_t)sizeof (from);
len = recvfrom(rdisc_mib_sock, &command, sizeof (int), 0,
(struct sockaddr *)&from, &fromlen);
if (len < sizeof (int) || command != RDISC_SNMP_INFO_REQ) {
trace_misc("Bad command on rdisc_mib_sock");
return;
}
for (drp = drs; drp < &drs[max_ads]; drp++) {
if (drp->dr_ts != 0) {
num++;
}
}
rdisc_info.info_type = RDISC_SNMP_INFO_RESPONSE;
rdisc_info.info_version = RDISC_SNMP_INFO_VER;
rdisc_info.info_num_of_routers = num;
(void) sendto(rdisc_mib_sock, &rdisc_info, sizeof (rdisc_info_t), 0,
(struct sockaddr *)&from, fromlen);
for (drp = drs; drp < &drs[max_ads]; drp++) {
if (drp->dr_ts != 0) {
def_router.defr_info_type = RDISC_DEF_ROUTER_INFO;
def_router.defr_version = RDISC_DEF_ROUTER_VER;
def_router.defr_index =
drp->dr_ifp->int_phys->phyi_index;
def_router.defr_life = drp->dr_life;
def_router.defr_addr.s_addr = drp->dr_gate;
def_router.defr_pref = drp->dr_pref;
(void) sendto(rdisc_mib_sock, &def_router,
sizeof (defr_t), 0, (struct sockaddr *)&from,
fromlen);
}
}
}