odhcpd: Replace strerror(errno) with %m format
[project/odhcpd.git] / src / dhcpv6-ia.c
index c2221d8..533af00 100644 (file)
 #include <libubox/usock.h>
 
 #define ADDR_ENTRY_VALID_IA_ADDR(iface, i, m, addrs) \
-    ((iface)->managed == RELAYD_MANAGED_NO_AFLAG || (i) == (m) || \
+    ((iface)->dhcpv6_assignall || (i) == (m) || \
      (addrs)[(i)].prefix > 64)
 
+static void dhcpv6_netevent_cb(unsigned long event, struct netevent_handler_info *info);
 static void free_dhcpv6_assignment(struct dhcpv6_assignment *c);
-static void reconf_timer(struct uloop_timeout *event);
-static struct uloop_timeout reconf_event = {.cb = reconf_timer};
+static void handle_addrlist_change(struct netevent_handler_info *info);
+static void start_reconf(struct dhcpv6_assignment *a);
+static void stop_reconf(struct dhcpv6_assignment *a);
+static void valid_until_cb(struct uloop_timeout *event);
+
+static struct netevent_handler dhcpv6_netevent_handler = { .cb = dhcpv6_netevent_cb, };
+static struct uloop_timeout valid_until_timeout = {.cb = valid_until_cb};
 static uint32_t serial = 0;
 static uint8_t statemd5[16];
 
 int dhcpv6_ia_init(void)
 {
-       uloop_timeout_set(&reconf_event, 2000);
+       uloop_timeout_set(&valid_until_timeout, 1000);
+
+       netlink_add_netevent_handler(&dhcpv6_netevent_handler);
+
        return 0;
 }
 
-int setup_dhcpv6_ia_interface(struct interface *iface, bool enable)
+int dhcpv6_setup_ia_interface(struct interface *iface, bool enable)
 {
        if (!enable && iface->ia_assignments.next) {
                struct dhcpv6_assignment *c;
@@ -62,7 +71,7 @@ int setup_dhcpv6_ia_interface(struct interface *iface, bool enable)
                }
        }
 
-       if (enable && iface->dhcpv6 == RELAYD_SERVER) {
+       if (enable && iface->dhcpv6 == MODE_SERVER) {
                if (!iface->ia_assignments.next)
                        INIT_LIST_HEAD(&iface->ia_assignments);
 
@@ -120,6 +129,7 @@ int setup_dhcpv6_ia_interface(struct interface *iface, bool enable)
                        }
 
                        if (a->head.next) {
+                               a->iface = iface;
                                if (lease->hostname[0]) {
                                        free(a->hostname);
                                        a->hostname = strdup(lease->hostname);
@@ -131,6 +141,24 @@ int setup_dhcpv6_ia_interface(struct interface *iface, bool enable)
        return 0;
 }
 
+
+static void dhcpv6_netevent_cb(unsigned long event, struct netevent_handler_info *info)
+{
+       struct interface *iface = info->iface;
+
+       if (!iface || iface->dhcpv6 != MODE_SERVER)
+               return;
+
+       switch (event) {
+       case NETEV_ADDR6LIST_CHANGE:
+               handle_addrlist_change(info);
+               break;
+       default:
+               break;
+       }
+}
+
+
 static void free_dhcpv6_assignment(struct dhcpv6_assignment *c)
 {
        if (c->managed_sock.fd.registered) {
@@ -141,6 +169,9 @@ static void free_dhcpv6_assignment(struct dhcpv6_assignment *c)
        if (c->head.next)
                list_del(&c->head);
 
+       if (c->reconf_cnt)
+               stop_reconf(c);
+
        free(c->managed);
        free(c->hostname);
        free(c);
@@ -170,7 +201,7 @@ static size_t get_preferred_addr(const struct odhcpd_ipaddr *addrs, const size_t
        return m;
 }
 
-static int send_reconf(struct interface *iface, struct dhcpv6_assignment *assign)
+static int send_reconf(struct dhcpv6_assignment *assign)
 {
        struct {
                struct dhcpv6_client_header hdr;
@@ -202,6 +233,7 @@ static int send_reconf(struct interface *iface, struct dhcpv6_assignment *assign
                .clid_len = htons(assign->clid_len),
                .clid_data = {0},
        };
+       struct interface *iface = assign->iface;
 
        odhcpd_get_mac(iface, reconf_msg.mac);
        memcpy(reconf_msg.clid_data, assign->clid_data, assign->clid_len);
@@ -236,8 +268,8 @@ static int send_reconf(struct interface *iface, struct dhcpv6_assignment *assign
 void dhcpv6_enum_ia_addrs(struct interface *iface, struct dhcpv6_assignment *c,
                                time_t now, dhcpv6_binding_cb_handler_t func, void *arg)
 {
-       struct odhcpd_ipaddr *addrs = (c->managed) ? c->managed : iface->ia_addr;
-       size_t addrlen = (c->managed) ? (size_t)c->managed_size : iface->ia_addr_len;
+       struct odhcpd_ipaddr *addrs = (c->managed) ? c->managed : iface->addr6;
+       size_t addrlen = (c->managed) ? (size_t)c->managed_size : iface->addr6_len;
        size_t m = get_preferred_addr(addrs, addrlen);
 
        for (size_t i = 0; i < addrlen; ++i) {
@@ -248,7 +280,7 @@ void dhcpv6_enum_ia_addrs(struct interface *iface, struct dhcpv6_assignment *c,
                if (!valid_addr(&addrs[i], now))
                        continue;
 
-               addr = addrs[i].addr;
+               addr = addrs[i].addr.in6;
                pref = addrs[i].preferred;
                valid = addrs[i].valid;
                if (prefix == 128) {
@@ -340,11 +372,11 @@ void dhcpv6_write_statefile(void)
                ctxt.buf_len = sizeof(leasebuf);
 
                list_for_each_entry(ctxt.iface, &interfaces, head) {
-                       if (ctxt.iface->dhcpv6 != RELAYD_SERVER &&
-                                       ctxt.iface->dhcpv4 != RELAYD_SERVER)
+                       if (ctxt.iface->dhcpv6 != MODE_SERVER &&
+                                       ctxt.iface->dhcpv4 != MODE_SERVER)
                                continue;
 
-                       if (ctxt.iface->dhcpv6 == RELAYD_SERVER &&
+                       if (ctxt.iface->dhcpv6 == MODE_SERVER &&
                                        ctxt.iface->ia_assignments.next) {
                                list_for_each_entry(ctxt.c, &ctxt.iface->ia_assignments, head) {
                                        if (!(ctxt.c->flags & OAF_BOUND) || ctxt.c->managed_size < 0)
@@ -372,7 +404,7 @@ void dhcpv6_write_statefile(void)
                                }
                        }
 
-                       if (ctxt.iface->dhcpv4 == RELAYD_SERVER &&
+                       if (ctxt.iface->dhcpv4 == MODE_SERVER &&
                                        ctxt.iface->dhcpv4_assignments.next) {
                                struct dhcpv4_assignment *c;
                                list_for_each_entry(c, &ctxt.iface->dhcpv4_assignments, head) {
@@ -390,9 +422,9 @@ void dhcpv6_write_statefile(void)
                                                                (c->valid_until > now ?
                                                                        (c->valid_until - now + wall_time) :
                                                                        (INFINITE_VALID(c->valid_until) ? -1 : 0)),
-                                                               c->addr);
+                                                               ntohl(c->addr));
 
-                                       struct in_addr addr = {htonl(c->addr)};
+                                       struct in_addr addr = {.s_addr = c->addr};
                                        inet_ntop(AF_INET, &addr, ipbuf, sizeof(ipbuf) - 1);
 
                                        if (c->hostname) {
@@ -434,24 +466,29 @@ void dhcpv6_write_statefile(void)
        }
 }
 
-
-static void apply_lease(struct interface *iface, struct dhcpv6_assignment *a, bool add)
+static void __apply_lease(struct interface *iface, struct dhcpv6_assignment *a,
+               struct odhcpd_ipaddr *addrs, ssize_t addr_len, bool add)
 {
-       if (a->length > 64 || a->managed_size < 0)
+       if (a->length > 64)
                return;
 
-       struct odhcpd_ipaddr *addrs = (a->managed) ? a->managed : iface->ia_addr;
-       size_t addrlen = (a->managed) ? (size_t)a->managed_size : iface->ia_addr_len;
-
-       for (size_t i = 0; i < addrlen; ++i) {
-               struct in6_addr prefix = addrs[i].addr;
+       for (ssize_t i = 0; i < addr_len; ++i) {
+               struct in6_addr prefix = addrs[i].addr.in6;
                prefix.s6_addr32[1] |= htonl(a->assigned);
                prefix.s6_addr32[2] = prefix.s6_addr32[3] = 0;
-               odhcpd_setup_route(&prefix, (a->managed_size) ? addrs[i].prefix : a->length,
-                               iface, &a->peer.sin6_addr, 1024, add);
+               netlink_setup_route(&prefix, (a->managed_size) ? addrs[i].prefix : a->length,
+                               iface->ifindex, &a->peer.sin6_addr, 1024, add);
        }
 }
 
+static void apply_lease(struct interface *iface, struct dhcpv6_assignment *a, bool add)
+{
+       struct odhcpd_ipaddr *addrs = (a->managed) ? a->managed : iface->addr6;
+       ssize_t addrlen = (a->managed) ? a->managed_size : (ssize_t)iface->addr6_len;
+
+       __apply_lease(iface, a, addrs, addrlen, add);
+}
+
 /* More data was received from TCP connection */
 static void managed_handle_pd_data(struct ustream *s, _unused int bytes_new)
 {
@@ -570,7 +607,7 @@ static bool assign_pd(struct interface *iface, struct dhcpv6_assignment *assign)
                }
 
                return false;
-       } else if (iface->ia_addr_len < 1)
+       } else if (iface->addr6_len < 1)
                return false;
 
        /* Try honoring the hint first */
@@ -648,42 +685,33 @@ static bool assign_na(struct interface *iface, struct dhcpv6_assignment *assign)
        return false;
 }
 
-void dhcpv6_ia_preupdate(struct interface *iface)
+static void handle_addrlist_change(struct netevent_handler_info *info)
 {
-       if (iface->dhcpv6 != RELAYD_SERVER)
-               return;
-
-       struct dhcpv6_assignment *c, *border = list_last_entry(
+       struct interface *iface = info->iface;
+       struct dhcpv6_assignment *c, *d, *border = list_last_entry(
                        &iface->ia_assignments, struct dhcpv6_assignment, head);
+       time_t now = odhcpd_time();
+       int minprefix = -1;
 
        list_for_each_entry(c, &iface->ia_assignments, head)
-               if (c != border && !iface->managed && (c->flags & OAF_BOUND))
-                       apply_lease(iface, c, false);
-}
-
-void dhcpv6_ia_postupdate(struct interface *iface, time_t now)
-{
-       if (iface->dhcpv6 != RELAYD_SERVER)
-               return;
-
-       int minprefix = -1;
-       for (size_t i = 0; i < iface->ia_addr_len; ++i) {
-               if (iface->ia_addr[i].preferred > (uint32_t)now &&
-                               iface->ia_addr[i].prefix < 64 &&
-                               iface->ia_addr[i].prefix > minprefix)
-                       minprefix = iface->ia_addr[i].prefix;
+               if (c != border && iface->ra_managed == RA_MANAGED_NO_MFLAG
+                               && (c->flags & OAF_BOUND))
+                       __apply_lease(iface, c, info->addrs_old.addrs,
+                                       info->addrs_old.len, false);
+
+       for (size_t i = 0; i < iface->addr6_len; ++i) {
+               if (iface->addr6[i].preferred > (uint32_t)now &&
+                               iface->addr6[i].prefix < 64 &&
+                               iface->addr6[i].prefix > minprefix)
+                       minprefix = iface->addr6[i].prefix;
        }
 
-       struct dhcpv6_assignment *border = list_last_entry(
-                       &iface->ia_assignments, struct dhcpv6_assignment, head);
-
        if (minprefix > 32 && minprefix <= 64)
                border->assigned = 1U << (64 - minprefix);
        else
                border->assigned = 0;
 
        struct list_head reassign = LIST_HEAD_INIT(reassign);
-       struct dhcpv6_assignment *c, *d;
        list_for_each_entry_safe(c, d, &iface->ia_assignments, head) {
                if (c->clid_len == 0 || (!INFINITE_VALID(c->valid_until) && c->valid_until < now) ||
                                c->managed_size)
@@ -695,16 +723,14 @@ void dhcpv6_ia_postupdate(struct interface *iface, time_t now)
                        apply_lease(iface, c, true);
 
                if (c->accept_reconf && c->reconf_cnt == 0) {
-                       c->reconf_cnt = 1;
-                       c->reconf_sent = now;
-                       send_reconf(iface, c);
+                       start_reconf(c);
 
                        /* Leave all other assignments of that client alone */
                        struct dhcpv6_assignment *a;
                        list_for_each_entry(a, &iface->ia_assignments, head)
                                if (a != c && a->clid_len == c->clid_len &&
                                                !memcmp(a->clid_data, c->clid_data, a->clid_len))
-                                       c->reconf_cnt = INT_MAX;
+                                       a->reconf_cnt = INT_MAX;
                }
        }
 
@@ -720,12 +746,42 @@ void dhcpv6_ia_postupdate(struct interface *iface, time_t now)
        dhcpv6_write_statefile();
 }
 
-static void reconf_timer(struct uloop_timeout *event)
+static void reconf_timeout_cb(struct uloop_timeout *event)
+{
+       struct dhcpv6_assignment *a = container_of(event, struct dhcpv6_assignment, reconf_timer);
+
+       if (a->reconf_cnt > 0 && a->reconf_cnt < DHCPV6_REC_MAX_RC) {
+               send_reconf(a);
+               uloop_timeout_set(&a->reconf_timer,
+                                       DHCPV6_REC_TIMEOUT << a->reconf_cnt);
+               a->reconf_cnt++;
+       } else
+               stop_reconf(a);
+}
+
+static void start_reconf(struct dhcpv6_assignment *a)
+{
+       uloop_timeout_set(&a->reconf_timer,
+                               DHCPV6_REC_TIMEOUT << a->reconf_cnt);
+       a->reconf_timer.cb = reconf_timeout_cb;
+       a->reconf_cnt++;
+
+       send_reconf(a);
+}
+
+static void stop_reconf(struct dhcpv6_assignment *a)
+{
+       uloop_timeout_cancel(&a->reconf_timer);
+       a->reconf_cnt = 0;
+       a->reconf_timer.cb = NULL;
+}
+
+static void valid_until_cb(struct uloop_timeout *event)
 {
        time_t now = odhcpd_time();
        struct interface *iface;
        list_for_each_entry(iface, &interfaces, head) {
-               if (iface->dhcpv6 != RELAYD_SERVER || iface->ia_assignments.next == NULL)
+               if (iface->dhcpv6 != MODE_SERVER || iface->ia_assignments.next == NULL)
                        continue;
 
                struct dhcpv6_assignment *a, *n;
@@ -735,15 +791,10 @@ static void reconf_timer(struct uloop_timeout *event)
                                                (a->length == 128 && a->clid_len == 0))
                                        free_dhcpv6_assignment(a);
 
-                       } else if (a->reconf_cnt > 0 && a->reconf_cnt < 8 &&
-                                       now > a->reconf_sent + (1 << a->reconf_cnt)) {
-                               ++a->reconf_cnt;
-                               a->reconf_sent = now;
-                               send_reconf(iface, a);
                        }
                }
        }
-       uloop_timeout_set(event, 2000);
+       uloop_timeout_set(event, 1000);
 }
 
 static size_t append_reply(uint8_t *buf, size_t buflen, uint16_t status,
@@ -778,8 +829,8 @@ static size_t append_reply(uint8_t *buf, size_t buflen, uint16_t status,
                        uint32_t pref = leasetime;
                        uint32_t valid = leasetime;
 
-                       struct odhcpd_ipaddr *addrs = (a->managed) ? a->managed : iface->ia_addr;
-                       size_t addrlen = (a->managed) ? (size_t)a->managed_size : iface->ia_addr_len;
+                       struct odhcpd_ipaddr *addrs = (a->managed) ? a->managed : iface->addr6;
+                       size_t addrlen = (a->managed) ? (size_t)a->managed_size : iface->addr6_len;
                        size_t m = get_preferred_addr(addrs, addrlen);
 
                        for (size_t i = 0; i < addrlen; ++i) {
@@ -802,7 +853,7 @@ static size_t append_reply(uint8_t *buf, size_t buflen, uint16_t status,
                                                .preferred = htonl(prefix_pref),
                                                .valid = htonl(prefix_valid),
                                                .prefix = (a->managed_size) ? addrs[i].prefix : a->length,
-                                               .addr = addrs[i].addr
+                                               .addr = addrs[i].addr.in6,
                                        };
                                        p.addr.s6_addr32[1] |= htonl(a->assigned);
                                        p.addr.s6_addr32[2] = p.addr.s6_addr32[3] = 0;
@@ -820,7 +871,7 @@ static size_t append_reply(uint8_t *buf, size_t buflen, uint16_t status,
                                        struct dhcpv6_ia_addr n = {
                                                .type = htons(DHCPV6_OPT_IA_ADDR),
                                                .len = htons(sizeof(n) - 4),
-                                               .addr = addrs[i].addr,
+                                               .addr = addrs[i].addr.in6,
                                                .preferred = htonl(prefix_pref),
                                                .valid = htonl(prefix_valid)
                                        };
@@ -872,14 +923,14 @@ static size_t append_reply(uint8_t *buf, size_t buflen, uint16_t status,
 
                                bool found = false;
                                if (a) {
-                                       struct odhcpd_ipaddr *addrs = (a->managed) ? a->managed : iface->ia_addr;
-                                       size_t addrlen = (a->managed) ? (size_t)a->managed_size : iface->ia_addr_len;
+                                       struct odhcpd_ipaddr *addrs = (a->managed) ? a->managed : iface->addr6;
+                                       size_t addrlen = (a->managed) ? (size_t)a->managed_size : iface->addr6_len;
 
                                        for (size_t i = 0; i < addrlen; ++i) {
                                                if (!valid_addr(&addrs[i], now))
                                                        continue;
 
-                                               struct in6_addr addr = addrs[i].addr;
+                                               struct in6_addr addr = addrs[i].addr.in6;
                                                if (ia->type == htons(DHCPV6_OPT_IA_PD)) {
                                                        addr.s6_addr32[1] |= htonl(a->assigned);
                                                        addr.s6_addr32[2] = addr.s6_addr32[3] = 0;
@@ -1122,8 +1173,7 @@ ssize_t dhcpv6_handle_ia(uint8_t *buf, size_t buflen, struct interface *iface,
                                a->clid_len = clid_len;
                                a->iaid = ia->iaid;
                                a->peer = *addr;
-                               a->reconf_cnt = 0;
-                               a->reconf_sent = 0;
+                               stop_reconf(a);
                                break;
                        }
                }
@@ -1150,6 +1200,7 @@ ssize_t dhcpv6_handle_ia(uint8_t *buf, size_t buflen, struct interface *iface,
                                        /* Set valid time to current time indicating  */
                                        /* assignment is not having infinite lifetime */
                                        a->valid_until = now;
+                                       a->iface = iface;
 
                                        if (first)
                                                memcpy(a->key, first->key, sizeof(a->key));
@@ -1168,7 +1219,7 @@ ssize_t dhcpv6_handle_ia(uint8_t *buf, size_t buflen, struct interface *iface,
                                }
                        }
 
-                       if (!assigned || iface->ia_addr_len == 0)
+                       if (!assigned || iface->addr6_len == 0)
                                /* Set error status */
                                status = (is_pd) ? DHCPV6_STATUS_NOPREFIXAVAIL : DHCPV6_STATUS_NOADDRSAVAIL;
                        else if (assigned && !first && hdr->msg_type != DHCPV6_MSG_REBIND) {