]> git.ipfire.org Git - thirdparty/systemd.git/blame - src/libsystemd-network/sd-radv.c
tree-wide: use ASSERT_PTR more
[thirdparty/systemd.git] / src / libsystemd-network / sd-radv.c
CommitLineData
db9ecf05 1/* SPDX-License-Identifier: LGPL-2.1-or-later */
04473969 2/***
810adae9 3 Copyright © 2017 Intel Corporation. All rights reserved.
04473969
PF
4***/
5
6#include <netinet/icmp6.h>
7#include <netinet/in.h>
204f99d2 8#include <arpa/inet.h>
04473969
PF
9
10#include "sd-radv.h"
11
12#include "alloc-util.h"
e965d6ab 13#include "dns-domain.h"
ae25915d 14#include "ether-addr-util.h"
807a8ede 15#include "event-util.h"
04473969
PF
16#include "fd-util.h"
17#include "icmp6-util.h"
18#include "in-addr-util.h"
5cfa2c3d
LP
19#include "io-util.h"
20#include "macro.h"
0a970718 21#include "memory-util.h"
61a9fa8f 22#include "network-common.h"
04473969 23#include "radv-internal.h"
5cfa2c3d 24#include "random-util.h"
04473969
PF
25#include "socket-util.h"
26#include "string-util.h"
e965d6ab 27#include "strv.h"
04473969 28
17347053 29int sd_radv_new(sd_radv **ret) {
204f99d2
PF
30 _cleanup_(sd_radv_unrefp) sd_radv *ra = NULL;
31
32 assert_return(ret, -EINVAL);
33
78f9d24f 34 ra = new(sd_radv, 1);
204f99d2
PF
35 if (!ra)
36 return -ENOMEM;
37
78f9d24f
YW
38 *ra = (sd_radv) {
39 .n_ref = 1,
40 .fd = -1,
72db0a71 41 .lifetime_usec = RADV_DEFAULT_ROUTER_LIFETIME_USEC,
78f9d24f 42 };
204f99d2 43
1cc6c93a 44 *ret = TAKE_PTR(ra);
204f99d2
PF
45
46 return 0;
47}
48
17347053 49int sd_radv_attach_event(sd_radv *ra, sd_event *event, int64_t priority) {
204f99d2
PF
50 int r;
51
52 assert_return(ra, -EINVAL);
53 assert_return(!ra->event, -EBUSY);
54
55 if (event)
56 ra->event = sd_event_ref(event);
57 else {
58 r = sd_event_default(&ra->event);
59 if (r < 0)
60 return 0;
61 }
62
63 ra->event_priority = priority;
64
65 return 0;
66}
67
17347053 68int sd_radv_detach_event(sd_radv *ra) {
204f99d2
PF
69
70 assert_return(ra, -EINVAL);
71
72 ra->event = sd_event_unref(ra->event);
73 return 0;
74}
75
17347053 76sd_event *sd_radv_get_event(sd_radv *ra) {
204f99d2
PF
77 assert_return(ra, NULL);
78
79 return ra->event;
80}
81
17347053 82int sd_radv_is_running(sd_radv *ra) {
96fe813c
YW
83 assert_return(ra, false);
84
d6fc0d67 85 return ra->state != RADV_STATE_IDLE;
96fe813c
YW
86}
87
204fb681 88static void radv_reset(sd_radv *ra) {
c4b6dda0 89 assert(ra);
204fb681 90
807a8ede 91 (void) event_source_disable(ra->timeout_event_source);
204fb681 92
eb2f7502 93 ra->recv_event_source = sd_event_source_disable_unref(ra->recv_event_source);
88d5a3db 94
204fb681
PF
95 ra->ra_sent = 0;
96}
97
8301aa0b 98static sd_radv *radv_free(sd_radv *ra) {
e866e17b
LP
99 if (!ra)
100 return NULL;
204f99d2
PF
101
102 while (ra->prefixes) {
103 sd_radv_prefix *p = ra->prefixes;
104
105 LIST_REMOVE(prefix, ra->prefixes, p);
106 sd_radv_prefix_unref(p);
107 }
108
69d7eba1
YW
109 while (ra->route_prefixes) {
110 sd_radv_route_prefix *p = ra->route_prefixes;
111
112 LIST_REMOVE(prefix, ra->route_prefixes, p);
113 sd_radv_route_prefix_unref(p);
114 }
115
e9c6da38 116 free(ra->rdnss);
f9aa5417 117 free(ra->dnssl);
e9c6da38 118
204fb681
PF
119 radv_reset(ra);
120
eb2f7502 121 sd_event_source_unref(ra->timeout_event_source);
204f99d2 122 sd_radv_detach_event(ra);
c4b6dda0
LP
123
124 ra->fd = safe_close(ra->fd);
61a9fa8f 125 free(ra->ifname);
c4b6dda0 126
204f99d2
PF
127 return mfree(ra);
128}
129
8301aa0b
YW
130DEFINE_PUBLIC_TRIVIAL_REF_UNREF_FUNC(sd_radv, sd_radv, radv_free);
131
09457670
YW
132static bool router_lifetime_is_valid(usec_t lifetime_usec) {
133 return lifetime_usec == 0 ||
134 (lifetime_usec >= RADV_MIN_ROUTER_LIFETIME_USEC &&
135 lifetime_usec <= RADV_MAX_ROUTER_LIFETIME_USEC);
136}
137
95e104e0
YW
138static be32_t usec_to_be32_sec(usec_t usec) {
139 if (usec == USEC_INFINITY)
140 /* UINT32_MAX is handled as infinity. */
141 return htobe32(UINT32_MAX);
142
143 if (usec >= UINT32_MAX * USEC_PER_SEC)
144 /* Finite but too large. Let's use the largest finite value. */
145 return htobe32(UINT32_MAX - 1);
146
147 return htobe32(usec / USEC_PER_SEC);
148}
149
7003b114 150static int radv_send(sd_radv *ra, const struct in6_addr *dst, usec_t lifetime_usec) {
77baf5ae
PF
151 struct sockaddr_in6 dst_addr = {
152 .sin6_family = AF_INET6,
153 .sin6_addr = IN6ADDR_ALL_NODES_MULTICAST_INIT,
154 };
155 struct nd_router_advert adv = {};
156 struct {
157 struct nd_opt_hdr opthdr;
158 struct ether_addr slladdr;
159 } _packed_ opt_mac = {
160 .opthdr = {
161 .nd_opt_type = ND_OPT_SOURCE_LINKADDR,
162 .nd_opt_len = (sizeof(struct nd_opt_hdr) +
163 sizeof(struct ether_addr) - 1) /8 + 1,
164 },
165 };
166 struct nd_opt_mtu opt_mtu = {
167 .nd_opt_mtu_type = ND_OPT_MTU,
168 .nd_opt_mtu_len = 1,
169 };
203d4df5 170 /* Reserve iov space for RA header, linkaddr, MTU, N prefixes, N routes, RDNSS
6852c0f6 171 and DNSSL */
203d4df5 172 struct iovec iov[5 + ra->n_prefixes + ra->n_route_prefixes];
77baf5ae
PF
173 struct msghdr msg = {
174 .msg_name = &dst_addr,
175 .msg_namelen = sizeof(dst_addr),
176 .msg_iov = iov,
177 };
d601b566
PF
178 usec_t time_now;
179 int r;
180
dc0ec5e2 181 assert(ra);
09457670 182 assert(router_lifetime_is_valid(lifetime_usec));
dc0ec5e2 183
ba4e0427 184 r = sd_event_now(ra->event, CLOCK_BOOTTIME, &time_now);
d601b566
PF
185 if (r < 0)
186 return r;
77baf5ae 187
94876904 188 if (dst && in6_addr_is_set(dst))
77baf5ae 189 dst_addr.sin6_addr = *dst;
88d5a3db 190
77baf5ae
PF
191 adv.nd_ra_type = ND_ROUTER_ADVERT;
192 adv.nd_ra_curhoplimit = ra->hop_limit;
193 adv.nd_ra_flags_reserved = ra->flags;
09457670
YW
194 assert_cc(RADV_MAX_ROUTER_LIFETIME_USEC <= UINT16_MAX * USEC_PER_SEC);
195 adv.nd_ra_router_lifetime = htobe16(DIV_ROUND_UP(lifetime_usec, USEC_PER_SEC));
5cfa2c3d 196 iov[msg.msg_iovlen++] = IOVEC_MAKE(&adv, sizeof(adv));
77baf5ae
PF
197
198 /* MAC address is optional, either because the link does not use L2
199 addresses or load sharing is desired. See RFC 4861, Section 4.2 */
ae25915d 200 if (!ether_addr_is_null(&ra->mac_addr)) {
77baf5ae 201 opt_mac.slladdr = ra->mac_addr;
5cfa2c3d 202 iov[msg.msg_iovlen++] = IOVEC_MAKE(&opt_mac, sizeof(opt_mac));
77baf5ae
PF
203 }
204
41521417 205 if (ra->mtu > 0) {
77baf5ae 206 opt_mtu.nd_opt_mtu_mtu = htobe32(ra->mtu);
5cfa2c3d 207 iov[msg.msg_iovlen++] = IOVEC_MAKE(&opt_mtu, sizeof(opt_mtu));
77baf5ae
PF
208 }
209
210 LIST_FOREACH(prefix, p, ra->prefixes) {
95e104e0 211 usec_t lifetime_valid_usec, lifetime_preferred_usec;
d601b566 212
95e104e0
YW
213 lifetime_valid_usec = MIN(usec_sub_unsigned(p->valid_until, time_now),
214 p->lifetime_valid_usec);
215
216 lifetime_preferred_usec = MIN3(usec_sub_unsigned(p->preferred_until, time_now),
217 p->lifetime_preferred_usec,
218 lifetime_valid_usec);
219
220 p->opt.lifetime_valid = usec_to_be32_sec(lifetime_valid_usec);
221 p->opt.lifetime_preferred = usec_to_be32_sec(lifetime_preferred_usec);
d601b566 222
5cfa2c3d 223 iov[msg.msg_iovlen++] = IOVEC_MAKE(&p->opt, sizeof(p->opt));
77baf5ae
PF
224 }
225
95e104e0
YW
226 LIST_FOREACH(prefix, rt, ra->route_prefixes) {
227 rt->opt.lifetime = usec_to_be32_sec(MIN(usec_sub_unsigned(rt->valid_until, time_now),
228 rt->lifetime_usec));
229
203d4df5 230 iov[msg.msg_iovlen++] = IOVEC_MAKE(&rt->opt, sizeof(rt->opt));
95e104e0 231 }
203d4df5 232
5cfa2c3d
LP
233 if (ra->rdnss)
234 iov[msg.msg_iovlen++] = IOVEC_MAKE(ra->rdnss, ra->rdnss->length * 8);
e9c6da38 235
5cfa2c3d
LP
236 if (ra->dnssl)
237 iov[msg.msg_iovlen++] = IOVEC_MAKE(ra->dnssl, ra->dnssl->length * 8);
e965d6ab 238
77baf5ae
PF
239 if (sendmsg(ra->fd, &msg, 0) < 0)
240 return -errno;
204fb681 241
77baf5ae 242 return 0;
204fb681
PF
243}
244
88d5a3db 245static int radv_recv(sd_event_source *s, int fd, uint32_t revents, void *userdata) {
99534007 246 sd_radv *ra = ASSERT_PTR(userdata);
88d5a3db
PF
247 struct in6_addr src;
248 triple_timestamp timestamp;
249 int r;
88d5a3db
PF
250
251 assert(s);
88d5a3db
PF
252 assert(ra->event);
253
dd6d433a 254 ssize_t buflen = next_datagram_size_fd(fd);
ab8a8a4e
YW
255 if (buflen < 0) {
256 if (ERRNO_IS_TRANSIENT(buflen) || ERRNO_IS_DISCONNECT(buflen))
257 return 0;
258
259 log_radv_errno(ra, buflen, "Failed to determine datagram size to read, ignoring: %m");
260 return 0;
261 }
88d5a3db 262
dd6d433a 263 _cleanup_free_ char *buf = new0(char, buflen);
88d5a3db 264 if (!buf)
e55a6eae 265 return -ENOMEM;
88d5a3db
PF
266
267 r = icmp6_receive(fd, buf, buflen, &src, &timestamp);
268 if (r < 0) {
ab8a8a4e
YW
269 if (ERRNO_IS_TRANSIENT(r) || ERRNO_IS_DISCONNECT(r))
270 return 0;
271
88d5a3db
PF
272 switch (r) {
273 case -EADDRNOTAVAIL:
84dbb3fd
ZJS
274 log_radv(ra, "Received RS from non-link-local address %s. Ignoring",
275 IN6_ADDR_TO_STRING(&src));
88d5a3db
PF
276 break;
277
278 case -EMULTIHOP:
35388783 279 log_radv(ra, "Received RS with invalid hop limit. Ignoring.");
88d5a3db
PF
280 break;
281
282 case -EPFNOSUPPORT:
35388783 283 log_radv(ra, "Received invalid source address from ICMPv6 socket. Ignoring.");
88d5a3db
PF
284 break;
285
286 default:
ab8a8a4e 287 log_radv_errno(ra, r, "Unexpected error receiving from ICMPv6 socket, ignoring: %m");
88d5a3db
PF
288 break;
289 }
290
291 return 0;
292 }
293
cfffddea 294 if ((size_t) buflen < sizeof(struct nd_router_solicit)) {
35388783 295 log_radv(ra, "Too short packet received, ignoring");
cfffddea
LP
296 return 0;
297 }
298
84dbb3fd 299 const char *addr = IN6_ADDR_TO_STRING(&src);
88d5a3db 300
7003b114 301 r = radv_send(ra, &src, ra->lifetime_usec);
88d5a3db 302 if (r < 0)
84dbb3fd 303 log_radv_errno(ra, r, "Unable to send solicited Router Advertisement to %s, ignoring: %m", addr);
88d5a3db 304 else
84dbb3fd 305 log_radv(ra, "Sent solicited Router Advertisement to %s", addr);
88d5a3db
PF
306
307 return 0;
308}
309
204fb681 310static int radv_timeout(sd_event_source *s, uint64_t usec, void *userdata) {
7003b114 311 usec_t min_timeout, max_timeout, time_now, timeout;
99534007 312 sd_radv *ra = ASSERT_PTR(userdata);
7003b114 313 int r;
204fb681
PF
314
315 assert(s);
204fb681 316 assert(ra->event);
80477557 317 assert(router_lifetime_is_valid(ra->lifetime_usec));
204fb681 318
ba4e0427 319 r = sd_event_now(ra->event, CLOCK_BOOTTIME, &time_now);
204fb681
PF
320 if (r < 0)
321 goto fail;
322
7003b114 323 r = radv_send(ra, NULL, ra->lifetime_usec);
204fb681 324 if (r < 0)
35388783 325 log_radv_errno(ra, r, "Unable to send Router Advertisement: %m");
204fb681
PF
326
327 /* RFC 4861, Section 6.2.4, sending initial Router Advertisements */
80477557 328 if (ra->ra_sent < RADV_MAX_INITIAL_RTR_ADVERTISEMENTS)
d6fc0d67 329 max_timeout = RADV_MAX_INITIAL_RTR_ADVERT_INTERVAL_USEC;
80477557 330 else
03ec10fd 331 max_timeout = RADV_DEFAULT_MAX_TIMEOUT_USEC;
204fb681 332
ef90b6a4 333 /* RFC 4861, Section 6.2.1, lifetime must be at least MaxRtrAdvInterval,
80477557
YW
334 * so lower the interval here */
335 if (ra->lifetime_usec > 0)
336 max_timeout = MIN(max_timeout, ra->lifetime_usec);
337
338 if (max_timeout >= 9 * USEC_PER_SEC)
ef90b6a4 339 min_timeout = max_timeout / 3;
80477557
YW
340 else
341 min_timeout = max_timeout * 3 / 4;
ef90b6a4 342
80477557
YW
343 /* RFC 4861, Section 6.2.1.
344 * MaxRtrAdvInterval MUST be no less than 4 seconds and no greater than 1800 seconds.
345 * MinRtrAdvInterval MUST be no less than 3 seconds and no greater than .75 * MaxRtrAdvInterval. */
346 assert(max_timeout >= RADV_MIN_MAX_TIMEOUT_USEC);
347 assert(max_timeout <= RADV_MAX_MAX_TIMEOUT_USEC);
348 assert(min_timeout >= RADV_MIN_MIN_TIMEOUT_USEC);
349 assert(min_timeout <= max_timeout * 3 / 4);
ef90b6a4 350
80477557 351 timeout = min_timeout + random_u64_range(max_timeout - min_timeout);
5291f26d 352 log_radv(ra, "Next Router Advertisement in %s", FORMAT_TIMESPAN(timeout, USEC_PER_SEC));
204fb681 353
807a8ede 354 r = event_reset_time(ra->event, &ra->timeout_event_source,
ba4e0427 355 CLOCK_BOOTTIME,
80477557 356 usec_add(time_now, timeout), MSEC_PER_SEC,
807a8ede
YW
357 radv_timeout, ra,
358 ra->event_priority, "radv-timeout", true);
204fb681
PF
359 if (r < 0)
360 goto fail;
361
362 ra->ra_sent++;
363
807a8ede
YW
364 return 0;
365
204fb681 366fail:
290696e5 367 sd_radv_stop(ra);
204fb681
PF
368
369 return 0;
370}
371
17347053 372int sd_radv_stop(sd_radv *ra) {
204fb681
PF
373 int r;
374
c8bae363
YW
375 if (!ra)
376 return 0;
204f99d2 377
d6fc0d67 378 if (ra->state == RADV_STATE_IDLE)
6f8a8b84
SS
379 return 0;
380
35388783 381 log_radv(ra, "Stopping IPv6 Router Advertisement daemon");
204f99d2 382
290696e5
YW
383 /* RFC 4861, Section 6.2.5, send at least one Router Advertisement
384 with zero lifetime */
385 r = radv_send(ra, NULL, 0);
386 if (r < 0)
35388783 387 log_radv_errno(ra, r, "Unable to send last Router Advertisement with router lifetime set to zero: %m");
204fb681
PF
388
389 radv_reset(ra);
77baf5ae 390 ra->fd = safe_close(ra->fd);
d6fc0d67 391 ra->state = RADV_STATE_IDLE;
204f99d2
PF
392
393 return 0;
394}
395
17347053 396int sd_radv_start(sd_radv *ra) {
f474884c 397 int r;
204fb681 398
204f99d2
PF
399 assert_return(ra, -EINVAL);
400 assert_return(ra->event, -EINVAL);
401 assert_return(ra->ifindex > 0, -EINVAL);
402
d6fc0d67 403 if (ra->state != RADV_STATE_IDLE)
204f99d2
PF
404 return 0;
405
807a8ede 406 r = event_reset_time(ra->event, &ra->timeout_event_source,
ba4e0427 407 CLOCK_BOOTTIME,
807a8ede
YW
408 0, 0,
409 radv_timeout, ra,
410 ra->event_priority, "radv-timeout", true);
204fb681
PF
411 if (r < 0)
412 goto fail;
413
77baf5ae
PF
414 r = icmp6_bind_router_advertisement(ra->ifindex);
415 if (r < 0)
416 goto fail;
417
418 ra->fd = r;
88d5a3db
PF
419
420 r = sd_event_add_io(ra->event, &ra->recv_event_source, ra->fd, EPOLLIN, radv_recv, ra);
421 if (r < 0)
422 goto fail;
423
424 r = sd_event_source_set_priority(ra->recv_event_source, ra->event_priority);
425 if (r < 0)
426 goto fail;
427
428 (void) sd_event_source_set_description(ra->recv_event_source, "radv-receive-message");
77baf5ae 429
d6fc0d67 430 ra->state = RADV_STATE_ADVERTISING;
204f99d2 431
35388783 432 log_radv(ra, "Started IPv6 Router Advertisement daemon");
204f99d2
PF
433
434 return 0;
204fb681
PF
435
436 fail:
437 radv_reset(ra);
438
439 return r;
204f99d2
PF
440}
441
17347053 442int sd_radv_set_ifindex(sd_radv *ra, int ifindex) {
204f99d2 443 assert_return(ra, -EINVAL);
7fa69c0a 444 assert_return(ifindex > 0, -EINVAL);
204f99d2 445
d6fc0d67 446 if (ra->state != RADV_STATE_IDLE)
204f99d2
PF
447 return -EBUSY;
448
449 ra->ifindex = ifindex;
450
451 return 0;
452}
453
61a9fa8f
YW
454int sd_radv_set_ifname(sd_radv *ra, const char *ifname) {
455 assert_return(ra, -EINVAL);
456 assert_return(ifname, -EINVAL);
457
458 if (!ifname_valid_full(ifname, IFNAME_VALID_ALTERNATIVE))
459 return -EINVAL;
460
461 return free_and_strdup(&ra->ifname, ifname);
462}
463
5977b71f
YW
464int sd_radv_get_ifname(sd_radv *ra, const char **ret) {
465 int r;
466
467 assert_return(ra, -EINVAL);
61a9fa8f 468
5977b71f
YW
469 r = get_ifname(ra->ifindex, &ra->ifname);
470 if (r < 0)
471 return r;
472
473 if (ret)
474 *ret = ra->ifname;
475
476 return 0;
61a9fa8f
YW
477}
478
17347053 479int sd_radv_set_mac(sd_radv *ra, const struct ether_addr *mac_addr) {
204f99d2
PF
480 assert_return(ra, -EINVAL);
481
d6fc0d67 482 if (ra->state != RADV_STATE_IDLE)
204f99d2
PF
483 return -EBUSY;
484
485 if (mac_addr)
486 ra->mac_addr = *mac_addr;
487 else
488 zero(ra->mac_addr);
489
490 return 0;
491}
492
17347053 493int sd_radv_set_mtu(sd_radv *ra, uint32_t mtu) {
204f99d2
PF
494 assert_return(ra, -EINVAL);
495 assert_return(mtu >= 1280, -EINVAL);
496
204f99d2
PF
497 ra->mtu = mtu;
498
499 return 0;
500}
501
17347053 502int sd_radv_set_hop_limit(sd_radv *ra, uint8_t hop_limit) {
204f99d2
PF
503 assert_return(ra, -EINVAL);
504
d6fc0d67 505 if (ra->state != RADV_STATE_IDLE)
204f99d2
PF
506 return -EBUSY;
507
508 ra->hop_limit = hop_limit;
509
510 return 0;
511}
512
17347053 513int sd_radv_set_router_lifetime(sd_radv *ra, uint64_t lifetime_usec) {
204f99d2
PF
514 assert_return(ra, -EINVAL);
515
d6fc0d67 516 if (ra->state != RADV_STATE_IDLE)
204f99d2
PF
517 return -EBUSY;
518
09457670
YW
519 if (!router_lifetime_is_valid(lifetime_usec))
520 return -EINVAL;
521
ac138551
YW
522 /* RFC 4191, Section 2.2, "...If the Router Lifetime is zero, the preference value MUST be set
523 * to (00) by the sender..." */
7003b114 524 if (lifetime_usec == 0 &&
204f99d2 525 (ra->flags & (0x3 << 3)) != (SD_NDISC_PREFERENCE_MEDIUM << 3))
09457670 526 return -EINVAL;
204f99d2 527
7003b114 528 ra->lifetime_usec = lifetime_usec;
204f99d2
PF
529
530 return 0;
531}
532
17347053 533int sd_radv_set_managed_information(sd_radv *ra, int managed) {
204f99d2
PF
534 assert_return(ra, -EINVAL);
535
d6fc0d67 536 if (ra->state != RADV_STATE_IDLE)
204f99d2
PF
537 return -EBUSY;
538
539 SET_FLAG(ra->flags, ND_RA_FLAG_MANAGED, managed);
540
541 return 0;
542}
543
17347053 544int sd_radv_set_other_information(sd_radv *ra, int other) {
204f99d2
PF
545 assert_return(ra, -EINVAL);
546
d6fc0d67 547 if (ra->state != RADV_STATE_IDLE)
204f99d2
PF
548 return -EBUSY;
549
550 SET_FLAG(ra->flags, ND_RA_FLAG_OTHER, other);
551
552 return 0;
553}
554
17347053 555int sd_radv_set_preference(sd_radv *ra, unsigned preference) {
204f99d2
PF
556 assert_return(ra, -EINVAL);
557 assert_return(IN_SET(preference,
558 SD_NDISC_PREFERENCE_LOW,
559 SD_NDISC_PREFERENCE_MEDIUM,
560 SD_NDISC_PREFERENCE_HIGH), -EINVAL);
561
dd1b1870
YW
562 /* RFC 4191, Section 2.2, "...If the Router Lifetime is zero, the preference value MUST be set
563 * to (00) by the sender..." */
7003b114 564 if (ra->lifetime_usec == 0 && preference != SD_NDISC_PREFERENCE_MEDIUM)
dd1b1870
YW
565 return -EINVAL;
566
204f99d2
PF
567 ra->flags = (ra->flags & ~(0x3 << 3)) | (preference << 3);
568
dd1b1870 569 return 0;
204f99d2
PF
570}
571
17347053 572int sd_radv_add_prefix(sd_radv *ra, sd_radv_prefix *p) {
03677889 573 sd_radv_prefix *found = NULL;
d601b566 574 int r;
204f99d2
PF
575
576 assert_return(ra, -EINVAL);
acbb5500 577 assert_return(p, -EINVAL);
204f99d2 578
59ea6e57 579 /* Refuse prefixes that don't have a prefix set */
94876904 580 if (in6_addr_is_null(&p->opt.in6_addr))
59ea6e57
LP
581 return -ENOEXEC;
582
c71384a9 583 const char *addr_p = IN6_ADDR_PREFIX_TO_STRING(&p->opt.in6_addr, p->opt.prefixlen);
5380707a 584
204f99d2 585 LIST_FOREACH(prefix, cur, ra->prefixes) {
204f99d2 586 r = in_addr_prefix_intersect(AF_INET6,
c633628d 587 (const union in_addr_union*) &cur->opt.in6_addr,
204f99d2 588 cur->opt.prefixlen,
c633628d 589 (const union in_addr_union*) &p->opt.in6_addr,
204f99d2 590 p->opt.prefixlen);
5380707a
YW
591 if (r < 0)
592 return r;
593 if (r == 0)
594 continue;
204f99d2 595
95e104e0 596 if (cur->opt.prefixlen == p->opt.prefixlen) {
56aa5143 597 found = cur;
b9f27a05 598 break;
95e104e0 599 }
d601b566 600
35388783 601 return log_radv_errno(ra, SYNTHETIC_ERRNO(EEXIST),
95e104e0 602 "IPv6 prefix %s conflicts with %s, ignoring.",
c71384a9
ZJS
603 addr_p,
604 IN6_ADDR_PREFIX_TO_STRING(&cur->opt.in6_addr, cur->opt.prefixlen));
204f99d2
PF
605 }
606
56aa5143 607 if (found) {
b9f27a05
YW
608 /* p and cur may be equivalent. First increment the reference counter. */
609 sd_radv_prefix_ref(p);
610
611 /* Then, remove the old entry. */
56aa5143
YW
612 LIST_REMOVE(prefix, ra->prefixes, found);
613 sd_radv_prefix_unref(found);
b9f27a05
YW
614
615 /* Finally, add the new entry. */
616 LIST_APPEND(prefix, ra->prefixes, p);
617
618 log_radv(ra, "Updated/replaced IPv6 prefix %s (preferred: %s, valid: %s)",
c71384a9 619 addr_p,
b9f27a05
YW
620 FORMAT_TIMESPAN(p->lifetime_preferred_usec, USEC_PER_SEC),
621 FORMAT_TIMESPAN(p->lifetime_valid_usec, USEC_PER_SEC));
622 } else {
623 /* The prefix is new. Let's simply add it. */
624
625 sd_radv_prefix_ref(p);
626 LIST_APPEND(prefix, ra->prefixes, p);
627 ra->n_prefixes++;
204f99d2 628
c71384a9 629 log_radv(ra, "Added prefix %s", addr_p);
b9f27a05 630 }
059d7b6e
YW
631
632 if (ra->state == RADV_STATE_IDLE)
633 return 0;
634
059d7b6e 635 if (ra->ra_sent == 0)
d601b566 636 return 0;
d601b566 637
97efde65 638 /* If RAs have already been sent, send an RA immediately to announce the newly-added prefix */
059d7b6e
YW
639 r = radv_send(ra, NULL, ra->lifetime_usec);
640 if (r < 0)
c71384a9 641 log_radv_errno(ra, r, "Unable to send Router Advertisement for added prefix %s: %m", addr_p);
059d7b6e 642 else
c71384a9 643 log_radv(ra, "Sent Router Advertisement for added/updated prefix %s.", addr_p);
97efde65 644
204f99d2
PF
645 return 0;
646}
647
95931532
YW
648void sd_radv_remove_prefix(
649 sd_radv *ra,
650 const struct in6_addr *prefix,
651 unsigned char prefixlen) {
34c169c4 652
95931532
YW
653 if (!ra)
654 return;
34c169c4 655
95931532
YW
656 if (!prefix)
657 return;
658
659 LIST_FOREACH(prefix, cur, ra->prefixes) {
34c169c4
PF
660 if (prefixlen != cur->opt.prefixlen)
661 continue;
662
94876904 663 if (!in6_addr_equal(prefix, &cur->opt.in6_addr))
34c169c4
PF
664 continue;
665
666 LIST_REMOVE(prefix, ra->prefixes, cur);
667 ra->n_prefixes--;
62bbbedf 668 sd_radv_prefix_unref(cur);
95931532 669 return;
34c169c4 670 }
34c169c4
PF
671}
672
17347053 673int sd_radv_add_route_prefix(sd_radv *ra, sd_radv_route_prefix *p) {
03677889 674 sd_radv_route_prefix *found = NULL;
203d4df5
SS
675 int r;
676
677 assert_return(ra, -EINVAL);
acbb5500 678 assert_return(p, -EINVAL);
203d4df5 679
c71384a9 680 const char *addr_p = IN6_ADDR_PREFIX_TO_STRING(&p->opt.in6_addr, p->opt.prefixlen);
203d4df5
SS
681
682 LIST_FOREACH(prefix, cur, ra->route_prefixes) {
203d4df5 683 r = in_addr_prefix_intersect(AF_INET6,
c633628d 684 (const union in_addr_union*) &cur->opt.in6_addr,
203d4df5 685 cur->opt.prefixlen,
c633628d 686 (const union in_addr_union*) &p->opt.in6_addr,
203d4df5
SS
687 p->opt.prefixlen);
688 if (r < 0)
689 return r;
690 if (r == 0)
691 continue;
692
95e104e0 693 if (cur->opt.prefixlen == p->opt.prefixlen) {
56aa5143 694 found = cur;
b9f27a05 695 break;
95e104e0 696 }
203d4df5 697
35388783 698 return log_radv_errno(ra, SYNTHETIC_ERRNO(EEXIST),
95e104e0 699 "IPv6 route prefix %s conflicts with %s, ignoring.",
c71384a9
ZJS
700 addr_p,
701 IN6_ADDR_PREFIX_TO_STRING(&cur->opt.in6_addr, cur->opt.prefixlen));
203d4df5
SS
702 }
703
56aa5143 704 if (found) {
b9f27a05
YW
705 /* p and cur may be equivalent. First increment the reference counter. */
706 sd_radv_route_prefix_ref(p);
707
708 /* Then, remove the old entry. */
56aa5143
YW
709 LIST_REMOVE(prefix, ra->route_prefixes, found);
710 sd_radv_route_prefix_unref(found);
b9f27a05
YW
711
712 /* Finally, add the new entry. */
713 LIST_APPEND(prefix, ra->route_prefixes, p);
714
715 log_radv(ra, "Updated/replaced IPv6 route prefix %s (lifetime: %s)",
716 strna(addr_p),
717 FORMAT_TIMESPAN(p->lifetime_usec, USEC_PER_SEC));
718 } else {
719 /* The route prefix is new. Let's simply add it. */
720
721 sd_radv_route_prefix_ref(p);
722 LIST_APPEND(prefix, ra->route_prefixes, p);
723 ra->n_route_prefixes++;
724
725 log_radv(ra, "Added route prefix %s", strna(addr_p));
726 }
059d7b6e
YW
727
728 if (ra->state == RADV_STATE_IDLE)
729 return 0;
730
059d7b6e 731 if (ra->ra_sent == 0)
203d4df5 732 return 0;
203d4df5 733
97efde65 734 /* If RAs have already been sent, send an RA immediately to announce the newly-added route prefix */
059d7b6e
YW
735 r = radv_send(ra, NULL, ra->lifetime_usec);
736 if (r < 0)
b9f27a05
YW
737 log_radv_errno(ra, r, "Unable to send Router Advertisement for added route prefix %s: %m",
738 strna(addr_p));
059d7b6e 739 else
b9f27a05 740 log_radv(ra, "Sent Router Advertisement for added route prefix %s.", strna(addr_p));
97efde65 741
203d4df5
SS
742 return 0;
743}
744
faaf3d66
YW
745int sd_radv_set_rdnss(
746 sd_radv *ra,
747 uint32_t lifetime,
748 const struct in6_addr *dns,
749 size_t n_dns) {
750
e9c6da38
PF
751 _cleanup_free_ struct sd_radv_opt_dns *opt_rdnss = NULL;
752 size_t len;
753
754 assert_return(ra, -EINVAL);
755 assert_return(n_dns < 128, -EINVAL);
756
757 if (!dns || n_dns == 0) {
758 ra->rdnss = mfree(ra->rdnss);
759 ra->n_rdnss = 0;
760
761 return 0;
762 }
763
764 len = sizeof(struct sd_radv_opt_dns) + sizeof(struct in6_addr) * n_dns;
765
766 opt_rdnss = malloc0(len);
767 if (!opt_rdnss)
768 return -ENOMEM;
769
d6fc0d67 770 opt_rdnss->type = RADV_OPT_RDNSS;
e9c6da38
PF
771 opt_rdnss->length = len / 8;
772 opt_rdnss->lifetime = htobe32(lifetime);
773
774 memcpy(opt_rdnss + 1, dns, n_dns * sizeof(struct in6_addr));
775
1cc6c93a 776 free_and_replace(ra->rdnss, opt_rdnss);
e9c6da38
PF
777
778 ra->n_rdnss = n_dns;
779
780 return 0;
781}
782
faaf3d66
YW
783int sd_radv_set_dnssl(
784 sd_radv *ra,
785 uint32_t lifetime,
786 char **search_list) {
787
e965d6ab
PF
788 _cleanup_free_ struct sd_radv_opt_dns *opt_dnssl = NULL;
789 size_t len = 0;
e965d6ab
PF
790 uint8_t *p;
791
792 assert_return(ra, -EINVAL);
793
97d7974b 794 if (strv_isempty(search_list)) {
e965d6ab 795 ra->dnssl = mfree(ra->dnssl);
e965d6ab
PF
796 return 0;
797 }
798
799 STRV_FOREACH(s, search_list)
800 len += strlen(*s) + 2;
801
802 len = (sizeof(struct sd_radv_opt_dns) + len + 7) & ~0x7;
803
804 opt_dnssl = malloc0(len);
805 if (!opt_dnssl)
806 return -ENOMEM;
807
d6fc0d67 808 opt_dnssl->type = RADV_OPT_DNSSL;
e965d6ab
PF
809 opt_dnssl->length = len / 8;
810 opt_dnssl->lifetime = htobe32(lifetime);
811
812 p = (uint8_t *)(opt_dnssl + 1);
813 len -= sizeof(struct sd_radv_opt_dns);
814
815 STRV_FOREACH(s, search_list) {
816 int r;
817
818 r = dns_name_to_wire_format(*s, p, len, false);
819 if (r < 0)
820 return r;
821
822 if (len < (size_t)r)
823 return -ENOBUFS;
824
825 p += r;
826 len -= r;
827 }
828
1cc6c93a 829 free_and_replace(ra->dnssl, opt_dnssl);
e965d6ab
PF
830
831 return 0;
832}
833
17347053 834int sd_radv_prefix_new(sd_radv_prefix **ret) {
d2c8eed2 835 sd_radv_prefix *p;
04473969
PF
836
837 assert_return(ret, -EINVAL);
838
d2c8eed2 839 p = new(sd_radv_prefix, 1);
04473969
PF
840 if (!p)
841 return -ENOMEM;
842
d2c8eed2
LP
843 *p = (sd_radv_prefix) {
844 .n_ref = 1,
04473969 845
d2c8eed2
LP
846 .opt.type = ND_OPT_PREFIX_INFORMATION,
847 .opt.length = (sizeof(p->opt) - 1)/8 + 1,
848 .opt.prefixlen = 64,
04473969 849
d2c8eed2
LP
850 /* RFC 4861, Section 6.2.1 */
851 .opt.flags = ND_OPT_PI_FLAG_ONLINK|ND_OPT_PI_FLAG_AUTO,
204f99d2 852
d951507d
YW
853 .lifetime_valid_usec = RADV_DEFAULT_VALID_LIFETIME_USEC,
854 .lifetime_preferred_usec = RADV_DEFAULT_PREFERRED_LIFETIME_USEC,
95e104e0
YW
855 .valid_until = USEC_INFINITY,
856 .preferred_until = USEC_INFINITY,
d2c8eed2 857 };
04473969 858
d2c8eed2 859 *ret = p;
04473969
PF
860 return 0;
861}
862
8301aa0b 863DEFINE_PUBLIC_TRIVIAL_REF_UNREF_FUNC(sd_radv_prefix, sd_radv_prefix, mfree);
04473969 864
faaf3d66
YW
865int sd_radv_prefix_set_prefix(
866 sd_radv_prefix *p,
867 const struct in6_addr *in6_addr,
868 unsigned char prefixlen) {
869
04473969
PF
870 assert_return(p, -EINVAL);
871 assert_return(in6_addr, -EINVAL);
872
873 if (prefixlen < 3 || prefixlen > 128)
874 return -EINVAL;
875
876 if (prefixlen > 64)
877 /* unusual but allowed, log it */
35388783 878 log_radv(NULL, "Unusual prefix length %d greater than 64", prefixlen);
04473969
PF
879
880 p->opt.in6_addr = *in6_addr;
881 p->opt.prefixlen = prefixlen;
882
883 return 0;
884}
885
faaf3d66
YW
886int sd_radv_prefix_get_prefix(
887 sd_radv_prefix *p,
888 struct in6_addr *ret_in6_addr,
889 unsigned char *ret_prefixlen) {
890
34332af2
SS
891 assert_return(p, -EINVAL);
892 assert_return(ret_in6_addr, -EINVAL);
893 assert_return(ret_prefixlen, -EINVAL);
894
895 *ret_in6_addr = p->opt.in6_addr;
896 *ret_prefixlen = p->opt.prefixlen;
897
898 return 0;
899}
900
17347053 901int sd_radv_prefix_set_onlink(sd_radv_prefix *p, int onlink) {
04473969
PF
902 assert_return(p, -EINVAL);
903
904 SET_FLAG(p->opt.flags, ND_OPT_PI_FLAG_ONLINK, onlink);
905
906 return 0;
907}
908
faaf3d66 909int sd_radv_prefix_set_address_autoconfiguration(sd_radv_prefix *p, int address_autoconfiguration) {
04473969
PF
910 assert_return(p, -EINVAL);
911
912 SET_FLAG(p->opt.flags, ND_OPT_PI_FLAG_AUTO, address_autoconfiguration);
913
914 return 0;
915}
916
17347053 917int sd_radv_prefix_set_valid_lifetime(sd_radv_prefix *p, uint64_t lifetime_usec, uint64_t valid_until) {
04473969
PF
918 assert_return(p, -EINVAL);
919
95e104e0
YW
920 p->lifetime_valid_usec = lifetime_usec;
921 p->valid_until = valid_until;
04473969
PF
922
923 return 0;
924}
925
17347053 926int sd_radv_prefix_set_preferred_lifetime(sd_radv_prefix *p, uint64_t lifetime_usec, uint64_t valid_until) {
04473969
PF
927 assert_return(p, -EINVAL);
928
95e104e0
YW
929 p->lifetime_preferred_usec = lifetime_usec;
930 p->preferred_until = valid_until;
04473969
PF
931
932 return 0;
933}
203d4df5 934
17347053 935int sd_radv_route_prefix_new(sd_radv_route_prefix **ret) {
203d4df5
SS
936 sd_radv_route_prefix *p;
937
938 assert_return(ret, -EINVAL);
939
940 p = new(sd_radv_route_prefix, 1);
941 if (!p)
942 return -ENOMEM;
943
944 *p = (sd_radv_route_prefix) {
945 .n_ref = 1,
946
d6fc0d67 947 .opt.type = RADV_OPT_ROUTE_INFORMATION,
203d4df5
SS
948 .opt.length = DIV_ROUND_UP(sizeof(p->opt), 8),
949 .opt.prefixlen = 64,
950
d951507d 951 .lifetime_usec = RADV_DEFAULT_VALID_LIFETIME_USEC,
95e104e0 952 .valid_until = USEC_INFINITY,
203d4df5
SS
953 };
954
955 *ret = p;
956 return 0;
957}
958
959DEFINE_PUBLIC_TRIVIAL_REF_UNREF_FUNC(sd_radv_route_prefix, sd_radv_route_prefix, mfree);
960
faaf3d66
YW
961int sd_radv_route_prefix_set_prefix(
962 sd_radv_route_prefix *p,
963 const struct in6_addr *in6_addr,
964 unsigned char prefixlen) {
965
203d4df5
SS
966 assert_return(p, -EINVAL);
967 assert_return(in6_addr, -EINVAL);
968
969 if (prefixlen > 128)
970 return -EINVAL;
971
972 if (prefixlen > 64)
973 /* unusual but allowed, log it */
35388783 974 log_radv(NULL, "Unusual prefix length %u greater than 64", prefixlen);
203d4df5
SS
975
976 p->opt.in6_addr = *in6_addr;
977 p->opt.prefixlen = prefixlen;
978
979 return 0;
980}
981
17347053 982int sd_radv_route_prefix_set_lifetime(sd_radv_route_prefix *p, uint64_t lifetime_usec, uint64_t valid_until) {
203d4df5
SS
983 assert_return(p, -EINVAL);
984
95e104e0
YW
985 p->lifetime_usec = lifetime_usec;
986 p->valid_until = valid_until;
203d4df5
SS
987
988 return 0;
989}