2 * netifd - network interface daemon
3 * Copyright (C) 2012 Felix Fietkau <nbd@openwrt.org>
4 * Copyright (C) 2012 Steven Barth <steven@midlink.org>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2
8 * as published by the Free Software Foundation
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
20 #include <arpa/inet.h>
24 #include "interface.h"
25 #include "interface-ip.h"
43 static const struct blobmsg_policy route_attr
[__ROUTE_MAX
] = {
44 [ROUTE_INTERFACE
] = { .name
= "interface", .type
= BLOBMSG_TYPE_STRING
},
45 [ROUTE_TARGET
] = { .name
= "target", .type
= BLOBMSG_TYPE_STRING
},
46 [ROUTE_MASK
] = { .name
= "netmask", .type
= BLOBMSG_TYPE_STRING
},
47 [ROUTE_GATEWAY
] = { .name
= "gateway", .type
= BLOBMSG_TYPE_STRING
},
48 [ROUTE_METRIC
] = { .name
= "metric", .type
= BLOBMSG_TYPE_INT32
},
49 [ROUTE_MTU
] = { .name
= "mtu", .type
= BLOBMSG_TYPE_INT32
},
50 [ROUTE_TABLE
] = { .name
= "table", .type
= BLOBMSG_TYPE_STRING
},
51 [ROUTE_VALID
] = { .name
= "valid", .type
= BLOBMSG_TYPE_INT32
},
52 [ROUTE_SOURCE
] = { .name
= "source", .type
= BLOBMSG_TYPE_STRING
},
55 const struct uci_blob_param_list route_attr_list
= {
56 .n_params
= __ROUTE_MAX
,
61 struct list_head prefixes
= LIST_HEAD_INIT(prefixes
);
62 static struct list_head source_tables
= LIST_HEAD_INIT(source_tables
);
63 static struct device_prefix
*ula_prefix
= NULL
;
64 static struct uloop_timeout valid_until_timeout
;
68 clear_if_addr(union if_addr
*a
, int mask
)
70 int m_bytes
= (mask
+ 7) / 8;
71 uint8_t m_clear
= (1 << (m_bytes
* 8 - mask
)) - 1;
72 uint8_t *p
= (uint8_t *) a
;
74 if (m_bytes
< sizeof(a
))
75 memset(p
+ m_bytes
, 0, sizeof(a
) - m_bytes
);
77 p
[m_bytes
- 1] &= ~m_clear
;
81 match_if_addr(union if_addr
*a1
, union if_addr
*a2
, int mask
)
83 union if_addr
*p1
, *p2
;
85 p1
= alloca(sizeof(*a1
));
86 p2
= alloca(sizeof(*a2
));
88 memcpy(p1
, a1
, sizeof(*a1
));
89 clear_if_addr(p1
, mask
);
90 memcpy(p2
, a2
, sizeof(*a2
));
91 clear_if_addr(p2
, mask
);
93 return !memcmp(p1
, p2
, sizeof(*p1
));
96 static int set_ip_source_policy(bool add
, bool v6
, unsigned int priority
,
97 const union if_addr
*addr
, uint8_t mask
, unsigned int table
,
98 struct interface
*in_iface
, const char *action
)
100 struct iprule rule
= {
101 .flags
= IPRULE_PRIORITY
,
106 rule
.flags
|= IPRULE_SRC
;
107 rule
.src_addr
= *addr
;
108 rule
.src_mask
= mask
;
112 rule
.flags
|= IPRULE_LOOKUP
;
118 rule
.flags
|= IPRULE_ACTION
;
119 system_resolve_iprule_action(action
, &rule
.action
);
122 if (in_iface
&& in_iface
->l3_dev
.dev
) {
123 rule
.flags
|= IPRULE_IN
;
124 strcpy(rule
.in_dev
, in_iface
->l3_dev
.dev
->ifname
);
127 rule
.flags
|= (v6
) ? IPRULE_INET6
: IPRULE_INET4
;
129 return (add
) ? system_add_iprule(&rule
) : system_del_iprule(&rule
);
132 static int set_ip_lo_policy(bool add
, bool v6
, struct interface
*iface
)
134 struct iprule rule
= {
135 .flags
= IPRULE_IN
| IPRULE_LOOKUP
| IPRULE_PRIORITY
,
136 .priority
= IPRULE_PRIORITY_NW
+ iface
->l3_dev
.dev
->ifindex
,
137 .lookup
= (v6
) ? iface
->ip6table
: iface
->ip4table
,
144 rule
.flags
|= (v6
) ? IPRULE_INET6
: IPRULE_INET4
;
146 return (add
) ? system_add_iprule(&rule
) : system_del_iprule(&rule
);
150 __find_ip_addr_target(struct interface_ip_settings
*ip
, union if_addr
*a
, bool v6
)
152 struct device_addr
*addr
;
154 vlist_for_each_element(&ip
->addr
, addr
, node
) {
158 if (v6
!= ((addr
->flags
& DEVADDR_FAMILY
) == DEVADDR_INET6
))
161 // Handle offlink addresses correctly
162 unsigned int mask
= addr
->mask
;
163 if ((addr
->flags
& DEVADDR_FAMILY
) == DEVADDR_INET6
&&
164 (addr
->flags
& DEVADDR_OFFLINK
))
167 if (!match_if_addr(&addr
->addr
, a
, mask
))
177 __find_ip_route_target(struct interface_ip_settings
*ip
, union if_addr
*a
,
178 bool v6
, struct device_route
**res
)
180 struct device_route
*route
;
182 vlist_for_each_element(&ip
->route
, route
, node
) {
186 if (v6
!= ((route
->flags
& DEVADDR_FAMILY
) == DEVADDR_INET6
))
189 if (!match_if_addr(&route
->addr
, a
, route
->mask
))
192 if (route
->flags
& DEVROUTE_TABLE
)
195 if (!*res
|| route
->mask
< (*res
)->mask
)
200 static struct device_source_table
*
201 find_source_table(const struct device_route
*route
)
203 struct device_source_table key
= {
204 .v6
= (route
->flags
& DEVADDR_FAMILY
) == DEVADDR_INET6
,
205 .addr
= route
->source
,
206 .mask
= route
->sourcemask
208 struct device_source_table
*c
;
209 list_for_each_entry(c
, &source_tables
, head
)
210 if (!memcmp(&c
->v6
, &key
.v6
, sizeof(key
) -
211 offsetof(struct device_source_table
, v6
)))
217 get_source_table(const struct device_route
*route
)
219 if (route
->table
|| route
->sourcemask
== 0)
222 struct device_source_table
*tbl
= find_source_table(route
);
225 tbl
= calloc(1, sizeof(*tbl
));
226 tbl
->addr
= route
->source
;
227 tbl
->mask
= route
->sourcemask
;
228 tbl
->v6
= (route
->flags
& DEVADDR_FAMILY
) == DEVADDR_INET6
;
229 tbl
->table
= IPRULE_PRIORITY_SOURCE
| (((~tbl
->mask
) & 0x7f) << 20);
231 struct list_head
*before
= NULL
;
232 struct device_source_table
*c
;
233 list_for_each_entry(c
, &source_tables
, head
) {
234 if (c
->table
> tbl
->table
) {
237 } else if (c
->table
== tbl
->table
) {
243 before
= &source_tables
;
245 list_add_tail(&tbl
->head
, before
);
246 set_ip_source_policy(true, tbl
->v6
, tbl
->table
, &tbl
->addr
,
247 tbl
->mask
, tbl
->table
, NULL
, NULL
);
255 put_source_table(const struct device_route
*route
)
257 struct device_source_table
*tbl
= find_source_table(route
);
258 if (tbl
&& tbl
->table
== route
->table
&& --tbl
->refcount
== 0) {
259 set_ip_source_policy(false, tbl
->v6
, tbl
->table
, &tbl
->addr
,
260 tbl
->mask
, tbl
->table
, NULL
, NULL
);
261 list_del(&tbl
->head
);
267 interface_ip_find_addr_target(struct interface
*iface
, union if_addr
*a
, bool v6
)
269 return __find_ip_addr_target(&iface
->proto_ip
, a
, v6
) ||
270 __find_ip_addr_target(&iface
->config_ip
, a
, v6
);
274 interface_ip_find_route_target(struct interface
*iface
, union if_addr
*a
,
275 bool v6
, struct device_route
**route
)
277 __find_ip_route_target(&iface
->proto_ip
, a
, v6
, route
);
278 __find_ip_route_target(&iface
->config_ip
, a
, v6
, route
);
282 interface_ip_add_target_route(union if_addr
*addr
, bool v6
, struct interface
*iface
)
284 struct device_route
*route
, *r_next
= NULL
;
285 bool defaultroute_target
= false;
286 int addrsize
= v6
? sizeof(addr
->in6
) : sizeof(addr
->in
);
288 route
= calloc(1, sizeof(*route
));
292 route
->flags
= v6
? DEVADDR_INET6
: DEVADDR_INET4
;
293 route
->mask
= v6
? 128 : 32;
294 if (memcmp(&route
->addr
, addr
, addrsize
) == 0)
295 defaultroute_target
= true;
297 memcpy(&route
->addr
, addr
, addrsize
);
300 /* look for locally addressable target first */
301 if (interface_ip_find_addr_target(iface
, addr
, v6
))
304 /* do not stop at the first route, let the lookup compare
305 * masks to find the best match */
306 interface_ip_find_route_target(iface
, addr
, v6
, &r_next
);
308 vlist_for_each_element(&interfaces
, iface
, node
) {
309 /* look for locally addressable target first */
310 if (interface_ip_find_addr_target(iface
, addr
, v6
))
313 /* do not stop at the first route, let the lookup compare
314 * masks to find the best match */
315 interface_ip_find_route_target(iface
, addr
, v6
, &r_next
);
324 iface
= r_next
->iface
;
325 memcpy(&route
->nexthop
, &r_next
->nexthop
, sizeof(route
->nexthop
));
326 route
->mtu
= r_next
->mtu
;
327 route
->metric
= r_next
->metric
;
328 route
->table
= r_next
->table
;
331 route
->iface
= iface
;
332 if (defaultroute_target
)
335 vlist_add(&iface
->host_routes
, &route
->node
, route
);
340 interface_ip_add_route(struct interface
*iface
, struct blob_attr
*attr
, bool v6
)
342 struct interface_ip_settings
*ip
;
343 struct blob_attr
*tb
[__ROUTE_MAX
], *cur
;
344 struct device_route
*route
;
345 int af
= v6
? AF_INET6
: AF_INET
;
346 bool is_proto_route
= !!iface
;
348 blobmsg_parse(route_attr
, __ROUTE_MAX
, tb
, blobmsg_data(attr
), blobmsg_data_len(attr
));
351 if ((cur
= tb
[ROUTE_INTERFACE
]) == NULL
)
354 iface
= vlist_find(&interfaces
, blobmsg_data(cur
), iface
, node
);
358 ip
= &iface
->config_ip
;
360 ip
= &iface
->proto_ip
;
363 route
= calloc(1, sizeof(*route
));
367 route
->flags
= v6
? DEVADDR_INET6
: DEVADDR_INET4
;
368 route
->mask
= v6
? 128 : 32;
369 if ((cur
= tb
[ROUTE_MASK
]) != NULL
) {
370 route
->mask
= parse_netmask_string(blobmsg_data(cur
), v6
);
371 if (route
->mask
> (v6
? 128 : 32))
375 if ((cur
= tb
[ROUTE_TARGET
]) != NULL
) {
376 if (!parse_ip_and_netmask(af
, blobmsg_data(cur
), &route
->addr
, &route
->mask
)) {
377 DPRINTF("Failed to parse route target: %s\n", (char *) blobmsg_data(cur
));
382 if ((cur
= tb
[ROUTE_GATEWAY
]) != NULL
) {
383 if (!inet_pton(af
, blobmsg_data(cur
), &route
->nexthop
)) {
384 DPRINTF("Failed to parse route gateway: %s\n", (char *) blobmsg_data(cur
));
389 if ((cur
= tb
[ROUTE_METRIC
]) != NULL
) {
390 route
->metric
= blobmsg_get_u32(cur
);
391 route
->flags
|= DEVROUTE_METRIC
;
394 if ((cur
= tb
[ROUTE_MTU
]) != NULL
) {
395 route
->mtu
= blobmsg_get_u32(cur
);
396 route
->flags
|= DEVROUTE_MTU
;
399 // Use source-based routing
400 if ((cur
= tb
[ROUTE_SOURCE
]) != NULL
) {
401 char *saveptr
, *source
= alloca(blobmsg_data_len(cur
));
402 memcpy(source
, blobmsg_data(cur
), blobmsg_data_len(cur
));
404 const char *addr
= strtok_r(source
, "/", &saveptr
);
405 const char *mask
= strtok_r(NULL
, "/", &saveptr
);
407 if (inet_pton(af
, addr
, &route
->source
) < 1) {
408 DPRINTF("Failed to parse route source: %s\n", addr
);
412 route
->sourcemask
= atoi(mask
);
413 } else if (is_proto_route
) {
414 route
->table
= (v6
) ? iface
->ip6table
: iface
->ip4table
;
415 route
->flags
|= DEVROUTE_SRCTABLE
;
418 if ((cur
= tb
[ROUTE_TABLE
]) != NULL
) {
419 if (!system_resolve_rt_table(blobmsg_data(cur
), &route
->table
)) {
420 DPRINTF("Failed to resolve routing table: %s\n", (char *) blobmsg_data(cur
));
425 route
->flags
|= DEVROUTE_TABLE
;
428 if ((cur
= tb
[ROUTE_VALID
]) != NULL
) {
429 int64_t valid
= blobmsg_get_u32(cur
);
430 int64_t valid_until
= valid
+ (int64_t)system_get_rtime();
431 if (valid_until
<= LONG_MAX
&& valid
!= 0xffffffffLL
) // Catch overflow
432 route
->valid_until
= valid_until
;
435 if (route
->sourcemask
) {
436 route
->table
= get_source_table(route
);
437 route
->flags
|= DEVROUTE_SRCTABLE
;
440 vlist_add(&ip
->route
, &route
->node
, route
);
448 addr_cmp(const void *k1
, const void *k2
, void *ptr
)
450 return memcmp(k1
, k2
, sizeof(struct device_addr
) -
451 offsetof(struct device_addr
, flags
));
455 route_cmp(const void *k1
, const void *k2
, void *ptr
)
457 const struct device_route
*r1
= k1
, *r2
= k2
;
459 if (r1
->mask
!= r2
->mask
)
460 return r2
->mask
- r1
->mask
;
462 if (r1
->metric
!= r2
->metric
)
463 return r1
->metric
- r2
->metric
;
465 if (r1
->flags
!= r2
->flags
)
466 return r2
->flags
- r1
->flags
;
468 if (r1
->sourcemask
!= r2
->sourcemask
)
469 return r1
->sourcemask
- r2
->sourcemask
;
471 int maskcmp
= memcmp(&r1
->source
, &r2
->source
, sizeof(r1
->source
));
475 return memcmp(&r1
->addr
, &r2
->addr
, sizeof(r1
->addr
));
479 prefix_cmp(const void *k1
, const void *k2
, void *ptr
)
481 return memcmp(k1
, k2
, offsetof(struct device_prefix
, pclass
) -
482 offsetof(struct device_prefix
, addr
));
486 interface_handle_subnet_route(struct interface
*iface
, struct device_addr
*addr
, bool add
)
488 struct device
*dev
= iface
->l3_dev
.dev
;
489 struct device_route route
;
491 memset(&route
, 0, sizeof(route
));
493 route
.flags
= addr
->flags
;
494 route
.mask
= addr
->mask
;
495 memcpy(&route
.addr
, &addr
->addr
, sizeof(route
.addr
));
496 clear_if_addr(&route
.addr
, route
.mask
);
499 route
.flags
|= DEVADDR_KERNEL
;
500 system_del_route(dev
, &route
);
502 if (!(addr
->flags
& DEVADDR_OFFLINK
)) {
503 route
.flags
&= ~DEVADDR_KERNEL
;
504 route
.metric
= iface
->metric
;
505 system_add_route(dev
, &route
);
508 if (!(addr
->flags
& DEVADDR_OFFLINK
))
509 system_del_route(dev
, &route
);
514 interface_update_proto_addr(struct vlist_tree
*tree
,
515 struct vlist_node
*node_new
,
516 struct vlist_node
*node_old
)
518 struct interface_ip_settings
*ip
;
519 struct interface
*iface
;
521 struct device_addr
*a_new
= NULL
, *a_old
= NULL
;
522 bool replace
= false;
526 ip
= container_of(tree
, struct interface_ip_settings
, addr
);
528 dev
= iface
->l3_dev
.dev
;
531 a_new
= container_of(node_new
, struct device_addr
, node
);
533 if ((a_new
->flags
& DEVADDR_FAMILY
) == DEVADDR_INET4
&&
537 uint32_t *a
= (uint32_t *) &a_new
->addr
;
539 mask
>>= a_new
->mask
;
540 a_new
->broadcast
= *a
| htonl(mask
);
545 a_old
= container_of(node_old
, struct device_addr
, node
);
547 if (a_new
&& a_old
) {
550 if (a_old
->flags
!= a_new
->flags
)
553 if (a_old
->valid_until
!= a_new
->valid_until
||
554 a_old
->preferred_until
!= a_new
->preferred_until
)
557 if ((a_new
->flags
& DEVADDR_FAMILY
) == DEVADDR_INET4
&&
558 a_new
->broadcast
!= a_old
->broadcast
)
563 if (!(a_old
->flags
& DEVADDR_EXTERNAL
) && a_old
->enabled
&& !keep
) {
564 interface_handle_subnet_route(iface
, a_old
, false);
566 if ((a_old
->flags
& DEVADDR_FAMILY
) == DEVADDR_INET6
)
569 //This is needed for source routing to work correctly. If a device
570 //has two connections to a network using the same subnet, adding
571 //only the network-rule will cause packets to be routed through the
572 //first matching network (source IP matches both masks).
573 set_ip_source_policy(false, v6
, IPRULE_PRIORITY_ADDR
, &a_old
->addr
,
574 (v6
) ? 128 : 32, (v6
) ? iface
->ip6table
: iface
->ip4table
,
576 set_ip_source_policy(false, v6
, IPRULE_PRIORITY_NW
, &a_old
->addr
,
577 a_old
->mask
, (v6
) ? iface
->ip6table
: iface
->ip4table
, NULL
, NULL
);
579 system_del_address(dev
, a_old
);
585 a_new
->enabled
= true;
586 if (!(a_new
->flags
& DEVADDR_EXTERNAL
) && (!keep
|| replace
)) {
587 system_add_address(dev
, a_new
);
590 if ((a_new
->flags
& DEVADDR_FAMILY
) == DEVADDR_INET6
)
593 set_ip_source_policy(true, v6
, IPRULE_PRIORITY_ADDR
, &a_new
->addr
,
594 (v6
) ? 128 : 32, (v6
) ? iface
->ip6table
: iface
->ip4table
,
596 set_ip_source_policy(true, v6
, IPRULE_PRIORITY_NW
, &a_new
->addr
,
597 a_new
->mask
, (v6
) ? iface
->ip6table
: iface
->ip4table
,
601 if ((a_new
->flags
& DEVADDR_OFFLINK
) || iface
->metric
)
602 interface_handle_subnet_route(iface
, a_new
, true);
608 enable_route(struct interface_ip_settings
*ip
, struct device_route
*route
)
610 if (ip
->no_defaultroute
&& !route
->mask
)
617 interface_update_proto_route(struct vlist_tree
*tree
,
618 struct vlist_node
*node_new
,
619 struct vlist_node
*node_old
)
621 struct interface_ip_settings
*ip
;
622 struct interface
*iface
;
624 struct device_route
*route_old
, *route_new
;
627 ip
= container_of(tree
, struct interface_ip_settings
, route
);
629 dev
= iface
->l3_dev
.dev
;
631 route_old
= container_of(node_old
, struct device_route
, node
);
632 route_new
= container_of(node_new
, struct device_route
, node
);
634 if (node_old
&& node_new
)
635 keep
= !memcmp(&route_old
->nexthop
, &route_new
->nexthop
, sizeof(route_old
->nexthop
));
638 if (!(route_old
->flags
& DEVADDR_EXTERNAL
) && route_old
->enabled
&& !keep
)
639 system_del_route(dev
, route_old
);
641 put_source_table(route_old
);
646 bool _enabled
= enable_route(ip
, route_new
);
648 if (!(route_new
->flags
& DEVROUTE_METRIC
))
649 route_new
->metric
= iface
->metric
;
651 if (!(route_new
->flags
& DEVADDR_EXTERNAL
) && !keep
&& _enabled
)
652 system_add_route(dev
, route_new
);
654 route_new
->iface
= iface
;
655 route_new
->enabled
= _enabled
;
660 interface_update_host_route(struct vlist_tree
*tree
,
661 struct vlist_node
*node_new
,
662 struct vlist_node
*node_old
)
664 struct interface
*iface
;
666 struct device_route
*route_old
, *route_new
;
668 iface
= container_of(tree
, struct interface
, host_routes
);
669 dev
= iface
->l3_dev
.dev
;
671 route_old
= container_of(node_old
, struct device_route
, node
);
672 route_new
= container_of(node_new
, struct device_route
, node
);
675 system_del_route(dev
, route_old
);
680 system_add_route(dev
, route_new
);
685 interface_set_prefix_address(struct device_prefix_assignment
*assignment
,
686 const struct device_prefix
*prefix
, struct interface
*iface
, bool add
)
688 const struct interface
*uplink
= prefix
->iface
;
689 if (!iface
->l3_dev
.dev
)
692 struct device
*l3_downlink
= iface
->l3_dev
.dev
;
694 struct device_addr addr
;
695 memset(&addr
, 0, sizeof(addr
));
696 addr
.addr
.in6
= prefix
->addr
;
697 addr
.addr
.in6
.s6_addr32
[1] |= htonl(assignment
->assigned
);
698 addr
.addr
.in6
.s6_addr
[15] += 1;
699 addr
.mask
= assignment
->length
;
700 addr
.flags
= DEVADDR_INET6
;
701 addr
.preferred_until
= prefix
->preferred_until
;
702 addr
.valid_until
= prefix
->valid_until
;
704 if (!add
&& assignment
->enabled
) {
705 time_t now
= system_get_rtime();
706 addr
.preferred_until
= now
;
707 if (!addr
.valid_until
|| addr
.valid_until
- now
> 7200)
708 addr
.valid_until
= now
+ 7200;
709 system_add_address(l3_downlink
, &addr
);
711 set_ip_source_policy(false, true, IPRULE_PRIORITY_NW
, &addr
.addr
,
712 addr
.mask
, prefix
->iface
->ip6table
, iface
, NULL
);
714 set_ip_source_policy(false, true, IPRULE_PRIORITY_REJECT
, &addr
.addr
,
715 addr
.mask
, 0, iface
, "unreachable");
718 assignment
->enabled
= false;
719 } else if (add
&& (iface
->state
== IFS_UP
|| iface
->state
== IFS_SETUP
)) {
720 system_add_address(l3_downlink
, &addr
);
721 if (prefix
->iface
&& !assignment
->enabled
) {
722 set_ip_source_policy(true, true, IPRULE_PRIORITY_REJECT
, &addr
.addr
,
723 addr
.mask
, 0, iface
, "unreachable");
725 set_ip_source_policy(true, true, IPRULE_PRIORITY_NW
, &addr
.addr
,
726 addr
.mask
, prefix
->iface
->ip6table
, iface
, NULL
);
728 if (uplink
&& uplink
->l3_dev
.dev
) {
729 int mtu
= system_update_ipv6_mtu(
730 uplink
->l3_dev
.dev
, 0);
732 system_update_ipv6_mtu(l3_downlink
, mtu
);
734 assignment
->enabled
= true;
738 static bool interface_prefix_assign(struct list_head
*list
,
739 struct device_prefix_assignment
*assign
)
741 int32_t current
= 0, asize
= (1 << (64 - assign
->length
)) - 1;
742 struct device_prefix_assignment
*c
;
743 list_for_each_entry(c
, list
, head
) {
744 if (assign
->assigned
!= -1) {
745 if (assign
->assigned
>= current
&& assign
->assigned
+ asize
< c
->assigned
) {
746 list_add_tail(&assign
->head
, &c
->head
);
749 } else if (assign
->assigned
== -1) {
750 current
= (current
+ asize
) & (~asize
);
751 if (current
+ asize
< c
->assigned
) {
752 assign
->assigned
= current
;
753 list_add_tail(&assign
->head
, &c
->head
);
757 current
= (c
->assigned
+ (1 << (64 - c
->length
)));
762 static void interface_update_prefix_assignments(struct device_prefix
*prefix
, bool setup
)
764 struct device_prefix_assignment
*c
;
765 struct interface
*iface
;
767 // Delete all assignments
768 while (!list_empty(&prefix
->assignments
)) {
769 c
= list_first_entry(&prefix
->assignments
,
770 struct device_prefix_assignment
, head
);
771 if ((iface
= vlist_find(&interfaces
, c
->name
, iface
, node
)))
772 interface_set_prefix_address(c
, prefix
, iface
, false);
780 // End-of-assignment sentinel
781 c
= malloc(sizeof(*c
) + 1);
782 c
->assigned
= 1 << (64 - prefix
->length
);
785 list_add(&c
->head
, &prefix
->assignments
);
788 if (prefix
->excl_length
> 0) {
789 const char name
[] = "!excluded";
790 c
= malloc(sizeof(*c
) + sizeof(name
));
791 c
->assigned
= ntohl(prefix
->excl_addr
.s6_addr32
[1]) &
792 ((1 << (64 - prefix
->length
)) - 1);
793 c
->length
= prefix
->excl_length
;
794 memcpy(c
->name
, name
, sizeof(name
));
795 list_add(&c
->head
, &prefix
->assignments
);
798 bool assigned_any
= false;
799 struct list_head assign_later
= LIST_HEAD_INIT(assign_later
);
800 vlist_for_each_element(&interfaces
, iface
, node
) {
801 if (iface
->assignment_length
< 48 ||
802 iface
->assignment_length
> 64)
805 // Test whether there is a matching class
806 if (!list_empty(&iface
->assignment_classes
)) {
809 struct interface_assignment_class
*c
;
810 list_for_each_entry(c
, &iface
->assignment_classes
, head
) {
811 if (!strcmp(c
->name
, prefix
->pclass
)) {
821 size_t namelen
= strlen(iface
->name
) + 1;
822 c
= malloc(sizeof(*c
) + namelen
);
823 c
->length
= iface
->assignment_length
;
824 c
->assigned
= iface
->assignment_hint
;
826 memcpy(c
->name
, iface
->name
, namelen
);
828 // First process all custom assignments, put all others in later-list
829 if (c
->assigned
== -1 || !interface_prefix_assign(&prefix
->assignments
, c
)) {
830 if (c
->assigned
!= -1) {
832 netifd_log_message(L_WARNING
, "Failed to assign requested subprefix "
833 "of size %hhu for %s, trying other\n", c
->length
, c
->name
);
836 struct list_head
*next
= &assign_later
;
837 struct device_prefix_assignment
*n
;
838 list_for_each_entry(n
, &assign_later
, head
) {
839 if (n
->length
< c
->length
) {
844 list_add_tail(&c
->head
, next
);
847 if (c
->assigned
!= -1)
851 // Then try to assign all other + failed custom assignments
852 while (!list_empty(&assign_later
)) {
853 c
= list_first_entry(&assign_later
, struct device_prefix_assignment
, head
);
856 bool assigned
= false;
858 assigned
= interface_prefix_assign(&prefix
->assignments
, c
);
859 } while (!assigned
&& ++c
->length
<= 64);
862 netifd_log_message(L_WARNING
, "Failed to assign subprefix "
863 "of size %hhu for %s\n", c
->length
, c
->name
);
870 list_for_each_entry(c
, &prefix
->assignments
, head
)
871 if ((iface
= vlist_find(&interfaces
, c
->name
, iface
, node
)))
872 interface_set_prefix_address(c
, prefix
, iface
, true);
875 netifd_log_message(L_WARNING
, "You have delegated IPv6-prefixes but haven't assigned them "
876 "to any interface. Did you forget to set option ip6assign on your lan-interfaces?");
880 void interface_refresh_assignments(bool hint
)
882 static bool refresh
= false;
883 if (!hint
&& refresh
) {
884 struct device_prefix
*p
;
885 list_for_each_entry(p
, &prefixes
, head
)
886 interface_update_prefix_assignments(p
, true);
893 interface_update_prefix(struct vlist_tree
*tree
,
894 struct vlist_node
*node_new
,
895 struct vlist_node
*node_old
)
897 struct device_prefix
*prefix_old
, *prefix_new
;
898 prefix_old
= container_of(node_old
, struct device_prefix
, node
);
899 prefix_new
= container_of(node_new
, struct device_prefix
, node
);
901 struct device_route route
;
902 memset(&route
, 0, sizeof(route
));
903 route
.flags
= DEVADDR_INET6
;
904 route
.metric
= INT32_MAX
;
905 route
.mask
= (node_new
) ? prefix_new
->length
: prefix_old
->length
;
906 route
.addr
.in6
= (node_new
) ? prefix_new
->addr
: prefix_old
->addr
;
909 struct device_prefix_assignment
*c
;
910 struct interface
*iface
;
912 if (node_old
&& node_new
) {
913 // Move assignments and refresh addresses to update valid times
914 list_splice(&prefix_old
->assignments
, &prefix_new
->assignments
);
916 list_for_each_entry(c
, &prefix_new
->assignments
, head
)
917 if ((iface
= vlist_find(&interfaces
, c
->name
, iface
, node
)))
918 interface_set_prefix_address(c
, prefix_new
, iface
, true);
919 } else if (node_new
) {
920 // Set null-route to avoid routing loops
921 system_add_route(NULL
, &route
);
923 if (!prefix_new
->iface
|| !prefix_new
->iface
->proto_ip
.no_delegation
)
924 interface_update_prefix_assignments(prefix_new
, true);
925 } else if (node_old
) {
927 interface_update_prefix_assignments(prefix_old
, false);
928 system_del_route(NULL
, &route
);
932 if (prefix_old
->head
.next
)
933 list_del(&prefix_old
->head
);
937 if (node_new
&& (!prefix_new
->iface
|| !prefix_new
->iface
->proto_ip
.no_delegation
))
938 list_add(&prefix_new
->head
, &prefixes
);
942 struct device_prefix
*
943 interface_ip_add_device_prefix(struct interface
*iface
, struct in6_addr
*addr
,
944 uint8_t length
, time_t valid_until
, time_t preferred_until
,
945 struct in6_addr
*excl_addr
, uint8_t excl_length
, const char *pclass
)
948 pclass
= (iface
) ? iface
->name
: "local";
950 struct device_prefix
*prefix
= calloc(1, sizeof(*prefix
) + strlen(pclass
) + 1);
951 prefix
->length
= length
;
952 prefix
->addr
= *addr
;
953 prefix
->preferred_until
= preferred_until
;
954 prefix
->valid_until
= valid_until
;
955 prefix
->iface
= iface
;
956 INIT_LIST_HEAD(&prefix
->assignments
);
959 prefix
->excl_addr
= *excl_addr
;
960 prefix
->excl_length
= excl_length
;
963 strcpy(prefix
->pclass
, pclass
);
966 vlist_add(&iface
->proto_ip
.prefix
, &prefix
->node
, &prefix
->addr
);
968 interface_update_prefix(NULL
, &prefix
->node
, NULL
);
974 interface_ip_set_ula_prefix(const char *prefix
)
976 char buf
[INET6_ADDRSTRLEN
+ 4] = {0}, *saveptr
;
978 strncpy(buf
, prefix
, sizeof(buf
) - 1);
979 char *prefixaddr
= strtok_r(buf
, "/", &saveptr
);
981 struct in6_addr addr
;
982 if (!prefixaddr
|| inet_pton(AF_INET6
, prefixaddr
, &addr
) < 1) {
984 interface_update_prefix(NULL
, NULL
, &ula_prefix
->node
);
991 char *prefixlen
= strtok_r(NULL
, ",", &saveptr
);
992 if (!prefixlen
|| (length
= atoi(prefixlen
)) < 1 || length
> 64)
995 if (!ula_prefix
|| !IN6_ARE_ADDR_EQUAL(&addr
, &ula_prefix
->addr
) ||
996 ula_prefix
->length
!= length
) {
998 interface_update_prefix(NULL
, NULL
, &ula_prefix
->node
);
1000 ula_prefix
= interface_ip_add_device_prefix(NULL
, &addr
, length
,
1001 0, 0, NULL
, 0, NULL
);
1006 interface_add_dns_server(struct interface_ip_settings
*ip
, const char *str
)
1008 struct dns_server
*s
;
1010 s
= calloc(1, sizeof(*s
));
1015 if (inet_pton(s
->af
, str
, &s
->addr
.in
))
1019 if (inet_pton(s
->af
, str
, &s
->addr
.in
))
1026 D(INTERFACE
, "Add IPv%c DNS server: %s\n",
1027 s
->af
== AF_INET6
? '6' : '4', str
);
1028 vlist_simple_add(&ip
->dns_servers
, &s
->node
);
1032 interface_add_dns_server_list(struct interface_ip_settings
*ip
, struct blob_attr
*list
)
1034 struct blob_attr
*cur
;
1037 blobmsg_for_each_attr(cur
, list
, rem
) {
1038 if (blobmsg_type(cur
) != BLOBMSG_TYPE_STRING
)
1041 if (!blobmsg_check_attr(cur
, NULL
))
1044 interface_add_dns_server(ip
, blobmsg_data(cur
));
1049 interface_add_dns_search_domain(struct interface_ip_settings
*ip
, const char *str
)
1051 struct dns_search_domain
*s
;
1052 int len
= strlen(str
);
1054 s
= calloc(1, sizeof(*s
) + len
+ 1);
1058 D(INTERFACE
, "Add DNS search domain: %s\n", str
);
1059 memcpy(s
->name
, str
, len
);
1060 vlist_simple_add(&ip
->dns_search
, &s
->node
);
1064 interface_add_dns_search_list(struct interface_ip_settings
*ip
, struct blob_attr
*list
)
1066 struct blob_attr
*cur
;
1069 blobmsg_for_each_attr(cur
, list
, rem
) {
1070 if (blobmsg_type(cur
) != BLOBMSG_TYPE_STRING
)
1073 if (!blobmsg_check_attr(cur
, NULL
))
1076 interface_add_dns_search_domain(ip
, blobmsg_data(cur
));
1081 write_resolv_conf_entries(FILE *f
, struct interface_ip_settings
*ip
)
1083 struct dns_server
*s
;
1084 struct dns_search_domain
*d
;
1086 char buf
[INET6_ADDRSTRLEN
];
1088 vlist_simple_for_each_element(&ip
->dns_servers
, s
, node
) {
1089 str
= inet_ntop(s
->af
, &s
->addr
, buf
, sizeof(buf
));
1093 fprintf(f
, "nameserver %s\n", str
);
1096 vlist_simple_for_each_element(&ip
->dns_search
, d
, node
) {
1097 fprintf(f
, "search %s\n", d
->name
);
1102 interface_write_resolv_conf(void)
1104 struct interface
*iface
;
1105 char *path
= alloca(strlen(resolv_conf
) + 5);
1107 uint32_t crcold
, crcnew
;
1109 sprintf(path
, "%s.tmp", resolv_conf
);
1111 f
= fopen(path
, "w+");
1113 D(INTERFACE
, "Failed to open %s for writing\n", path
);
1117 vlist_for_each_element(&interfaces
, iface
, node
) {
1118 if (iface
->state
!= IFS_UP
)
1121 if (vlist_simple_empty(&iface
->proto_ip
.dns_search
) &&
1122 vlist_simple_empty(&iface
->proto_ip
.dns_servers
) &&
1123 vlist_simple_empty(&iface
->config_ip
.dns_search
) &&
1124 vlist_simple_empty(&iface
->config_ip
.dns_servers
))
1127 fprintf(f
, "# Interface %s\n", iface
->name
);
1128 write_resolv_conf_entries(f
, &iface
->config_ip
);
1129 if (!iface
->proto_ip
.no_dns
)
1130 write_resolv_conf_entries(f
, &iface
->proto_ip
);
1134 crcnew
= crc32_file(f
);
1137 crcold
= crcnew
+ 1;
1138 f
= fopen(resolv_conf
, "r");
1140 crcold
= crc32_file(f
);
1144 if (crcold
== crcnew
) {
1146 } else if (rename(path
, resolv_conf
) < 0) {
1147 D(INTERFACE
, "Failed to replace %s\n", resolv_conf
);
1152 void interface_ip_set_enabled(struct interface_ip_settings
*ip
, bool enabled
)
1154 struct device_addr
*addr
;
1155 struct device_route
*route
;
1158 ip
->enabled
= enabled
;
1159 dev
= ip
->iface
->l3_dev
.dev
;
1163 vlist_for_each_element(&ip
->addr
, addr
, node
) {
1164 if (addr
->enabled
== enabled
)
1168 system_add_address(dev
, addr
);
1170 system_del_address(dev
, addr
);
1171 addr
->enabled
= enabled
;
1174 vlist_for_each_element(&ip
->route
, route
, node
) {
1175 bool _enabled
= enabled
;
1177 if (!enable_route(ip
, route
))
1180 if (route
->enabled
== _enabled
)
1184 if (!(route
->flags
& DEVROUTE_METRIC
))
1185 route
->metric
= ip
->iface
->metric
;
1187 system_add_route(dev
, route
);
1189 system_del_route(dev
, route
);
1190 route
->enabled
= _enabled
;
1193 struct device_prefix
*c
;
1194 struct device_prefix_assignment
*a
;
1195 list_for_each_entry(c
, &prefixes
, head
)
1196 list_for_each_entry(a
, &c
->assignments
, head
)
1197 if (!strcmp(a
->name
, ip
->iface
->name
))
1198 interface_set_prefix_address(a
, c
, ip
->iface
, enabled
);
1200 if (ip
->iface
&& ip
->iface
->l3_dev
.dev
) {
1201 set_ip_lo_policy(enabled
, true, ip
->iface
);
1202 set_ip_lo_policy(enabled
, false, ip
->iface
);
1204 set_ip_source_policy(enabled
, true, IPRULE_PRIORITY_REJECT
+ ip
->iface
->l3_dev
.dev
->ifindex
,
1205 NULL
, 0, 0, ip
->iface
, "failed_policy");
1210 interface_ip_update_start(struct interface_ip_settings
*ip
)
1212 if (ip
!= &ip
->iface
->config_ip
) {
1213 vlist_simple_update(&ip
->dns_servers
);
1214 vlist_simple_update(&ip
->dns_search
);
1216 vlist_update(&ip
->route
);
1217 vlist_update(&ip
->addr
);
1218 vlist_update(&ip
->prefix
);
1222 interface_ip_update_complete(struct interface_ip_settings
*ip
)
1224 vlist_simple_flush(&ip
->dns_servers
);
1225 vlist_simple_flush(&ip
->dns_search
);
1226 vlist_flush(&ip
->route
);
1227 vlist_flush(&ip
->addr
);
1228 vlist_flush(&ip
->prefix
);
1229 interface_write_resolv_conf();
1233 interface_ip_flush(struct interface_ip_settings
*ip
)
1235 if (ip
== &ip
->iface
->proto_ip
)
1236 vlist_flush_all(&ip
->iface
->host_routes
);
1237 vlist_simple_flush_all(&ip
->dns_servers
);
1238 vlist_simple_flush_all(&ip
->dns_search
);
1239 vlist_flush_all(&ip
->route
);
1240 vlist_flush_all(&ip
->addr
);
1241 vlist_flush_all(&ip
->prefix
);
1245 __interface_ip_init(struct interface_ip_settings
*ip
, struct interface
*iface
)
1249 vlist_simple_init(&ip
->dns_search
, struct dns_search_domain
, node
);
1250 vlist_simple_init(&ip
->dns_servers
, struct dns_server
, node
);
1251 vlist_init(&ip
->route
, route_cmp
, interface_update_proto_route
);
1252 vlist_init(&ip
->addr
, addr_cmp
, interface_update_proto_addr
);
1253 vlist_init(&ip
->prefix
, prefix_cmp
, interface_update_prefix
);
1257 interface_ip_init(struct interface
*iface
)
1259 __interface_ip_init(&iface
->proto_ip
, iface
);
1260 __interface_ip_init(&iface
->config_ip
, iface
);
1261 vlist_init(&iface
->host_routes
, route_cmp
, interface_update_host_route
);
1266 interface_ip_valid_until_handler(struct uloop_timeout
*t
)
1268 time_t now
= system_get_rtime();
1269 struct interface
*iface
;
1270 vlist_for_each_element(&interfaces
, iface
, node
) {
1271 if (iface
->state
!= IFS_UP
)
1274 struct device_addr
*addr
, *addrp
;
1275 struct device_route
*route
, *routep
;
1276 struct device_prefix
*pref
, *prefp
;
1278 vlist_for_each_element_safe(&iface
->proto_ip
.addr
, addr
, node
, addrp
)
1279 if (addr
->valid_until
&& addr
->valid_until
< now
)
1280 vlist_delete(&iface
->proto_ip
.addr
, &addr
->node
);
1282 vlist_for_each_element_safe(&iface
->proto_ip
.route
, route
, node
, routep
)
1283 if (route
->valid_until
&& route
->valid_until
< now
)
1284 vlist_delete(&iface
->proto_ip
.route
, &route
->node
);
1286 vlist_for_each_element_safe(&iface
->proto_ip
.prefix
, pref
, node
, prefp
)
1287 if (pref
->valid_until
&& pref
->valid_until
< now
)
1288 vlist_delete(&iface
->proto_ip
.prefix
, &pref
->node
);
1292 uloop_timeout_set(t
, 1000);
1296 interface_ip_init_worker(void)
1298 valid_until_timeout
.cb
= interface_ip_valid_until_handler
;
1299 uloop_timeout_set(&valid_until_timeout
, 1000);