2 * Copyright (C) 2017 Hans Dedecker <dedeckeh@gmail.com>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License v2 as published by
6 * the Free Software Foundation.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
19 #include <linux/netlink.h>
20 #include <linux/if_addr.h>
21 #include <linux/neighbour.h>
22 #include <linux/rtnetlink.h>
24 #include <netlink/msg.h>
25 #include <netlink/socket.h>
26 #include <netlink/attr.h>
28 #include <arpa/inet.h>
29 #include <libubox/list.h>
34 struct odhcpd_event ev
;
39 static void handle_rtnl_event(struct odhcpd_event
*ev
);
40 static int cb_rtnl_valid(struct nl_msg
*msg
, void *arg
);
41 static void catch_rtnl_err(struct odhcpd_event
*e
, int error
);
42 static struct nl_sock
*create_socket(int protocol
);
44 static struct nl_sock
*rtnl_socket
= NULL
;
45 struct list_head netevent_handler_list
= LIST_HEAD_INIT(netevent_handler_list
);
46 static struct event_socket rtnl_event
= {
48 .uloop
= {.fd
= - 1, },
50 .handle_error
= catch_rtnl_err
,
51 .recv_msgs
= handle_rtnl_event
,
54 .sock_bufsize
= 133120,
57 int netlink_init(void)
59 rtnl_socket
= create_socket(NETLINK_ROUTE
);
61 syslog(LOG_ERR
, "Unable to open nl socket: %m");
65 rtnl_event
.sock
= create_socket(NETLINK_ROUTE
);
66 if (!rtnl_event
.sock
) {
67 syslog(LOG_ERR
, "Unable to open nl event socket: %m");
71 rtnl_event
.ev
.uloop
.fd
= nl_socket_get_fd(rtnl_event
.sock
);
73 if (nl_socket_set_buffer_size(rtnl_event
.sock
, rtnl_event
.sock_bufsize
, 0))
76 nl_socket_disable_seq_check(rtnl_event
.sock
);
78 nl_socket_modify_cb(rtnl_event
.sock
, NL_CB_VALID
, NL_CB_CUSTOM
,
81 /* Receive IPv4 address, IPv6 address, IPv6 routes and neighbor events */
82 if (nl_socket_add_memberships(rtnl_event
.sock
, RTNLGRP_IPV4_IFADDR
,
83 RTNLGRP_IPV6_IFADDR
, RTNLGRP_IPV6_ROUTE
,
84 RTNLGRP_NEIGH
, RTNLGRP_LINK
, 0))
87 odhcpd_register(&rtnl_event
.ev
);
93 nl_socket_free(rtnl_socket
);
97 if (rtnl_event
.sock
) {
98 nl_socket_free(rtnl_event
.sock
);
99 rtnl_event
.sock
= NULL
;
100 rtnl_event
.ev
.uloop
.fd
= -1;
107 int netlink_add_netevent_handler(struct netevent_handler
*handler
)
112 list_add(&handler
->head
, &netevent_handler_list
);
117 static void call_netevent_handler_list(unsigned long event
, struct netevent_handler_info
*info
)
119 struct netevent_handler
*handler
;
121 list_for_each_entry(handler
, &netevent_handler_list
, head
)
122 handler
->cb(event
, info
);
125 static void handle_rtnl_event(struct odhcpd_event
*e
)
127 struct event_socket
*ev_sock
= container_of(e
, struct event_socket
, ev
);
129 nl_recvmsgs_default(ev_sock
->sock
);
132 static void refresh_iface_addr4(int ifindex
)
134 struct odhcpd_ipaddr
*addr
= NULL
;
135 struct interface
*iface
;
136 ssize_t len
= netlink_get_interface_addrs(ifindex
, false, &addr
);
142 avl_for_each_element(&interfaces
, iface
, avl
) {
143 struct netevent_handler_info event_info
;
145 if (iface
->ifindex
!= ifindex
)
148 memset(&event_info
, 0, sizeof(event_info
));
149 event_info
.iface
= iface
;
150 event_info
.addrs_old
.addrs
= iface
->addr4
;
151 event_info
.addrs_old
.len
= iface
->addr4_len
;
154 change
= len
!= (ssize_t
)iface
->addr4_len
;
155 for (ssize_t i
= 0; !change
&& i
< len
; ++i
) {
156 if (addr
[i
].addr
.in
.s_addr
!= iface
->addr4
[i
].addr
.in
.s_addr
)
162 iface
->addr4_len
= len
;
165 call_netevent_handler_list(NETEV_ADDRLIST_CHANGE
, &event_info
);
167 free(event_info
.addrs_old
.addrs
);
172 addr
= malloc(len
* sizeof(*addr
));
176 memcpy(addr
, iface
->addr4
, len
* sizeof(*addr
));
182 static void refresh_iface_addr6(int ifindex
)
184 struct odhcpd_ipaddr
*addr
= NULL
;
185 struct interface
*iface
;
186 ssize_t len
= netlink_get_interface_addrs(ifindex
, true, &addr
);
187 time_t now
= odhcpd_time();
193 avl_for_each_element(&interfaces
, iface
, avl
) {
194 struct netevent_handler_info event_info
;
196 if (iface
->ifindex
!= ifindex
)
199 memset(&event_info
, 0, sizeof(event_info
));
200 event_info
.iface
= iface
;
201 event_info
.addrs_old
.addrs
= iface
->addr6
;
202 event_info
.addrs_old
.len
= iface
->addr6_len
;
205 change
= len
!= (ssize_t
)iface
->addr6_len
;
206 for (ssize_t i
= 0; !change
&& i
< len
; ++i
) {
207 if (!IN6_ARE_ADDR_EQUAL(&addr
[i
].addr
.in6
, &iface
->addr6
[i
].addr
.in6
) ||
208 addr
[i
].prefix
!= iface
->addr6
[i
].prefix
||
209 (addr
[i
].preferred_lt
> (uint32_t)now
) != (iface
->addr6
[i
].preferred_lt
> (uint32_t)now
) ||
210 addr
[i
].valid_lt
< iface
->addr6
[i
].valid_lt
|| addr
[i
].preferred_lt
< iface
->addr6
[i
].preferred_lt
)
216 * Keep track of removed prefixes, so we could advertise them as invalid
217 * for at least a couple of times.
220 * L-13: If the delegated prefix changes, i.e., the current prefix is
221 * replaced with a new prefix without any overlapping time
222 * period, then the IPv6 CE router MUST immediately advertise the
223 * old prefix with a Preferred Lifetime of zero and a Valid
224 * Lifetime of either a) zero or b) the lower of the current
225 * Valid Lifetime and two hours (which must be decremented in
226 * real time) in a Router Advertisement message as described in
227 * Section 5.5.3, (e) of [RFC4862].
230 for (size_t i
= 0; i
< iface
->addr6_len
; ++i
) {
233 if (iface
->addr6
[i
].valid_lt
<= (uint32_t)now
)
236 for (ssize_t j
= 0; removed
&& j
< len
; ++j
) {
237 size_t plen
= min(addr
[j
].prefix
, iface
->addr6
[i
].prefix
);
239 if (odhcpd_bmemcmp(&addr
[j
].addr
.in6
, &iface
->addr6
[i
].addr
.in6
, plen
) == 0)
243 for (size_t j
= 0; removed
&& j
< iface
->invalid_addr6_len
; ++j
) {
244 size_t plen
= min(iface
->invalid_addr6
[j
].prefix
, iface
->addr6
[i
].prefix
);
246 if (odhcpd_bmemcmp(&iface
->invalid_addr6
[j
].addr
.in6
, &iface
->addr6
[i
].addr
.in6
, plen
) == 0)
251 size_t pos
= iface
->invalid_addr6_len
;
252 struct odhcpd_ipaddr
*new_invalid_addr6
= realloc(iface
->invalid_addr6
,
253 sizeof(*iface
->invalid_addr6
) * (pos
+ 1));
255 if (!new_invalid_addr6
)
258 iface
->invalid_addr6
= new_invalid_addr6
;
259 iface
->invalid_addr6_len
++;
260 memcpy(&iface
->invalid_addr6
[pos
], &iface
->addr6
[i
], sizeof(*iface
->invalid_addr6
));
261 iface
->invalid_addr6
[pos
].valid_lt
= iface
->invalid_addr6
[pos
].preferred_lt
= (uint32_t)now
;
263 if (iface
->invalid_addr6
[pos
].prefix
< 64)
264 iface
->invalid_addr6
[pos
].prefix
= 64;
271 iface
->addr6_len
= len
;
274 call_netevent_handler_list(NETEV_ADDR6LIST_CHANGE
, &event_info
);
276 free(event_info
.addrs_old
.addrs
);
281 addr
= malloc(len
* sizeof(*addr
));
285 memcpy(addr
, iface
->addr6
, len
* sizeof(*addr
));
291 static int handle_rtm_link(struct nlmsghdr
*hdr
)
293 struct ifinfomsg
*ifi
= nlmsg_data(hdr
);
294 struct nlattr
*nla
[__IFLA_MAX
];
295 struct interface
*iface
;
296 struct netevent_handler_info event_info
;
299 memset(&event_info
, 0, sizeof(event_info
));
301 if (!nlmsg_valid_hdr(hdr
, sizeof(*ifi
)) || ifi
->ifi_family
!= AF_UNSPEC
)
304 nlmsg_parse(hdr
, sizeof(*ifi
), nla
, __IFLA_MAX
- 1, NULL
);
305 if (!nla
[IFLA_IFNAME
])
308 ifname
= nla_get_string(nla
[IFLA_IFNAME
]);
310 avl_for_each_element(&interfaces
, iface
, avl
) {
311 if (strcmp(iface
->ifname
, ifname
))
314 iface
->ifflags
= ifi
->ifi_flags
;
317 * Assume for link event of the same index, that link changed
318 * and reload services to enable or disable them based on the
319 * RUNNING state of the interface.
321 if (iface
->ifindex
== ifi
->ifi_index
) {
322 reload_services(iface
);
326 iface
->ifindex
= ifi
->ifi_index
;
327 event_info
.iface
= iface
;
328 call_netevent_handler_list(NETEV_IFINDEX_CHANGE
, &event_info
);
334 static int handle_rtm_route(struct nlmsghdr
*hdr
, bool add
)
336 struct rtmsg
*rtm
= nlmsg_data(hdr
);
337 struct nlattr
*nla
[__RTA_MAX
];
338 struct interface
*iface
;
339 struct netevent_handler_info event_info
;
342 if (!nlmsg_valid_hdr(hdr
, sizeof(*rtm
)) || rtm
->rtm_family
!= AF_INET6
)
345 nlmsg_parse(hdr
, sizeof(*rtm
), nla
, __RTA_MAX
- 1, NULL
);
347 memset(&event_info
, 0, sizeof(event_info
));
348 event_info
.rt
.dst_len
= rtm
->rtm_dst_len
;
351 nla_memcpy(&event_info
.rt
.dst
, nla
[RTA_DST
],
352 sizeof(event_info
.rt
.dst
));
355 ifindex
= nla_get_u32(nla
[RTA_OIF
]);
357 if (nla
[RTA_GATEWAY
])
358 nla_memcpy(&event_info
.rt
.gateway
, nla
[RTA_GATEWAY
],
359 sizeof(event_info
.rt
.gateway
));
361 avl_for_each_element(&interfaces
, iface
, avl
) {
362 if (ifindex
&& iface
->ifindex
!= ifindex
)
365 event_info
.iface
= ifindex
? iface
: NULL
;
366 call_netevent_handler_list(add
? NETEV_ROUTE6_ADD
: NETEV_ROUTE6_DEL
,
373 static int handle_rtm_addr(struct nlmsghdr
*hdr
, bool add
)
375 struct ifaddrmsg
*ifa
= nlmsg_data(hdr
);
376 struct nlattr
*nla
[__IFA_MAX
];
377 struct interface
*iface
;
378 struct netevent_handler_info event_info
;
379 char buf
[INET6_ADDRSTRLEN
];
381 if (!nlmsg_valid_hdr(hdr
, sizeof(*ifa
)) ||
382 (ifa
->ifa_family
!= AF_INET6
&&
383 ifa
->ifa_family
!= AF_INET
))
386 memset(&event_info
, 0, sizeof(event_info
));
388 nlmsg_parse(hdr
, sizeof(*ifa
), nla
, __IFA_MAX
- 1, NULL
);
390 if (ifa
->ifa_family
== AF_INET6
) {
391 if (!nla
[IFA_ADDRESS
])
394 nla_memcpy(&event_info
.addr
, nla
[IFA_ADDRESS
], sizeof(event_info
.addr
));
396 if (IN6_IS_ADDR_MULTICAST(&event_info
.addr
))
399 inet_ntop(AF_INET6
, &event_info
.addr
, buf
, sizeof(buf
));
401 avl_for_each_element(&interfaces
, iface
, avl
) {
402 if (iface
->ifindex
!= (int)ifa
->ifa_index
)
405 if (add
&& IN6_IS_ADDR_LINKLOCAL(&event_info
.addr
)) {
406 iface
->have_link_local
= true;
410 syslog(LOG_DEBUG
, "Netlink %s %s on %s", add
? "newaddr" : "deladdr",
413 event_info
.iface
= iface
;
414 call_netevent_handler_list(add
? NETEV_ADDR6_ADD
: NETEV_ADDR6_DEL
,
418 refresh_iface_addr6(ifa
->ifa_index
);
423 nla_memcpy(&event_info
.addr
, nla
[IFA_LOCAL
], sizeof(event_info
.addr
));
425 inet_ntop(AF_INET
, &event_info
.addr
, buf
, sizeof(buf
));
427 avl_for_each_element(&interfaces
, iface
, avl
) {
428 if (iface
->ifindex
!= (int)ifa
->ifa_index
)
431 syslog(LOG_DEBUG
, "Netlink %s %s on %s", add
? "newaddr" : "deladdr",
434 event_info
.iface
= iface
;
435 call_netevent_handler_list(add
? NETEV_ADDR_ADD
: NETEV_ADDR_DEL
,
439 refresh_iface_addr4(ifa
->ifa_index
);
445 static int handle_rtm_neigh(struct nlmsghdr
*hdr
, bool add
)
447 struct ndmsg
*ndm
= nlmsg_data(hdr
);
448 struct nlattr
*nla
[__NDA_MAX
];
449 struct interface
*iface
;
450 struct netevent_handler_info event_info
;
451 char buf
[INET6_ADDRSTRLEN
];
453 if (!nlmsg_valid_hdr(hdr
, sizeof(*ndm
)) ||
454 ndm
->ndm_family
!= AF_INET6
)
457 nlmsg_parse(hdr
, sizeof(*ndm
), nla
, __NDA_MAX
- 1, NULL
);
461 memset(&event_info
, 0, sizeof(event_info
));
463 nla_memcpy(&event_info
.neigh
.dst
, nla
[NDA_DST
], sizeof(event_info
.neigh
.dst
));
465 if (IN6_IS_ADDR_LINKLOCAL(&event_info
.neigh
.dst
) ||
466 IN6_IS_ADDR_MULTICAST(&event_info
.neigh
.dst
))
469 inet_ntop(AF_INET6
, &event_info
.neigh
.dst
, buf
, sizeof(buf
));
471 avl_for_each_element(&interfaces
, iface
, avl
) {
472 if (iface
->ifindex
!= ndm
->ndm_ifindex
)
475 syslog(LOG_DEBUG
, "Netlink %s %s on %s", true ? "newneigh" : "delneigh",
478 event_info
.iface
= iface
;
479 event_info
.neigh
.state
= ndm
->ndm_state
;
480 event_info
.neigh
.flags
= ndm
->ndm_flags
;
482 call_netevent_handler_list(add
? NETEV_NEIGH6_ADD
: NETEV_NEIGH6_DEL
,
489 /* Handler for neighbor cache entries from the kernel. This is our source
490 * to learn and unlearn hosts on interfaces. */
491 static int cb_rtnl_valid(struct nl_msg
*msg
, _unused
void *arg
)
493 struct nlmsghdr
*hdr
= nlmsg_hdr(msg
);
497 switch (hdr
->nlmsg_type
) {
499 ret
= handle_rtm_link(hdr
);
506 ret
= handle_rtm_route(hdr
, add
);
513 ret
= handle_rtm_addr(hdr
, add
);
520 ret
= handle_rtm_neigh(hdr
, add
);
530 static void catch_rtnl_err(struct odhcpd_event
*e
, int error
)
532 struct event_socket
*ev_sock
= container_of(e
, struct event_socket
, ev
);
534 if (error
!= ENOBUFS
)
537 /* Double netlink event buffer size */
538 ev_sock
->sock_bufsize
*= 2;
540 if (nl_socket_set_buffer_size(ev_sock
->sock
, ev_sock
->sock_bufsize
, 0))
543 netlink_dump_addr_table(true);
547 odhcpd_deregister(e
);
550 static struct nl_sock
*create_socket(int protocol
)
552 struct nl_sock
*nl_sock
;
554 nl_sock
= nl_socket_alloc();
558 if (nl_connect(nl_sock
, protocol
) < 0)
565 nl_socket_free(nl_sock
);
574 struct odhcpd_ipaddr
**addrs
;
580 static int cb_addr_valid(struct nl_msg
*msg
, void *arg
)
582 struct addr_info
*ctxt
= (struct addr_info
*)arg
;
583 struct odhcpd_ipaddr
*addrs
= *(ctxt
->addrs
);
584 struct nlmsghdr
*hdr
= nlmsg_hdr(msg
);
585 struct ifaddrmsg
*ifa
;
586 struct nlattr
*nla
[__IFA_MAX
], *nla_addr
= NULL
;
588 if (hdr
->nlmsg_type
!= RTM_NEWADDR
)
591 ifa
= NLMSG_DATA(hdr
);
592 if (ifa
->ifa_scope
!= RT_SCOPE_UNIVERSE
||
593 (ctxt
->af
!= ifa
->ifa_family
) ||
594 (ctxt
->ifindex
&& ifa
->ifa_index
!= (unsigned)ctxt
->ifindex
))
597 nlmsg_parse(hdr
, sizeof(*ifa
), nla
, __IFA_MAX
- 1, NULL
);
599 switch (ifa
->ifa_family
) {
601 if (nla
[IFA_ADDRESS
])
602 nla_addr
= nla
[IFA_ADDRESS
];
607 nla_addr
= nla
[IFA_LOCAL
];
616 addrs
= realloc(addrs
, sizeof(*addrs
)*(ctxt
->ret
+ 1));
620 memset(&addrs
[ctxt
->ret
], 0, sizeof(addrs
[ctxt
->ret
]));
621 addrs
[ctxt
->ret
].prefix
= ifa
->ifa_prefixlen
;
623 nla_memcpy(&addrs
[ctxt
->ret
].addr
, nla_addr
,
624 sizeof(addrs
[ctxt
->ret
].addr
));
626 if (nla
[IFA_BROADCAST
])
627 nla_memcpy(&addrs
[ctxt
->ret
].broadcast
, nla
[IFA_BROADCAST
],
628 sizeof(addrs
[ctxt
->ret
].broadcast
));
630 if (nla
[IFA_CACHEINFO
]) {
631 struct ifa_cacheinfo
*ifc
= nla_data(nla
[IFA_CACHEINFO
]);
633 addrs
[ctxt
->ret
].preferred_lt
= ifc
->ifa_prefered
;
634 addrs
[ctxt
->ret
].valid_lt
= ifc
->ifa_valid
;
637 if (ifa
->ifa_flags
& IFA_F_DEPRECATED
)
638 addrs
[ctxt
->ret
].preferred_lt
= 0;
640 if (ifa
->ifa_family
== AF_INET6
&&
641 ifa
->ifa_flags
& IFA_F_TENTATIVE
)
642 addrs
[ctxt
->ret
].tentative
= true;
645 *(ctxt
->addrs
) = addrs
;
651 static int cb_addr_finish(_unused
struct nl_msg
*msg
, void *arg
)
653 struct addr_info
*ctxt
= (struct addr_info
*)arg
;
661 static int cb_addr_error(_unused
struct sockaddr_nl
*nla
, struct nlmsgerr
*err
,
664 struct addr_info
*ctxt
= (struct addr_info
*)arg
;
667 ctxt
->ret
= err
->error
;
673 static int prefix_cmp(const void *va
, const void *vb
)
675 const struct odhcpd_ipaddr
*a
= va
, *b
= vb
;
678 if (a
->prefix
== b
->prefix
) {
679 ret
= (ntohl(a
->addr
.in
.s_addr
) < ntohl(b
->addr
.in
.s_addr
)) ? 1 :
680 (ntohl(a
->addr
.in
.s_addr
) > ntohl(b
->addr
.in
.s_addr
)) ? -1 : 0;
682 ret
= a
->prefix
< b
->prefix
? 1 : -1;
688 /* compare IPv6 prefixes */
689 static int prefix6_cmp(const void *va
, const void *vb
)
691 const struct odhcpd_ipaddr
*a
= va
, *b
= vb
;
692 uint32_t a_pref_lt
= IN6_IS_ADDR_ULA(&a
->addr
.in6
) ? 1 : a
->preferred_lt
;
693 uint32_t b_pref_lt
= IN6_IS_ADDR_ULA(&b
->addr
.in6
) ? 1 : b
->preferred_lt
;
694 return (a_pref_lt
< b_pref_lt
) ? 1 : (a_pref_lt
> b_pref_lt
) ? -1 : 0;
698 /* Detect an IPV6-address currently assigned to the given interface */
699 ssize_t
netlink_get_interface_addrs(int ifindex
, bool v6
, struct odhcpd_ipaddr
**addrs
)
702 struct ifaddrmsg ifa
= {
703 .ifa_family
= v6
? AF_INET6
: AF_INET
,
707 .ifa_index
= ifindex
, };
708 struct nl_cb
*cb
= nl_cb_alloc(NL_CB_DEFAULT
);
709 struct addr_info ctxt
= {
711 .af
= v6
? AF_INET6
: AF_INET
,
722 msg
= nlmsg_alloc_simple(RTM_GETADDR
, NLM_F_REQUEST
| NLM_F_DUMP
);
729 nlmsg_append(msg
, &ifa
, sizeof(ifa
), 0);
731 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, cb_addr_valid
, &ctxt
);
732 nl_cb_set(cb
, NL_CB_FINISH
, NL_CB_CUSTOM
, cb_addr_finish
, &ctxt
);
733 nl_cb_err(cb
, NL_CB_CUSTOM
, cb_addr_error
, &ctxt
);
735 ctxt
.ret
= nl_send_auto_complete(rtnl_socket
, msg
);
740 while (ctxt
.pending
> 0)
741 nl_recvmsgs(rtnl_socket
, cb
);
746 time_t now
= odhcpd_time();
747 struct odhcpd_ipaddr
*addr
= *addrs
;
749 qsort(addr
, ctxt
.ret
, sizeof(*addr
), v6
? prefix6_cmp
: prefix_cmp
);
751 for (ssize_t i
= 0; i
< ctxt
.ret
; ++i
) {
752 if (addr
[i
].preferred_lt
< UINT32_MAX
- now
)
753 addr
[i
].preferred_lt
+= now
;
755 if (addr
[i
].valid_lt
< UINT32_MAX
- now
)
756 addr
[i
].valid_lt
+= now
;
768 static int cb_linklocal_valid(struct nl_msg
*msg
, void *arg
)
770 struct addr_info
*ctxt
= (struct addr_info
*)arg
;
771 struct odhcpd_ipaddr
*addrs
= *(ctxt
->addrs
);
772 struct nlmsghdr
*hdr
= nlmsg_hdr(msg
);
773 struct ifaddrmsg
*ifa
;
774 struct nlattr
*nla
[__IFA_MAX
], *nla_addr
= NULL
;
775 struct in6_addr addr
;
777 if (hdr
->nlmsg_type
!= RTM_NEWADDR
)
780 ifa
= NLMSG_DATA(hdr
);
781 if (ifa
->ifa_scope
!= RT_SCOPE_LINK
||
782 (ctxt
->af
!= ifa
->ifa_family
) ||
783 (ctxt
->ifindex
&& ifa
->ifa_index
!= (unsigned)ctxt
->ifindex
))
786 nlmsg_parse(hdr
, sizeof(*ifa
), nla
, __IFA_MAX
- 1, NULL
);
788 switch (ifa
->ifa_family
) {
790 if (nla
[IFA_ADDRESS
])
791 nla_addr
= nla
[IFA_ADDRESS
];
800 nla_memcpy(&addr
, nla_addr
, sizeof(addr
));
802 if (!IN6_IS_ADDR_LINKLOCAL(&addr
))
805 addrs
= realloc(addrs
, sizeof(*addrs
)*(ctxt
->ret
+ 1));
809 memset(&addrs
[ctxt
->ret
], 0, sizeof(addrs
[ctxt
->ret
]));
811 addrs
= realloc(addrs
, sizeof(*addrs
)*(ctxt
->ret
+ 1));
816 memcpy(&addrs
[ctxt
->ret
].addr
, &addr
, sizeof(addrs
[ctxt
->ret
].addr
));
818 if (ifa
->ifa_flags
& IFA_F_TENTATIVE
)
819 addrs
[ctxt
->ret
].tentative
= true;
822 *(ctxt
->addrs
) = addrs
;
828 static int cb_linklocal_finish(_unused
struct nl_msg
*msg
, void *arg
)
830 struct addr_info
*ctxt
= (struct addr_info
*)arg
;
838 static int cb_linklocal_error(_unused
struct sockaddr_nl
*nla
, struct nlmsgerr
*err
,
841 struct addr_info
*ctxt
= (struct addr_info
*)arg
;
844 ctxt
->ret
= err
->error
;
850 /* Detect a link local IPV6-address currently assigned to the given interface */
851 ssize_t
netlink_get_interface_linklocal(int ifindex
, struct odhcpd_ipaddr
**addrs
)
854 struct ifaddrmsg ifa
= {
855 .ifa_family
= AF_INET6
,
859 .ifa_index
= ifindex
, };
860 struct nl_cb
*cb
= nl_cb_alloc(NL_CB_DEFAULT
);
861 struct addr_info ctxt
= {
874 msg
= nlmsg_alloc_simple(RTM_GETADDR
, NLM_F_REQUEST
| NLM_F_DUMP
);
881 nlmsg_append(msg
, &ifa
, sizeof(ifa
), 0);
883 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, cb_linklocal_valid
, &ctxt
);
884 nl_cb_set(cb
, NL_CB_FINISH
, NL_CB_CUSTOM
, cb_linklocal_finish
, &ctxt
);
885 nl_cb_err(cb
, NL_CB_CUSTOM
, cb_linklocal_error
, &ctxt
);
887 ctxt
.ret
= nl_send_auto_complete(rtnl_socket
, msg
);
892 while (ctxt
.pending
> 0)
893 nl_recvmsgs(rtnl_socket
, cb
);
910 const struct in6_addr
*addr
;
915 static int cb_proxy_neigh_valid(struct nl_msg
*msg
, void *arg
)
917 struct neigh_info
*ctxt
= (struct neigh_info
*)arg
;
918 struct nlmsghdr
*hdr
= nlmsg_hdr(msg
);
920 struct nlattr
*nla_dst
;
922 if (hdr
->nlmsg_type
!= RTM_NEWNEIGH
)
925 ndm
= NLMSG_DATA(hdr
);
926 if (ndm
->ndm_family
!= AF_INET6
||
927 (ctxt
->ifindex
&& ndm
->ndm_ifindex
!= ctxt
->ifindex
))
930 if (!(ndm
->ndm_flags
& NTF_PROXY
))
933 nla_dst
= nlmsg_find_attr(hdr
, sizeof(*ndm
), NDA_DST
);
937 if (nla_memcmp(nla_dst
,ctxt
->addr
, 16) == 0)
944 static int cb_proxy_neigh_finish(_unused
struct nl_msg
*msg
, void *arg
)
946 struct neigh_info
*ctxt
= (struct neigh_info
*)arg
;
954 static int cb_proxy_neigh_error(_unused
struct sockaddr_nl
*nla
, struct nlmsgerr
*err
,
957 struct neigh_info
*ctxt
= (struct neigh_info
*)arg
;
960 ctxt
->ret
= err
->error
;
965 /* Detect an IPV6-address proxy neighbor for the given interface */
966 int netlink_get_interface_proxy_neigh(int ifindex
, const struct in6_addr
*addr
)
970 .ndm_family
= AF_INET6
,
971 .ndm_flags
= NTF_PROXY
,
972 .ndm_ifindex
= ifindex
,
974 struct nl_cb
*cb
= nl_cb_alloc(NL_CB_DEFAULT
);
975 struct neigh_info ctxt
= {
987 msg
= nlmsg_alloc_simple(RTM_GETNEIGH
, NLM_F_REQUEST
| NLM_F_MATCH
);
994 nlmsg_append(msg
, &ndm
, sizeof(ndm
), 0);
995 nla_put(msg
, NDA_DST
, sizeof(*addr
), addr
);
997 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, cb_proxy_neigh_valid
, &ctxt
);
998 nl_cb_set(cb
, NL_CB_FINISH
, NL_CB_CUSTOM
, cb_proxy_neigh_finish
, &ctxt
);
999 nl_cb_err(cb
, NL_CB_CUSTOM
, cb_proxy_neigh_error
, &ctxt
);
1001 ctxt
.ret
= nl_send_auto_complete(rtnl_socket
, msg
);
1005 while (ctxt
.pending
> 0)
1006 nl_recvmsgs(rtnl_socket
, cb
);
1017 int netlink_setup_route(const struct in6_addr
*addr
, const int prefixlen
,
1018 const int ifindex
, const struct in6_addr
*gw
,
1019 const uint32_t metric
, const bool add
)
1022 struct rtmsg rtm
= {
1023 .rtm_family
= AF_INET6
,
1024 .rtm_dst_len
= prefixlen
,
1026 .rtm_table
= RT_TABLE_MAIN
,
1027 .rtm_protocol
= (add
? RTPROT_STATIC
: RTPROT_UNSPEC
),
1028 .rtm_scope
= (add
? (gw
? RT_SCOPE_UNIVERSE
: RT_SCOPE_LINK
) : RT_SCOPE_NOWHERE
),
1029 .rtm_type
= (add
? RTN_UNICAST
: RTN_UNSPEC
),
1033 msg
= nlmsg_alloc_simple(add
? RTM_NEWROUTE
: RTM_DELROUTE
,
1034 add
? NLM_F_CREATE
| NLM_F_REPLACE
: 0);
1038 nlmsg_append(msg
, &rtm
, sizeof(rtm
), 0);
1040 nla_put(msg
, RTA_DST
, sizeof(*addr
), addr
);
1041 nla_put_u32(msg
, RTA_OIF
, ifindex
);
1042 nla_put_u32(msg
, RTA_PRIORITY
, metric
);
1045 nla_put(msg
, RTA_GATEWAY
, sizeof(*gw
), gw
);
1047 ret
= nl_send_auto_complete(rtnl_socket
, msg
);
1053 return nl_wait_for_ack(rtnl_socket
);
1057 int netlink_setup_proxy_neigh(const struct in6_addr
*addr
,
1058 const int ifindex
, const bool add
)
1061 struct ndmsg ndm
= {
1062 .ndm_family
= AF_INET6
,
1063 .ndm_flags
= NTF_PROXY
,
1064 .ndm_ifindex
= ifindex
,
1066 int ret
= 0, flags
= NLM_F_REQUEST
;
1069 flags
|= NLM_F_REPLACE
| NLM_F_CREATE
;
1071 msg
= nlmsg_alloc_simple(add
? RTM_NEWNEIGH
: RTM_DELNEIGH
, flags
);
1075 nlmsg_append(msg
, &ndm
, sizeof(ndm
), 0);
1077 nla_put(msg
, NDA_DST
, sizeof(*addr
), addr
);
1079 ret
= nl_send_auto_complete(rtnl_socket
, msg
);
1085 return nl_wait_for_ack(rtnl_socket
);
1089 int netlink_setup_addr(struct odhcpd_ipaddr
*addr
,
1090 const int ifindex
, const bool v6
, const bool add
)
1093 struct ifaddrmsg ifa
= {
1094 .ifa_family
= v6
? AF_INET6
: AF_INET
,
1095 .ifa_prefixlen
= addr
->prefix
,
1098 .ifa_index
= ifindex
, };
1099 int ret
= 0, flags
= NLM_F_REQUEST
;
1102 flags
|= NLM_F_REPLACE
| NLM_F_CREATE
;
1104 msg
= nlmsg_alloc_simple(add
? RTM_NEWADDR
: RTM_DELADDR
, 0);
1108 nlmsg_append(msg
, &ifa
, sizeof(ifa
), flags
);
1109 nla_put(msg
, IFA_LOCAL
, v6
? 16 : 4, &addr
->addr
);
1111 struct ifa_cacheinfo cinfo
= { .ifa_prefered
= 0xffffffffU
,
1112 .ifa_valid
= 0xffffffffU
,
1115 time_t now
= odhcpd_time();
1117 if (addr
->preferred_lt
) {
1118 int64_t preferred_lt
= addr
->preferred_lt
- now
;
1119 if (preferred_lt
< 0)
1121 else if (preferred_lt
> UINT32_MAX
)
1122 preferred_lt
= UINT32_MAX
;
1124 cinfo
.ifa_prefered
= preferred_lt
;
1127 if (addr
->valid_lt
) {
1128 int64_t valid_lt
= addr
->valid_lt
- now
;
1129 if (valid_lt
<= 0) {
1133 else if (valid_lt
> UINT32_MAX
)
1134 valid_lt
= UINT32_MAX
;
1136 cinfo
.ifa_valid
= valid_lt
;
1139 nla_put(msg
, IFA_CACHEINFO
, sizeof(cinfo
), &cinfo
);
1141 nla_put_u32(msg
, IFA_FLAGS
, IFA_F_NOPREFIXROUTE
);
1143 if (addr
->broadcast
.s_addr
)
1144 nla_put_u32(msg
, IFA_BROADCAST
, addr
->broadcast
.s_addr
);
1147 ret
= nl_send_auto_complete(rtnl_socket
, msg
);
1153 return nl_wait_for_ack(rtnl_socket
);
1156 void netlink_dump_neigh_table(const bool proxy
)
1159 struct ndmsg ndm
= {
1160 .ndm_family
= AF_INET6
,
1161 .ndm_flags
= proxy
? NTF_PROXY
: 0,
1164 msg
= nlmsg_alloc_simple(RTM_GETNEIGH
, NLM_F_REQUEST
| NLM_F_DUMP
);
1168 nlmsg_append(msg
, &ndm
, sizeof(ndm
), 0);
1170 nl_send_auto_complete(rtnl_event
.sock
, msg
);
1175 void netlink_dump_addr_table(const bool v6
)
1178 struct ifaddrmsg ifa
= {
1179 .ifa_family
= v6
? AF_INET6
: AF_INET
,
1182 msg
= nlmsg_alloc_simple(RTM_GETADDR
, NLM_F_REQUEST
| NLM_F_DUMP
);
1186 nlmsg_append(msg
, &ifa
, sizeof(ifa
), 0);
1188 nl_send_auto_complete(rtnl_event
.sock
, msg
);