Remove prefix coloring support, refine hybrid management mode
[project/odhcpd.git] / src / router.c
index 3ba552d..60d6b3f 100644 (file)
@@ -30,8 +30,8 @@ static void forward_router_solicitation(const struct interface *iface);
 static void forward_router_advertisement(uint8_t *data, size_t len);
 
 static void handle_icmpv6(void *addr, void *data, size_t len,
-               struct interface *iface);
-static void send_router_advert(struct uloop_timeout *event);
+               struct interface *iface, void *dest);
+static void trigger_router_advert(struct uloop_timeout *event);
 static void sigusr1_refresh(int signal);
 
 static struct odhcpd_event router_event = {{.fd = -1}, handle_icmpv6};
@@ -88,6 +88,9 @@ int init_router(void)
 
 int setup_router_interface(struct interface *iface, bool enable)
 {
+       if (!fp_route || router_event.uloop.fd < 0)
+               return -1;
+
        struct ipv6_mreq all_nodes = {ALL_IPV6_NODES, iface->ifindex};
        struct ipv6_mreq all_routers = {ALL_IPV6_ROUTERS, iface->ifindex};
 
@@ -101,7 +104,7 @@ int setup_router_interface(struct interface *iface, bool enable)
 
        if (!enable) {
                if (iface->ra)
-                       send_router_advert(&iface->timer_rs);
+                       trigger_router_advert(&iface->timer_rs);
        } else {
                void *mreq = &all_routers;
 
@@ -109,8 +112,8 @@ int setup_router_interface(struct interface *iface, bool enable)
                        mreq = &all_nodes;
                        forward_router_solicitation(iface);
                } else if (iface->ra == RELAYD_SERVER && !iface->master) {
-                       iface->timer_rs.cb = send_router_advert;
-                       send_router_advert(&iface->timer_rs);
+                       iface->timer_rs.cb = trigger_router_advert;
+                       trigger_router_advert(&iface->timer_rs);
                }
 
                if (iface->ra == RELAYD_RELAY || (iface->ra == RELAYD_SERVER && !iface->master))
@@ -165,26 +168,6 @@ static bool router_icmpv6_valid(struct sockaddr_in6 *source, uint8_t *data, size
        return opt == end;
 }
 
-// Event handler for incoming ICMPv6 packets
-static void handle_icmpv6(void *addr, void *data, size_t len,
-               struct interface *iface)
-{
-       struct icmp6_hdr *hdr = data;
-
-       if (!router_icmpv6_valid(addr, data, len))
-               return;
-
-       if ((iface->ra == RELAYD_SERVER && !iface->master)) { // Server mode
-               if (hdr->icmp6_type == ND_ROUTER_SOLICIT)
-                       send_router_advert(&iface->timer_rs);
-       } else if (iface->ra == RELAYD_RELAY) { // Relay mode
-               if (hdr->icmp6_type == ND_ROUTER_ADVERT && iface->master)
-                       forward_router_advertisement(data, len);
-               else if (hdr->icmp6_type == ND_ROUTER_SOLICIT && !iface->master)
-                       forward_router_solicitation(odhcpd_get_master_interface());
-       }
-}
-
 
 // Detect whether a default route exists, also find the source prefixes
 static bool parse_routes(struct odhcpd_ipaddr *n, ssize_t len)
@@ -193,7 +176,7 @@ static bool parse_routes(struct odhcpd_ipaddr *n, ssize_t len)
 
        char line[512], ifname[16];
        bool found_default = false;
-       struct odhcpd_ipaddr p = {IN6ADDR_ANY_INIT, 0, 0, false, 0, 0, 0};
+       struct odhcpd_ipaddr p = {IN6ADDR_ANY_INIT, 0, 0, 0, 0};
        while (fgets(line, sizeof(line), fp_route)) {
                uint32_t rflags;
                if (sscanf(line, "00000000000000000000000000000000 00 "
@@ -224,11 +207,8 @@ static bool parse_routes(struct odhcpd_ipaddr *n, ssize_t len)
 
 
 // Router Advert server mode
-static void send_router_advert(struct uloop_timeout *event)
+static uint64_t send_router_advert(struct interface *iface, const struct in6_addr *from)
 {
-       struct interface *iface =
-                       container_of(event, struct interface, timer_rs);
-
        int mtu = odhcpd_get_interface_mtu(iface->ifname);
        if (mtu < 0)
                mtu = 1500;
@@ -262,7 +242,7 @@ static void send_router_advert(struct uloop_timeout *event)
        uint64_t maxpreferred = 0;
 
        // If not shutdown
-       if (event->cb) {
+       if (iface->timer_rs.cb) {
                ipcnt = odhcpd_get_interface_addresses(iface->ifindex,
                                addrs, ARRAY_SIZE(addrs));
 
@@ -282,7 +262,7 @@ static void send_router_advert(struct uloop_timeout *event)
 
        for (ssize_t i = 0; i < ipcnt; ++i) {
                struct odhcpd_ipaddr *addr = &addrs[i];
-               if (addr->prefix > 96 || addr->has_class)
+               if (addr->prefix > 96)
                        continue; // Address not suitable
 
                if (addr->preferred > MaxPreferredTime)
@@ -313,7 +293,8 @@ static void send_router_advert(struct uloop_timeout *event)
                                maxpreferred = 1000 * addr->preferred;
                }
 
-               odhcpd_bmemcpy(&p->nd_opt_pi_prefix, &addr->addr, addr->prefix);
+               odhcpd_bmemcpy(&p->nd_opt_pi_prefix, &addr->addr,
+                               (iface->ra_advrouter) ? 128 : addr->prefix);
                p->nd_opt_pi_type = ND_OPT_PREFIX_INFORMATION;
                p->nd_opt_pi_len = 4;
                p->nd_opt_pi_prefix_len = (addr->prefix < 64) ? 64 : addr->prefix;
@@ -322,6 +303,8 @@ static void send_router_advert(struct uloop_timeout *event)
                        p->nd_opt_pi_flags_reserved |= ND_OPT_PI_FLAG_ONLINK;
                if (iface->managed < RELAYD_MANAGED_NO_AFLAG && addr->prefix <= 64)
                        p->nd_opt_pi_flags_reserved |= ND_OPT_PI_FLAG_AUTO;
+               if (iface->ra_advrouter)
+                       p->nd_opt_pi_flags_reserved |= ND_OPT_PI_FLAG_RADDR;
                p->nd_opt_pi_valid_time = htonl(addr->valid);
                p->nd_opt_pi_preferred_time = htonl(addr->preferred);
 
@@ -382,10 +365,6 @@ static void send_router_advert(struct uloop_timeout *event)
                uint8_t name[];
        } *search = alloca(sizeof(*search) + search_padded);
 
-       if (!search) {
-               syslog(LOG_ERR, "Alloca failed for dns search on interface %s", iface->ifname);
-               return;
-       }
        search->type = ND_OPT_DNS_SEARCH;
        search->len = search_len ? ((sizeof(*search) + search_padded) / 8) : 0;
        search->pad = 0;
@@ -407,7 +386,8 @@ static void send_router_advert(struct uloop_timeout *event)
 
        for (ssize_t i = 0; i < ipcnt; ++i) {
                struct odhcpd_ipaddr *addr = &addrs[i];
-               if (addr->dprefix > 64 || addr->dprefix == 0) {
+               if (addr->dprefix > 64 || addr->dprefix == 0 ||
+                               (addr->dprefix == 64 && addr->prefix == 64)) {
                        continue; // Address not suitable
                } else if (addr->dprefix > 32) {
                        addr->addr.s6_addr32[1] &= htonl(~((1U << (64 - addr->dprefix)) - 1));
@@ -433,36 +413,78 @@ static void send_router_advert(struct uloop_timeout *event)
                ++routes_cnt;
        }
 
+       // Calculate periodic transmit
+       int msecs = 0;
+       uint32_t maxival = MaxRtrAdvInterval * 1000;
+       uint32_t minival = MinRtrAdvInterval * 1000;
+
+       if (maxpreferred > 0 && maxival > maxpreferred / 2) {
+               maxival = maxpreferred / 2;
+               if (maxival < 4000)
+                       maxival = 4000;
+
+               if (maxival >= 9000)
+                       minival = maxival / 3;
+               else
+                       minival = (maxival * 3) / 4;
+       }
+
+       odhcpd_urandom(&msecs, sizeof(msecs));
+       msecs = (labs(msecs) % (maxival - minival)) + minival;
+
+       struct icmpv6_opt adv_interval = {
+               .type = ND_OPT_RTR_ADV_INTERVAL,
+               .len = 1,
+               .data = {0, 0, maxival >> 24, maxival >> 16, maxival >> 8, maxival}
+       };
 
        struct iovec iov[] = {{&adv, (uint8_t*)&adv.prefix[cnt] - (uint8_t*)&adv},
                        {&routes, routes_cnt * sizeof(*routes)},
                        {&dns, (dns_cnt) ? sizeof(dns) : 0},
                        {dns_addr, dns_cnt * sizeof(*dns_addr)},
-                       {search, search->len * 8}};
-       struct sockaddr_in6 all_nodes = {AF_INET6, 0, 0, ALL_IPV6_NODES, 0};
+                       {search, search->len * 8},
+                       {&adv_interval, adv_interval.len * 8}};
+       struct sockaddr_in6 dest = {AF_INET6, 0, 0, ALL_IPV6_NODES, 0};
+
+       if (from && !IN6_IS_ADDR_UNSPECIFIED(from))
+               dest.sin6_addr = *from;
+
        odhcpd_send(router_event.uloop.fd,
-                       &all_nodes, iov, ARRAY_SIZE(iov), iface);
+                       &dest, iov, ARRAY_SIZE(iov), iface);
+
+       return msecs;
+}
+
+
+static void trigger_router_advert(struct uloop_timeout *event)
+{
+       struct interface *iface = container_of(event, struct interface, timer_rs);
+       int msecs = send_router_advert(iface, NULL);
 
        // Rearm timer if not shut down
-       if (event->cb) {
-               uint32_t maxinterval = MaxRtrAdvInterval * 1000;
-               uint32_t mininterval = MinRtrAdvInterval * 1000;
-
-               if (maxpreferred > 0 && maxinterval > maxpreferred / 2) {
-                       maxinterval = maxpreferred / 2;
-                       if (maxinterval < 4000)
-                               maxinterval = 4000;
-
-                       if (maxinterval >= 9000)
-                               mininterval = maxinterval / 3;
-                       else
-                               mininterval = (maxinterval * 3) / 4;
-               }
+       if (event->cb)
+               uloop_timeout_set(event, msecs);
+}
 
-               int msecs;
-               odhcpd_urandom(&msecs, sizeof(msecs));
-               msecs = (labs(msecs) % (maxinterval - mininterval)) + mininterval;
-               uloop_timeout_set(&iface->timer_rs, msecs);
+
+// Event handler for incoming ICMPv6 packets
+static void handle_icmpv6(void *addr, void *data, size_t len,
+               struct interface *iface, _unused void *dest)
+{
+       struct icmp6_hdr *hdr = data;
+       struct sockaddr_in6 *from = addr;
+
+       if (!router_icmpv6_valid(addr, data, len))
+               return;
+
+       if ((iface->ra == RELAYD_SERVER && !iface->master)) { // Server mode
+               if (hdr->icmp6_type == ND_ROUTER_SOLICIT)
+                       send_router_advert(iface, &from->sin6_addr);
+       } else if (iface->ra == RELAYD_RELAY) { // Relay mode
+               if (hdr->icmp6_type == ND_ROUTER_ADVERT && iface->master)
+                       forward_router_advertisement(data, len);
+               else if (hdr->icmp6_type == ND_ROUTER_SOLICIT && !iface->master)
+                       forward_router_solicitation(odhcpd_get_master_interface());
        }
 }
 
@@ -515,7 +537,6 @@ static void forward_router_advertisement(uint8_t *data, size_t len)
        struct sockaddr_in6 all_nodes = {AF_INET6, 0, 0, ALL_IPV6_NODES, 0};
        struct iovec iov = {data, len};
 
-       struct odhcpd_ipaddr addr;
        struct interface *iface;
        list_for_each_entry(iface, &interfaces, head) {
                if (iface->ra != RELAYD_RELAY || iface->master)
@@ -528,13 +549,14 @@ static void forward_router_advertisement(uint8_t *data, size_t len)
                // If we have to rewrite DNS entries
                if (iface->always_rewrite_dns && dns_ptr && dns_count > 0) {
                        const struct in6_addr *rewrite = iface->dns;
+                       struct in6_addr addr;
                        size_t rewrite_cnt = iface->dns_cnt;
 
                        if (rewrite_cnt == 0) {
-                               if (odhcpd_get_interface_addresses(iface->ifindex, &addr, 1) < 1)
+                               if (odhcpd_get_preferred_interface_address(iface->ifindex, &addr) < 1)
                                        continue; // Unable to comply
 
-                               rewrite = &addr.addr;
+                               rewrite = &addr;
                                rewrite_cnt = 1;
                        }