Ensure signal-safety of signal handlers

[odhcp6c.git] / src / ra.c

diff --git a/src/ra.c b/src/ra.c
index d048e85d0419b67205c8203a4e10fff3f4f8da10..9c5eb220897552b629e66df8fb5bb3d7eda2ff6a 100644 (file)
--- a/src/ra.c
+++ b/src/ra.c
@@ -1,5 +1,5 @@
 /**
- * Copyright (C) 2012-2013 Steven Barth <steven@midlink.org>
+ * Copyright (C) 2012-2014 Steven Barth <steven@midlink.org>
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License v2 as published by
@@ -55,6 +55,15 @@ static char if_name[IF_NAMESIZE] = {0};
 static volatile int rs_attempt = 0;
 static struct in6_addr lladdr = IN6ADDR_ANY_INIT;
 
+struct {
+       struct icmp6_hdr hdr;
+       struct icmpv6_opt lladdr;
+} rs = {
+       .hdr = {ND_ROUTER_SOLICIT, 0, 0, {{0}}},
+       .lladdr = {ND_OPT_SOURCE_LINKADDR, 1, {0}},
+};
+
+
 static void ra_send_rs(int signal __attribute__((unused)));
 
 int ra_init(const char *ifname, const struct in6_addr *ifid)
@@ -92,6 +101,7 @@ int ra_init(const char *ifname, const struct in6_addr *ifid)
                .ifi = {.ifi_index = if_index}
        };
        send(rtnl, &req, sizeof(req), 0);
+       ra_link_up();
 
        // Filter ICMPv6 package types
        struct icmp6_filter filt;
@@ -132,9 +142,16 @@ int ra_init(const char *ifname, const struct in6_addr *ifid)
 
 static void ra_send_rs(int signal __attribute__((unused)))
 {
-       const struct icmp6_hdr rs = {ND_ROUTER_SOLICIT, 0, 0, {{0}}};
        const struct sockaddr_in6 dest = {AF_INET6, 0, 0, ALL_IPV6_ROUTERS, if_index};
-       sendto(sock, &rs, sizeof(rs), MSG_DONTWAIT, (struct sockaddr*)&dest, sizeof(dest));
+       const struct icmpv6_opt llnull = {ND_OPT_SOURCE_LINKADDR, 1, {0}};
+       size_t len;
+
+       if ((rs_attempt % 2 == 0) && memcmp(&rs.lladdr, &llnull, sizeof(llnull)))
+               len = sizeof(rs);
+       else
+               len = sizeof(struct icmp6_hdr);
+
+       sendto(sock, &rs, len, MSG_DONTWAIT, (struct sockaddr*)&dest, sizeof(dest));
 
        if (++rs_attempt <= 3)
                alarm(4);
@@ -179,6 +196,14 @@ bool ra_link_up(void)
                                resp.msg.ifi_index != if_index)
                        continue;
 
+               ssize_t alen = NLMSG_PAYLOAD(&resp.hdr, sizeof(resp.msg));
+               for (struct rtattr *rta = (struct rtattr*)(resp.pad);
+                               RTA_OK(rta, alen); rta = RTA_NEXT(rta, alen)) {
+                       if (rta->rta_type == IFLA_ADDRESS &&
+                                       RTA_PAYLOAD(rta) >= sizeof(rs.lladdr.data))
+                               memcpy(rs.lladdr.data, RTA_DATA(rta), sizeof(rs.lladdr.data));
+               }
+
                bool hascarrier = resp.msg.ifi_flags & IFF_LOWER_UP;
                if (!firstcall && nocarrier != !hascarrier)
                        ret = true;
@@ -230,7 +255,7 @@ bool ra_process(void)
        bool has_lladdr = !IN6_IS_ADDR_UNSPECIFIED(&lladdr);
        uint8_t buf[1500], cmsg_buf[128];
        struct nd_router_advert *adv = (struct nd_router_advert*)buf;
-       struct odhcp6c_entry entry = {IN6ADDR_ANY_INIT, 0, 0, IN6ADDR_ANY_INIT, 0, 0, 0, 0, 0};
+       struct odhcp6c_entry entry = {IN6ADDR_ANY_INIT, 0, 0, IN6ADDR_ANY_INIT, 0, 0, 0, 0, 0, 0};
        const struct in6_addr any = IN6ADDR_ANY_INIT;
 
        if (!has_lladdr) {
@@ -311,11 +336,13 @@ bool ra_process(void)
                        update_proc("conf", "hop_limit", adv->nd_ra_curhoplimit);
 
                // Parse ND parameters
-               if (ntohl(adv->nd_ra_reachable) <= 3600000)
-                       update_proc("neigh", "base_reachable_time_ms", ntohl(adv->nd_ra_reachable));
+               uint32_t reachable = ntohl(adv->nd_ra_reachable);
+               if (reachable > 0 && reachable <= 3600000)
+                       update_proc("neigh", "base_reachable_time_ms", reachable);
 
-               if (ntohl(adv->nd_ra_retransmit) <= 60000)
-                       update_proc("neigh", "retrans_time_ms", ntohl(adv->nd_ra_retransmit));
+               uint32_t retransmit = ntohl(adv->nd_ra_retransmit);
+               if (retransmit > 0 && retransmit <= 60000)
+                       update_proc("neigh", "retrans_time_ms", retransmit);
 
 
                // Evaluate options