1 /*-
2 * SPDX-License-Identifier: BSD-3-Clause
3 *
4 * Copyright (c) 1988, 1991, 1993
5 * The Regents of the University of California. All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. Neither the name of the University nor the names of its contributors
16 * may be used to endorse or promote products derived from this software
17 * without specific prior written permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 * SUCH DAMAGE.
30 */
31 #include "opt_ddb.h"
32 #include "opt_route.h"
33 #include "opt_inet.h"
34 #include "opt_inet6.h"
35
36 #include <sys/param.h>
37 #include <sys/jail.h>
38 #include <sys/kernel.h>
39 #include <sys/eventhandler.h>
40 #include <sys/domain.h>
41 #include <sys/lock.h>
42 #include <sys/malloc.h>
43 #include <sys/mbuf.h>
44 #include <sys/priv.h>
45 #include <sys/proc.h>
46 #include <sys/protosw.h>
47 #include <sys/rmlock.h>
48 #include <sys/rwlock.h>
49 #include <sys/signalvar.h>
50 #include <sys/socket.h>
51 #include <sys/socketvar.h>
52 #include <sys/sysctl.h>
53 #include <sys/systm.h>
54
55 #include <net/if.h>
56 #include <net/if_var.h>
57 #include <net/if_private.h>
58 #include <net/if_dl.h>
59 #include <net/if_llatbl.h>
60 #include <net/if_types.h>
61 #include <net/netisr.h>
62 #include <net/route.h>
63 #include <net/route/route_ctl.h>
64 #include <net/route/route_var.h>
65 #include <net/vnet.h>
66
67 #include <netinet/in.h>
68 #include <netinet/if_ether.h>
69 #include <netinet/ip_carp.h>
70 #ifdef INET6
71 #include <netinet6/in6_var.h>
72 #include <netinet6/ip6_var.h>
73 #include <netinet6/scope6_var.h>
74 #endif
75 #include <net/route/nhop.h>
76
77 #define DEBUG_MOD_NAME rtsock
78 #define DEBUG_MAX_LEVEL LOG_DEBUG
79 #include <net/route/route_debug.h>
80 _DECLARE_DEBUG(LOG_INFO);
81
82 #ifdef COMPAT_FREEBSD32
83 #include <sys/mount.h>
84 #include <compat/freebsd32/freebsd32.h>
85
86 struct if_msghdr32 {
87 uint16_t ifm_msglen;
88 uint8_t ifm_version;
89 uint8_t ifm_type;
90 int32_t ifm_addrs;
91 int32_t ifm_flags;
92 uint16_t ifm_index;
93 uint16_t _ifm_spare1;
94 struct if_data ifm_data;
95 };
96
97 struct if_msghdrl32 {
98 uint16_t ifm_msglen;
99 uint8_t ifm_version;
100 uint8_t ifm_type;
101 int32_t ifm_addrs;
102 int32_t ifm_flags;
103 uint16_t ifm_index;
104 uint16_t _ifm_spare1;
105 uint16_t ifm_len;
106 uint16_t ifm_data_off;
107 uint32_t _ifm_spare2;
108 struct if_data ifm_data;
109 };
110
111 struct ifa_msghdrl32 {
112 uint16_t ifam_msglen;
113 uint8_t ifam_version;
114 uint8_t ifam_type;
115 int32_t ifam_addrs;
116 int32_t ifam_flags;
117 uint16_t ifam_index;
118 uint16_t _ifam_spare1;
119 uint16_t ifam_len;
120 uint16_t ifam_data_off;
121 int32_t ifam_metric;
122 struct if_data ifam_data;
123 };
124
125 #define SA_SIZE32(sa) \
126 ( (((struct sockaddr *)(sa))->sa_len == 0) ? \
127 sizeof(int) : \
128 1 + ( (((struct sockaddr *)(sa))->sa_len - 1) | (sizeof(int) - 1) ) )
129
130 #endif /* COMPAT_FREEBSD32 */
131
132 struct linear_buffer {
133 char *base; /* Base allocated memory pointer */
134 uint32_t offset; /* Currently used offset */
135 uint32_t size; /* Total buffer size */
136 };
137 #define SCRATCH_BUFFER_SIZE 1024
138
139 #define RTS_PID_LOG(_l, _fmt, ...) RT_LOG_##_l(_l, "PID %d: " _fmt, curproc ? curproc->p_pid : 0, ## __VA_ARGS__)
140
141 MALLOC_DEFINE(M_RTABLE, "routetbl", "routing tables");
142
143 /* NB: these are not modified */
144 static struct sockaddr route_src = { 2, PF_ROUTE, };
145 static struct sockaddr sa_zero = { sizeof(sa_zero), AF_INET, };
146
147 /* These are external hooks for CARP. */
148 int (*carp_get_vhid_p)(struct ifaddr *);
149
150 /*
151 * Used by rtsock callback code to decide whether to filter the update
152 * notification to a socket bound to a particular FIB.
153 */
154 #define RTS_FILTER_FIB M_PROTO8
155 /*
156 * Used to store address family of the notification.
157 */
158 #define m_rtsock_family m_pkthdr.PH_loc.eight[0]
159
160 struct rcb {
161 LIST_ENTRY(rcb) list;
162 struct socket *rcb_socket;
163 sa_family_t rcb_family;
164 };
165
166 typedef struct {
167 LIST_HEAD(, rcb) cblist;
168 int ip_count; /* attached w/ AF_INET */
169 int ip6_count; /* attached w/ AF_INET6 */
170 int any_count; /* total attached */
171 } route_cb_t;
172 VNET_DEFINE_STATIC(route_cb_t, route_cb);
173 #define V_route_cb VNET(route_cb)
174
175 struct mtx rtsock_mtx;
176 MTX_SYSINIT(rtsock, &rtsock_mtx, "rtsock route_cb lock", MTX_DEF);
177
178 #define RTSOCK_LOCK() mtx_lock(&rtsock_mtx)
179 #define RTSOCK_UNLOCK() mtx_unlock(&rtsock_mtx)
180 #define RTSOCK_LOCK_ASSERT() mtx_assert(&rtsock_mtx, MA_OWNED)
181
182 SYSCTL_NODE(_net, OID_AUTO, route, CTLFLAG_RD | CTLFLAG_MPSAFE, 0, "");
183
184 struct walkarg {
185 int family;
186 int w_tmemsize;
187 int w_op, w_arg;
188 caddr_t w_tmem;
189 struct sysctl_req *w_req;
190 struct sockaddr *dst;
191 struct sockaddr *mask;
192 };
193
194 static void rts_input(struct mbuf *m);
195 static struct mbuf *rtsock_msg_mbuf(int type, struct rt_addrinfo *rtinfo);
196 static int rtsock_msg_buffer(int type, struct rt_addrinfo *rtinfo,
197 struct walkarg *w, int *plen);
198 static int rt_xaddrs(caddr_t cp, caddr_t cplim,
199 struct rt_addrinfo *rtinfo);
200 static int cleanup_xaddrs(struct rt_addrinfo *info, struct linear_buffer *lb);
201 static int sysctl_dumpentry(struct rtentry *rt, void *vw);
202 static int sysctl_dumpnhop(struct rtentry *rt, struct nhop_object *nh,
203 uint32_t weight, struct walkarg *w);
204 static int sysctl_iflist(int af, struct walkarg *w);
205 static int sysctl_ifmalist(int af, struct walkarg *w);
206 static void rt_getmetrics(const struct rtentry *rt,
207 const struct nhop_object *nh, struct rt_metrics *out);
208 static void rt_dispatch(struct mbuf *, sa_family_t);
209 static void rt_ifannouncemsg(struct ifnet *ifp, int what);
210 static int handle_rtm_get(struct rt_addrinfo *info, u_int fibnum,
211 struct rt_msghdr *rtm, struct rib_cmd_info *rc);
212 static int update_rtm_from_rc(struct rt_addrinfo *info,
213 struct rt_msghdr **prtm, int alloc_len,
214 struct rib_cmd_info *rc, struct nhop_object *nh);
215 static void send_rtm_reply(struct socket *so, struct rt_msghdr *rtm,
216 struct mbuf *m, sa_family_t saf, u_int fibnum,
217 int rtm_errno);
218 static void rtsock_notify_event(uint32_t fibnum, const struct rib_cmd_info *rc);
219 static void rtsock_ifmsg(struct ifnet *ifp, int if_flags_mask);
220
221 static struct netisr_handler rtsock_nh = {
222 .nh_name = "rtsock",
223 .nh_handler = rts_input,
224 .nh_proto = NETISR_ROUTE,
225 .nh_policy = NETISR_POLICY_SOURCE,
226 };
227
228 static int
sysctl_route_netisr_maxqlen(SYSCTL_HANDLER_ARGS)229 sysctl_route_netisr_maxqlen(SYSCTL_HANDLER_ARGS)
230 {
231 int error, qlimit;
232
233 netisr_getqlimit(&rtsock_nh, &qlimit);
234 error = sysctl_handle_int(oidp, &qlimit, 0, req);
235 if (error || !req->newptr)
236 return (error);
237 if (qlimit < 1)
238 return (EINVAL);
239 return (netisr_setqlimit(&rtsock_nh, qlimit));
240 }
241 SYSCTL_PROC(_net_route, OID_AUTO, netisr_maxqlen,
242 CTLTYPE_INT | CTLFLAG_RWTUN | CTLFLAG_NOFETCH | CTLFLAG_MPSAFE,
243 0, 0, sysctl_route_netisr_maxqlen, "I",
244 "maximum routing socket dispatch queue length");
245
246 static void
vnet_rts_init(void)247 vnet_rts_init(void)
248 {
249 int tmp;
250
251 if (IS_DEFAULT_VNET(curvnet)) {
252 if (TUNABLE_INT_FETCH("net.route.netisr_maxqlen", &tmp))
253 rtsock_nh.nh_qlimit = tmp;
254 netisr_register(&rtsock_nh);
255 }
256 #ifdef VIMAGE
257 else
258 netisr_register_vnet(&rtsock_nh);
259 #endif
260 }
261 VNET_SYSINIT(vnet_rtsock, SI_SUB_PROTO_DOMAIN, SI_ORDER_THIRD,
262 vnet_rts_init, 0);
263
264 #ifdef VIMAGE
265 static void
vnet_rts_uninit(void)266 vnet_rts_uninit(void)
267 {
268
269 netisr_unregister_vnet(&rtsock_nh);
270 }
271 VNET_SYSUNINIT(vnet_rts_uninit, SI_SUB_PROTO_DOMAIN, SI_ORDER_THIRD,
272 vnet_rts_uninit, 0);
273 #endif
274
275 static void
report_route_event(const struct rib_cmd_info * rc,void * _cbdata)276 report_route_event(const struct rib_cmd_info *rc, void *_cbdata)
277 {
278 uint32_t fibnum = (uint32_t)(uintptr_t)_cbdata;
279 struct nhop_object *nh;
280
281 nh = rc->rc_cmd == RTM_DELETE ? rc->rc_nh_old : rc->rc_nh_new;
282 rt_routemsg(rc->rc_cmd, rc->rc_rt, nh, fibnum);
283 }
284
285 static void
rts_handle_route_event(uint32_t fibnum,const struct rib_cmd_info * rc)286 rts_handle_route_event(uint32_t fibnum, const struct rib_cmd_info *rc)
287 {
288 #ifdef ROUTE_MPATH
289 if ((rc->rc_nh_new && NH_IS_NHGRP(rc->rc_nh_new)) ||
290 (rc->rc_nh_old && NH_IS_NHGRP(rc->rc_nh_old))) {
291 rib_decompose_notification(rc, report_route_event,
292 (void *)(uintptr_t)fibnum);
293 } else
294 #endif
295 report_route_event(rc, (void *)(uintptr_t)fibnum);
296 }
297 static struct rtbridge rtsbridge = {
298 .route_f = rts_handle_route_event,
299 .ifmsg_f = rtsock_ifmsg,
300 };
301 static struct rtbridge *rtsbridge_orig_p;
302
303 static void
rtsock_notify_event(uint32_t fibnum,const struct rib_cmd_info * rc)304 rtsock_notify_event(uint32_t fibnum, const struct rib_cmd_info *rc)
305 {
306 netlink_callback_p->route_f(fibnum, rc);
307 }
308
309 static void
rtsock_init(void)310 rtsock_init(void)
311 {
312 rtsbridge_orig_p = rtsock_callback_p;
313 rtsock_callback_p = &rtsbridge;
314 }
315 SYSINIT(rtsock_init, SI_SUB_PROTO_DOMAIN, SI_ORDER_THIRD, rtsock_init, NULL);
316
317 static void
rts_handle_ifnet_arrival(void * arg __unused,struct ifnet * ifp)318 rts_handle_ifnet_arrival(void *arg __unused, struct ifnet *ifp)
319 {
320 rt_ifannouncemsg(ifp, IFAN_ARRIVAL);
321 }
322 EVENTHANDLER_DEFINE(ifnet_arrival_event, rts_handle_ifnet_arrival, NULL, 0);
323
324 static void
rts_handle_ifnet_departure(void * arg __unused,struct ifnet * ifp)325 rts_handle_ifnet_departure(void *arg __unused, struct ifnet *ifp)
326 {
327 rt_ifannouncemsg(ifp, IFAN_DEPARTURE);
328 }
329 EVENTHANDLER_DEFINE(ifnet_departure_event, rts_handle_ifnet_departure, NULL, 0);
330
331 static void
rts_append_data(struct socket * so,struct mbuf * m)332 rts_append_data(struct socket *so, struct mbuf *m)
333 {
334
335 if (sbappendaddr(&so->so_rcv, &route_src, m, NULL) == 0) {
336 soroverflow(so);
337 m_freem(m);
338 } else
339 sorwakeup(so);
340 }
341
342 static void
rts_input(struct mbuf * m)343 rts_input(struct mbuf *m)
344 {
345 struct rcb *rcb;
346 struct socket *last;
347
348 last = NULL;
349 RTSOCK_LOCK();
350 LIST_FOREACH(rcb, &V_route_cb.cblist, list) {
351 if (rcb->rcb_family != AF_UNSPEC &&
352 rcb->rcb_family != m->m_rtsock_family)
353 continue;
354 if ((m->m_flags & RTS_FILTER_FIB) &&
355 M_GETFIB(m) != rcb->rcb_socket->so_fibnum)
356 continue;
357 if (last != NULL) {
358 struct mbuf *n;
359
360 n = m_copym(m, 0, M_COPYALL, M_NOWAIT);
361 if (n != NULL)
362 rts_append_data(last, n);
363 }
364 last = rcb->rcb_socket;
365 }
366 if (last != NULL)
367 rts_append_data(last, m);
368 else
369 m_freem(m);
370 RTSOCK_UNLOCK();
371 }
372
373 static void
rts_close(struct socket * so)374 rts_close(struct socket *so)
375 {
376
377 soisdisconnected(so);
378 }
379
380 static SYSCTL_NODE(_net, OID_AUTO, rtsock, CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
381 "Routing socket infrastructure");
382 static u_long rts_sendspace = 8192;
383 SYSCTL_ULONG(_net_rtsock, OID_AUTO, sendspace, CTLFLAG_RW, &rts_sendspace, 0,
384 "Default routing socket send space");
385 static u_long rts_recvspace = 8192;
386 SYSCTL_ULONG(_net_rtsock, OID_AUTO, recvspace, CTLFLAG_RW, &rts_recvspace, 0,
387 "Default routing socket receive space");
388
389 static int
rts_attach(struct socket * so,int proto,struct thread * td)390 rts_attach(struct socket *so, int proto, struct thread *td)
391 {
392 struct rcb *rcb;
393 int error;
394
395 error = soreserve(so, rts_sendspace, rts_recvspace);
396 if (error)
397 return (error);
398
399 rcb = malloc(sizeof(*rcb), M_PCB, M_WAITOK);
400 rcb->rcb_socket = so;
401 rcb->rcb_family = proto;
402
403 so->so_pcb = rcb;
404 so->so_fibnum = td->td_proc->p_fibnum;
405 so->so_options |= SO_USELOOPBACK;
406
407 RTSOCK_LOCK();
408 LIST_INSERT_HEAD(&V_route_cb.cblist, rcb, list);
409 switch (proto) {
410 case AF_INET:
411 V_route_cb.ip_count++;
412 break;
413 case AF_INET6:
414 V_route_cb.ip6_count++;
415 break;
416 }
417 V_route_cb.any_count++;
418 RTSOCK_UNLOCK();
419 soisconnected(so);
420
421 return (0);
422 }
423
424 static void
rts_detach(struct socket * so)425 rts_detach(struct socket *so)
426 {
427 struct rcb *rcb = so->so_pcb;
428
429 RTSOCK_LOCK();
430 LIST_REMOVE(rcb, list);
431 switch(rcb->rcb_family) {
432 case AF_INET:
433 V_route_cb.ip_count--;
434 break;
435 case AF_INET6:
436 V_route_cb.ip6_count--;
437 break;
438 }
439 V_route_cb.any_count--;
440 RTSOCK_UNLOCK();
441 free(rcb, M_PCB);
442 so->so_pcb = NULL;
443 }
444
445 static int
rts_disconnect(struct socket * so)446 rts_disconnect(struct socket *so)
447 {
448
449 return (ENOTCONN);
450 }
451
452 static int
rts_shutdown(struct socket * so,enum shutdown_how how)453 rts_shutdown(struct socket *so, enum shutdown_how how)
454 {
455 /*
456 * Note: route socket marks itself as connected through its lifetime.
457 */
458 switch (how) {
459 case SHUT_RD:
460 sorflush(so);
461 break;
462 case SHUT_RDWR:
463 sorflush(so);
464 /* FALLTHROUGH */
465 case SHUT_WR:
466 socantsendmore(so);
467 }
468
469 return (0);
470 }
471
472 #ifndef _SOCKADDR_UNION_DEFINED
473 #define _SOCKADDR_UNION_DEFINED
474 /*
475 * The union of all possible address formats we handle.
476 */
477 union sockaddr_union {
478 struct sockaddr sa;
479 struct sockaddr_in sin;
480 struct sockaddr_in6 sin6;
481 };
482 #endif /* _SOCKADDR_UNION_DEFINED */
483
484 static int
rtm_get_jailed(struct rt_addrinfo * info,struct ifnet * ifp,struct nhop_object * nh,union sockaddr_union * saun,struct ucred * cred)485 rtm_get_jailed(struct rt_addrinfo *info, struct ifnet *ifp,
486 struct nhop_object *nh, union sockaddr_union *saun, struct ucred *cred)
487 {
488 #if defined(INET) || defined(INET6)
489 struct epoch_tracker et;
490 #endif
491
492 /* First, see if the returned address is part of the jail. */
493 if (prison_if(cred, nh->nh_ifa->ifa_addr) == 0) {
494 info->rti_info[RTAX_IFA] = nh->nh_ifa->ifa_addr;
495 return (0);
496 }
497
498 switch (info->rti_info[RTAX_DST]->sa_family) {
499 #ifdef INET
500 case AF_INET:
501 {
502 struct in_addr ia;
503 struct ifaddr *ifa;
504 int found;
505
506 found = 0;
507 /*
508 * Try to find an address on the given outgoing interface
509 * that belongs to the jail.
510 */
511 NET_EPOCH_ENTER(et);
512 CK_STAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
513 struct sockaddr *sa;
514 sa = ifa->ifa_addr;
515 if (sa->sa_family != AF_INET)
516 continue;
517 ia = ((struct sockaddr_in *)sa)->sin_addr;
518 if (prison_check_ip4(cred, &ia) == 0) {
519 found = 1;
520 break;
521 }
522 }
523 NET_EPOCH_EXIT(et);
524 if (!found) {
525 /*
526 * As a last resort return the 'default' jail address.
527 */
528 ia = ((struct sockaddr_in *)nh->nh_ifa->ifa_addr)->
529 sin_addr;
530 if (prison_get_ip4(cred, &ia) != 0)
531 return (ESRCH);
532 }
533 bzero(&saun->sin, sizeof(struct sockaddr_in));
534 saun->sin.sin_len = sizeof(struct sockaddr_in);
535 saun->sin.sin_family = AF_INET;
536 saun->sin.sin_addr.s_addr = ia.s_addr;
537 info->rti_info[RTAX_IFA] = (struct sockaddr *)&saun->sin;
538 break;
539 }
540 #endif
541 #ifdef INET6
542 case AF_INET6:
543 {
544 struct in6_addr ia6;
545 struct ifaddr *ifa;
546 int found;
547
548 found = 0;
549 /*
550 * Try to find an address on the given outgoing interface
551 * that belongs to the jail.
552 */
553 NET_EPOCH_ENTER(et);
554 CK_STAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
555 struct sockaddr *sa;
556 sa = ifa->ifa_addr;
557 if (sa->sa_family != AF_INET6)
558 continue;
559 bcopy(&((struct sockaddr_in6 *)sa)->sin6_addr,
560 &ia6, sizeof(struct in6_addr));
561 if (prison_check_ip6(cred, &ia6) == 0) {
562 found = 1;
563 break;
564 }
565 }
566 NET_EPOCH_EXIT(et);
567 if (!found) {
568 /*
569 * As a last resort return the 'default' jail address.
570 */
571 ia6 = ((struct sockaddr_in6 *)nh->nh_ifa->ifa_addr)->
572 sin6_addr;
573 if (prison_get_ip6(cred, &ia6) != 0)
574 return (ESRCH);
575 }
576 bzero(&saun->sin6, sizeof(struct sockaddr_in6));
577 saun->sin6.sin6_len = sizeof(struct sockaddr_in6);
578 saun->sin6.sin6_family = AF_INET6;
579 bcopy(&ia6, &saun->sin6.sin6_addr, sizeof(struct in6_addr));
580 if (sa6_recoverscope(&saun->sin6) != 0)
581 return (ESRCH);
582 info->rti_info[RTAX_IFA] = (struct sockaddr *)&saun->sin6;
583 break;
584 }
585 #endif
586 default:
587 return (ESRCH);
588 }
589 return (0);
590 }
591
592 static int
fill_blackholeinfo(struct rt_addrinfo * info,union sockaddr_union * saun)593 fill_blackholeinfo(struct rt_addrinfo *info, union sockaddr_union *saun)
594 {
595 struct ifaddr *ifa;
596 sa_family_t saf;
597
598 if (V_loif == NULL) {
599 RTS_PID_LOG(LOG_INFO, "Unable to add blackhole/reject nhop without loopback");
600 return (ENOTSUP);
601 }
602 info->rti_ifp = V_loif;
603
604 saf = info->rti_info[RTAX_DST]->sa_family;
605
606 CK_STAILQ_FOREACH(ifa, &info->rti_ifp->if_addrhead, ifa_link) {
607 if (ifa->ifa_addr->sa_family == saf) {
608 info->rti_ifa = ifa;
609 break;
610 }
611 }
612 if (info->rti_ifa == NULL) {
613 RTS_PID_LOG(LOG_INFO, "Unable to find ifa for blackhole/reject nhop");
614 return (ENOTSUP);
615 }
616
617 bzero(saun, sizeof(union sockaddr_union));
618 switch (saf) {
619 #ifdef INET
620 case AF_INET:
621 saun->sin.sin_family = AF_INET;
622 saun->sin.sin_len = sizeof(struct sockaddr_in);
623 saun->sin.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
624 break;
625 #endif
626 #ifdef INET6
627 case AF_INET6:
628 saun->sin6.sin6_family = AF_INET6;
629 saun->sin6.sin6_len = sizeof(struct sockaddr_in6);
630 saun->sin6.sin6_addr = in6addr_loopback;
631 break;
632 #endif
633 default:
634 RTS_PID_LOG(LOG_INFO, "unsupported family: %d", saf);
635 return (ENOTSUP);
636 }
637 info->rti_info[RTAX_GATEWAY] = &saun->sa;
638 info->rti_flags |= RTF_GATEWAY;
639
640 return (0);
641 }
642
643 /*
644 * Fills in @info based on userland-provided @rtm message.
645 *
646 * Returns 0 on success.
647 */
648 static int
fill_addrinfo(struct rt_msghdr * rtm,int len,struct linear_buffer * lb,u_int fibnum,struct rt_addrinfo * info)649 fill_addrinfo(struct rt_msghdr *rtm, int len, struct linear_buffer *lb, u_int fibnum,
650 struct rt_addrinfo *info)
651 {
652 int error;
653
654 rtm->rtm_pid = curproc->p_pid;
655 info->rti_addrs = rtm->rtm_addrs;
656
657 info->rti_mflags = rtm->rtm_inits;
658 info->rti_rmx = &rtm->rtm_rmx;
659
660 /*
661 * rt_xaddrs() performs s6_addr[2] := sin6_scope_id for AF_INET6
662 * link-local address because rtrequest requires addresses with
663 * embedded scope id.
664 */
665 if (rt_xaddrs((caddr_t)(rtm + 1), len + (caddr_t)rtm, info))
666 return (EINVAL);
667
668 info->rti_flags = rtm->rtm_flags;
669 error = cleanup_xaddrs(info, lb);
670 if (error != 0)
671 return (error);
672 /*
673 * Verify that the caller has the appropriate privilege; RTM_GET
674 * is the only operation the non-superuser is allowed.
675 */
676 if (rtm->rtm_type != RTM_GET) {
677 error = priv_check(curthread, PRIV_NET_ROUTE);
678 if (error != 0)
679 return (error);
680 }
681
682 /*
683 * The given gateway address may be an interface address.
684 * For example, issuing a "route change" command on a route
685 * entry that was created from a tunnel, and the gateway
686 * address given is the local end point. In this case the
687 * RTF_GATEWAY flag must be cleared or the destination will
688 * not be reachable even though there is no error message.
689 */
690 if (info->rti_info[RTAX_GATEWAY] != NULL &&
691 info->rti_info[RTAX_GATEWAY]->sa_family != AF_LINK) {
692 struct nhop_object *nh;
693
694 /*
695 * A host route through the loopback interface is
696 * installed for each interface address. In pre 8.0
697 * releases the interface address of a PPP link type
698 * is not reachable locally. This behavior is fixed as
699 * part of the new L2/L3 redesign and rewrite work. The
700 * signature of this interface address route is the
701 * AF_LINK sa_family type of the gateway, and the
702 * rt_ifp has the IFF_LOOPBACK flag set.
703 */
704 nh = rib_lookup(fibnum, info->rti_info[RTAX_GATEWAY], NHR_NONE, 0);
705 if (nh != NULL && nh->gw_sa.sa_family == AF_LINK &&
706 nh->nh_ifp->if_flags & IFF_LOOPBACK) {
707 info->rti_flags &= ~RTF_GATEWAY;
708 info->rti_flags |= RTF_GWFLAG_COMPAT;
709 }
710 }
711
712 return (0);
713 }
714
715 static struct nhop_object *
select_nhop(struct nhop_object * nh,const struct sockaddr * gw)716 select_nhop(struct nhop_object *nh, const struct sockaddr *gw)
717 {
718 if (!NH_IS_NHGRP(nh))
719 return (nh);
720 #ifdef ROUTE_MPATH
721 const struct weightened_nhop *wn;
722 uint32_t num_nhops;
723 wn = nhgrp_get_nhops((struct nhgrp_object *)nh, &num_nhops);
724 if (gw == NULL)
725 return (wn[0].nh);
726 for (int i = 0; i < num_nhops; i++) {
727 if (match_nhop_gw(wn[i].nh, gw))
728 return (wn[i].nh);
729 }
730 #endif
731 return (NULL);
732 }
733
734 /*
735 * Handles RTM_GET message from routing socket, returning matching rt.
736 *
737 * Returns:
738 * 0 on success, with locked and referenced matching rt in @rt_nrt
739 * errno of failure
740 */
741 static int
handle_rtm_get(struct rt_addrinfo * info,u_int fibnum,struct rt_msghdr * rtm,struct rib_cmd_info * rc)742 handle_rtm_get(struct rt_addrinfo *info, u_int fibnum,
743 struct rt_msghdr *rtm, struct rib_cmd_info *rc)
744 {
745 RIB_RLOCK_TRACKER;
746 struct rib_head *rnh;
747 struct nhop_object *nh;
748 sa_family_t saf;
749
750 saf = info->rti_info[RTAX_DST]->sa_family;
751
752 rnh = rt_tables_get_rnh(fibnum, saf);
753 if (rnh == NULL)
754 return (EAFNOSUPPORT);
755
756 RIB_RLOCK(rnh);
757
758 /*
759 * By (implicit) convention host route (one without netmask)
760 * means longest-prefix-match request and the route with netmask
761 * means exact-match lookup.
762 * As cleanup_xaddrs() cleans up info flags&addrs for the /32,/128
763 * prefixes, use original data to check for the netmask presence.
764 */
765 if ((rtm->rtm_addrs & RTA_NETMASK) == 0) {
766 /*
767 * Provide longest prefix match for
768 * address lookup (no mask).
769 * 'route -n get addr'
770 */
771 rc->rc_rt = (struct rtentry *) rnh->rnh_matchaddr(
772 info->rti_info[RTAX_DST], &rnh->head);
773 } else
774 rc->rc_rt = (struct rtentry *) rnh->rnh_lookup(
775 info->rti_info[RTAX_DST],
776 info->rti_info[RTAX_NETMASK], &rnh->head);
777
778 if (rc->rc_rt == NULL) {
779 RIB_RUNLOCK(rnh);
780 return (ESRCH);
781 }
782
783 nh = select_nhop(rt_get_raw_nhop(rc->rc_rt), info->rti_info[RTAX_GATEWAY]);
784 if (nh == NULL) {
785 RIB_RUNLOCK(rnh);
786 return (ESRCH);
787 }
788 /*
789 * If performing proxied L2 entry insertion, and
790 * the actual PPP host entry is found, perform
791 * another search to retrieve the prefix route of
792 * the local end point of the PPP link.
793 * TODO: move this logic to userland.
794 */
795 if (rtm->rtm_flags & RTF_ANNOUNCE) {
796 struct sockaddr_storage laddr;
797
798 if (nh->nh_ifp != NULL &&
799 nh->nh_ifp->if_type == IFT_PROPVIRTUAL) {
800 struct ifaddr *ifa;
801
802 ifa = ifa_ifwithnet(info->rti_info[RTAX_DST], 1,
803 RT_ALL_FIBS);
804 if (ifa != NULL)
805 rt_maskedcopy(ifa->ifa_addr,
806 (struct sockaddr *)&laddr,
807 ifa->ifa_netmask);
808 } else
809 rt_maskedcopy(nh->nh_ifa->ifa_addr,
810 (struct sockaddr *)&laddr,
811 nh->nh_ifa->ifa_netmask);
812 /*
813 * refactor rt and no lock operation necessary
814 */
815 rc->rc_rt = (struct rtentry *)rnh->rnh_matchaddr(
816 (struct sockaddr *)&laddr, &rnh->head);
817 if (rc->rc_rt == NULL) {
818 RIB_RUNLOCK(rnh);
819 return (ESRCH);
820 }
821 nh = select_nhop(rt_get_raw_nhop(rc->rc_rt), info->rti_info[RTAX_GATEWAY]);
822 if (nh == NULL) {
823 RIB_RUNLOCK(rnh);
824 return (ESRCH);
825 }
826 }
827 rc->rc_nh_new = nh;
828 rc->rc_nh_weight = rc->rc_rt->rt_weight;
829 RIB_RUNLOCK(rnh);
830
831 return (0);
832 }
833
834 static void
init_sockaddrs_family(int family,struct sockaddr * dst,struct sockaddr * mask)835 init_sockaddrs_family(int family, struct sockaddr *dst, struct sockaddr *mask)
836 {
837 #ifdef INET
838 if (family == AF_INET) {
839 struct sockaddr_in *dst4 = (struct sockaddr_in *)dst;
840 struct sockaddr_in *mask4 = (struct sockaddr_in *)mask;
841
842 bzero(dst4, sizeof(struct sockaddr_in));
843 bzero(mask4, sizeof(struct sockaddr_in));
844
845 dst4->sin_family = AF_INET;
846 dst4->sin_len = sizeof(struct sockaddr_in);
847 mask4->sin_family = AF_INET;
848 mask4->sin_len = sizeof(struct sockaddr_in);
849 }
850 #endif
851 #ifdef INET6
852 if (family == AF_INET6) {
853 struct sockaddr_in6 *dst6 = (struct sockaddr_in6 *)dst;
854 struct sockaddr_in6 *mask6 = (struct sockaddr_in6 *)mask;
855
856 bzero(dst6, sizeof(struct sockaddr_in6));
857 bzero(mask6, sizeof(struct sockaddr_in6));
858
859 dst6->sin6_family = AF_INET6;
860 dst6->sin6_len = sizeof(struct sockaddr_in6);
861 mask6->sin6_family = AF_INET6;
862 mask6->sin6_len = sizeof(struct sockaddr_in6);
863 }
864 #endif
865 }
866
867 static void
export_rtaddrs(const struct rtentry * rt,struct sockaddr * dst,struct sockaddr * mask)868 export_rtaddrs(const struct rtentry *rt, struct sockaddr *dst,
869 struct sockaddr *mask)
870 {
871 #ifdef INET
872 if (dst->sa_family == AF_INET) {
873 struct sockaddr_in *dst4 = (struct sockaddr_in *)dst;
874 struct sockaddr_in *mask4 = (struct sockaddr_in *)mask;
875 uint32_t scopeid = 0;
876 rt_get_inet_prefix_pmask(rt, &dst4->sin_addr, &mask4->sin_addr,
877 &scopeid);
878 return;
879 }
880 #endif
881 #ifdef INET6
882 if (dst->sa_family == AF_INET6) {
883 struct sockaddr_in6 *dst6 = (struct sockaddr_in6 *)dst;
884 struct sockaddr_in6 *mask6 = (struct sockaddr_in6 *)mask;
885 uint32_t scopeid = 0;
886 rt_get_inet6_prefix_pmask(rt, &dst6->sin6_addr,
887 &mask6->sin6_addr, &scopeid);
888 dst6->sin6_scope_id = scopeid;
889 return;
890 }
891 #endif
892 }
893
894 static int
update_rtm_from_info(struct rt_addrinfo * info,struct rt_msghdr ** prtm,int alloc_len)895 update_rtm_from_info(struct rt_addrinfo *info, struct rt_msghdr **prtm,
896 int alloc_len)
897 {
898 struct rt_msghdr *rtm, *orig_rtm = NULL;
899 struct walkarg w;
900 int len;
901
902 rtm = *prtm;
903 /* Check if we need to realloc storage */
904 rtsock_msg_buffer(rtm->rtm_type, info, NULL, &len);
905 if (len > alloc_len) {
906 struct rt_msghdr *tmp_rtm;
907
908 tmp_rtm = malloc(len, M_TEMP, M_NOWAIT);
909 if (tmp_rtm == NULL)
910 return (ENOBUFS);
911 bcopy(rtm, tmp_rtm, rtm->rtm_msglen);
912 orig_rtm = rtm;
913 rtm = tmp_rtm;
914 alloc_len = len;
915
916 /*
917 * Delay freeing original rtm as info contains
918 * data referencing it.
919 */
920 }
921
922 w.w_tmem = (caddr_t)rtm;
923 w.w_tmemsize = alloc_len;
924 rtsock_msg_buffer(rtm->rtm_type, info, &w, &len);
925 rtm->rtm_addrs = info->rti_addrs;
926
927 if (orig_rtm != NULL)
928 free(orig_rtm, M_TEMP);
929 *prtm = rtm;
930 return (0);
931 }
932
933
934 /*
935 * Update sockaddrs, flags, etc in @prtm based on @rc data.
936 * rtm can be reallocated.
937 *
938 * Returns 0 on success, along with pointer to (potentially reallocated)
939 * rtm.
940 *
941 */
942 static int
update_rtm_from_rc(struct rt_addrinfo * info,struct rt_msghdr ** prtm,int alloc_len,struct rib_cmd_info * rc,struct nhop_object * nh)943 update_rtm_from_rc(struct rt_addrinfo *info, struct rt_msghdr **prtm,
944 int alloc_len, struct rib_cmd_info *rc, struct nhop_object *nh)
945 {
946 union sockaddr_union saun;
947 struct rt_msghdr *rtm;
948 struct ifnet *ifp;
949 int error;
950
951 rtm = *prtm;
952 union sockaddr_union sa_dst, sa_mask;
953 int family = info->rti_info[RTAX_DST]->sa_family;
954 init_sockaddrs_family(family, &sa_dst.sa, &sa_mask.sa);
955 export_rtaddrs(rc->rc_rt, &sa_dst.sa, &sa_mask.sa);
956
957 info->rti_info[RTAX_DST] = &sa_dst.sa;
958 info->rti_info[RTAX_NETMASK] = rt_is_host(rc->rc_rt) ? NULL : &sa_mask.sa;
959 info->rti_info[RTAX_GATEWAY] = &nh->gw_sa;
960 info->rti_info[RTAX_GENMASK] = 0;
961 ifp = nh->nh_ifp;
962 if (rtm->rtm_addrs & (RTA_IFP | RTA_IFA)) {
963 if (ifp) {
964 info->rti_info[RTAX_IFP] =
965 ifp->if_addr->ifa_addr;
966 error = rtm_get_jailed(info, ifp, nh,
967 &saun, curthread->td_ucred);
968 if (error != 0)
969 return (error);
970 if (ifp->if_flags & IFF_POINTOPOINT)
971 info->rti_info[RTAX_BRD] =
972 nh->nh_ifa->ifa_dstaddr;
973 rtm->rtm_index = ifp->if_index;
974 } else {
975 info->rti_info[RTAX_IFP] = NULL;
976 info->rti_info[RTAX_IFA] = NULL;
977 }
978 } else if (ifp != NULL)
979 rtm->rtm_index = ifp->if_index;
980
981 if ((error = update_rtm_from_info(info, prtm, alloc_len)) != 0)
982 return (error);
983
984 rtm = *prtm;
985 rtm->rtm_flags = rc->rc_rt->rte_flags | nhop_get_rtflags(nh);
986 if (rtm->rtm_flags & RTF_GWFLAG_COMPAT)
987 rtm->rtm_flags = RTF_GATEWAY |
988 (rtm->rtm_flags & ~RTF_GWFLAG_COMPAT);
989 rt_getmetrics(rc->rc_rt, nh, &rtm->rtm_rmx);
990 rtm->rtm_rmx.rmx_weight = rc->rc_nh_weight;
991
992 return (0);
993 }
994
995 #ifdef ROUTE_MPATH
996 static void
save_del_notification(const struct rib_cmd_info * rc,void * _cbdata)997 save_del_notification(const struct rib_cmd_info *rc, void *_cbdata)
998 {
999 struct rib_cmd_info *rc_new = (struct rib_cmd_info *)_cbdata;
1000
1001 if (rc->rc_cmd == RTM_DELETE)
1002 *rc_new = *rc;
1003 }
1004
1005 static void
save_add_notification(const struct rib_cmd_info * rc,void * _cbdata)1006 save_add_notification(const struct rib_cmd_info *rc, void *_cbdata)
1007 {
1008 struct rib_cmd_info *rc_new = (struct rib_cmd_info *)_cbdata;
1009
1010 if (rc->rc_cmd == RTM_ADD)
1011 *rc_new = *rc;
1012 }
1013 #endif
1014
1015 #if defined(INET6) || defined(INET)
1016 static struct sockaddr *
alloc_sockaddr_aligned(struct linear_buffer * lb,int len)1017 alloc_sockaddr_aligned(struct linear_buffer *lb, int len)
1018 {
1019 len = roundup2(len, sizeof(uint64_t));
1020 if (lb->offset + len > lb->size)
1021 return (NULL);
1022 struct sockaddr *sa = (struct sockaddr *)(lb->base + lb->offset);
1023 lb->offset += len;
1024 return (sa);
1025 }
1026 #endif
1027
1028 static int
rts_send(struct socket * so,int flags,struct mbuf * m,struct sockaddr * nam,struct mbuf * control,struct thread * td)1029 rts_send(struct socket *so, int flags, struct mbuf *m,
1030 struct sockaddr *nam, struct mbuf *control, struct thread *td)
1031 {
1032 struct rt_msghdr *rtm = NULL;
1033 struct rt_addrinfo info;
1034 struct epoch_tracker et;
1035 #ifdef INET6
1036 struct sockaddr_storage ss;
1037 struct sockaddr_in6 *sin6;
1038 int i, rti_need_deembed = 0;
1039 #endif
1040 int alloc_len = 0, len, error = 0, fibnum;
1041 sa_family_t saf = AF_UNSPEC;
1042 struct rib_cmd_info rc;
1043 struct nhop_object *nh;
1044
1045 if ((flags & PRUS_OOB) || control != NULL) {
1046 m_freem(m);
1047 if (control != NULL)
1048 m_freem(control);
1049 return (EOPNOTSUPP);
1050 }
1051
1052 fibnum = so->so_fibnum;
1053 #define senderr(e) { error = e; goto flush;}
1054 if (m == NULL || ((m->m_len < sizeof(long)) &&
1055 (m = m_pullup(m, sizeof(long))) == NULL))
1056 return (ENOBUFS);
1057 if ((m->m_flags & M_PKTHDR) == 0)
1058 panic("route_output");
1059 NET_EPOCH_ENTER(et);
1060 len = m->m_pkthdr.len;
1061 if (len < sizeof(*rtm) ||
1062 len != mtod(m, struct rt_msghdr *)->rtm_msglen)
1063 senderr(EINVAL);
1064
1065 /*
1066 * Most of current messages are in range 200-240 bytes,
1067 * minimize possible re-allocation on reply using larger size
1068 * buffer aligned on 1k boundaty.
1069 */
1070 alloc_len = roundup2(len, 1024);
1071 int total_len = alloc_len + SCRATCH_BUFFER_SIZE;
1072 if ((rtm = malloc(total_len, M_TEMP, M_NOWAIT)) == NULL)
1073 senderr(ENOBUFS);
1074
1075 m_copydata(m, 0, len, (caddr_t)rtm);
1076 bzero(&info, sizeof(info));
1077 nh = NULL;
1078 struct linear_buffer lb = {
1079 .base = (char *)rtm + alloc_len,
1080 .size = SCRATCH_BUFFER_SIZE,
1081 };
1082
1083 if (rtm->rtm_version != RTM_VERSION) {
1084 /* Do not touch message since format is unknown */
1085 free(rtm, M_TEMP);
1086 rtm = NULL;
1087 senderr(EPROTONOSUPPORT);
1088 }
1089
1090 /*
1091 * Starting from here, it is possible
1092 * to alter original message and insert
1093 * caller PID and error value.
1094 */
1095
1096 if ((error = fill_addrinfo(rtm, len, &lb, fibnum, &info)) != 0) {
1097 senderr(error);
1098 }
1099 /* fill_addringo() embeds scope into IPv6 addresses */
1100 #ifdef INET6
1101 rti_need_deembed = 1;
1102 #endif
1103
1104 saf = info.rti_info[RTAX_DST]->sa_family;
1105
1106 /* support for new ARP code */
1107 if (rtm->rtm_flags & RTF_LLDATA) {
1108 error = lla_rt_output(rtm, &info);
1109 goto flush;
1110 }
1111
1112 union sockaddr_union gw_saun;
1113 int blackhole_flags = rtm->rtm_flags & (RTF_BLACKHOLE|RTF_REJECT);
1114 if (blackhole_flags != 0) {
1115 if (blackhole_flags != (RTF_BLACKHOLE | RTF_REJECT))
1116 error = fill_blackholeinfo(&info, &gw_saun);
1117 else {
1118 RTS_PID_LOG(LOG_DEBUG, "both BLACKHOLE and REJECT flags specifiied");
1119 error = EINVAL;
1120 }
1121 if (error != 0)
1122 senderr(error);
1123 }
1124
1125 switch (rtm->rtm_type) {
1126 case RTM_ADD:
1127 case RTM_CHANGE:
1128 if (rtm->rtm_type == RTM_ADD) {
1129 if (info.rti_info[RTAX_GATEWAY] == NULL) {
1130 RTS_PID_LOG(LOG_DEBUG, "RTM_ADD w/o gateway");
1131 senderr(EINVAL);
1132 }
1133 }
1134 error = rib_action(fibnum, rtm->rtm_type, &info, &rc);
1135 if (error == 0) {
1136 rtsock_notify_event(fibnum, &rc);
1137 #ifdef ROUTE_MPATH
1138 if (NH_IS_NHGRP(rc.rc_nh_new) ||
1139 (rc.rc_nh_old && NH_IS_NHGRP(rc.rc_nh_old))) {
1140 struct rib_cmd_info rc_simple = {};
1141 rib_decompose_notification(&rc,
1142 save_add_notification, (void *)&rc_simple);
1143 rc = rc_simple;
1144 }
1145 #endif
1146 /* nh MAY be empty if RTM_CHANGE request is no-op */
1147 nh = rc.rc_nh_new;
1148 if (nh != NULL) {
1149 rtm->rtm_index = nh->nh_ifp->if_index;
1150 rtm->rtm_flags = rc.rc_rt->rte_flags | nhop_get_rtflags(nh);
1151 }
1152 }
1153 break;
1154
1155 case RTM_DELETE:
1156 error = rib_action(fibnum, RTM_DELETE, &info, &rc);
1157 if (error == 0) {
1158 rtsock_notify_event(fibnum, &rc);
1159 #ifdef ROUTE_MPATH
1160 if (NH_IS_NHGRP(rc.rc_nh_old) ||
1161 (rc.rc_nh_new && NH_IS_NHGRP(rc.rc_nh_new))) {
1162 struct rib_cmd_info rc_simple = {};
1163 rib_decompose_notification(&rc,
1164 save_del_notification, (void *)&rc_simple);
1165 rc = rc_simple;
1166 }
1167 #endif
1168 nh = rc.rc_nh_old;
1169 }
1170 break;
1171
1172 case RTM_GET:
1173 error = handle_rtm_get(&info, fibnum, rtm, &rc);
1174 if (error != 0)
1175 senderr(error);
1176 nh = rc.rc_nh_new;
1177
1178 if (!rt_is_exportable(rc.rc_rt, curthread->td_ucred))
1179 senderr(ESRCH);
1180 break;
1181
1182 default:
1183 senderr(EOPNOTSUPP);
1184 }
1185
1186 if (error == 0 && nh != NULL) {
1187 error = update_rtm_from_rc(&info, &rtm, alloc_len, &rc, nh);
1188 /*
1189 * Note that some sockaddr pointers may have changed to
1190 * point to memory outsize @rtm. Some may be pointing
1191 * to the on-stack variables.
1192 * Given that, any pointer in @info CANNOT BE USED.
1193 */
1194
1195 /*
1196 * scopeid deembedding has been performed while
1197 * writing updated rtm in rtsock_msg_buffer().
1198 * With that in mind, skip deembedding procedure below.
1199 */
1200 #ifdef INET6
1201 rti_need_deembed = 0;
1202 #endif
1203 }
1204
1205 flush:
1206 NET_EPOCH_EXIT(et);
1207
1208 #ifdef INET6
1209 if (rtm != NULL) {
1210 if (rti_need_deembed) {
1211 /* sin6_scope_id is recovered before sending rtm. */
1212 sin6 = (struct sockaddr_in6 *)&ss;
1213 for (i = 0; i < RTAX_MAX; i++) {
1214 if (info.rti_info[i] == NULL)
1215 continue;
1216 if (info.rti_info[i]->sa_family != AF_INET6)
1217 continue;
1218 bcopy(info.rti_info[i], sin6, sizeof(*sin6));
1219 if (sa6_recoverscope(sin6) == 0)
1220 bcopy(sin6, info.rti_info[i],
1221 sizeof(*sin6));
1222 }
1223 if (update_rtm_from_info(&info, &rtm, alloc_len) != 0) {
1224 if (error != 0)
1225 error = ENOBUFS;
1226 }
1227 }
1228 }
1229 #endif
1230 send_rtm_reply(so, rtm, m, saf, fibnum, error);
1231
1232 return (error);
1233 }
1234
1235 /*
1236 * Sends the prepared reply message in @rtm to all rtsock clients.
1237 * Frees @m and @rtm.
1238 *
1239 */
1240 static void
send_rtm_reply(struct socket * so,struct rt_msghdr * rtm,struct mbuf * m,sa_family_t saf,u_int fibnum,int rtm_errno)1241 send_rtm_reply(struct socket *so, struct rt_msghdr *rtm, struct mbuf *m,
1242 sa_family_t saf, u_int fibnum, int rtm_errno)
1243 {
1244 struct rcb *rcb = NULL;
1245
1246 /*
1247 * Check to see if we don't want our own messages.
1248 */
1249 if ((so->so_options & SO_USELOOPBACK) == 0) {
1250 if (V_route_cb.any_count <= 1) {
1251 if (rtm != NULL)
1252 free(rtm, M_TEMP);
1253 m_freem(m);
1254 return;
1255 }
1256 /* There is another listener, so construct message */
1257 rcb = so->so_pcb;
1258 }
1259
1260 if (rtm != NULL) {
1261 if (rtm_errno!= 0)
1262 rtm->rtm_errno = rtm_errno;
1263 else
1264 rtm->rtm_flags |= RTF_DONE;
1265
1266 m_copyback(m, 0, rtm->rtm_msglen, (caddr_t)rtm);
1267 if (m->m_pkthdr.len < rtm->rtm_msglen) {
1268 m_freem(m);
1269 m = NULL;
1270 } else if (m->m_pkthdr.len > rtm->rtm_msglen)
1271 m_adj(m, rtm->rtm_msglen - m->m_pkthdr.len);
1272
1273 free(rtm, M_TEMP);
1274 }
1275 if (m != NULL) {
1276 M_SETFIB(m, fibnum);
1277 m->m_flags |= RTS_FILTER_FIB;
1278 if (rcb) {
1279 /*
1280 * XXX insure we don't get a copy by
1281 * invalidating our protocol
1282 */
1283 sa_family_t family = rcb->rcb_family;
1284 rcb->rcb_family = AF_UNSPEC;
1285 rt_dispatch(m, saf);
1286 rcb->rcb_family = family;
1287 } else
1288 rt_dispatch(m, saf);
1289 }
1290 }
1291
1292 static void
rt_getmetrics(const struct rtentry * rt,const struct nhop_object * nh,struct rt_metrics * out)1293 rt_getmetrics(const struct rtentry *rt, const struct nhop_object *nh,
1294 struct rt_metrics *out)
1295 {
1296
1297 bzero(out, sizeof(*out));
1298 out->rmx_mtu = nh->nh_mtu;
1299 out->rmx_weight = rt->rt_weight;
1300 out->rmx_nhidx = nhop_get_idx(nh);
1301 /* Kernel -> userland timebase conversion. */
1302 out->rmx_expire = nhop_get_expire(nh) ?
1303 nhop_get_expire(nh) - time_uptime + time_second : 0;
1304 }
1305
1306 /*
1307 * Extract the addresses of the passed sockaddrs.
1308 * Do a little sanity checking so as to avoid bad memory references.
1309 * This data is derived straight from userland.
1310 */
1311 static int
rt_xaddrs(caddr_t cp,caddr_t cplim,struct rt_addrinfo * rtinfo)1312 rt_xaddrs(caddr_t cp, caddr_t cplim, struct rt_addrinfo *rtinfo)
1313 {
1314 struct sockaddr *sa;
1315 int i;
1316
1317 for (i = 0; i < RTAX_MAX && cp < cplim; i++) {
1318 if ((rtinfo->rti_addrs & (1 << i)) == 0)
1319 continue;
1320 sa = (struct sockaddr *)cp;
1321 /*
1322 * It won't fit.
1323 */
1324 if (cp + sa->sa_len > cplim) {
1325 RTS_PID_LOG(LOG_DEBUG, "sa_len too big for sa type %d", i);
1326 return (EINVAL);
1327 }
1328 /*
1329 * there are no more.. quit now
1330 * If there are more bits, they are in error.
1331 * I've seen this. route(1) can evidently generate these.
1332 * This causes kernel to core dump.
1333 * for compatibility, If we see this, point to a safe address.
1334 */
1335 if (sa->sa_len == 0) {
1336 rtinfo->rti_info[i] = &sa_zero;
1337 return (0); /* should be EINVAL but for compat */
1338 }
1339 /* accept it */
1340 #ifdef INET6
1341 if (sa->sa_family == AF_INET6)
1342 sa6_embedscope((struct sockaddr_in6 *)sa,
1343 V_ip6_use_defzone);
1344 #endif
1345 rtinfo->rti_info[i] = sa;
1346 cp += SA_SIZE(sa);
1347 }
1348 return (0);
1349 }
1350
1351 #ifdef INET
1352 static inline void
fill_sockaddr_inet(struct sockaddr_in * sin,struct in_addr addr)1353 fill_sockaddr_inet(struct sockaddr_in *sin, struct in_addr addr)
1354 {
1355
1356 const struct sockaddr_in nsin = {
1357 .sin_family = AF_INET,
1358 .sin_len = sizeof(struct sockaddr_in),
1359 .sin_addr = addr,
1360 };
1361 *sin = nsin;
1362 }
1363 #endif
1364
1365 #ifdef INET6
1366 static inline void
fill_sockaddr_inet6(struct sockaddr_in6 * sin6,const struct in6_addr * addr6,uint32_t scopeid)1367 fill_sockaddr_inet6(struct sockaddr_in6 *sin6, const struct in6_addr *addr6,
1368 uint32_t scopeid)
1369 {
1370
1371 const struct sockaddr_in6 nsin6 = {
1372 .sin6_family = AF_INET6,
1373 .sin6_len = sizeof(struct sockaddr_in6),
1374 .sin6_addr = *addr6,
1375 .sin6_scope_id = scopeid,
1376 };
1377 *sin6 = nsin6;
1378 }
1379 #endif
1380
1381 #if defined(INET6) || defined(INET)
1382 /*
1383 * Checks if gateway is suitable for lltable operations.
1384 * Lltable code requires AF_LINK gateway with ifindex
1385 * and mac address specified.
1386 * Returns 0 on success.
1387 */
1388 static int
cleanup_xaddrs_lladdr(struct rt_addrinfo * info)1389 cleanup_xaddrs_lladdr(struct rt_addrinfo *info)
1390 {
1391 struct sockaddr_dl *sdl = (struct sockaddr_dl *)info->rti_info[RTAX_GATEWAY];
1392
1393 if (sdl->sdl_family != AF_LINK)
1394 return (EINVAL);
1395
1396 if (sdl->sdl_index == 0) {
1397 RTS_PID_LOG(LOG_DEBUG, "AF_LINK gateway w/o ifindex");
1398 return (EINVAL);
1399 }
1400
1401 if (offsetof(struct sockaddr_dl, sdl_data) + sdl->sdl_nlen + sdl->sdl_alen > sdl->sdl_len) {
1402 RTS_PID_LOG(LOG_DEBUG, "AF_LINK gw: sdl_nlen/sdl_alen too large");
1403 return (EINVAL);
1404 }
1405
1406 return (0);
1407 }
1408
1409 static int
cleanup_xaddrs_gateway(struct rt_addrinfo * info,struct linear_buffer * lb)1410 cleanup_xaddrs_gateway(struct rt_addrinfo *info, struct linear_buffer *lb)
1411 {
1412 struct sockaddr *gw = info->rti_info[RTAX_GATEWAY];
1413 struct sockaddr *sa;
1414
1415 if (info->rti_flags & RTF_LLDATA)
1416 return (cleanup_xaddrs_lladdr(info));
1417
1418 switch (gw->sa_family) {
1419 #ifdef INET
1420 case AF_INET:
1421 {
1422 struct sockaddr_in *gw_sin = (struct sockaddr_in *)gw;
1423
1424 /* Ensure reads do not go beyoud SA boundary */
1425 if (SA_SIZE(gw) < offsetof(struct sockaddr_in, sin_zero)) {
1426 RTS_PID_LOG(LOG_DEBUG, "gateway sin_len too small: %d",
1427 gw->sa_len);
1428 return (EINVAL);
1429 }
1430 sa = alloc_sockaddr_aligned(lb, sizeof(struct sockaddr_in));
1431 if (sa == NULL)
1432 return (ENOBUFS);
1433 fill_sockaddr_inet((struct sockaddr_in *)sa, gw_sin->sin_addr);
1434 info->rti_info[RTAX_GATEWAY] = sa;
1435 }
1436 break;
1437 #endif
1438 #ifdef INET6
1439 case AF_INET6:
1440 {
1441 struct sockaddr_in6 *gw_sin6 = (struct sockaddr_in6 *)gw;
1442 if (gw_sin6->sin6_len < sizeof(struct sockaddr_in6)) {
1443 RTS_PID_LOG(LOG_DEBUG, "gateway sin6_len too small: %d",
1444 gw->sa_len);
1445 return (EINVAL);
1446 }
1447 fill_sockaddr_inet6(gw_sin6, &gw_sin6->sin6_addr, 0);
1448 break;
1449 }
1450 #endif
1451 case AF_LINK:
1452 {
1453 struct sockaddr_dl *gw_sdl;
1454
1455 size_t sdl_min_len = offsetof(struct sockaddr_dl, sdl_data);
1456 gw_sdl = (struct sockaddr_dl *)gw;
1457 if (gw_sdl->sdl_len < sdl_min_len) {
1458 RTS_PID_LOG(LOG_DEBUG, "gateway sdl_len too small: %d",
1459 gw_sdl->sdl_len);
1460 return (EINVAL);
1461 }
1462 sa = alloc_sockaddr_aligned(lb, sizeof(struct sockaddr_dl_short));
1463 if (sa == NULL)
1464 return (ENOBUFS);
1465
1466 const struct sockaddr_dl_short sdl = {
1467 .sdl_family = AF_LINK,
1468 .sdl_len = sizeof(struct sockaddr_dl_short),
1469 .sdl_index = gw_sdl->sdl_index,
1470 };
1471 *((struct sockaddr_dl_short *)sa) = sdl;
1472 info->rti_info[RTAX_GATEWAY] = sa;
1473 break;
1474 }
1475 }
1476
1477 return (0);
1478 }
1479 #endif
1480
1481 static void
remove_netmask(struct rt_addrinfo * info)1482 remove_netmask(struct rt_addrinfo *info)
1483 {
1484 info->rti_info[RTAX_NETMASK] = NULL;
1485 info->rti_flags |= RTF_HOST;
1486 info->rti_addrs &= ~RTA_NETMASK;
1487 }
1488
1489 #ifdef INET
1490 static int
cleanup_xaddrs_inet(struct rt_addrinfo * info,struct linear_buffer * lb)1491 cleanup_xaddrs_inet(struct rt_addrinfo *info, struct linear_buffer *lb)
1492 {
1493 struct sockaddr_in *dst_sa, *mask_sa;
1494 const int sa_len = sizeof(struct sockaddr_in);
1495 struct in_addr dst, mask;
1496
1497 /* Check & fixup dst/netmask combination first */
1498 dst_sa = (struct sockaddr_in *)info->rti_info[RTAX_DST];
1499 mask_sa = (struct sockaddr_in *)info->rti_info[RTAX_NETMASK];
1500
1501 /* Ensure reads do not go beyound the buffer size */
1502 if (SA_SIZE(dst_sa) < offsetof(struct sockaddr_in, sin_zero)) {
1503 RTS_PID_LOG(LOG_DEBUG, "prefix dst sin_len too small: %d",
1504 dst_sa->sin_len);
1505 return (EINVAL);
1506 }
1507
1508 if ((mask_sa != NULL) && mask_sa->sin_len < sizeof(struct sockaddr_in)) {
1509 /*
1510 * Some older routing software encode mask length into the
1511 * sin_len, thus resulting in "truncated" sockaddr.
1512 */
1513 int len = mask_sa->sin_len - offsetof(struct sockaddr_in, sin_addr);
1514 if (len >= 0) {
1515 mask.s_addr = 0;
1516 if (len > sizeof(struct in_addr))
1517 len = sizeof(struct in_addr);
1518 memcpy(&mask, &mask_sa->sin_addr, len);
1519 } else {
1520 RTS_PID_LOG(LOG_DEBUG, "prefix mask sin_len too small: %d",
1521 mask_sa->sin_len);
1522 return (EINVAL);
1523 }
1524 } else
1525 mask.s_addr = mask_sa ? mask_sa->sin_addr.s_addr : INADDR_BROADCAST;
1526
1527 dst.s_addr = htonl(ntohl(dst_sa->sin_addr.s_addr) & ntohl(mask.s_addr));
1528
1529 /* Construct new "clean" dst/mask sockaddresses */
1530 if ((dst_sa = (struct sockaddr_in *)alloc_sockaddr_aligned(lb, sa_len)) == NULL)
1531 return (ENOBUFS);
1532 fill_sockaddr_inet(dst_sa, dst);
1533 info->rti_info[RTAX_DST] = (struct sockaddr *)dst_sa;
1534
1535 if (mask.s_addr != INADDR_BROADCAST) {
1536 if ((mask_sa = (struct sockaddr_in *)alloc_sockaddr_aligned(lb, sa_len)) == NULL)
1537 return (ENOBUFS);
1538 fill_sockaddr_inet(mask_sa, mask);
1539 info->rti_info[RTAX_NETMASK] = (struct sockaddr *)mask_sa;
1540 info->rti_flags &= ~RTF_HOST;
1541 } else
1542 remove_netmask(info);
1543
1544 /* Check gateway */
1545 if (info->rti_info[RTAX_GATEWAY] != NULL)
1546 return (cleanup_xaddrs_gateway(info, lb));
1547
1548 return (0);
1549 }
1550 #endif
1551
1552 #ifdef INET6
1553 static int
cleanup_xaddrs_inet6(struct rt_addrinfo * info,struct linear_buffer * lb)1554 cleanup_xaddrs_inet6(struct rt_addrinfo *info, struct linear_buffer *lb)
1555 {
1556 struct sockaddr *sa;
1557 struct sockaddr_in6 *dst_sa, *mask_sa;
1558 struct in6_addr mask, *dst;
1559 const int sa_len = sizeof(struct sockaddr_in6);
1560
1561 /* Check & fixup dst/netmask combination first */
1562 dst_sa = (struct sockaddr_in6 *)info->rti_info[RTAX_DST];
1563 mask_sa = (struct sockaddr_in6 *)info->rti_info[RTAX_NETMASK];
1564
1565 if (dst_sa->sin6_len < sizeof(struct sockaddr_in6)) {
1566 RTS_PID_LOG(LOG_DEBUG, "prefix dst sin6_len too small: %d",
1567 dst_sa->sin6_len);
1568 return (EINVAL);
1569 }
1570
1571 if (mask_sa && mask_sa->sin6_len < sizeof(struct sockaddr_in6)) {
1572 /*
1573 * Some older routing software encode mask length into the
1574 * sin6_len, thus resulting in "truncated" sockaddr.
1575 */
1576 int len = mask_sa->sin6_len - offsetof(struct sockaddr_in6, sin6_addr);
1577 if (len >= 0) {
1578 bzero(&mask, sizeof(mask));
1579 if (len > sizeof(struct in6_addr))
1580 len = sizeof(struct in6_addr);
1581 memcpy(&mask, &mask_sa->sin6_addr, len);
1582 } else {
1583 RTS_PID_LOG(LOG_DEBUG, "rtsock: prefix mask sin6_len too small: %d",
1584 mask_sa->sin6_len);
1585 return (EINVAL);
1586 }
1587 } else
1588 mask = mask_sa ? mask_sa->sin6_addr : in6mask128;
1589
1590 dst = &dst_sa->sin6_addr;
1591 IN6_MASK_ADDR(dst, &mask);
1592
1593 if ((sa = alloc_sockaddr_aligned(lb, sa_len)) == NULL)
1594 return (ENOBUFS);
1595 fill_sockaddr_inet6((struct sockaddr_in6 *)sa, dst, 0);
1596 info->rti_info[RTAX_DST] = sa;
1597
1598 if (!IN6_ARE_ADDR_EQUAL(&mask, &in6mask128)) {
1599 if ((sa = alloc_sockaddr_aligned(lb, sa_len)) == NULL)
1600 return (ENOBUFS);
1601 fill_sockaddr_inet6((struct sockaddr_in6 *)sa, &mask, 0);
1602 info->rti_info[RTAX_NETMASK] = sa;
1603 info->rti_flags &= ~RTF_HOST;
1604 } else
1605 remove_netmask(info);
1606
1607 /* Check gateway */
1608 if (info->rti_info[RTAX_GATEWAY] != NULL)
1609 return (cleanup_xaddrs_gateway(info, lb));
1610
1611 return (0);
1612 }
1613 #endif
1614
1615 static int
cleanup_xaddrs(struct rt_addrinfo * info,struct linear_buffer * lb)1616 cleanup_xaddrs(struct rt_addrinfo *info, struct linear_buffer *lb)
1617 {
1618 int error = EAFNOSUPPORT;
1619
1620 if (info->rti_info[RTAX_DST] == NULL) {
1621 RTS_PID_LOG(LOG_DEBUG, "prefix dst is not set");
1622 return (EINVAL);
1623 }
1624
1625 if (info->rti_flags & RTF_LLDATA) {
1626 /*
1627 * arp(8)/ndp(8) sends RTA_NETMASK for the associated
1628 * prefix along with the actual address in RTA_DST.
1629 * Remove netmask to avoid unnecessary address masking.
1630 */
1631 remove_netmask(info);
1632 }
1633
1634 switch (info->rti_info[RTAX_DST]->sa_family) {
1635 #ifdef INET
1636 case AF_INET:
1637 error = cleanup_xaddrs_inet(info, lb);
1638 break;
1639 #endif
1640 #ifdef INET6
1641 case AF_INET6:
1642 error = cleanup_xaddrs_inet6(info, lb);
1643 break;
1644 #endif
1645 }
1646
1647 return (error);
1648 }
1649
1650 /*
1651 * Fill in @dmask with valid netmask leaving original @smask
1652 * intact. Mostly used with radix netmasks.
1653 */
1654 struct sockaddr *
rtsock_fix_netmask(const struct sockaddr * dst,const struct sockaddr * smask,struct sockaddr_storage * dmask)1655 rtsock_fix_netmask(const struct sockaddr *dst, const struct sockaddr *smask,
1656 struct sockaddr_storage *dmask)
1657 {
1658 if (dst == NULL || smask == NULL)
1659 return (NULL);
1660
1661 memset(dmask, 0, dst->sa_len);
1662 memcpy(dmask, smask, smask->sa_len);
1663 dmask->ss_len = dst->sa_len;
1664 dmask->ss_family = dst->sa_family;
1665
1666 return ((struct sockaddr *)dmask);
1667 }
1668
1669 /*
1670 * Writes information related to @rtinfo object to newly-allocated mbuf.
1671 * Assumes MCLBYTES is enough to construct any message.
1672 * Used for OS notifications of vaious events (if/ifa announces,etc)
1673 *
1674 * Returns allocated mbuf or NULL on failure.
1675 */
1676 static struct mbuf *
rtsock_msg_mbuf(int type,struct rt_addrinfo * rtinfo)1677 rtsock_msg_mbuf(int type, struct rt_addrinfo *rtinfo)
1678 {
1679 struct sockaddr_storage ss;
1680 struct rt_msghdr *rtm;
1681 struct mbuf *m;
1682 int i;
1683 struct sockaddr *sa;
1684 #ifdef INET6
1685 struct sockaddr_in6 *sin6;
1686 #endif
1687 int len, dlen;
1688
1689 switch (type) {
1690 case RTM_DELADDR:
1691 case RTM_NEWADDR:
1692 len = sizeof(struct ifa_msghdr);
1693 break;
1694
1695 case RTM_DELMADDR:
1696 case RTM_NEWMADDR:
1697 len = sizeof(struct ifma_msghdr);
1698 break;
1699
1700 case RTM_IFINFO:
1701 len = sizeof(struct if_msghdr);
1702 break;
1703
1704 case RTM_IFANNOUNCE:
1705 case RTM_IEEE80211:
1706 len = sizeof(struct if_announcemsghdr);
1707 break;
1708
1709 default:
1710 len = sizeof(struct rt_msghdr);
1711 }
1712
1713 /* XXXGL: can we use MJUMPAGESIZE cluster here? */
1714 KASSERT(len <= MCLBYTES, ("%s: message too big", __func__));
1715 if (len > MHLEN)
1716 m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
1717 else
1718 m = m_gethdr(M_NOWAIT, MT_DATA);
1719 if (m == NULL)
1720 return (m);
1721
1722 m->m_pkthdr.len = m->m_len = len;
1723 rtm = mtod(m, struct rt_msghdr *);
1724 bzero((caddr_t)rtm, len);
1725 for (i = 0; i < RTAX_MAX; i++) {
1726 if ((sa = rtinfo->rti_info[i]) == NULL)
1727 continue;
1728 rtinfo->rti_addrs |= (1 << i);
1729
1730 dlen = SA_SIZE(sa);
1731 KASSERT(dlen <= sizeof(ss),
1732 ("%s: sockaddr size overflow", __func__));
1733 bzero(&ss, sizeof(ss));
1734 bcopy(sa, &ss, sa->sa_len);
1735 sa = (struct sockaddr *)&ss;
1736 #ifdef INET6
1737 if (sa->sa_family == AF_INET6) {
1738 sin6 = (struct sockaddr_in6 *)sa;
1739 (void)sa6_recoverscope(sin6);
1740 }
1741 #endif
1742 m_copyback(m, len, dlen, (caddr_t)sa);
1743 len += dlen;
1744 }
1745 if (m->m_pkthdr.len != len) {
1746 m_freem(m);
1747 return (NULL);
1748 }
1749 rtm->rtm_msglen = len;
1750 rtm->rtm_version = RTM_VERSION;
1751 rtm->rtm_type = type;
1752 return (m);
1753 }
1754
1755 /*
1756 * Writes information related to @rtinfo object to preallocated buffer.
1757 * Stores needed size in @plen. If @w is NULL, calculates size without
1758 * writing.
1759 * Used for sysctl dumps and rtsock answers (RTM_DEL/RTM_GET) generation.
1760 *
1761 * Returns 0 on success.
1762 *
1763 */
1764 static int
rtsock_msg_buffer(int type,struct rt_addrinfo * rtinfo,struct walkarg * w,int * plen)1765 rtsock_msg_buffer(int type, struct rt_addrinfo *rtinfo, struct walkarg *w, int *plen)
1766 {
1767 struct sockaddr_storage ss;
1768 int len, buflen = 0, dlen, i;
1769 caddr_t cp = NULL;
1770 struct rt_msghdr *rtm = NULL;
1771 #ifdef INET6
1772 struct sockaddr_in6 *sin6;
1773 #endif
1774 #ifdef COMPAT_FREEBSD32
1775 bool compat32 = false;
1776 #endif
1777
1778 switch (type) {
1779 case RTM_DELADDR:
1780 case RTM_NEWADDR:
1781 if (w != NULL && w->w_op == NET_RT_IFLISTL) {
1782 #ifdef COMPAT_FREEBSD32
1783 if (w->w_req->flags & SCTL_MASK32) {
1784 len = sizeof(struct ifa_msghdrl32);
1785 compat32 = true;
1786 } else
1787 #endif
1788 len = sizeof(struct ifa_msghdrl);
1789 } else
1790 len = sizeof(struct ifa_msghdr);
1791 break;
1792
1793 case RTM_IFINFO:
1794 #ifdef COMPAT_FREEBSD32
1795 if (w != NULL && w->w_req->flags & SCTL_MASK32) {
1796 if (w->w_op == NET_RT_IFLISTL)
1797 len = sizeof(struct if_msghdrl32);
1798 else
1799 len = sizeof(struct if_msghdr32);
1800 compat32 = true;
1801 break;
1802 }
1803 #endif
1804 if (w != NULL && w->w_op == NET_RT_IFLISTL)
1805 len = sizeof(struct if_msghdrl);
1806 else
1807 len = sizeof(struct if_msghdr);
1808 break;
1809
1810 case RTM_NEWMADDR:
1811 len = sizeof(struct ifma_msghdr);
1812 break;
1813
1814 default:
1815 len = sizeof(struct rt_msghdr);
1816 }
1817
1818 if (w != NULL) {
1819 rtm = (struct rt_msghdr *)w->w_tmem;
1820 buflen = w->w_tmemsize - len;
1821 cp = (caddr_t)w->w_tmem + len;
1822 }
1823
1824 rtinfo->rti_addrs = 0;
1825 for (i = 0; i < RTAX_MAX; i++) {
1826 struct sockaddr *sa;
1827
1828 if ((sa = rtinfo->rti_info[i]) == NULL)
1829 continue;
1830 rtinfo->rti_addrs |= (1 << i);
1831 #ifdef COMPAT_FREEBSD32
1832 if (compat32)
1833 dlen = SA_SIZE32(sa);
1834 else
1835 #endif
1836 dlen = SA_SIZE(sa);
1837 if (cp != NULL && buflen >= dlen) {
1838 KASSERT(dlen <= sizeof(ss),
1839 ("%s: sockaddr size overflow", __func__));
1840 bzero(&ss, sizeof(ss));
1841 bcopy(sa, &ss, sa->sa_len);
1842 sa = (struct sockaddr *)&ss;
1843 #ifdef INET6
1844 if (sa->sa_family == AF_INET6) {
1845 sin6 = (struct sockaddr_in6 *)sa;
1846 (void)sa6_recoverscope(sin6);
1847 }
1848 #endif
1849 bcopy((caddr_t)sa, cp, (unsigned)dlen);
1850 cp += dlen;
1851 buflen -= dlen;
1852 } else if (cp != NULL) {
1853 /*
1854 * Buffer too small. Count needed size
1855 * and return with error.
1856 */
1857 cp = NULL;
1858 }
1859
1860 len += dlen;
1861 }
1862
1863 if (cp != NULL) {
1864 dlen = ALIGN(len) - len;
1865 if (buflen < dlen)
1866 cp = NULL;
1867 else {
1868 bzero(cp, dlen);
1869 cp += dlen;
1870 buflen -= dlen;
1871 }
1872 }
1873 len = ALIGN(len);
1874
1875 if (cp != NULL) {
1876 /* fill header iff buffer is large enough */
1877 rtm->rtm_version = RTM_VERSION;
1878 rtm->rtm_type = type;
1879 rtm->rtm_msglen = len;
1880 }
1881
1882 *plen = len;
1883
1884 if (w != NULL && cp == NULL)
1885 return (ENOBUFS);
1886
1887 return (0);
1888 }
1889
1890 /*
1891 * This routine is called to generate a message from the routing
1892 * socket indicating that a redirect has occurred, a routing lookup
1893 * has failed, or that a protocol has detected timeouts to a particular
1894 * destination.
1895 */
1896 void
rt_missmsg_fib(int type,struct rt_addrinfo * rtinfo,int flags,int error,int fibnum)1897 rt_missmsg_fib(int type, struct rt_addrinfo *rtinfo, int flags, int error,
1898 int fibnum)
1899 {
1900 struct rt_msghdr *rtm;
1901 struct mbuf *m;
1902 struct sockaddr *sa = rtinfo->rti_info[RTAX_DST];
1903
1904 if (V_route_cb.any_count == 0)
1905 return;
1906 m = rtsock_msg_mbuf(type, rtinfo);
1907 if (m == NULL)
1908 return;
1909
1910 if (fibnum != RT_ALL_FIBS) {
1911 KASSERT(fibnum >= 0 && fibnum < rt_numfibs, ("%s: fibnum out "
1912 "of range 0 <= %d < %d", __func__, fibnum, rt_numfibs));
1913 M_SETFIB(m, fibnum);
1914 m->m_flags |= RTS_FILTER_FIB;
1915 }
1916
1917 rtm = mtod(m, struct rt_msghdr *);
1918 rtm->rtm_flags = RTF_DONE | flags;
1919 rtm->rtm_errno = error;
1920 rtm->rtm_addrs = rtinfo->rti_addrs;
1921 rt_dispatch(m, sa ? sa->sa_family : AF_UNSPEC);
1922 }
1923
1924 void
rt_missmsg(int type,struct rt_addrinfo * rtinfo,int flags,int error)1925 rt_missmsg(int type, struct rt_addrinfo *rtinfo, int flags, int error)
1926 {
1927
1928 rt_missmsg_fib(type, rtinfo, flags, error, RT_ALL_FIBS);
1929 }
1930
1931 /*
1932 * This routine is called to generate a message from the routing
1933 * socket indicating that the status of a network interface has changed.
1934 */
1935 static void
rtsock_ifmsg(struct ifnet * ifp,int if_flags_mask __unused)1936 rtsock_ifmsg(struct ifnet *ifp, int if_flags_mask __unused)
1937 {
1938 struct if_msghdr *ifm;
1939 struct mbuf *m;
1940 struct rt_addrinfo info;
1941
1942 if (V_route_cb.any_count == 0)
1943 return;
1944 bzero((caddr_t)&info, sizeof(info));
1945 m = rtsock_msg_mbuf(RTM_IFINFO, &info);
1946 if (m == NULL)
1947 return;
1948 ifm = mtod(m, struct if_msghdr *);
1949 ifm->ifm_index = ifp->if_index;
1950 ifm->ifm_flags = ifp->if_flags | ifp->if_drv_flags;
1951 if_data_copy(ifp, &ifm->ifm_data);
1952 ifm->ifm_addrs = 0;
1953 rt_dispatch(m, AF_UNSPEC);
1954 }
1955
1956 /*
1957 * Announce interface address arrival/withdraw.
1958 * Please do not call directly, use rt_addrmsg().
1959 * Assume input data to be valid.
1960 * Returns 0 on success.
1961 */
1962 int
rtsock_addrmsg(int cmd,struct ifaddr * ifa,int fibnum)1963 rtsock_addrmsg(int cmd, struct ifaddr *ifa, int fibnum)
1964 {
1965 struct rt_addrinfo info;
1966 struct sockaddr *sa;
1967 int ncmd;
1968 struct mbuf *m;
1969 struct ifa_msghdr *ifam;
1970 struct ifnet *ifp = ifa->ifa_ifp;
1971 struct sockaddr_storage ss;
1972
1973 if (V_route_cb.any_count == 0)
1974 return (0);
1975
1976 ncmd = cmd == RTM_ADD ? RTM_NEWADDR : RTM_DELADDR;
1977
1978 bzero((caddr_t)&info, sizeof(info));
1979 info.rti_info[RTAX_IFA] = sa = ifa->ifa_addr;
1980 info.rti_info[RTAX_IFP] = ifp->if_addr->ifa_addr;
1981 info.rti_info[RTAX_NETMASK] = rtsock_fix_netmask(
1982 info.rti_info[RTAX_IFA], ifa->ifa_netmask, &ss);
1983 info.rti_info[RTAX_BRD] = ifa->ifa_dstaddr;
1984 if ((m = rtsock_msg_mbuf(ncmd, &info)) == NULL)
1985 return (ENOBUFS);
1986 ifam = mtod(m, struct ifa_msghdr *);
1987 ifam->ifam_index = ifp->if_index;
1988 ifam->ifam_metric = ifa->ifa_ifp->if_metric;
1989 ifam->ifam_flags = ifa->ifa_flags;
1990 ifam->ifam_addrs = info.rti_addrs;
1991
1992 if (fibnum != RT_ALL_FIBS) {
1993 M_SETFIB(m, fibnum);
1994 m->m_flags |= RTS_FILTER_FIB;
1995 }
1996
1997 rt_dispatch(m, sa ? sa->sa_family : AF_UNSPEC);
1998
1999 return (0);
2000 }
2001
2002 /*
2003 * Announce route addition/removal to rtsock based on @rt data.
2004 * Callers are advives to use rt_routemsg() instead of using this
2005 * function directly.
2006 * Assume @rt data is consistent.
2007 *
2008 * Returns 0 on success.
2009 */
2010 int
rtsock_routemsg(int cmd,struct rtentry * rt,struct nhop_object * nh,int fibnum)2011 rtsock_routemsg(int cmd, struct rtentry *rt, struct nhop_object *nh,
2012 int fibnum)
2013 {
2014 union sockaddr_union dst, mask;
2015 struct rt_addrinfo info;
2016
2017 if (V_route_cb.any_count == 0)
2018 return (0);
2019
2020 int family = rt_get_family(rt);
2021 init_sockaddrs_family(family, &dst.sa, &mask.sa);
2022 export_rtaddrs(rt, &dst.sa, &mask.sa);
2023
2024 bzero((caddr_t)&info, sizeof(info));
2025 info.rti_info[RTAX_DST] = &dst.sa;
2026 info.rti_info[RTAX_NETMASK] = &mask.sa;
2027 info.rti_info[RTAX_GATEWAY] = &nh->gw_sa;
2028 info.rti_flags = rt->rte_flags | nhop_get_rtflags(nh);
2029 info.rti_ifp = nh->nh_ifp;
2030
2031 return (rtsock_routemsg_info(cmd, &info, fibnum));
2032 }
2033
2034 int
rtsock_routemsg_info(int cmd,struct rt_addrinfo * info,int fibnum)2035 rtsock_routemsg_info(int cmd, struct rt_addrinfo *info, int fibnum)
2036 {
2037 struct rt_msghdr *rtm;
2038 struct sockaddr *sa;
2039 struct mbuf *m;
2040
2041 if (V_route_cb.any_count == 0)
2042 return (0);
2043
2044 if (info->rti_flags & RTF_HOST)
2045 info->rti_info[RTAX_NETMASK] = NULL;
2046
2047 m = rtsock_msg_mbuf(cmd, info);
2048 if (m == NULL)
2049 return (ENOBUFS);
2050
2051 if (fibnum != RT_ALL_FIBS) {
2052 KASSERT(fibnum >= 0 && fibnum < rt_numfibs, ("%s: fibnum out "
2053 "of range 0 <= %d < %d", __func__, fibnum, rt_numfibs));
2054 M_SETFIB(m, fibnum);
2055 m->m_flags |= RTS_FILTER_FIB;
2056 }
2057
2058 rtm = mtod(m, struct rt_msghdr *);
2059 rtm->rtm_addrs = info->rti_addrs;
2060 if (info->rti_ifp != NULL)
2061 rtm->rtm_index = info->rti_ifp->if_index;
2062 /* Add RTF_DONE to indicate command 'completion' required by API */
2063 info->rti_flags |= RTF_DONE;
2064 /* Reported routes has to be up */
2065 if (cmd == RTM_ADD || cmd == RTM_CHANGE)
2066 info->rti_flags |= RTF_UP;
2067 rtm->rtm_flags = info->rti_flags;
2068
2069 sa = info->rti_info[RTAX_DST];
2070 rt_dispatch(m, sa ? sa->sa_family : AF_UNSPEC);
2071
2072 return (0);
2073 }
2074
2075 /*
2076 * This is the analogue to the rt_newaddrmsg which performs the same
2077 * function but for multicast group memberhips. This is easier since
2078 * there is no route state to worry about.
2079 */
2080 void
rt_newmaddrmsg(int cmd,struct ifmultiaddr * ifma)2081 rt_newmaddrmsg(int cmd, struct ifmultiaddr *ifma)
2082 {
2083 struct rt_addrinfo info;
2084 struct mbuf *m = NULL;
2085 struct ifnet *ifp = ifma->ifma_ifp;
2086 struct ifma_msghdr *ifmam;
2087
2088 if (V_route_cb.any_count == 0)
2089 return;
2090
2091 bzero((caddr_t)&info, sizeof(info));
2092 info.rti_info[RTAX_IFA] = ifma->ifma_addr;
2093 if (ifp && ifp->if_addr)
2094 info.rti_info[RTAX_IFP] = ifp->if_addr->ifa_addr;
2095 else
2096 info.rti_info[RTAX_IFP] = NULL;
2097 /*
2098 * If a link-layer address is present, present it as a ``gateway''
2099 * (similarly to how ARP entries, e.g., are presented).
2100 */
2101 info.rti_info[RTAX_GATEWAY] = ifma->ifma_lladdr;
2102 m = rtsock_msg_mbuf(cmd, &info);
2103 if (m == NULL)
2104 return;
2105 ifmam = mtod(m, struct ifma_msghdr *);
2106 KASSERT(ifp != NULL, ("%s: link-layer multicast address w/o ifp\n",
2107 __func__));
2108 ifmam->ifmam_index = ifp->if_index;
2109 ifmam->ifmam_addrs = info.rti_addrs;
2110 rt_dispatch(m, ifma->ifma_addr ? ifma->ifma_addr->sa_family : AF_UNSPEC);
2111 }
2112
2113 static struct mbuf *
rt_makeifannouncemsg(struct ifnet * ifp,int type,int what,struct rt_addrinfo * info)2114 rt_makeifannouncemsg(struct ifnet *ifp, int type, int what,
2115 struct rt_addrinfo *info)
2116 {
2117 struct if_announcemsghdr *ifan;
2118 struct mbuf *m;
2119
2120 if (V_route_cb.any_count == 0)
2121 return NULL;
2122 bzero((caddr_t)info, sizeof(*info));
2123 m = rtsock_msg_mbuf(type, info);
2124 if (m != NULL) {
2125 ifan = mtod(m, struct if_announcemsghdr *);
2126 ifan->ifan_index = ifp->if_index;
2127 strlcpy(ifan->ifan_name, ifp->if_xname,
2128 sizeof(ifan->ifan_name));
2129 ifan->ifan_what = what;
2130 }
2131 return m;
2132 }
2133
2134 /*
2135 * This is called to generate routing socket messages indicating
2136 * IEEE80211 wireless events.
2137 * XXX we piggyback on the RTM_IFANNOUNCE msg format in a clumsy way.
2138 */
2139 void
rt_ieee80211msg(struct ifnet * ifp,int what,void * data,size_t data_len)2140 rt_ieee80211msg(struct ifnet *ifp, int what, void *data, size_t data_len)
2141 {
2142 struct mbuf *m;
2143 struct rt_addrinfo info;
2144
2145 m = rt_makeifannouncemsg(ifp, RTM_IEEE80211, what, &info);
2146 if (m != NULL) {
2147 /*
2148 * Append the ieee80211 data. Try to stick it in the
2149 * mbuf containing the ifannounce msg; otherwise allocate
2150 * a new mbuf and append.
2151 *
2152 * NB: we assume m is a single mbuf.
2153 */
2154 if (data_len > M_TRAILINGSPACE(m)) {
2155 struct mbuf *n = m_get(M_NOWAIT, MT_DATA);
2156 if (n == NULL) {
2157 m_freem(m);
2158 return;
2159 }
2160 bcopy(data, mtod(n, void *), data_len);
2161 n->m_len = data_len;
2162 m->m_next = n;
2163 } else if (data_len > 0) {
2164 bcopy(data, mtod(m, u_int8_t *) + m->m_len, data_len);
2165 m->m_len += data_len;
2166 }
2167 if (m->m_flags & M_PKTHDR)
2168 m->m_pkthdr.len += data_len;
2169 mtod(m, struct if_announcemsghdr *)->ifan_msglen += data_len;
2170 rt_dispatch(m, AF_UNSPEC);
2171 }
2172 }
2173
2174 /*
2175 * This is called to generate routing socket messages indicating
2176 * network interface arrival and departure.
2177 */
2178 static void
rt_ifannouncemsg(struct ifnet * ifp,int what)2179 rt_ifannouncemsg(struct ifnet *ifp, int what)
2180 {
2181 struct mbuf *m;
2182 struct rt_addrinfo info;
2183
2184 m = rt_makeifannouncemsg(ifp, RTM_IFANNOUNCE, what, &info);
2185 if (m != NULL)
2186 rt_dispatch(m, AF_UNSPEC);
2187 }
2188
2189 static void
rt_dispatch(struct mbuf * m,sa_family_t saf)2190 rt_dispatch(struct mbuf *m, sa_family_t saf)
2191 {
2192
2193 M_ASSERTPKTHDR(m);
2194
2195 m->m_rtsock_family = saf;
2196 if (V_loif)
2197 m->m_pkthdr.rcvif = V_loif;
2198 else {
2199 m_freem(m);
2200 return;
2201 }
2202 netisr_queue(NETISR_ROUTE, m); /* mbuf is free'd on failure. */
2203 }
2204
2205 /*
2206 * This is used in dumping the kernel table via sysctl().
2207 */
2208 static int
sysctl_dumpentry(struct rtentry * rt,void * vw)2209 sysctl_dumpentry(struct rtentry *rt, void *vw)
2210 {
2211 struct walkarg *w = vw;
2212 struct nhop_object *nh;
2213
2214 NET_EPOCH_ASSERT();
2215
2216 if (!rt_is_exportable(rt, w->w_req->td->td_ucred))
2217 return (0);
2218
2219 export_rtaddrs(rt, w->dst, w->mask);
2220 nh = rt_get_raw_nhop(rt);
2221 #ifdef ROUTE_MPATH
2222 if (NH_IS_NHGRP(nh)) {
2223 const struct weightened_nhop *wn;
2224 uint32_t num_nhops;
2225 int error;
2226 wn = nhgrp_get_nhops((struct nhgrp_object *)nh, &num_nhops);
2227 for (int i = 0; i < num_nhops; i++) {
2228 error = sysctl_dumpnhop(rt, wn[i].nh, wn[i].weight, w);
2229 if (error != 0)
2230 return (error);
2231 }
2232 } else
2233 #endif
2234 sysctl_dumpnhop(rt, nh, rt->rt_weight, w);
2235
2236 return (0);
2237 }
2238
2239
2240 static int
sysctl_dumpnhop(struct rtentry * rt,struct nhop_object * nh,uint32_t weight,struct walkarg * w)2241 sysctl_dumpnhop(struct rtentry *rt, struct nhop_object *nh, uint32_t weight,
2242 struct walkarg *w)
2243 {
2244 struct rt_addrinfo info;
2245 int error = 0, size;
2246 uint32_t rtflags;
2247
2248 rtflags = nhop_get_rtflags(nh);
2249
2250 if (w->w_op == NET_RT_FLAGS && !(rtflags & w->w_arg))
2251 return (0);
2252
2253 bzero((caddr_t)&info, sizeof(info));
2254 info.rti_info[RTAX_DST] = w->dst;
2255 info.rti_info[RTAX_GATEWAY] = &nh->gw_sa;
2256 info.rti_info[RTAX_NETMASK] = (rtflags & RTF_HOST) ? NULL : w->mask;
2257 info.rti_info[RTAX_GENMASK] = 0;
2258 if (nh->nh_ifp && !(nh->nh_ifp->if_flags & IFF_DYING)) {
2259 info.rti_info[RTAX_IFP] = nh->nh_ifp->if_addr->ifa_addr;
2260 info.rti_info[RTAX_IFA] = nh->nh_ifa->ifa_addr;
2261 if (nh->nh_ifp->if_flags & IFF_POINTOPOINT)
2262 info.rti_info[RTAX_BRD] = nh->nh_ifa->ifa_dstaddr;
2263 }
2264 if ((error = rtsock_msg_buffer(RTM_GET, &info, w, &size)) != 0)
2265 return (error);
2266 if (w->w_req && w->w_tmem) {
2267 struct rt_msghdr *rtm = (struct rt_msghdr *)w->w_tmem;
2268
2269 bzero(&rtm->rtm_index,
2270 sizeof(*rtm) - offsetof(struct rt_msghdr, rtm_index));
2271
2272 /*
2273 * rte flags may consist of RTF_HOST (duplicated in nhop rtflags)
2274 * and RTF_UP (if entry is linked, which is always true here).
2275 * Given that, use nhop rtflags & add RTF_UP.
2276 */
2277 rtm->rtm_flags = rtflags | RTF_UP;
2278 if (rtm->rtm_flags & RTF_GWFLAG_COMPAT)
2279 rtm->rtm_flags = RTF_GATEWAY |
2280 (rtm->rtm_flags & ~RTF_GWFLAG_COMPAT);
2281 rt_getmetrics(rt, nh, &rtm->rtm_rmx);
2282 rtm->rtm_rmx.rmx_weight = weight;
2283 rtm->rtm_index = nh->nh_ifp->if_index;
2284 rtm->rtm_addrs = info.rti_addrs;
2285 error = SYSCTL_OUT(w->w_req, (caddr_t)rtm, size);
2286 return (error);
2287 }
2288 return (error);
2289 }
2290
2291 static int
sysctl_iflist_ifml(struct ifnet * ifp,const struct if_data * src_ifd,struct rt_addrinfo * info,struct walkarg * w,int len)2292 sysctl_iflist_ifml(struct ifnet *ifp, const struct if_data *src_ifd,
2293 struct rt_addrinfo *info, struct walkarg *w, int len)
2294 {
2295 struct if_msghdrl *ifm;
2296 struct if_data *ifd;
2297
2298 ifm = (struct if_msghdrl *)w->w_tmem;
2299
2300 #ifdef COMPAT_FREEBSD32
2301 if (w->w_req->flags & SCTL_MASK32) {
2302 struct if_msghdrl32 *ifm32;
2303
2304 ifm32 = (struct if_msghdrl32 *)ifm;
2305 ifm32->ifm_addrs = info->rti_addrs;
2306 ifm32->ifm_flags = ifp->if_flags | ifp->if_drv_flags;
2307 ifm32->ifm_index = ifp->if_index;
2308 ifm32->_ifm_spare1 = 0;
2309 ifm32->ifm_len = sizeof(*ifm32);
2310 ifm32->ifm_data_off = offsetof(struct if_msghdrl32, ifm_data);
2311 ifm32->_ifm_spare2 = 0;
2312 ifd = &ifm32->ifm_data;
2313 } else
2314 #endif
2315 {
2316 ifm->ifm_addrs = info->rti_addrs;
2317 ifm->ifm_flags = ifp->if_flags | ifp->if_drv_flags;
2318 ifm->ifm_index = ifp->if_index;
2319 ifm->_ifm_spare1 = 0;
2320 ifm->ifm_len = sizeof(*ifm);
2321 ifm->ifm_data_off = offsetof(struct if_msghdrl, ifm_data);
2322 ifm->_ifm_spare2 = 0;
2323 ifd = &ifm->ifm_data;
2324 }
2325
2326 memcpy(ifd, src_ifd, sizeof(*ifd));
2327
2328 return (SYSCTL_OUT(w->w_req, (caddr_t)ifm, len));
2329 }
2330
2331 static int
sysctl_iflist_ifm(struct ifnet * ifp,const struct if_data * src_ifd,struct rt_addrinfo * info,struct walkarg * w,int len)2332 sysctl_iflist_ifm(struct ifnet *ifp, const struct if_data *src_ifd,
2333 struct rt_addrinfo *info, struct walkarg *w, int len)
2334 {
2335 struct if_msghdr *ifm;
2336 struct if_data *ifd;
2337
2338 ifm = (struct if_msghdr *)w->w_tmem;
2339
2340 #ifdef COMPAT_FREEBSD32
2341 if (w->w_req->flags & SCTL_MASK32) {
2342 struct if_msghdr32 *ifm32;
2343
2344 ifm32 = (struct if_msghdr32 *)ifm;
2345 ifm32->ifm_addrs = info->rti_addrs;
2346 ifm32->ifm_flags = ifp->if_flags | ifp->if_drv_flags;
2347 ifm32->ifm_index = ifp->if_index;
2348 ifm32->_ifm_spare1 = 0;
2349 ifd = &ifm32->ifm_data;
2350 } else
2351 #endif
2352 {
2353 ifm->ifm_addrs = info->rti_addrs;
2354 ifm->ifm_flags = ifp->if_flags | ifp->if_drv_flags;
2355 ifm->ifm_index = ifp->if_index;
2356 ifm->_ifm_spare1 = 0;
2357 ifd = &ifm->ifm_data;
2358 }
2359
2360 memcpy(ifd, src_ifd, sizeof(*ifd));
2361
2362 return (SYSCTL_OUT(w->w_req, (caddr_t)ifm, len));
2363 }
2364
2365 static int
sysctl_iflist_ifaml(struct ifaddr * ifa,struct rt_addrinfo * info,struct walkarg * w,int len)2366 sysctl_iflist_ifaml(struct ifaddr *ifa, struct rt_addrinfo *info,
2367 struct walkarg *w, int len)
2368 {
2369 struct ifa_msghdrl *ifam;
2370 struct if_data *ifd;
2371
2372 ifam = (struct ifa_msghdrl *)w->w_tmem;
2373
2374 #ifdef COMPAT_FREEBSD32
2375 if (w->w_req->flags & SCTL_MASK32) {
2376 struct ifa_msghdrl32 *ifam32;
2377
2378 ifam32 = (struct ifa_msghdrl32 *)ifam;
2379 ifam32->ifam_addrs = info->rti_addrs;
2380 ifam32->ifam_flags = ifa->ifa_flags;
2381 ifam32->ifam_index = ifa->ifa_ifp->if_index;
2382 ifam32->_ifam_spare1 = 0;
2383 ifam32->ifam_len = sizeof(*ifam32);
2384 ifam32->ifam_data_off =
2385 offsetof(struct ifa_msghdrl32, ifam_data);
2386 ifam32->ifam_metric = ifa->ifa_ifp->if_metric;
2387 ifd = &ifam32->ifam_data;
2388 } else
2389 #endif
2390 {
2391 ifam->ifam_addrs = info->rti_addrs;
2392 ifam->ifam_flags = ifa->ifa_flags;
2393 ifam->ifam_index = ifa->ifa_ifp->if_index;
2394 ifam->_ifam_spare1 = 0;
2395 ifam->ifam_len = sizeof(*ifam);
2396 ifam->ifam_data_off = offsetof(struct ifa_msghdrl, ifam_data);
2397 ifam->ifam_metric = ifa->ifa_ifp->if_metric;
2398 ifd = &ifam->ifam_data;
2399 }
2400
2401 bzero(ifd, sizeof(*ifd));
2402 ifd->ifi_datalen = sizeof(struct if_data);
2403 ifd->ifi_ipackets = counter_u64_fetch(ifa->ifa_ipackets);
2404 ifd->ifi_opackets = counter_u64_fetch(ifa->ifa_opackets);
2405 ifd->ifi_ibytes = counter_u64_fetch(ifa->ifa_ibytes);
2406 ifd->ifi_obytes = counter_u64_fetch(ifa->ifa_obytes);
2407
2408 /* Fixup if_data carp(4) vhid. */
2409 if (carp_get_vhid_p != NULL)
2410 ifd->ifi_vhid = (*carp_get_vhid_p)(ifa);
2411
2412 return (SYSCTL_OUT(w->w_req, w->w_tmem, len));
2413 }
2414
2415 static int
sysctl_iflist_ifam(struct ifaddr * ifa,struct rt_addrinfo * info,struct walkarg * w,int len)2416 sysctl_iflist_ifam(struct ifaddr *ifa, struct rt_addrinfo *info,
2417 struct walkarg *w, int len)
2418 {
2419 struct ifa_msghdr *ifam;
2420
2421 ifam = (struct ifa_msghdr *)w->w_tmem;
2422 ifam->ifam_addrs = info->rti_addrs;
2423 ifam->ifam_flags = ifa->ifa_flags;
2424 ifam->ifam_index = ifa->ifa_ifp->if_index;
2425 ifam->_ifam_spare1 = 0;
2426 ifam->ifam_metric = ifa->ifa_ifp->if_metric;
2427
2428 return (SYSCTL_OUT(w->w_req, w->w_tmem, len));
2429 }
2430
2431 static int
sysctl_iflist(int af,struct walkarg * w)2432 sysctl_iflist(int af, struct walkarg *w)
2433 {
2434 struct ifnet *ifp;
2435 struct ifaddr *ifa;
2436 struct if_data ifd;
2437 struct rt_addrinfo info;
2438 int len, error = 0;
2439 struct sockaddr_storage ss;
2440
2441 bzero((caddr_t)&info, sizeof(info));
2442 bzero(&ifd, sizeof(ifd));
2443 CK_STAILQ_FOREACH(ifp, &V_ifnet, if_link) {
2444 if (w->w_arg && w->w_arg != ifp->if_index)
2445 continue;
2446 if_data_copy(ifp, &ifd);
2447 ifa = ifp->if_addr;
2448 info.rti_info[RTAX_IFP] = ifa->ifa_addr;
2449 error = rtsock_msg_buffer(RTM_IFINFO, &info, w, &len);
2450 if (error != 0)
2451 goto done;
2452 info.rti_info[RTAX_IFP] = NULL;
2453 if (w->w_req && w->w_tmem) {
2454 if (w->w_op == NET_RT_IFLISTL)
2455 error = sysctl_iflist_ifml(ifp, &ifd, &info, w,
2456 len);
2457 else
2458 error = sysctl_iflist_ifm(ifp, &ifd, &info, w,
2459 len);
2460 if (error)
2461 goto done;
2462 }
2463 while ((ifa = CK_STAILQ_NEXT(ifa, ifa_link)) != NULL) {
2464 if (af && af != ifa->ifa_addr->sa_family)
2465 continue;
2466 if (prison_if(w->w_req->td->td_ucred,
2467 ifa->ifa_addr) != 0)
2468 continue;
2469 info.rti_info[RTAX_IFA] = ifa->ifa_addr;
2470 info.rti_info[RTAX_NETMASK] = rtsock_fix_netmask(
2471 ifa->ifa_addr, ifa->ifa_netmask, &ss);
2472 info.rti_info[RTAX_BRD] = ifa->ifa_dstaddr;
2473 error = rtsock_msg_buffer(RTM_NEWADDR, &info, w, &len);
2474 if (error != 0)
2475 goto done;
2476 if (w->w_req && w->w_tmem) {
2477 if (w->w_op == NET_RT_IFLISTL)
2478 error = sysctl_iflist_ifaml(ifa, &info,
2479 w, len);
2480 else
2481 error = sysctl_iflist_ifam(ifa, &info,
2482 w, len);
2483 if (error)
2484 goto done;
2485 }
2486 }
2487 info.rti_info[RTAX_IFA] = NULL;
2488 info.rti_info[RTAX_NETMASK] = NULL;
2489 info.rti_info[RTAX_BRD] = NULL;
2490 }
2491 done:
2492 return (error);
2493 }
2494
2495 static int
sysctl_ifmalist(int af,struct walkarg * w)2496 sysctl_ifmalist(int af, struct walkarg *w)
2497 {
2498 struct rt_addrinfo info;
2499 struct ifaddr *ifa;
2500 struct ifmultiaddr *ifma;
2501 struct ifnet *ifp;
2502 int error, len;
2503
2504 NET_EPOCH_ASSERT();
2505
2506 error = 0;
2507 bzero((caddr_t)&info, sizeof(info));
2508
2509 CK_STAILQ_FOREACH(ifp, &V_ifnet, if_link) {
2510 if (w->w_arg && w->w_arg != ifp->if_index)
2511 continue;
2512 ifa = ifp->if_addr;
2513 info.rti_info[RTAX_IFP] = ifa ? ifa->ifa_addr : NULL;
2514 CK_STAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
2515 if (af && af != ifma->ifma_addr->sa_family)
2516 continue;
2517 if (prison_if(w->w_req->td->td_ucred,
2518 ifma->ifma_addr) != 0)
2519 continue;
2520 info.rti_info[RTAX_IFA] = ifma->ifma_addr;
2521 info.rti_info[RTAX_GATEWAY] =
2522 (ifma->ifma_addr->sa_family != AF_LINK) ?
2523 ifma->ifma_lladdr : NULL;
2524 error = rtsock_msg_buffer(RTM_NEWMADDR, &info, w, &len);
2525 if (error != 0)
2526 break;
2527 if (w->w_req && w->w_tmem) {
2528 struct ifma_msghdr *ifmam;
2529
2530 ifmam = (struct ifma_msghdr *)w->w_tmem;
2531 ifmam->ifmam_index = ifma->ifma_ifp->if_index;
2532 ifmam->ifmam_flags = 0;
2533 ifmam->ifmam_addrs = info.rti_addrs;
2534 ifmam->_ifmam_spare1 = 0;
2535 error = SYSCTL_OUT(w->w_req, w->w_tmem, len);
2536 if (error != 0)
2537 break;
2538 }
2539 }
2540 if (error != 0)
2541 break;
2542 }
2543 return (error);
2544 }
2545
2546 static void
rtable_sysctl_dump(uint32_t fibnum,int family,struct walkarg * w)2547 rtable_sysctl_dump(uint32_t fibnum, int family, struct walkarg *w)
2548 {
2549 union sockaddr_union sa_dst, sa_mask;
2550
2551 w->family = family;
2552 w->dst = (struct sockaddr *)&sa_dst;
2553 w->mask = (struct sockaddr *)&sa_mask;
2554
2555 init_sockaddrs_family(family, w->dst, w->mask);
2556
2557 rib_walk(fibnum, family, false, sysctl_dumpentry, w);
2558 }
2559
2560 static int
sysctl_rtsock(SYSCTL_HANDLER_ARGS)2561 sysctl_rtsock(SYSCTL_HANDLER_ARGS)
2562 {
2563 struct epoch_tracker et;
2564 int *name = (int *)arg1;
2565 u_int namelen = arg2;
2566 struct rib_head *rnh = NULL; /* silence compiler. */
2567 int i, lim, error = EINVAL;
2568 int fib = 0;
2569 u_char af;
2570 struct walkarg w;
2571
2572 if (namelen < 3)
2573 return (EINVAL);
2574
2575 name++;
2576 namelen--;
2577 if (req->newptr)
2578 return (EPERM);
2579 if (name[1] == NET_RT_DUMP || name[1] == NET_RT_NHOP || name[1] == NET_RT_NHGRP) {
2580 if (namelen == 3)
2581 fib = req->td->td_proc->p_fibnum;
2582 else if (namelen == 4)
2583 fib = (name[3] == RT_ALL_FIBS) ?
2584 req->td->td_proc->p_fibnum : name[3];
2585 else
2586 return ((namelen < 3) ? EISDIR : ENOTDIR);
2587 if (fib < 0 || fib >= rt_numfibs)
2588 return (EINVAL);
2589 } else if (namelen != 3)
2590 return ((namelen < 3) ? EISDIR : ENOTDIR);
2591 af = name[0];
2592 if (af > AF_MAX)
2593 return (EINVAL);
2594 bzero(&w, sizeof(w));
2595 w.w_op = name[1];
2596 w.w_arg = name[2];
2597 w.w_req = req;
2598
2599 error = sysctl_wire_old_buffer(req, 0);
2600 if (error)
2601 return (error);
2602
2603 /*
2604 * Allocate reply buffer in advance.
2605 * All rtsock messages has maximum length of u_short.
2606 */
2607 w.w_tmemsize = 65536;
2608 w.w_tmem = malloc(w.w_tmemsize, M_TEMP, M_WAITOK);
2609
2610 NET_EPOCH_ENTER(et);
2611 switch (w.w_op) {
2612 case NET_RT_DUMP:
2613 case NET_RT_FLAGS:
2614 if (af == 0) { /* dump all tables */
2615 i = 1;
2616 lim = AF_MAX;
2617 } else /* dump only one table */
2618 i = lim = af;
2619
2620 /*
2621 * take care of llinfo entries, the caller must
2622 * specify an AF
2623 */
2624 if (w.w_op == NET_RT_FLAGS &&
2625 (w.w_arg == 0 || w.w_arg & RTF_LLINFO)) {
2626 if (af != 0)
2627 error = lltable_sysctl_dumparp(af, w.w_req);
2628 else
2629 error = EINVAL;
2630 break;
2631 }
2632 /*
2633 * take care of routing entries
2634 */
2635 for (error = 0; error == 0 && i <= lim; i++) {
2636 rnh = rt_tables_get_rnh(fib, i);
2637 if (rnh != NULL) {
2638 rtable_sysctl_dump(fib, i, &w);
2639 } else if (af != 0)
2640 error = EAFNOSUPPORT;
2641 }
2642 break;
2643 case NET_RT_NHOP:
2644 case NET_RT_NHGRP:
2645 /* Allow dumping one specific af/fib at a time */
2646 if (namelen < 4) {
2647 error = EINVAL;
2648 break;
2649 }
2650 fib = name[3];
2651 if (fib < 0 || fib > rt_numfibs) {
2652 error = EINVAL;
2653 break;
2654 }
2655 rnh = rt_tables_get_rnh(fib, af);
2656 if (rnh == NULL) {
2657 error = EAFNOSUPPORT;
2658 break;
2659 }
2660 if (w.w_op == NET_RT_NHOP)
2661 error = nhops_dump_sysctl(rnh, w.w_req);
2662 else
2663 #ifdef ROUTE_MPATH
2664 error = nhgrp_dump_sysctl(rnh, w.w_req);
2665 #else
2666 error = ENOTSUP;
2667 #endif
2668 break;
2669 case NET_RT_IFLIST:
2670 case NET_RT_IFLISTL:
2671 error = sysctl_iflist(af, &w);
2672 break;
2673
2674 case NET_RT_IFMALIST:
2675 error = sysctl_ifmalist(af, &w);
2676 break;
2677 }
2678 NET_EPOCH_EXIT(et);
2679
2680 free(w.w_tmem, M_TEMP);
2681 return (error);
2682 }
2683
2684 static SYSCTL_NODE(_net, PF_ROUTE, routetable, CTLFLAG_RD | CTLFLAG_MPSAFE,
2685 sysctl_rtsock, "Return route tables and interface/address lists");
2686
2687 /*
2688 * Definitions of protocols supported in the ROUTE domain.
2689 */
2690
2691 static struct domain routedomain; /* or at least forward */
2692
2693 static struct protosw routesw = {
2694 .pr_type = SOCK_RAW,
2695 .pr_flags = PR_ATOMIC|PR_ADDR,
2696 .pr_abort = rts_close,
2697 .pr_attach = rts_attach,
2698 .pr_detach = rts_detach,
2699 .pr_send = rts_send,
2700 .pr_shutdown = rts_shutdown,
2701 .pr_disconnect = rts_disconnect,
2702 .pr_close = rts_close,
2703 };
2704
2705 static struct domain routedomain = {
2706 .dom_family = PF_ROUTE,
2707 .dom_name = "route",
2708 .dom_nprotosw = 1,
2709 .dom_protosw = { &routesw },
2710 };
2711
2712 DOMAIN_SET(route);
2713