]>
Commit | Line | Data |
---|---|---|
e3169126 PF |
1 | /*** |
2 | This file is part of systemd. | |
3 | ||
4 | Copyright (C) 2014 Intel Corporation. All rights reserved. | |
5 | ||
6 | systemd is free software; you can redistribute it and/or modify it | |
7 | under the terms of the GNU Lesser General Public License as published by | |
8 | the Free Software Foundation; either version 2.1 of the License, or | |
9 | (at your option) any later version. | |
10 | ||
11 | systemd is distributed in the hope that it will be useful, but | |
12 | WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
14 | Lesser General Public License for more details. | |
15 | ||
16 | You should have received a copy of the GNU Lesser General Public License | |
17 | along with systemd; If not, see <http://www.gnu.org/licenses/>. | |
18 | ***/ | |
19 | ||
20 | #include <netinet/icmp6.h> | |
07630cea | 21 | #include <netinet/in.h> |
e3169126 | 22 | |
07630cea LP |
23 | #include "sd-ndisc.h" |
24 | ||
b5efdb8a | 25 | #include "alloc-util.h" |
1e7a0e21 | 26 | #include "fd-util.h" |
07630cea | 27 | #include "icmp6-util.h" |
9d96e6c3 | 28 | #include "in-addr-util.h" |
1e7a0e21 LP |
29 | #include "ndisc-internal.h" |
30 | #include "ndisc-router.h" | |
940367a0 | 31 | #include "socket-util.h" |
d7fa4380 | 32 | #include "string-util.h" |
1e7a0e21 | 33 | #include "util.h" |
e3169126 | 34 | |
9c2438b8 | 35 | #define NDISC_ROUTER_SOLICITATION_INTERVAL (4U * USEC_PER_SEC) |
1e7a0e21 | 36 | #define NDISC_MAX_ROUTER_SOLICITATIONS 3U |
e3169126 | 37 | |
1e7a0e21 LP |
38 | static void ndisc_callback(sd_ndisc *ndisc, sd_ndisc_event event, sd_ndisc_router *rt) { |
39 | assert(ndisc); | |
e3169126 | 40 | |
1e7a0e21 | 41 | log_ndisc("Invoking callback for '%c'.", event); |
09667885 | 42 | |
1e7a0e21 LP |
43 | if (!ndisc->callback) |
44 | return; | |
9d96e6c3 | 45 | |
1e7a0e21 | 46 | ndisc->callback(ndisc, event, rt, ndisc->userdata); |
5624c480 PF |
47 | } |
48 | ||
1e7a0e21 | 49 | _public_ int sd_ndisc_set_callback( |
a1140666 | 50 | sd_ndisc *nd, |
a1140666 LP |
51 | sd_ndisc_callback_t callback, |
52 | void *userdata) { | |
53 | ||
54 | assert_return(nd, -EINVAL); | |
e3169126 PF |
55 | |
56 | nd->callback = callback; | |
57 | nd->userdata = userdata; | |
58 | ||
59 | return 0; | |
60 | } | |
61 | ||
1e7a0e21 | 62 | _public_ int sd_ndisc_set_ifindex(sd_ndisc *nd, int ifindex) { |
2f8e7633 LP |
63 | assert_return(nd, -EINVAL); |
64 | assert_return(ifindex > 0, -EINVAL); | |
1e7a0e21 | 65 | assert_return(nd->fd < 0, -EBUSY); |
e3169126 | 66 | |
2f8e7633 | 67 | nd->ifindex = ifindex; |
e3169126 PF |
68 | return 0; |
69 | } | |
70 | ||
1e7a0e21 | 71 | _public_ int sd_ndisc_set_mac(sd_ndisc *nd, const struct ether_addr *mac_addr) { |
a1140666 | 72 | assert_return(nd, -EINVAL); |
e3169126 PF |
73 | |
74 | if (mac_addr) | |
1e7a0e21 | 75 | nd->mac_addr = *mac_addr; |
e3169126 | 76 | else |
eccaf899 | 77 | zero(nd->mac_addr); |
e3169126 PF |
78 | |
79 | return 0; | |
e3169126 PF |
80 | } |
81 | ||
1e7a0e21 | 82 | _public_ int sd_ndisc_attach_event(sd_ndisc *nd, sd_event *event, int64_t priority) { |
e3169126 PF |
83 | int r; |
84 | ||
85 | assert_return(nd, -EINVAL); | |
1e7a0e21 | 86 | assert_return(nd->fd < 0, -EBUSY); |
e3169126 PF |
87 | assert_return(!nd->event, -EBUSY); |
88 | ||
89 | if (event) | |
90 | nd->event = sd_event_ref(event); | |
91 | else { | |
92 | r = sd_event_default(&nd->event); | |
93 | if (r < 0) | |
94 | return 0; | |
95 | } | |
96 | ||
97 | nd->event_priority = priority; | |
98 | ||
99 | return 0; | |
100 | } | |
101 | ||
1e7a0e21 LP |
102 | _public_ int sd_ndisc_detach_event(sd_ndisc *nd) { |
103 | ||
e3169126 | 104 | assert_return(nd, -EINVAL); |
1e7a0e21 | 105 | assert_return(nd->fd < 0, -EBUSY); |
e3169126 PF |
106 | |
107 | nd->event = sd_event_unref(nd->event); | |
e3169126 PF |
108 | return 0; |
109 | } | |
110 | ||
1e7a0e21 | 111 | _public_ sd_event *sd_ndisc_get_event(sd_ndisc *nd) { |
a1140666 | 112 | assert_return(nd, NULL); |
e3169126 PF |
113 | |
114 | return nd->event; | |
115 | } | |
116 | ||
1e7a0e21 | 117 | _public_ sd_ndisc *sd_ndisc_ref(sd_ndisc *nd) { |
e3169126 | 118 | |
9c8e3101 LP |
119 | if (!nd) |
120 | return NULL; | |
121 | ||
122 | assert(nd->n_ref > 0); | |
123 | nd->n_ref++; | |
e3169126 PF |
124 | |
125 | return nd; | |
126 | } | |
127 | ||
5c4c338a | 128 | static int ndisc_reset(sd_ndisc *nd) { |
e3169126 PF |
129 | assert(nd); |
130 | ||
3e261cfd | 131 | nd->timeout_event_source = sd_event_source_unref(nd->timeout_event_source); |
1e7a0e21 LP |
132 | nd->recv_event_source = sd_event_source_unref(nd->recv_event_source); |
133 | nd->fd = safe_close(nd->fd); | |
e3169126 PF |
134 | |
135 | return 0; | |
136 | } | |
137 | ||
1e7a0e21 | 138 | _public_ sd_ndisc *sd_ndisc_unref(sd_ndisc *nd) { |
e3169126 | 139 | |
9c8e3101 LP |
140 | if (!nd) |
141 | return NULL; | |
142 | ||
143 | assert(nd->n_ref > 0); | |
144 | nd->n_ref--; | |
145 | ||
146 | if (nd->n_ref > 0) | |
147 | return NULL; | |
e3169126 | 148 | |
5c4c338a | 149 | ndisc_reset(nd); |
4d7b83da | 150 | sd_ndisc_detach_event(nd); |
6b430fdb | 151 | return mfree(nd); |
e3169126 PF |
152 | } |
153 | ||
1e7a0e21 | 154 | _public_ int sd_ndisc_new(sd_ndisc **ret) { |
4afd3348 | 155 | _cleanup_(sd_ndisc_unrefp) sd_ndisc *nd = NULL; |
e3169126 | 156 | |
a1140666 | 157 | assert_return(ret, -EINVAL); |
e3169126 | 158 | |
4d7b83da | 159 | nd = new0(sd_ndisc, 1); |
e3169126 PF |
160 | if (!nd) |
161 | return -ENOMEM; | |
162 | ||
9c8e3101 | 163 | nd->n_ref = 1; |
03de7ed9 | 164 | nd->fd = -1; |
e3169126 PF |
165 | |
166 | *ret = nd; | |
167 | nd = NULL; | |
168 | ||
169 | return 0; | |
170 | } | |
171 | ||
1e7a0e21 | 172 | _public_ int sd_ndisc_get_mtu(sd_ndisc *nd, uint32_t *mtu) { |
d14b5bc6 PF |
173 | assert_return(nd, -EINVAL); |
174 | assert_return(mtu, -EINVAL); | |
175 | ||
176 | if (nd->mtu == 0) | |
1e7a0e21 | 177 | return -ENODATA; |
d14b5bc6 PF |
178 | |
179 | *mtu = nd->mtu; | |
d14b5bc6 PF |
180 | return 0; |
181 | } | |
182 | ||
1e7a0e21 LP |
183 | _public_ int sd_ndisc_get_hop_limit(sd_ndisc *nd, uint8_t *ret) { |
184 | assert_return(nd, -EINVAL); | |
185 | assert_return(ret, -EINVAL); | |
d77bde34 | 186 | |
1e7a0e21 LP |
187 | if (nd->hop_limit == 0) |
188 | return -ENODATA; | |
d77bde34 | 189 | |
1e7a0e21 | 190 | *ret = nd->hop_limit; |
d77bde34 PF |
191 | return 0; |
192 | } | |
193 | ||
1e7a0e21 | 194 | static int ndisc_handle_datagram(sd_ndisc *nd, sd_ndisc_router *rt) { |
f6e0ce66 | 195 | int r; |
d77bde34 | 196 | |
f6e0ce66 | 197 | assert(nd); |
1e7a0e21 | 198 | assert(rt); |
d77bde34 | 199 | |
1e7a0e21 LP |
200 | r = ndisc_router_parse(rt); |
201 | if (r == -EBADMSG) /* Bad packet */ | |
9d96e6c3 | 202 | return 0; |
f6e0ce66 | 203 | if (r < 0) |
1e7a0e21 | 204 | return 0; |
09667885 | 205 | |
1e7a0e21 LP |
206 | /* Update global variables we keep */ |
207 | if (rt->mtu > 0) | |
208 | nd->mtu = rt->mtu; | |
209 | if (rt->hop_limit > 0) | |
210 | nd->hop_limit = rt->hop_limit; | |
09667885 | 211 | |
1e7a0e21 LP |
212 | log_ndisc("Received Router Advertisement: flags %s preference %s lifetime %" PRIu16 " sec", |
213 | rt->flags & ND_RA_FLAG_MANAGED ? "MANAGED" : rt->flags & ND_RA_FLAG_OTHER ? "OTHER" : "none", | |
214 | rt->preference == SD_NDISC_PREFERENCE_HIGH ? "high" : rt->preference == SD_NDISC_PREFERENCE_LOW ? "low" : "medium", | |
215 | rt->lifetime); | |
09667885 | 216 | |
1e7a0e21 | 217 | ndisc_callback(nd, SD_NDISC_EVENT_ROUTER, rt); |
09667885 PF |
218 | return 0; |
219 | } | |
220 | ||
1e7a0e21 LP |
221 | static int ndisc_recv(sd_event_source *s, int fd, uint32_t revents, void *userdata) { |
222 | _cleanup_(sd_ndisc_router_unrefp) sd_ndisc_router *rt = NULL; | |
4d7b83da | 223 | sd_ndisc *nd = userdata; |
cddf4d81 TG |
224 | union { |
225 | struct cmsghdr cmsghdr; | |
1e7a0e21 LP |
226 | uint8_t buf[CMSG_SPACE(sizeof(int)) + /* ttl */ |
227 | CMSG_SPACE(sizeof(struct timeval))]; | |
cddf4d81 TG |
228 | } control = {}; |
229 | struct iovec iov = {}; | |
230 | union sockaddr_union sa = {}; | |
231 | struct msghdr msg = { | |
232 | .msg_name = &sa.sa, | |
233 | .msg_namelen = sizeof(sa), | |
234 | .msg_iov = &iov, | |
235 | .msg_iovlen = 1, | |
236 | .msg_control = &control, | |
237 | .msg_controllen = sizeof(control), | |
238 | }; | |
239 | struct cmsghdr *cmsg; | |
4edc2c9b | 240 | ssize_t len, buflen; |
e3169126 PF |
241 | |
242 | assert(s); | |
243 | assert(nd); | |
244 | assert(nd->event); | |
245 | ||
4edc2c9b LP |
246 | buflen = next_datagram_size_fd(fd); |
247 | if (buflen < 0) | |
1e7a0e21 | 248 | return log_ndisc_errno(buflen, "Failed to determine datagram size to read: %m"); |
cddf4d81 | 249 | |
1e7a0e21 LP |
250 | rt = ndisc_router_new(buflen); |
251 | if (!rt) | |
09667885 PF |
252 | return -ENOMEM; |
253 | ||
1e7a0e21 LP |
254 | iov.iov_base = NDISC_ROUTER_RAW(rt); |
255 | iov.iov_len = rt->raw_size; | |
cddf4d81 | 256 | |
1e7a0e21 | 257 | len = recvmsg(fd, &msg, MSG_DONTWAIT); |
09667885 | 258 | if (len < 0) { |
0d43d2fc TG |
259 | if (errno == EAGAIN || errno == EINTR) |
260 | return 0; | |
261 | ||
1e7a0e21 | 262 | return log_ndisc_errno(errno, "Could not receive message from ICMPv6 socket: %m"); |
004845d1 | 263 | } |
1e7a0e21 LP |
264 | |
265 | if ((size_t) len != rt->raw_size) { | |
266 | log_ndisc("Packet size mismatch."); | |
267 | return -EINVAL; | |
004845d1 LP |
268 | } |
269 | ||
1e7a0e21 LP |
270 | if (msg.msg_namelen == sizeof(struct sockaddr_in6) && |
271 | sa.in6.sin6_family == AF_INET6) { | |
272 | ||
273 | if (in_addr_is_link_local(AF_INET6, (union in_addr_union*) &sa.in6.sin6_addr) <= 0) { | |
274 | _cleanup_free_ char *addr = NULL; | |
275 | ||
276 | (void) in_addr_to_string(AF_INET6, (union in_addr_union*) &sa.in6.sin6_addr, &addr); | |
277 | log_ndisc("Received RA from non-link-local address %s. Ignoring.", strna(addr)); | |
278 | return 0; | |
279 | } | |
280 | ||
281 | rt->address = sa.in6.sin6_addr; | |
282 | ||
283 | } else if (msg.msg_namelen > 0) { | |
284 | log_ndisc("Received invalid source address size from ICMPv6 socket: %zu bytes", (size_t) msg.msg_namelen); | |
285 | return -EINVAL; | |
286 | } | |
287 | ||
288 | /* namelen == 0 only happens when running the test-suite over a socketpair */ | |
cddf4d81 TG |
289 | |
290 | assert(!(msg.msg_flags & MSG_CTRUNC)); | |
291 | assert(!(msg.msg_flags & MSG_TRUNC)); | |
292 | ||
293 | CMSG_FOREACH(cmsg, &msg) { | |
294 | if (cmsg->cmsg_level == SOL_IPV6 && | |
295 | cmsg->cmsg_type == IPV6_HOPLIMIT && | |
296 | cmsg->cmsg_len == CMSG_LEN(sizeof(int))) { | |
1e7a0e21 | 297 | int hops = *(int*) CMSG_DATA(cmsg); |
cddf4d81 TG |
298 | |
299 | if (hops != 255) { | |
1e7a0e21 | 300 | log_ndisc("Received RA with invalid hop limit %d. Ignoring.", hops); |
cddf4d81 TG |
301 | return 0; |
302 | } | |
cddf4d81 | 303 | } |
d7fa4380 | 304 | |
1e7a0e21 LP |
305 | if (cmsg->cmsg_level == SOL_SOCKET && |
306 | cmsg->cmsg_type == SO_TIMESTAMP && | |
307 | cmsg->cmsg_len == CMSG_LEN(sizeof(struct timeval))) | |
a48072b7 | 308 | triple_timestamp_from_realtime(&rt->timestamp, timeval_load((struct timeval*) CMSG_DATA(cmsg))); |
d7fa4380 | 309 | } |
3ccd3163 | 310 | |
1e7a0e21 LP |
311 | if (!triple_timestamp_is_set(&rt->timestamp)) |
312 | triple_timestamp_get(&rt->timestamp); | |
e3169126 | 313 | |
3e261cfd | 314 | nd->timeout_event_source = sd_event_source_unref(nd->timeout_event_source); |
09667885 | 315 | |
1e7a0e21 | 316 | return ndisc_handle_datagram(nd, rt); |
e3169126 PF |
317 | } |
318 | ||
1e7a0e21 | 319 | static int ndisc_timeout(sd_event_source *s, uint64_t usec, void *userdata) { |
4d7b83da | 320 | sd_ndisc *nd = userdata; |
9c4f6ccb | 321 | usec_t time_now, next_timeout; |
e3169126 PF |
322 | int r; |
323 | ||
324 | assert(s); | |
325 | assert(nd); | |
326 | assert(nd->event); | |
327 | ||
46ec6687 | 328 | if (nd->nd_sent >= NDISC_MAX_ROUTER_SOLICITATIONS) { |
1e7a0e21 LP |
329 | nd->timeout_event_source = sd_event_source_unref(nd->timeout_event_source); |
330 | ndisc_callback(nd, SD_NDISC_EVENT_TIMEOUT, NULL); | |
331 | return 0; | |
332 | } | |
e3169126 | 333 | |
1e7a0e21 LP |
334 | r = icmp6_send_router_solicitation(nd->fd, &nd->mac_addr); |
335 | if (r < 0) { | |
336 | log_ndisc_errno(r, "Error sending Router Solicitation: %m"); | |
337 | goto fail; | |
338 | } | |
e3169126 | 339 | |
1e7a0e21 LP |
340 | log_ndisc("Sent Router Solicitation"); |
341 | nd->nd_sent++; | |
e3169126 | 342 | |
1e7a0e21 LP |
343 | assert_se(sd_event_now(nd->event, clock_boottime_or_monotonic(), &time_now) >= 0); |
344 | next_timeout = time_now + NDISC_ROUTER_SOLICITATION_INTERVAL; | |
e3169126 | 345 | |
1e7a0e21 LP |
346 | r = sd_event_source_set_time(nd->timeout_event_source, next_timeout); |
347 | if (r < 0) { | |
348 | log_ndisc_errno(r, "Error updating timer: %m"); | |
349 | goto fail; | |
350 | } | |
9021bb9f | 351 | |
1e7a0e21 LP |
352 | r = sd_event_source_set_enabled(nd->timeout_event_source, SD_EVENT_ONESHOT); |
353 | if (r < 0) { | |
354 | log_ndisc_errno(r, "Error reenabling timer: %m"); | |
355 | goto fail; | |
e3169126 PF |
356 | } |
357 | ||
358 | return 0; | |
b9e7b1cf LP |
359 | |
360 | fail: | |
361 | sd_ndisc_stop(nd); | |
362 | return 0; | |
e3169126 PF |
363 | } |
364 | ||
1e7a0e21 | 365 | _public_ int sd_ndisc_stop(sd_ndisc *nd) { |
836cf090 | 366 | assert_return(nd, -EINVAL); |
836cf090 | 367 | |
1e7a0e21 | 368 | if (nd->fd < 0) |
c1c9b211 LP |
369 | return 0; |
370 | ||
1e7a0e21 | 371 | log_ndisc("Stopping IPv6 Router Solicitation client"); |
836cf090 | 372 | |
5c4c338a | 373 | ndisc_reset(nd); |
1e7a0e21 | 374 | return 1; |
836cf090 PF |
375 | } |
376 | ||
1e7a0e21 | 377 | _public_ int sd_ndisc_start(sd_ndisc *nd) { |
e3169126 PF |
378 | int r; |
379 | ||
a1140666 LP |
380 | assert_return(nd, -EINVAL); |
381 | assert_return(nd->event, -EINVAL); | |
382 | assert_return(nd->ifindex > 0, -EINVAL); | |
e3169126 | 383 | |
1e7a0e21 LP |
384 | if (nd->fd >= 0) |
385 | return 0; | |
e3169126 | 386 | |
1e7a0e21 LP |
387 | assert(!nd->recv_event_source); |
388 | assert(!nd->timeout_event_source); | |
e3169126 | 389 | |
1e7a0e21 LP |
390 | nd->fd = icmp6_bind_router_solicitation(nd->ifindex); |
391 | if (nd->fd < 0) | |
392 | return nd->fd; | |
393 | ||
394 | r = sd_event_add_io(nd->event, &nd->recv_event_source, nd->fd, EPOLLIN, ndisc_recv, nd); | |
e3169126 | 395 | if (r < 0) |
5c4c338a | 396 | goto fail; |
e3169126 | 397 | |
3e261cfd | 398 | r = sd_event_source_set_priority(nd->recv_event_source, nd->event_priority); |
e3169126 | 399 | if (r < 0) |
5c4c338a | 400 | goto fail; |
e3169126 | 401 | |
3e261cfd | 402 | (void) sd_event_source_set_description(nd->recv_event_source, "ndisc-receive-message"); |
9021bb9f | 403 | |
1e7a0e21 | 404 | r = sd_event_add_time(nd->event, &nd->timeout_event_source, clock_boottime_or_monotonic(), 0, 0, ndisc_timeout, nd); |
e3169126 | 405 | if (r < 0) |
5c4c338a | 406 | goto fail; |
e3169126 | 407 | |
3e261cfd | 408 | r = sd_event_source_set_priority(nd->timeout_event_source, nd->event_priority); |
9021bb9f | 409 | if (r < 0) |
5c4c338a | 410 | goto fail; |
e3169126 | 411 | |
3e261cfd | 412 | (void) sd_event_source_set_description(nd->timeout_event_source, "ndisc-timeout"); |
5c4c338a | 413 | |
1e7a0e21 LP |
414 | log_ndisc("Started IPv6 Router Solicitation client"); |
415 | return 1; | |
e3169126 | 416 | |
5c4c338a LP |
417 | fail: |
418 | ndisc_reset(nd); | |
e3169126 PF |
419 | return r; |
420 | } |