]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/net/rtsock.c
Move net/route/shared.h definitions to net/route/route_var.h.
[FreeBSD/FreeBSD.git] / sys / net / rtsock.c
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  *      @(#)rtsock.c    8.7 (Berkeley) 10/12/95
32  * $FreeBSD$
33  */
34 #include "opt_ddb.h"
35 #include "opt_mpath.h"
36 #include "opt_inet.h"
37 #include "opt_inet6.h"
38
39 #include <sys/param.h>
40 #include <sys/jail.h>
41 #include <sys/kernel.h>
42 #include <sys/domain.h>
43 #include <sys/lock.h>
44 #include <sys/malloc.h>
45 #include <sys/mbuf.h>
46 #include <sys/priv.h>
47 #include <sys/proc.h>
48 #include <sys/protosw.h>
49 #include <sys/rmlock.h>
50 #include <sys/rwlock.h>
51 #include <sys/signalvar.h>
52 #include <sys/socket.h>
53 #include <sys/socketvar.h>
54 #include <sys/sysctl.h>
55 #include <sys/systm.h>
56
57 #include <net/if.h>
58 #include <net/if_var.h>
59 #include <net/if_dl.h>
60 #include <net/if_llatbl.h>
61 #include <net/if_types.h>
62 #include <net/netisr.h>
63 #include <net/raw_cb.h>
64 #include <net/route.h>
65 #include <net/route/route_ctl.h>
66 #include <net/route/route_var.h>
67 #ifdef RADIX_MPATH
68 #include <net/radix_mpath.h>
69 #endif
70 #include <net/vnet.h>
71
72 #include <netinet/in.h>
73 #include <netinet/if_ether.h>
74 #include <netinet/ip_carp.h>
75 #ifdef INET6
76 #include <netinet6/ip6_var.h>
77 #include <netinet6/scope6_var.h>
78 #endif
79 #include <net/route/nhop.h>
80
81 #ifdef COMPAT_FREEBSD32
82 #include <sys/mount.h>
83 #include <compat/freebsd32/freebsd32.h>
84
85 struct if_msghdr32 {
86         uint16_t ifm_msglen;
87         uint8_t ifm_version;
88         uint8_t ifm_type;
89         int32_t ifm_addrs;
90         int32_t ifm_flags;
91         uint16_t ifm_index;
92         uint16_t _ifm_spare1;
93         struct  if_data ifm_data;
94 };
95
96 struct if_msghdrl32 {
97         uint16_t ifm_msglen;
98         uint8_t ifm_version;
99         uint8_t ifm_type;
100         int32_t ifm_addrs;
101         int32_t ifm_flags;
102         uint16_t ifm_index;
103         uint16_t _ifm_spare1;
104         uint16_t ifm_len;
105         uint16_t ifm_data_off;
106         uint32_t _ifm_spare2;
107         struct  if_data ifm_data;
108 };
109
110 struct ifa_msghdrl32 {
111         uint16_t ifam_msglen;
112         uint8_t ifam_version;
113         uint8_t ifam_type;
114         int32_t ifam_addrs;
115         int32_t ifam_flags;
116         uint16_t ifam_index;
117         uint16_t _ifam_spare1;
118         uint16_t ifam_len;
119         uint16_t ifam_data_off;
120         int32_t ifam_metric;
121         struct  if_data ifam_data;
122 };
123
124 #define SA_SIZE32(sa)                                           \
125     (  (((struct sockaddr *)(sa))->sa_len == 0) ?               \
126         sizeof(int)             :                               \
127         1 + ( (((struct sockaddr *)(sa))->sa_len - 1) | (sizeof(int) - 1) ) )
128
129 #endif /* COMPAT_FREEBSD32 */
130
131 MALLOC_DEFINE(M_RTABLE, "routetbl", "routing tables");
132
133 /* NB: these are not modified */
134 static struct   sockaddr route_src = { 2, PF_ROUTE, };
135 static struct   sockaddr sa_zero   = { sizeof(sa_zero), AF_INET, };
136
137 /* These are external hooks for CARP. */
138 int     (*carp_get_vhid_p)(struct ifaddr *);
139
140 /*
141  * Used by rtsock/raw_input callback code to decide whether to filter the update
142  * notification to a socket bound to a particular FIB.
143  */
144 #define RTS_FILTER_FIB  M_PROTO8
145
146 typedef struct {
147         int     ip_count;       /* attached w/ AF_INET */
148         int     ip6_count;      /* attached w/ AF_INET6 */
149         int     any_count;      /* total attached */
150 } route_cb_t;
151 VNET_DEFINE_STATIC(route_cb_t, route_cb);
152 #define V_route_cb VNET(route_cb)
153
154 struct mtx rtsock_mtx;
155 MTX_SYSINIT(rtsock, &rtsock_mtx, "rtsock route_cb lock", MTX_DEF);
156
157 #define RTSOCK_LOCK()   mtx_lock(&rtsock_mtx)
158 #define RTSOCK_UNLOCK() mtx_unlock(&rtsock_mtx)
159 #define RTSOCK_LOCK_ASSERT()    mtx_assert(&rtsock_mtx, MA_OWNED)
160
161 static SYSCTL_NODE(_net, OID_AUTO, route, CTLFLAG_RD | CTLFLAG_MPSAFE, 0,
162     "");
163
164 struct walkarg {
165         int     w_tmemsize;
166         int     w_op, w_arg;
167         caddr_t w_tmem;
168         struct sysctl_req *w_req;
169 };
170
171 static void     rts_input(struct mbuf *m);
172 static struct mbuf *rtsock_msg_mbuf(int type, struct rt_addrinfo *rtinfo);
173 static int      rtsock_msg_buffer(int type, struct rt_addrinfo *rtinfo,
174                         struct walkarg *w, int *plen);
175 static int      rt_xaddrs(caddr_t cp, caddr_t cplim,
176                         struct rt_addrinfo *rtinfo);
177 static int      sysctl_dumpentry(struct radix_node *rn, void *vw);
178 static int      sysctl_iflist(int af, struct walkarg *w);
179 static int      sysctl_ifmalist(int af, struct walkarg *w);
180 static int      route_output(struct mbuf *m, struct socket *so, ...);
181 static void     rt_getmetrics(const struct rtentry *rt,
182                         const struct nhop_object *nh, struct rt_metrics *out);
183 static void     rt_dispatch(struct mbuf *, sa_family_t);
184 static int      handle_rtm_get(struct rt_addrinfo *info, u_int fibnum,
185                         struct rt_msghdr *rtm, struct rib_cmd_info *rc);
186 static int      update_rtm_from_rc(struct rt_addrinfo *info,
187                         struct rt_msghdr **prtm, int alloc_len,
188                         struct rib_cmd_info *rc, struct nhop_object *nh);
189 static void     send_rtm_reply(struct socket *so, struct rt_msghdr *rtm,
190                         struct mbuf *m, sa_family_t saf, u_int fibnum,
191                         int rtm_errno);
192 static int      can_export_rte(struct ucred *td_ucred, const struct rtentry *rt);
193
194 static struct netisr_handler rtsock_nh = {
195         .nh_name = "rtsock",
196         .nh_handler = rts_input,
197         .nh_proto = NETISR_ROUTE,
198         .nh_policy = NETISR_POLICY_SOURCE,
199 };
200
201 static int
202 sysctl_route_netisr_maxqlen(SYSCTL_HANDLER_ARGS)
203 {
204         int error, qlimit;
205
206         netisr_getqlimit(&rtsock_nh, &qlimit);
207         error = sysctl_handle_int(oidp, &qlimit, 0, req);
208         if (error || !req->newptr)
209                 return (error);
210         if (qlimit < 1)
211                 return (EINVAL);
212         return (netisr_setqlimit(&rtsock_nh, qlimit));
213 }
214 SYSCTL_PROC(_net_route, OID_AUTO, netisr_maxqlen,
215     CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE,
216     0, 0, sysctl_route_netisr_maxqlen, "I",
217     "maximum routing socket dispatch queue length");
218
219 static void
220 vnet_rts_init(void)
221 {
222         int tmp;
223
224         if (IS_DEFAULT_VNET(curvnet)) {
225                 if (TUNABLE_INT_FETCH("net.route.netisr_maxqlen", &tmp))
226                         rtsock_nh.nh_qlimit = tmp;
227                 netisr_register(&rtsock_nh);
228         }
229 #ifdef VIMAGE
230          else
231                 netisr_register_vnet(&rtsock_nh);
232 #endif
233 }
234 VNET_SYSINIT(vnet_rtsock, SI_SUB_PROTO_DOMAIN, SI_ORDER_THIRD,
235     vnet_rts_init, 0);
236
237 #ifdef VIMAGE
238 static void
239 vnet_rts_uninit(void)
240 {
241
242         netisr_unregister_vnet(&rtsock_nh);
243 }
244 VNET_SYSUNINIT(vnet_rts_uninit, SI_SUB_PROTO_DOMAIN, SI_ORDER_THIRD,
245     vnet_rts_uninit, 0);
246 #endif
247
248 static int
249 raw_input_rts_cb(struct mbuf *m, struct sockproto *proto, struct sockaddr *src,
250     struct rawcb *rp)
251 {
252         int fibnum;
253
254         KASSERT(m != NULL, ("%s: m is NULL", __func__));
255         KASSERT(proto != NULL, ("%s: proto is NULL", __func__));
256         KASSERT(rp != NULL, ("%s: rp is NULL", __func__));
257
258         /* No filtering requested. */
259         if ((m->m_flags & RTS_FILTER_FIB) == 0)
260                 return (0);
261
262         /* Check if it is a rts and the fib matches the one of the socket. */
263         fibnum = M_GETFIB(m);
264         if (proto->sp_family != PF_ROUTE ||
265             rp->rcb_socket == NULL ||
266             rp->rcb_socket->so_fibnum == fibnum)
267                 return (0);
268
269         /* Filtering requested and no match, the socket shall be skipped. */
270         return (1);
271 }
272
273 static void
274 rts_input(struct mbuf *m)
275 {
276         struct sockproto route_proto;
277         unsigned short *family;
278         struct m_tag *tag;
279
280         route_proto.sp_family = PF_ROUTE;
281         tag = m_tag_find(m, PACKET_TAG_RTSOCKFAM, NULL);
282         if (tag != NULL) {
283                 family = (unsigned short *)(tag + 1);
284                 route_proto.sp_protocol = *family;
285                 m_tag_delete(m, tag);
286         } else
287                 route_proto.sp_protocol = 0;
288
289         raw_input_ext(m, &route_proto, &route_src, raw_input_rts_cb);
290 }
291
292 /*
293  * It really doesn't make any sense at all for this code to share much
294  * with raw_usrreq.c, since its functionality is so restricted.  XXX
295  */
296 static void
297 rts_abort(struct socket *so)
298 {
299
300         raw_usrreqs.pru_abort(so);
301 }
302
303 static void
304 rts_close(struct socket *so)
305 {
306
307         raw_usrreqs.pru_close(so);
308 }
309
310 /* pru_accept is EOPNOTSUPP */
311
312 static int
313 rts_attach(struct socket *so, int proto, struct thread *td)
314 {
315         struct rawcb *rp;
316         int error;
317
318         KASSERT(so->so_pcb == NULL, ("rts_attach: so_pcb != NULL"));
319
320         /* XXX */
321         rp = malloc(sizeof *rp, M_PCB, M_WAITOK | M_ZERO);
322
323         so->so_pcb = (caddr_t)rp;
324         so->so_fibnum = td->td_proc->p_fibnum;
325         error = raw_attach(so, proto);
326         rp = sotorawcb(so);
327         if (error) {
328                 so->so_pcb = NULL;
329                 free(rp, M_PCB);
330                 return error;
331         }
332         RTSOCK_LOCK();
333         switch(rp->rcb_proto.sp_protocol) {
334         case AF_INET:
335                 V_route_cb.ip_count++;
336                 break;
337         case AF_INET6:
338                 V_route_cb.ip6_count++;
339                 break;
340         }
341         V_route_cb.any_count++;
342         RTSOCK_UNLOCK();
343         soisconnected(so);
344         so->so_options |= SO_USELOOPBACK;
345         return 0;
346 }
347
348 static int
349 rts_bind(struct socket *so, struct sockaddr *nam, struct thread *td)
350 {
351
352         return (raw_usrreqs.pru_bind(so, nam, td)); /* xxx just EINVAL */
353 }
354
355 static int
356 rts_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
357 {
358
359         return (raw_usrreqs.pru_connect(so, nam, td)); /* XXX just EINVAL */
360 }
361
362 /* pru_connect2 is EOPNOTSUPP */
363 /* pru_control is EOPNOTSUPP */
364
365 static void
366 rts_detach(struct socket *so)
367 {
368         struct rawcb *rp = sotorawcb(so);
369
370         KASSERT(rp != NULL, ("rts_detach: rp == NULL"));
371
372         RTSOCK_LOCK();
373         switch(rp->rcb_proto.sp_protocol) {
374         case AF_INET:
375                 V_route_cb.ip_count--;
376                 break;
377         case AF_INET6:
378                 V_route_cb.ip6_count--;
379                 break;
380         }
381         V_route_cb.any_count--;
382         RTSOCK_UNLOCK();
383         raw_usrreqs.pru_detach(so);
384 }
385
386 static int
387 rts_disconnect(struct socket *so)
388 {
389
390         return (raw_usrreqs.pru_disconnect(so));
391 }
392
393 /* pru_listen is EOPNOTSUPP */
394
395 static int
396 rts_peeraddr(struct socket *so, struct sockaddr **nam)
397 {
398
399         return (raw_usrreqs.pru_peeraddr(so, nam));
400 }
401
402 /* pru_rcvd is EOPNOTSUPP */
403 /* pru_rcvoob is EOPNOTSUPP */
404
405 static int
406 rts_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *nam,
407          struct mbuf *control, struct thread *td)
408 {
409
410         return (raw_usrreqs.pru_send(so, flags, m, nam, control, td));
411 }
412
413 /* pru_sense is null */
414
415 static int
416 rts_shutdown(struct socket *so)
417 {
418
419         return (raw_usrreqs.pru_shutdown(so));
420 }
421
422 static int
423 rts_sockaddr(struct socket *so, struct sockaddr **nam)
424 {
425
426         return (raw_usrreqs.pru_sockaddr(so, nam));
427 }
428
429 static struct pr_usrreqs route_usrreqs = {
430         .pru_abort =            rts_abort,
431         .pru_attach =           rts_attach,
432         .pru_bind =             rts_bind,
433         .pru_connect =          rts_connect,
434         .pru_detach =           rts_detach,
435         .pru_disconnect =       rts_disconnect,
436         .pru_peeraddr =         rts_peeraddr,
437         .pru_send =             rts_send,
438         .pru_shutdown =         rts_shutdown,
439         .pru_sockaddr =         rts_sockaddr,
440         .pru_close =            rts_close,
441 };
442
443 #ifndef _SOCKADDR_UNION_DEFINED
444 #define _SOCKADDR_UNION_DEFINED
445 /*
446  * The union of all possible address formats we handle.
447  */
448 union sockaddr_union {
449         struct sockaddr         sa;
450         struct sockaddr_in      sin;
451         struct sockaddr_in6     sin6;
452 };
453 #endif /* _SOCKADDR_UNION_DEFINED */
454
455 static int
456 rtm_get_jailed(struct rt_addrinfo *info, struct ifnet *ifp,
457     struct nhop_object *nh, union sockaddr_union *saun, struct ucred *cred)
458 {
459 #if defined(INET) || defined(INET6)
460         struct epoch_tracker et;
461 #endif
462
463         /* First, see if the returned address is part of the jail. */
464         if (prison_if(cred, nh->nh_ifa->ifa_addr) == 0) {
465                 info->rti_info[RTAX_IFA] = nh->nh_ifa->ifa_addr;
466                 return (0);
467         }
468
469         switch (info->rti_info[RTAX_DST]->sa_family) {
470 #ifdef INET
471         case AF_INET:
472         {
473                 struct in_addr ia;
474                 struct ifaddr *ifa;
475                 int found;
476
477                 found = 0;
478                 /*
479                  * Try to find an address on the given outgoing interface
480                  * that belongs to the jail.
481                  */
482                 NET_EPOCH_ENTER(et);
483                 CK_STAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
484                         struct sockaddr *sa;
485                         sa = ifa->ifa_addr;
486                         if (sa->sa_family != AF_INET)
487                                 continue;
488                         ia = ((struct sockaddr_in *)sa)->sin_addr;
489                         if (prison_check_ip4(cred, &ia) == 0) {
490                                 found = 1;
491                                 break;
492                         }
493                 }
494                 NET_EPOCH_EXIT(et);
495                 if (!found) {
496                         /*
497                          * As a last resort return the 'default' jail address.
498                          */
499                         ia = ((struct sockaddr_in *)nh->nh_ifa->ifa_addr)->
500                             sin_addr;
501                         if (prison_get_ip4(cred, &ia) != 0)
502                                 return (ESRCH);
503                 }
504                 bzero(&saun->sin, sizeof(struct sockaddr_in));
505                 saun->sin.sin_len = sizeof(struct sockaddr_in);
506                 saun->sin.sin_family = AF_INET;
507                 saun->sin.sin_addr.s_addr = ia.s_addr;
508                 info->rti_info[RTAX_IFA] = (struct sockaddr *)&saun->sin;
509                 break;
510         }
511 #endif
512 #ifdef INET6
513         case AF_INET6:
514         {
515                 struct in6_addr ia6;
516                 struct ifaddr *ifa;
517                 int found;
518
519                 found = 0;
520                 /*
521                  * Try to find an address on the given outgoing interface
522                  * that belongs to the jail.
523                  */
524                 NET_EPOCH_ENTER(et);
525                 CK_STAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
526                         struct sockaddr *sa;
527                         sa = ifa->ifa_addr;
528                         if (sa->sa_family != AF_INET6)
529                                 continue;
530                         bcopy(&((struct sockaddr_in6 *)sa)->sin6_addr,
531                             &ia6, sizeof(struct in6_addr));
532                         if (prison_check_ip6(cred, &ia6) == 0) {
533                                 found = 1;
534                                 break;
535                         }
536                 }
537                 NET_EPOCH_EXIT(et);
538                 if (!found) {
539                         /*
540                          * As a last resort return the 'default' jail address.
541                          */
542                         ia6 = ((struct sockaddr_in6 *)nh->nh_ifa->ifa_addr)->
543                             sin6_addr;
544                         if (prison_get_ip6(cred, &ia6) != 0)
545                                 return (ESRCH);
546                 }
547                 bzero(&saun->sin6, sizeof(struct sockaddr_in6));
548                 saun->sin6.sin6_len = sizeof(struct sockaddr_in6);
549                 saun->sin6.sin6_family = AF_INET6;
550                 bcopy(&ia6, &saun->sin6.sin6_addr, sizeof(struct in6_addr));
551                 if (sa6_recoverscope(&saun->sin6) != 0)
552                         return (ESRCH);
553                 info->rti_info[RTAX_IFA] = (struct sockaddr *)&saun->sin6;
554                 break;
555         }
556 #endif
557         default:
558                 return (ESRCH);
559         }
560         return (0);
561 }
562
563 /*
564  * Fills in @info based on userland-provided @rtm message.
565  *
566  * Returns 0 on success.
567  */
568 static int
569 fill_addrinfo(struct rt_msghdr *rtm, int len, u_int fibnum, struct rt_addrinfo *info)
570 {
571         int error;
572         sa_family_t saf;
573
574         rtm->rtm_pid = curproc->p_pid;
575         info->rti_addrs = rtm->rtm_addrs;
576
577         info->rti_mflags = rtm->rtm_inits;
578         info->rti_rmx = &rtm->rtm_rmx;
579
580         /*
581          * rt_xaddrs() performs s6_addr[2] := sin6_scope_id for AF_INET6
582          * link-local address because rtrequest requires addresses with
583          * embedded scope id.
584          */
585         if (rt_xaddrs((caddr_t)(rtm + 1), len + (caddr_t)rtm, info))
586                 return (EINVAL);
587
588         if (rtm->rtm_flags & RTF_RNH_LOCKED)
589                 return (EINVAL);
590         info->rti_flags = rtm->rtm_flags;
591         if (info->rti_info[RTAX_DST] == NULL ||
592             info->rti_info[RTAX_DST]->sa_family >= AF_MAX ||
593             (info->rti_info[RTAX_GATEWAY] != NULL &&
594              info->rti_info[RTAX_GATEWAY]->sa_family >= AF_MAX))
595                 return (EINVAL);
596         saf = info->rti_info[RTAX_DST]->sa_family;
597         /*
598          * Verify that the caller has the appropriate privilege; RTM_GET
599          * is the only operation the non-superuser is allowed.
600          */
601         if (rtm->rtm_type != RTM_GET) {
602                 error = priv_check(curthread, PRIV_NET_ROUTE);
603                 if (error != 0)
604                         return (error);
605         }
606
607         /*
608          * The given gateway address may be an interface address.
609          * For example, issuing a "route change" command on a route
610          * entry that was created from a tunnel, and the gateway
611          * address given is the local end point. In this case the 
612          * RTF_GATEWAY flag must be cleared or the destination will
613          * not be reachable even though there is no error message.
614          */
615         if (info->rti_info[RTAX_GATEWAY] != NULL &&
616             info->rti_info[RTAX_GATEWAY]->sa_family != AF_LINK) {
617                 struct rt_addrinfo ginfo;
618                 struct sockaddr *gdst;
619                 struct sockaddr_storage ss;
620
621                 bzero(&ginfo, sizeof(ginfo));
622                 bzero(&ss, sizeof(ss));
623                 ss.ss_len = sizeof(ss);
624
625                 ginfo.rti_info[RTAX_GATEWAY] = (struct sockaddr *)&ss;
626                 gdst = info->rti_info[RTAX_GATEWAY];
627
628                 /* 
629                  * A host route through the loopback interface is 
630                  * installed for each interface adddress. In pre 8.0
631                  * releases the interface address of a PPP link type
632                  * is not reachable locally. This behavior is fixed as 
633                  * part of the new L2/L3 redesign and rewrite work. The
634                  * signature of this interface address route is the
635                  * AF_LINK sa_family type of the gateway, and the
636                  * rt_ifp has the IFF_LOOPBACK flag set.
637                  */
638                 if (rib_lookup_info(fibnum, gdst, NHR_REF, 0, &ginfo) == 0) {
639                         if (ss.ss_family == AF_LINK &&
640                             ginfo.rti_ifp->if_flags & IFF_LOOPBACK) {
641                                 info->rti_flags &= ~RTF_GATEWAY;
642                                 info->rti_flags |= RTF_GWFLAG_COMPAT;
643                         }
644                         rib_free_info(&ginfo);
645                 }
646         }
647
648         return (0);
649 }
650
651 /*
652  * Handles RTM_GET message from routing socket, returning matching rt.
653  *
654  * Returns:
655  * 0 on success, with locked and referenced matching rt in @rt_nrt
656  * errno of failure
657  */
658 static int
659 handle_rtm_get(struct rt_addrinfo *info, u_int fibnum,
660     struct rt_msghdr *rtm, struct rib_cmd_info *rc)
661 {
662         RIB_RLOCK_TRACKER;
663         struct rib_head *rnh;
664         sa_family_t saf;
665
666         saf = info->rti_info[RTAX_DST]->sa_family;
667
668         rnh = rt_tables_get_rnh(fibnum, saf);
669         if (rnh == NULL)
670                 return (EAFNOSUPPORT);
671
672         RIB_RLOCK(rnh);
673
674         if (info->rti_info[RTAX_NETMASK] == NULL) {
675                 /*
676                  * Provide longest prefix match for
677                  * address lookup (no mask).
678                  * 'route -n get addr'
679                  */
680                 rc->rc_rt = (struct rtentry *) rnh->rnh_matchaddr(
681                     info->rti_info[RTAX_DST], &rnh->head);
682         } else
683                 rc->rc_rt = (struct rtentry *) rnh->rnh_lookup(
684                     info->rti_info[RTAX_DST],
685                     info->rti_info[RTAX_NETMASK], &rnh->head);
686
687         if (rc->rc_rt == NULL) {
688                 RIB_RUNLOCK(rnh);
689                 return (ESRCH);
690         }
691 #ifdef RADIX_MPATH
692         /*
693          * for RTM_GET, gate is optional even with multipath.
694          * if gate == NULL the first match is returned.
695          * (no need to call rt_mpath_matchgate if gate == NULL)
696          */
697         if (rt_mpath_capable(rnh) && info->rti_info[RTAX_GATEWAY]) {
698                 rc->rc_rt = rt_mpath_matchgate(rc->rc_rt,
699                     info->rti_info[RTAX_GATEWAY]);
700                 if (rc->rc_rt == NULL) {
701                         RIB_RUNLOCK(rnh);
702                         return (ESRCH);
703                 }
704         }
705 #endif
706         /*
707          * If performing proxied L2 entry insertion, and
708          * the actual PPP host entry is found, perform
709          * another search to retrieve the prefix route of
710          * the local end point of the PPP link.
711          * TODO: move this logic to userland.
712          */
713         if (rtm->rtm_flags & RTF_ANNOUNCE) {
714                 struct sockaddr laddr;
715                 struct nhop_object *nh;
716
717                 nh = rc->rc_rt->rt_nhop;
718                 if (nh->nh_ifp != NULL &&
719                     nh->nh_ifp->if_type == IFT_PROPVIRTUAL) {
720                         struct ifaddr *ifa;
721
722                         ifa = ifa_ifwithnet(info->rti_info[RTAX_DST], 1,
723                                         RT_ALL_FIBS);
724                         if (ifa != NULL)
725                                 rt_maskedcopy(ifa->ifa_addr,
726                                               &laddr,
727                                               ifa->ifa_netmask);
728                 } else
729                         rt_maskedcopy(nh->nh_ifa->ifa_addr,
730                                       &laddr,
731                                       nh->nh_ifa->ifa_netmask);
732                 /* 
733                  * refactor rt and no lock operation necessary
734                  */
735                 rc->rc_rt = (struct rtentry *)rnh->rnh_matchaddr(&laddr,
736                     &rnh->head);
737                 if (rc->rc_rt == NULL) {
738                         RIB_RUNLOCK(rnh);
739                         return (ESRCH);
740                 }
741         }
742         rc->rc_nh_new = rc->rc_rt->rt_nhop;
743         RIB_RUNLOCK(rnh);
744
745         return (0);
746 }
747
748 /*
749  * Update sockaddrs, flags, etc in @prtm based on @rc data.
750  * rtm can be reallocated.
751  *
752  * Returns 0 on success, along with pointer to (potentially reallocated)
753  *  rtm.
754  *
755  */
756 static int
757 update_rtm_from_rc(struct rt_addrinfo *info, struct rt_msghdr **prtm,
758     int alloc_len, struct rib_cmd_info *rc, struct nhop_object *nh)
759 {
760         struct sockaddr_storage netmask_ss;
761         struct walkarg w;
762         union sockaddr_union saun;
763         struct rt_msghdr *rtm, *orig_rtm = NULL;
764         struct ifnet *ifp;
765         int error, len;
766
767         rtm = *prtm;
768
769         info->rti_info[RTAX_DST] = rt_key(rc->rc_rt);
770         info->rti_info[RTAX_GATEWAY] = &nh->gw_sa;
771         info->rti_info[RTAX_NETMASK] = rtsock_fix_netmask(rt_key(rc->rc_rt),
772             rt_mask(rc->rc_rt), &netmask_ss);
773         info->rti_info[RTAX_GENMASK] = 0;
774         ifp = nh->nh_ifp;
775         if (rtm->rtm_addrs & (RTA_IFP | RTA_IFA)) {
776                 if (ifp) {
777                         info->rti_info[RTAX_IFP] =
778                             ifp->if_addr->ifa_addr;
779                         error = rtm_get_jailed(info, ifp, nh,
780                             &saun, curthread->td_ucred);
781                         if (error != 0)
782                                 return (error);
783                         if (ifp->if_flags & IFF_POINTOPOINT)
784                                 info->rti_info[RTAX_BRD] =
785                                     nh->nh_ifa->ifa_dstaddr;
786                         rtm->rtm_index = ifp->if_index;
787                 } else {
788                         info->rti_info[RTAX_IFP] = NULL;
789                         info->rti_info[RTAX_IFA] = NULL;
790                 }
791         } else if (ifp != NULL)
792                 rtm->rtm_index = ifp->if_index;
793
794         /* Check if we need to realloc storage */
795         rtsock_msg_buffer(rtm->rtm_type, info, NULL, &len);
796         if (len > alloc_len) {
797                 struct rt_msghdr *tmp_rtm;
798
799                 tmp_rtm = malloc(len, M_TEMP, M_NOWAIT);
800                 if (tmp_rtm == NULL)
801                         return (ENOBUFS);
802                 bcopy(rtm, tmp_rtm, rtm->rtm_msglen);
803                 orig_rtm = rtm;
804                 rtm = tmp_rtm;
805                 alloc_len = len;
806
807                 /*
808                  * Delay freeing original rtm as info contains
809                  * data referencing it.
810                  */
811         }
812
813         w.w_tmem = (caddr_t)rtm;
814         w.w_tmemsize = alloc_len;
815         rtsock_msg_buffer(rtm->rtm_type, info, &w, &len);
816
817         rtm->rtm_flags = rc->rc_rt->rte_flags | nhop_get_rtflags(nh);
818         if (rtm->rtm_flags & RTF_GWFLAG_COMPAT)
819                 rtm->rtm_flags = RTF_GATEWAY | 
820                         (rtm->rtm_flags & ~RTF_GWFLAG_COMPAT);
821         rt_getmetrics(rc->rc_rt, nh, &rtm->rtm_rmx);
822         rtm->rtm_rmx.rmx_weight = rc->rc_nh_weight;
823         rtm->rtm_addrs = info->rti_addrs;
824
825         if (orig_rtm != NULL)
826                 free(orig_rtm, M_TEMP);
827         *prtm = rtm;
828
829         return (0);
830 }
831
832 /*ARGSUSED*/
833 static int
834 route_output(struct mbuf *m, struct socket *so, ...)
835 {
836         struct rt_msghdr *rtm = NULL;
837         struct rtentry *rt = NULL;
838         struct rt_addrinfo info;
839         struct epoch_tracker et;
840 #ifdef INET6
841         struct sockaddr_storage ss;
842         struct sockaddr_in6 *sin6;
843         int i, rti_need_deembed = 0;
844 #endif
845         int alloc_len = 0, len, error = 0, fibnum;
846         sa_family_t saf = AF_UNSPEC;
847         struct walkarg w;
848         struct rib_cmd_info rc;
849         struct nhop_object *nh;
850
851         fibnum = so->so_fibnum;
852
853 #define senderr(e) { error = e; goto flush;}
854         if (m == NULL || ((m->m_len < sizeof(long)) &&
855                        (m = m_pullup(m, sizeof(long))) == NULL))
856                 return (ENOBUFS);
857         if ((m->m_flags & M_PKTHDR) == 0)
858                 panic("route_output");
859         NET_EPOCH_ENTER(et);
860         len = m->m_pkthdr.len;
861         if (len < sizeof(*rtm) ||
862             len != mtod(m, struct rt_msghdr *)->rtm_msglen)
863                 senderr(EINVAL);
864
865         /*
866          * Most of current messages are in range 200-240 bytes,
867          * minimize possible re-allocation on reply using larger size
868          * buffer aligned on 1k boundaty.
869          */
870         alloc_len = roundup2(len, 1024);
871         if ((rtm = malloc(alloc_len, M_TEMP, M_NOWAIT)) == NULL)
872                 senderr(ENOBUFS);
873
874         m_copydata(m, 0, len, (caddr_t)rtm);
875         bzero(&info, sizeof(info));
876         bzero(&w, sizeof(w));
877         nh = NULL;
878
879         if (rtm->rtm_version != RTM_VERSION) {
880                 /* Do not touch message since format is unknown */
881                 free(rtm, M_TEMP);
882                 rtm = NULL;
883                 senderr(EPROTONOSUPPORT);
884         }
885
886         /*
887          * Starting from here, it is possible
888          * to alter original message and insert
889          * caller PID and error value.
890          */
891
892         if ((error = fill_addrinfo(rtm, len, fibnum, &info)) != 0) {
893                 senderr(error);
894         }
895
896         saf = info.rti_info[RTAX_DST]->sa_family;
897
898         /* support for new ARP code */
899         if (rtm->rtm_flags & RTF_LLDATA) {
900                 error = lla_rt_output(rtm, &info);
901 #ifdef INET6
902                 if (error == 0)
903                         rti_need_deembed = 1;
904 #endif
905                 goto flush;
906         }
907
908         switch (rtm->rtm_type) {
909         case RTM_ADD:
910         case RTM_CHANGE:
911                 if (rtm->rtm_type == RTM_ADD) {
912                         if (info.rti_info[RTAX_GATEWAY] == NULL)
913                                 senderr(EINVAL);
914                 }
915                 error = rib_action(fibnum, rtm->rtm_type, &info, &rc);
916                 if (error == 0) {
917 #ifdef INET6
918                         rti_need_deembed = 1;
919 #endif
920                         nh = rc.rc_nh_new;
921                         rtm->rtm_index = nh->nh_ifp->if_index;
922                 }
923                 break;
924
925         case RTM_DELETE:
926                 error = rib_action(fibnum, RTM_DELETE, &info, &rc);
927                 if (error == 0) {
928                         nh = rc.rc_nh_old;
929                         goto report;
930                 }
931 #ifdef INET6
932                 /* rt_msg2() will not be used when RTM_DELETE fails. */
933                 rti_need_deembed = 1;
934 #endif
935                 break;
936
937         case RTM_GET:
938                 error = handle_rtm_get(&info, fibnum, rtm, &rc);
939                 if (error != 0)
940                         senderr(error);
941                 nh = rc.rc_nh_new;
942
943 report:
944                 if (!can_export_rte(curthread->td_ucred, rc.rc_rt)) {
945                         senderr(ESRCH);
946                 }
947
948                 error = update_rtm_from_rc(&info, &rtm, alloc_len, &rc, nh);
949                 /*
950                  * Note that some sockaddr pointers may have changed to
951                  * point to memory outsize @rtm. Some may be pointing
952                  * to the on-stack variables.
953                  * Given that, any pointer in @info CANNOT BE USED.
954                  */
955
956                 /*
957                  * scopeid deembedding has been performed while
958                  * writing updated rtm in rtsock_msg_buffer().
959                  * With that in mind, skip deembedding procedure below.
960                  */
961 #ifdef INET6
962                 rti_need_deembed = 0;
963 #endif
964                 if (error != 0)
965                         senderr(error);
966                 break;
967
968         default:
969                 senderr(EOPNOTSUPP);
970         }
971
972 flush:
973         NET_EPOCH_EXIT(et);
974         rt = NULL;
975
976 #ifdef INET6
977         if (rtm != NULL) {
978                 if (rti_need_deembed) {
979                         /* sin6_scope_id is recovered before sending rtm. */
980                         sin6 = (struct sockaddr_in6 *)&ss;
981                         for (i = 0; i < RTAX_MAX; i++) {
982                                 if (info.rti_info[i] == NULL)
983                                         continue;
984                                 if (info.rti_info[i]->sa_family != AF_INET6)
985                                         continue;
986                                 bcopy(info.rti_info[i], sin6, sizeof(*sin6));
987                                 if (sa6_recoverscope(sin6) == 0)
988                                         bcopy(sin6, info.rti_info[i],
989                                                     sizeof(*sin6));
990                         }
991                 }
992         }
993 #endif
994         send_rtm_reply(so, rtm, m, saf, fibnum, error);
995
996         return (error);
997 }
998
999 /*
1000  * Sends the prepared reply message in @rtm to all rtsock clients.
1001  * Frees @m and @rtm.
1002  *
1003  */
1004 static void
1005 send_rtm_reply(struct socket *so, struct rt_msghdr *rtm, struct mbuf *m,
1006     sa_family_t saf, u_int fibnum, int rtm_errno)
1007 {
1008         struct rawcb *rp = NULL;
1009
1010         /*
1011          * Check to see if we don't want our own messages.
1012          */
1013         if ((so->so_options & SO_USELOOPBACK) == 0) {
1014                 if (V_route_cb.any_count <= 1) {
1015                         if (rtm != NULL)
1016                                 free(rtm, M_TEMP);
1017                         m_freem(m);
1018                         return;
1019                 }
1020                 /* There is another listener, so construct message */
1021                 rp = sotorawcb(so);
1022         }
1023
1024         if (rtm != NULL) {
1025                 if (rtm_errno!= 0)
1026                         rtm->rtm_errno = rtm_errno;
1027                 else
1028                         rtm->rtm_flags |= RTF_DONE;
1029
1030                 m_copyback(m, 0, rtm->rtm_msglen, (caddr_t)rtm);
1031                 if (m->m_pkthdr.len < rtm->rtm_msglen) {
1032                         m_freem(m);
1033                         m = NULL;
1034                 } else if (m->m_pkthdr.len > rtm->rtm_msglen)
1035                         m_adj(m, rtm->rtm_msglen - m->m_pkthdr.len);
1036
1037                 free(rtm, M_TEMP);
1038         }
1039         if (m != NULL) {
1040                 M_SETFIB(m, fibnum);
1041                 m->m_flags |= RTS_FILTER_FIB;
1042                 if (rp) {
1043                         /*
1044                          * XXX insure we don't get a copy by
1045                          * invalidating our protocol
1046                          */
1047                         unsigned short family = rp->rcb_proto.sp_family;
1048                         rp->rcb_proto.sp_family = 0;
1049                         rt_dispatch(m, saf);
1050                         rp->rcb_proto.sp_family = family;
1051                 } else
1052                         rt_dispatch(m, saf);
1053         }
1054 }
1055
1056
1057 static void
1058 rt_getmetrics(const struct rtentry *rt, const struct nhop_object *nh,
1059     struct rt_metrics *out)
1060 {
1061
1062         bzero(out, sizeof(*out));
1063         out->rmx_mtu = nh->nh_mtu;
1064         out->rmx_weight = rt->rt_weight;
1065         out->rmx_nhidx = nhop_get_idx(nh);
1066         /* Kernel -> userland timebase conversion. */
1067         out->rmx_expire = rt->rt_expire ?
1068             rt->rt_expire - time_uptime + time_second : 0;
1069 }
1070
1071 /*
1072  * Extract the addresses of the passed sockaddrs.
1073  * Do a little sanity checking so as to avoid bad memory references.
1074  * This data is derived straight from userland.
1075  */
1076 static int
1077 rt_xaddrs(caddr_t cp, caddr_t cplim, struct rt_addrinfo *rtinfo)
1078 {
1079         struct sockaddr *sa;
1080         int i;
1081
1082         for (i = 0; i < RTAX_MAX && cp < cplim; i++) {
1083                 if ((rtinfo->rti_addrs & (1 << i)) == 0)
1084                         continue;
1085                 sa = (struct sockaddr *)cp;
1086                 /*
1087                  * It won't fit.
1088                  */
1089                 if (cp + sa->sa_len > cplim)
1090                         return (EINVAL);
1091                 /*
1092                  * there are no more.. quit now
1093                  * If there are more bits, they are in error.
1094                  * I've seen this. route(1) can evidently generate these. 
1095                  * This causes kernel to core dump.
1096                  * for compatibility, If we see this, point to a safe address.
1097                  */
1098                 if (sa->sa_len == 0) {
1099                         rtinfo->rti_info[i] = &sa_zero;
1100                         return (0); /* should be EINVAL but for compat */
1101                 }
1102                 /* accept it */
1103 #ifdef INET6
1104                 if (sa->sa_family == AF_INET6)
1105                         sa6_embedscope((struct sockaddr_in6 *)sa,
1106                             V_ip6_use_defzone);
1107 #endif
1108                 rtinfo->rti_info[i] = sa;
1109                 cp += SA_SIZE(sa);
1110         }
1111         return (0);
1112 }
1113
1114 /*
1115  * Fill in @dmask with valid netmask leaving original @smask
1116  * intact. Mostly used with radix netmasks.
1117  */
1118 struct sockaddr *
1119 rtsock_fix_netmask(const struct sockaddr *dst, const struct sockaddr *smask,
1120     struct sockaddr_storage *dmask)
1121 {
1122         if (dst == NULL || smask == NULL)
1123                 return (NULL);
1124
1125         memset(dmask, 0, dst->sa_len);
1126         memcpy(dmask, smask, smask->sa_len);
1127         dmask->ss_len = dst->sa_len;
1128         dmask->ss_family = dst->sa_family;
1129
1130         return ((struct sockaddr *)dmask);
1131 }
1132
1133 /*
1134  * Writes information related to @rtinfo object to newly-allocated mbuf.
1135  * Assumes MCLBYTES is enough to construct any message.
1136  * Used for OS notifications of vaious events (if/ifa announces,etc)
1137  *
1138  * Returns allocated mbuf or NULL on failure.
1139  */
1140 static struct mbuf *
1141 rtsock_msg_mbuf(int type, struct rt_addrinfo *rtinfo)
1142 {
1143         struct rt_msghdr *rtm;
1144         struct mbuf *m;
1145         int i;
1146         struct sockaddr *sa;
1147 #ifdef INET6
1148         struct sockaddr_storage ss;
1149         struct sockaddr_in6 *sin6;
1150 #endif
1151         int len, dlen;
1152
1153         switch (type) {
1154
1155         case RTM_DELADDR:
1156         case RTM_NEWADDR:
1157                 len = sizeof(struct ifa_msghdr);
1158                 break;
1159
1160         case RTM_DELMADDR:
1161         case RTM_NEWMADDR:
1162                 len = sizeof(struct ifma_msghdr);
1163                 break;
1164
1165         case RTM_IFINFO:
1166                 len = sizeof(struct if_msghdr);
1167                 break;
1168
1169         case RTM_IFANNOUNCE:
1170         case RTM_IEEE80211:
1171                 len = sizeof(struct if_announcemsghdr);
1172                 break;
1173
1174         default:
1175                 len = sizeof(struct rt_msghdr);
1176         }
1177
1178         /* XXXGL: can we use MJUMPAGESIZE cluster here? */
1179         KASSERT(len <= MCLBYTES, ("%s: message too big", __func__));
1180         if (len > MHLEN)
1181                 m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
1182         else
1183                 m = m_gethdr(M_NOWAIT, MT_DATA);
1184         if (m == NULL)
1185                 return (m);
1186
1187         m->m_pkthdr.len = m->m_len = len;
1188         rtm = mtod(m, struct rt_msghdr *);
1189         bzero((caddr_t)rtm, len);
1190         for (i = 0; i < RTAX_MAX; i++) {
1191                 if ((sa = rtinfo->rti_info[i]) == NULL)
1192                         continue;
1193                 rtinfo->rti_addrs |= (1 << i);
1194                 dlen = SA_SIZE(sa);
1195 #ifdef INET6
1196                 if (sa->sa_family == AF_INET6) {
1197                         sin6 = (struct sockaddr_in6 *)&ss;
1198                         bcopy(sa, sin6, sizeof(*sin6));
1199                         if (sa6_recoverscope(sin6) == 0)
1200                                 sa = (struct sockaddr *)sin6;
1201                 }
1202 #endif
1203                 m_copyback(m, len, dlen, (caddr_t)sa);
1204                 len += dlen;
1205         }
1206         if (m->m_pkthdr.len != len) {
1207                 m_freem(m);
1208                 return (NULL);
1209         }
1210         rtm->rtm_msglen = len;
1211         rtm->rtm_version = RTM_VERSION;
1212         rtm->rtm_type = type;
1213         return (m);
1214 }
1215
1216 /*
1217  * Writes information related to @rtinfo object to preallocated buffer.
1218  * Stores needed size in @plen. If @w is NULL, calculates size without
1219  * writing.
1220  * Used for sysctl dumps and rtsock answers (RTM_DEL/RTM_GET) generation.
1221  *
1222  * Returns 0 on success.
1223  *
1224  */
1225 static int
1226 rtsock_msg_buffer(int type, struct rt_addrinfo *rtinfo, struct walkarg *w, int *plen)
1227 {
1228         int i;
1229         int len, buflen = 0, dlen;
1230         caddr_t cp = NULL;
1231         struct rt_msghdr *rtm = NULL;
1232 #ifdef INET6
1233         struct sockaddr_storage ss;
1234         struct sockaddr_in6 *sin6;
1235 #endif
1236 #ifdef COMPAT_FREEBSD32
1237         bool compat32 = false;
1238 #endif
1239
1240         switch (type) {
1241
1242         case RTM_DELADDR:
1243         case RTM_NEWADDR:
1244                 if (w != NULL && w->w_op == NET_RT_IFLISTL) {
1245 #ifdef COMPAT_FREEBSD32
1246                         if (w->w_req->flags & SCTL_MASK32) {
1247                                 len = sizeof(struct ifa_msghdrl32);
1248                                 compat32 = true;
1249                         } else
1250 #endif
1251                                 len = sizeof(struct ifa_msghdrl);
1252                 } else
1253                         len = sizeof(struct ifa_msghdr);
1254                 break;
1255
1256         case RTM_IFINFO:
1257 #ifdef COMPAT_FREEBSD32
1258                 if (w != NULL && w->w_req->flags & SCTL_MASK32) {
1259                         if (w->w_op == NET_RT_IFLISTL)
1260                                 len = sizeof(struct if_msghdrl32);
1261                         else
1262                                 len = sizeof(struct if_msghdr32);
1263                         compat32 = true;
1264                         break;
1265                 }
1266 #endif
1267                 if (w != NULL && w->w_op == NET_RT_IFLISTL)
1268                         len = sizeof(struct if_msghdrl);
1269                 else
1270                         len = sizeof(struct if_msghdr);
1271                 break;
1272
1273         case RTM_NEWMADDR:
1274                 len = sizeof(struct ifma_msghdr);
1275                 break;
1276
1277         default:
1278                 len = sizeof(struct rt_msghdr);
1279         }
1280
1281         if (w != NULL) {
1282                 rtm = (struct rt_msghdr *)w->w_tmem;
1283                 buflen = w->w_tmemsize - len;
1284                 cp = (caddr_t)w->w_tmem + len;
1285         }
1286
1287         rtinfo->rti_addrs = 0;
1288         for (i = 0; i < RTAX_MAX; i++) {
1289                 struct sockaddr *sa;
1290
1291                 if ((sa = rtinfo->rti_info[i]) == NULL)
1292                         continue;
1293                 rtinfo->rti_addrs |= (1 << i);
1294 #ifdef COMPAT_FREEBSD32
1295                 if (compat32)
1296                         dlen = SA_SIZE32(sa);
1297                 else
1298 #endif
1299                         dlen = SA_SIZE(sa);
1300                 if (cp != NULL && buflen >= dlen) {
1301 #ifdef INET6
1302                         if (sa->sa_family == AF_INET6) {
1303                                 sin6 = (struct sockaddr_in6 *)&ss;
1304                                 bcopy(sa, sin6, sizeof(*sin6));
1305                                 if (sa6_recoverscope(sin6) == 0)
1306                                         sa = (struct sockaddr *)sin6;
1307                         }
1308 #endif
1309                         bcopy((caddr_t)sa, cp, (unsigned)dlen);
1310                         cp += dlen;
1311                         buflen -= dlen;
1312                 } else if (cp != NULL) {
1313                         /*
1314                          * Buffer too small. Count needed size
1315                          * and return with error.
1316                          */
1317                         cp = NULL;
1318                 }
1319
1320                 len += dlen;
1321         }
1322
1323         if (cp != NULL) {
1324                 dlen = ALIGN(len) - len;
1325                 if (buflen < dlen)
1326                         cp = NULL;
1327                 else {
1328                         bzero(cp, dlen);
1329                         cp += dlen;
1330                         buflen -= dlen;
1331                 }
1332         }
1333         len = ALIGN(len);
1334
1335         if (cp != NULL) {
1336                 /* fill header iff buffer is large enough */
1337                 rtm->rtm_version = RTM_VERSION;
1338                 rtm->rtm_type = type;
1339                 rtm->rtm_msglen = len;
1340         }
1341
1342         *plen = len;
1343
1344         if (w != NULL && cp == NULL)
1345                 return (ENOBUFS);
1346
1347         return (0);
1348 }
1349
1350 /*
1351  * This routine is called to generate a message from the routing
1352  * socket indicating that a redirect has occurred, a routing lookup
1353  * has failed, or that a protocol has detected timeouts to a particular
1354  * destination.
1355  */
1356 void
1357 rt_missmsg_fib(int type, struct rt_addrinfo *rtinfo, int flags, int error,
1358     int fibnum)
1359 {
1360         struct rt_msghdr *rtm;
1361         struct mbuf *m;
1362         struct sockaddr *sa = rtinfo->rti_info[RTAX_DST];
1363
1364         if (V_route_cb.any_count == 0)
1365                 return;
1366         m = rtsock_msg_mbuf(type, rtinfo);
1367         if (m == NULL)
1368                 return;
1369
1370         if (fibnum != RT_ALL_FIBS) {
1371                 KASSERT(fibnum >= 0 && fibnum < rt_numfibs, ("%s: fibnum out "
1372                     "of range 0 <= %d < %d", __func__, fibnum, rt_numfibs));
1373                 M_SETFIB(m, fibnum);
1374                 m->m_flags |= RTS_FILTER_FIB;
1375         }
1376
1377         rtm = mtod(m, struct rt_msghdr *);
1378         rtm->rtm_flags = RTF_DONE | flags;
1379         rtm->rtm_errno = error;
1380         rtm->rtm_addrs = rtinfo->rti_addrs;
1381         rt_dispatch(m, sa ? sa->sa_family : AF_UNSPEC);
1382 }
1383
1384 void
1385 rt_missmsg(int type, struct rt_addrinfo *rtinfo, int flags, int error)
1386 {
1387
1388         rt_missmsg_fib(type, rtinfo, flags, error, RT_ALL_FIBS);
1389 }
1390
1391 /*
1392  * This routine is called to generate a message from the routing
1393  * socket indicating that the status of a network interface has changed.
1394  */
1395 void
1396 rt_ifmsg(struct ifnet *ifp)
1397 {
1398         struct if_msghdr *ifm;
1399         struct mbuf *m;
1400         struct rt_addrinfo info;
1401
1402         if (V_route_cb.any_count == 0)
1403                 return;
1404         bzero((caddr_t)&info, sizeof(info));
1405         m = rtsock_msg_mbuf(RTM_IFINFO, &info);
1406         if (m == NULL)
1407                 return;
1408         ifm = mtod(m, struct if_msghdr *);
1409         ifm->ifm_index = ifp->if_index;
1410         ifm->ifm_flags = ifp->if_flags | ifp->if_drv_flags;
1411         if_data_copy(ifp, &ifm->ifm_data);
1412         ifm->ifm_addrs = 0;
1413         rt_dispatch(m, AF_UNSPEC);
1414 }
1415
1416 /*
1417  * Announce interface address arrival/withdraw.
1418  * Please do not call directly, use rt_addrmsg().
1419  * Assume input data to be valid.
1420  * Returns 0 on success.
1421  */
1422 int
1423 rtsock_addrmsg(int cmd, struct ifaddr *ifa, int fibnum)
1424 {
1425         struct rt_addrinfo info;
1426         struct sockaddr *sa;
1427         int ncmd;
1428         struct mbuf *m;
1429         struct ifa_msghdr *ifam;
1430         struct ifnet *ifp = ifa->ifa_ifp;
1431         struct sockaddr_storage ss;
1432
1433         if (V_route_cb.any_count == 0)
1434                 return (0);
1435
1436         ncmd = cmd == RTM_ADD ? RTM_NEWADDR : RTM_DELADDR;
1437
1438         bzero((caddr_t)&info, sizeof(info));
1439         info.rti_info[RTAX_IFA] = sa = ifa->ifa_addr;
1440         info.rti_info[RTAX_IFP] = ifp->if_addr->ifa_addr;
1441         info.rti_info[RTAX_NETMASK] = rtsock_fix_netmask(
1442             info.rti_info[RTAX_IFA], ifa->ifa_netmask, &ss);
1443         info.rti_info[RTAX_BRD] = ifa->ifa_dstaddr;
1444         if ((m = rtsock_msg_mbuf(ncmd, &info)) == NULL)
1445                 return (ENOBUFS);
1446         ifam = mtod(m, struct ifa_msghdr *);
1447         ifam->ifam_index = ifp->if_index;
1448         ifam->ifam_metric = ifa->ifa_ifp->if_metric;
1449         ifam->ifam_flags = ifa->ifa_flags;
1450         ifam->ifam_addrs = info.rti_addrs;
1451
1452         if (fibnum != RT_ALL_FIBS) {
1453                 M_SETFIB(m, fibnum);
1454                 m->m_flags |= RTS_FILTER_FIB;
1455         }
1456
1457         rt_dispatch(m, sa ? sa->sa_family : AF_UNSPEC);
1458
1459         return (0);
1460 }
1461
1462 /*
1463  * Announce route addition/removal to rtsock based on @rt data.
1464  * Callers are advives to use rt_routemsg() instead of using this
1465  *  function directly.
1466  * Assume @rt data is consistent.
1467  *
1468  * Returns 0 on success.
1469  */
1470 int
1471 rtsock_routemsg(int cmd, struct rtentry *rt, struct ifnet *ifp, int rti_addrs,
1472     int fibnum)
1473 {
1474         struct sockaddr_storage ss;
1475         struct rt_addrinfo info;
1476         struct nhop_object *nh;
1477
1478         if (V_route_cb.any_count == 0)
1479                 return (0);
1480
1481         nh = rt->rt_nhop;
1482         bzero((caddr_t)&info, sizeof(info));
1483         info.rti_info[RTAX_DST] = rt_key(rt);
1484         info.rti_info[RTAX_NETMASK] = rtsock_fix_netmask(rt_key(rt), rt_mask(rt), &ss);
1485         info.rti_info[RTAX_GATEWAY] = &nh->gw_sa;
1486         info.rti_flags = rt->rte_flags | nhop_get_rtflags(nh);
1487         info.rti_ifp = ifp;
1488
1489         return (rtsock_routemsg_info(cmd, &info, fibnum));
1490 }
1491
1492 int
1493 rtsock_routemsg_info(int cmd, struct rt_addrinfo *info, int fibnum)
1494 {
1495         struct rt_msghdr *rtm;
1496         struct sockaddr *sa;
1497         struct mbuf *m;
1498
1499         if (V_route_cb.any_count == 0)
1500                 return (0);
1501
1502         if (info->rti_flags & RTF_HOST)
1503                 info->rti_info[RTAX_NETMASK] = NULL;
1504
1505         m = rtsock_msg_mbuf(cmd, info);
1506         if (m == NULL)
1507                 return (ENOBUFS);
1508
1509         if (fibnum != RT_ALL_FIBS) {
1510                 KASSERT(fibnum >= 0 && fibnum < rt_numfibs, ("%s: fibnum out "
1511                     "of range 0 <= %d < %d", __func__, fibnum, rt_numfibs));
1512                 M_SETFIB(m, fibnum);
1513                 m->m_flags |= RTS_FILTER_FIB;
1514         }
1515
1516         rtm = mtod(m, struct rt_msghdr *);
1517         rtm->rtm_addrs = info->rti_addrs;
1518         if (info->rti_ifp != NULL)
1519                 rtm->rtm_index = info->rti_ifp->if_index;
1520         /* Add RTF_DONE to indicate command 'completion' required by API */
1521         info->rti_flags |= RTF_DONE;
1522         /* Reported routes has to be up */
1523         if (cmd == RTM_ADD || cmd == RTM_CHANGE)
1524                 info->rti_flags |= RTF_UP;
1525         rtm->rtm_flags = info->rti_flags;
1526
1527         sa = info->rti_info[RTAX_DST];
1528         rt_dispatch(m, sa ? sa->sa_family : AF_UNSPEC);
1529
1530         return (0);
1531 }
1532
1533 /*
1534  * This is the analogue to the rt_newaddrmsg which performs the same
1535  * function but for multicast group memberhips.  This is easier since
1536  * there is no route state to worry about.
1537  */
1538 void
1539 rt_newmaddrmsg(int cmd, struct ifmultiaddr *ifma)
1540 {
1541         struct rt_addrinfo info;
1542         struct mbuf *m = NULL;
1543         struct ifnet *ifp = ifma->ifma_ifp;
1544         struct ifma_msghdr *ifmam;
1545
1546         if (V_route_cb.any_count == 0)
1547                 return;
1548
1549         bzero((caddr_t)&info, sizeof(info));
1550         info.rti_info[RTAX_IFA] = ifma->ifma_addr;
1551         if (ifp && ifp->if_addr)
1552                 info.rti_info[RTAX_IFP] = ifp->if_addr->ifa_addr;
1553         else
1554                 info.rti_info[RTAX_IFP] = NULL;
1555         /*
1556          * If a link-layer address is present, present it as a ``gateway''
1557          * (similarly to how ARP entries, e.g., are presented).
1558          */
1559         info.rti_info[RTAX_GATEWAY] = ifma->ifma_lladdr;
1560         m = rtsock_msg_mbuf(cmd, &info);
1561         if (m == NULL)
1562                 return;
1563         ifmam = mtod(m, struct ifma_msghdr *);
1564         KASSERT(ifp != NULL, ("%s: link-layer multicast address w/o ifp\n",
1565             __func__));
1566         ifmam->ifmam_index = ifp->if_index;
1567         ifmam->ifmam_addrs = info.rti_addrs;
1568         rt_dispatch(m, ifma->ifma_addr ? ifma->ifma_addr->sa_family : AF_UNSPEC);
1569 }
1570
1571 static struct mbuf *
1572 rt_makeifannouncemsg(struct ifnet *ifp, int type, int what,
1573         struct rt_addrinfo *info)
1574 {
1575         struct if_announcemsghdr *ifan;
1576         struct mbuf *m;
1577
1578         if (V_route_cb.any_count == 0)
1579                 return NULL;
1580         bzero((caddr_t)info, sizeof(*info));
1581         m = rtsock_msg_mbuf(type, info);
1582         if (m != NULL) {
1583                 ifan = mtod(m, struct if_announcemsghdr *);
1584                 ifan->ifan_index = ifp->if_index;
1585                 strlcpy(ifan->ifan_name, ifp->if_xname,
1586                         sizeof(ifan->ifan_name));
1587                 ifan->ifan_what = what;
1588         }
1589         return m;
1590 }
1591
1592 /*
1593  * This is called to generate routing socket messages indicating
1594  * IEEE80211 wireless events.
1595  * XXX we piggyback on the RTM_IFANNOUNCE msg format in a clumsy way.
1596  */
1597 void
1598 rt_ieee80211msg(struct ifnet *ifp, int what, void *data, size_t data_len)
1599 {
1600         struct mbuf *m;
1601         struct rt_addrinfo info;
1602
1603         m = rt_makeifannouncemsg(ifp, RTM_IEEE80211, what, &info);
1604         if (m != NULL) {
1605                 /*
1606                  * Append the ieee80211 data.  Try to stick it in the
1607                  * mbuf containing the ifannounce msg; otherwise allocate
1608                  * a new mbuf and append.
1609                  *
1610                  * NB: we assume m is a single mbuf.
1611                  */
1612                 if (data_len > M_TRAILINGSPACE(m)) {
1613                         struct mbuf *n = m_get(M_NOWAIT, MT_DATA);
1614                         if (n == NULL) {
1615                                 m_freem(m);
1616                                 return;
1617                         }
1618                         bcopy(data, mtod(n, void *), data_len);
1619                         n->m_len = data_len;
1620                         m->m_next = n;
1621                 } else if (data_len > 0) {
1622                         bcopy(data, mtod(m, u_int8_t *) + m->m_len, data_len);
1623                         m->m_len += data_len;
1624                 }
1625                 if (m->m_flags & M_PKTHDR)
1626                         m->m_pkthdr.len += data_len;
1627                 mtod(m, struct if_announcemsghdr *)->ifan_msglen += data_len;
1628                 rt_dispatch(m, AF_UNSPEC);
1629         }
1630 }
1631
1632 /*
1633  * This is called to generate routing socket messages indicating
1634  * network interface arrival and departure.
1635  */
1636 void
1637 rt_ifannouncemsg(struct ifnet *ifp, int what)
1638 {
1639         struct mbuf *m;
1640         struct rt_addrinfo info;
1641
1642         m = rt_makeifannouncemsg(ifp, RTM_IFANNOUNCE, what, &info);
1643         if (m != NULL)
1644                 rt_dispatch(m, AF_UNSPEC);
1645 }
1646
1647 static void
1648 rt_dispatch(struct mbuf *m, sa_family_t saf)
1649 {
1650         struct m_tag *tag;
1651
1652         /*
1653          * Preserve the family from the sockaddr, if any, in an m_tag for
1654          * use when injecting the mbuf into the routing socket buffer from
1655          * the netisr.
1656          */
1657         if (saf != AF_UNSPEC) {
1658                 tag = m_tag_get(PACKET_TAG_RTSOCKFAM, sizeof(unsigned short),
1659                     M_NOWAIT);
1660                 if (tag == NULL) {
1661                         m_freem(m);
1662                         return;
1663                 }
1664                 *(unsigned short *)(tag + 1) = saf;
1665                 m_tag_prepend(m, tag);
1666         }
1667 #ifdef VIMAGE
1668         if (V_loif)
1669                 m->m_pkthdr.rcvif = V_loif;
1670         else {
1671                 m_freem(m);
1672                 return;
1673         }
1674 #endif
1675         netisr_queue(NETISR_ROUTE, m);  /* mbuf is free'd on failure. */
1676 }
1677
1678 /*
1679  * Checks if rte can be exported v.r.t jails/vnets.
1680  *
1681  * Returns 1 if it can, 0 otherwise.
1682  */
1683 static int
1684 can_export_rte(struct ucred *td_ucred, const struct rtentry *rt)
1685 {
1686
1687         if ((rt->rte_flags & RTF_HOST) == 0
1688             ? jailed_without_vnet(td_ucred)
1689             : prison_if(td_ucred, rt_key_const(rt)) != 0)
1690                 return (0);
1691         return (1);
1692 }
1693
1694 /*
1695  * This is used in dumping the kernel table via sysctl().
1696  */
1697 static int
1698 sysctl_dumpentry(struct radix_node *rn, void *vw)
1699 {
1700         struct walkarg *w = vw;
1701         struct rtentry *rt = (struct rtentry *)rn;
1702         struct nhop_object *nh;
1703         int error = 0, size;
1704         struct rt_addrinfo info;
1705         struct sockaddr_storage ss;
1706
1707         NET_EPOCH_ASSERT();
1708
1709         if (w->w_op == NET_RT_FLAGS && !(rt->rte_flags & w->w_arg))
1710                 return 0;
1711         if (!can_export_rte(w->w_req->td->td_ucred, rt))
1712                 return (0);
1713         nh = rt->rt_nhop;
1714         bzero((caddr_t)&info, sizeof(info));
1715         info.rti_info[RTAX_DST] = rt_key(rt);
1716         info.rti_info[RTAX_GATEWAY] = &nh->gw_sa;
1717         info.rti_info[RTAX_NETMASK] = rtsock_fix_netmask(rt_key(rt),
1718             rt_mask(rt), &ss);
1719         info.rti_info[RTAX_GENMASK] = 0;
1720         if (nh->nh_ifp && !(nh->nh_ifp->if_flags & IFF_DYING)) {
1721                 info.rti_info[RTAX_IFP] = nh->nh_ifp->if_addr->ifa_addr;
1722                 info.rti_info[RTAX_IFA] = nh->nh_ifa->ifa_addr;
1723                 if (nh->nh_ifp->if_flags & IFF_POINTOPOINT)
1724                         info.rti_info[RTAX_BRD] = nh->nh_ifa->ifa_dstaddr;
1725         }
1726         if ((error = rtsock_msg_buffer(RTM_GET, &info, w, &size)) != 0)
1727                 return (error);
1728         if (w->w_req && w->w_tmem) {
1729                 struct rt_msghdr *rtm = (struct rt_msghdr *)w->w_tmem;
1730
1731                 bzero(&rtm->rtm_index,
1732                     sizeof(*rtm) - offsetof(struct rt_msghdr, rtm_index));
1733                 if (rt->rte_flags & RTF_GWFLAG_COMPAT)
1734                         rtm->rtm_flags = RTF_GATEWAY | 
1735                                 (rt->rte_flags & ~RTF_GWFLAG_COMPAT);
1736                 else
1737                         rtm->rtm_flags = rt->rte_flags;
1738                 rtm->rtm_flags |= nhop_get_rtflags(nh);
1739                 rt_getmetrics(rt, nh, &rtm->rtm_rmx);
1740                 rtm->rtm_index = nh->nh_ifp->if_index;
1741                 rtm->rtm_addrs = info.rti_addrs;
1742                 error = SYSCTL_OUT(w->w_req, (caddr_t)rtm, size);
1743                 return (error);
1744         }
1745         return (error);
1746 }
1747
1748 static int
1749 sysctl_iflist_ifml(struct ifnet *ifp, const struct if_data *src_ifd,
1750     struct rt_addrinfo *info, struct walkarg *w, int len)
1751 {
1752         struct if_msghdrl *ifm;
1753         struct if_data *ifd;
1754
1755         ifm = (struct if_msghdrl *)w->w_tmem;
1756
1757 #ifdef COMPAT_FREEBSD32
1758         if (w->w_req->flags & SCTL_MASK32) {
1759                 struct if_msghdrl32 *ifm32;
1760
1761                 ifm32 = (struct if_msghdrl32 *)ifm;
1762                 ifm32->ifm_addrs = info->rti_addrs;
1763                 ifm32->ifm_flags = ifp->if_flags | ifp->if_drv_flags;
1764                 ifm32->ifm_index = ifp->if_index;
1765                 ifm32->_ifm_spare1 = 0;
1766                 ifm32->ifm_len = sizeof(*ifm32);
1767                 ifm32->ifm_data_off = offsetof(struct if_msghdrl32, ifm_data);
1768                 ifm32->_ifm_spare2 = 0;
1769                 ifd = &ifm32->ifm_data;
1770         } else
1771 #endif
1772         {
1773                 ifm->ifm_addrs = info->rti_addrs;
1774                 ifm->ifm_flags = ifp->if_flags | ifp->if_drv_flags;
1775                 ifm->ifm_index = ifp->if_index;
1776                 ifm->_ifm_spare1 = 0;
1777                 ifm->ifm_len = sizeof(*ifm);
1778                 ifm->ifm_data_off = offsetof(struct if_msghdrl, ifm_data);
1779                 ifm->_ifm_spare2 = 0;
1780                 ifd = &ifm->ifm_data;
1781         }
1782
1783         memcpy(ifd, src_ifd, sizeof(*ifd));
1784
1785         return (SYSCTL_OUT(w->w_req, (caddr_t)ifm, len));
1786 }
1787
1788 static int
1789 sysctl_iflist_ifm(struct ifnet *ifp, const struct if_data *src_ifd,
1790     struct rt_addrinfo *info, struct walkarg *w, int len)
1791 {
1792         struct if_msghdr *ifm;
1793         struct if_data *ifd;
1794
1795         ifm = (struct if_msghdr *)w->w_tmem;
1796
1797 #ifdef COMPAT_FREEBSD32
1798         if (w->w_req->flags & SCTL_MASK32) {
1799                 struct if_msghdr32 *ifm32;
1800
1801                 ifm32 = (struct if_msghdr32 *)ifm;
1802                 ifm32->ifm_addrs = info->rti_addrs;
1803                 ifm32->ifm_flags = ifp->if_flags | ifp->if_drv_flags;
1804                 ifm32->ifm_index = ifp->if_index;
1805                 ifm32->_ifm_spare1 = 0;
1806                 ifd = &ifm32->ifm_data;
1807         } else
1808 #endif
1809         {
1810                 ifm->ifm_addrs = info->rti_addrs;
1811                 ifm->ifm_flags = ifp->if_flags | ifp->if_drv_flags;
1812                 ifm->ifm_index = ifp->if_index;
1813                 ifm->_ifm_spare1 = 0;
1814                 ifd = &ifm->ifm_data;
1815         }
1816
1817         memcpy(ifd, src_ifd, sizeof(*ifd));
1818
1819         return (SYSCTL_OUT(w->w_req, (caddr_t)ifm, len));
1820 }
1821
1822 static int
1823 sysctl_iflist_ifaml(struct ifaddr *ifa, struct rt_addrinfo *info,
1824     struct walkarg *w, int len)
1825 {
1826         struct ifa_msghdrl *ifam;
1827         struct if_data *ifd;
1828
1829         ifam = (struct ifa_msghdrl *)w->w_tmem;
1830
1831 #ifdef COMPAT_FREEBSD32
1832         if (w->w_req->flags & SCTL_MASK32) {
1833                 struct ifa_msghdrl32 *ifam32;
1834
1835                 ifam32 = (struct ifa_msghdrl32 *)ifam;
1836                 ifam32->ifam_addrs = info->rti_addrs;
1837                 ifam32->ifam_flags = ifa->ifa_flags;
1838                 ifam32->ifam_index = ifa->ifa_ifp->if_index;
1839                 ifam32->_ifam_spare1 = 0;
1840                 ifam32->ifam_len = sizeof(*ifam32);
1841                 ifam32->ifam_data_off =
1842                     offsetof(struct ifa_msghdrl32, ifam_data);
1843                 ifam32->ifam_metric = ifa->ifa_ifp->if_metric;
1844                 ifd = &ifam32->ifam_data;
1845         } else
1846 #endif
1847         {
1848                 ifam->ifam_addrs = info->rti_addrs;
1849                 ifam->ifam_flags = ifa->ifa_flags;
1850                 ifam->ifam_index = ifa->ifa_ifp->if_index;
1851                 ifam->_ifam_spare1 = 0;
1852                 ifam->ifam_len = sizeof(*ifam);
1853                 ifam->ifam_data_off = offsetof(struct ifa_msghdrl, ifam_data);
1854                 ifam->ifam_metric = ifa->ifa_ifp->if_metric;
1855                 ifd = &ifam->ifam_data;
1856         }
1857
1858         bzero(ifd, sizeof(*ifd));
1859         ifd->ifi_datalen = sizeof(struct if_data);
1860         ifd->ifi_ipackets = counter_u64_fetch(ifa->ifa_ipackets);
1861         ifd->ifi_opackets = counter_u64_fetch(ifa->ifa_opackets);
1862         ifd->ifi_ibytes = counter_u64_fetch(ifa->ifa_ibytes);
1863         ifd->ifi_obytes = counter_u64_fetch(ifa->ifa_obytes);
1864
1865         /* Fixup if_data carp(4) vhid. */
1866         if (carp_get_vhid_p != NULL)
1867                 ifd->ifi_vhid = (*carp_get_vhid_p)(ifa);
1868
1869         return (SYSCTL_OUT(w->w_req, w->w_tmem, len));
1870 }
1871
1872 static int
1873 sysctl_iflist_ifam(struct ifaddr *ifa, struct rt_addrinfo *info,
1874     struct walkarg *w, int len)
1875 {
1876         struct ifa_msghdr *ifam;
1877
1878         ifam = (struct ifa_msghdr *)w->w_tmem;
1879         ifam->ifam_addrs = info->rti_addrs;
1880         ifam->ifam_flags = ifa->ifa_flags;
1881         ifam->ifam_index = ifa->ifa_ifp->if_index;
1882         ifam->_ifam_spare1 = 0;
1883         ifam->ifam_metric = ifa->ifa_ifp->if_metric;
1884
1885         return (SYSCTL_OUT(w->w_req, w->w_tmem, len));
1886 }
1887
1888 static int
1889 sysctl_iflist(int af, struct walkarg *w)
1890 {
1891         struct ifnet *ifp;
1892         struct ifaddr *ifa;
1893         struct if_data ifd;
1894         struct rt_addrinfo info;
1895         int len, error = 0;
1896         struct sockaddr_storage ss;
1897
1898         bzero((caddr_t)&info, sizeof(info));
1899         bzero(&ifd, sizeof(ifd));
1900         CK_STAILQ_FOREACH(ifp, &V_ifnet, if_link) {
1901                 if (w->w_arg && w->w_arg != ifp->if_index)
1902                         continue;
1903                 if_data_copy(ifp, &ifd);
1904                 ifa = ifp->if_addr;
1905                 info.rti_info[RTAX_IFP] = ifa->ifa_addr;
1906                 error = rtsock_msg_buffer(RTM_IFINFO, &info, w, &len);
1907                 if (error != 0)
1908                         goto done;
1909                 info.rti_info[RTAX_IFP] = NULL;
1910                 if (w->w_req && w->w_tmem) {
1911                         if (w->w_op == NET_RT_IFLISTL)
1912                                 error = sysctl_iflist_ifml(ifp, &ifd, &info, w,
1913                                     len);
1914                         else
1915                                 error = sysctl_iflist_ifm(ifp, &ifd, &info, w,
1916                                     len);
1917                         if (error)
1918                                 goto done;
1919                 }
1920                 while ((ifa = CK_STAILQ_NEXT(ifa, ifa_link)) != NULL) {
1921                         if (af && af != ifa->ifa_addr->sa_family)
1922                                 continue;
1923                         if (prison_if(w->w_req->td->td_ucred,
1924                             ifa->ifa_addr) != 0)
1925                                 continue;
1926                         info.rti_info[RTAX_IFA] = ifa->ifa_addr;
1927                         info.rti_info[RTAX_NETMASK] = rtsock_fix_netmask(
1928                             ifa->ifa_addr, ifa->ifa_netmask, &ss);
1929                         info.rti_info[RTAX_BRD] = ifa->ifa_dstaddr;
1930                         error = rtsock_msg_buffer(RTM_NEWADDR, &info, w, &len);
1931                         if (error != 0)
1932                                 goto done;
1933                         if (w->w_req && w->w_tmem) {
1934                                 if (w->w_op == NET_RT_IFLISTL)
1935                                         error = sysctl_iflist_ifaml(ifa, &info,
1936                                             w, len);
1937                                 else
1938                                         error = sysctl_iflist_ifam(ifa, &info,
1939                                             w, len);
1940                                 if (error)
1941                                         goto done;
1942                         }
1943                 }
1944                 info.rti_info[RTAX_IFA] = NULL;
1945                 info.rti_info[RTAX_NETMASK] = NULL;
1946                 info.rti_info[RTAX_BRD] = NULL;
1947         }
1948 done:
1949         return (error);
1950 }
1951
1952 static int
1953 sysctl_ifmalist(int af, struct walkarg *w)
1954 {
1955         struct rt_addrinfo info;
1956         struct ifaddr *ifa;
1957         struct ifmultiaddr *ifma;
1958         struct ifnet *ifp;
1959         int error, len;
1960
1961         NET_EPOCH_ASSERT();
1962
1963         error = 0;
1964         bzero((caddr_t)&info, sizeof(info));
1965
1966         CK_STAILQ_FOREACH(ifp, &V_ifnet, if_link) {
1967                 if (w->w_arg && w->w_arg != ifp->if_index)
1968                         continue;
1969                 ifa = ifp->if_addr;
1970                 info.rti_info[RTAX_IFP] = ifa ? ifa->ifa_addr : NULL;
1971                 CK_STAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
1972                         if (af && af != ifma->ifma_addr->sa_family)
1973                                 continue;
1974                         if (prison_if(w->w_req->td->td_ucred,
1975                             ifma->ifma_addr) != 0)
1976                                 continue;
1977                         info.rti_info[RTAX_IFA] = ifma->ifma_addr;
1978                         info.rti_info[RTAX_GATEWAY] =
1979                             (ifma->ifma_addr->sa_family != AF_LINK) ?
1980                             ifma->ifma_lladdr : NULL;
1981                         error = rtsock_msg_buffer(RTM_NEWMADDR, &info, w, &len);
1982                         if (error != 0)
1983                                 break;
1984                         if (w->w_req && w->w_tmem) {
1985                                 struct ifma_msghdr *ifmam;
1986
1987                                 ifmam = (struct ifma_msghdr *)w->w_tmem;
1988                                 ifmam->ifmam_index = ifma->ifma_ifp->if_index;
1989                                 ifmam->ifmam_flags = 0;
1990                                 ifmam->ifmam_addrs = info.rti_addrs;
1991                                 ifmam->_ifmam_spare1 = 0;
1992                                 error = SYSCTL_OUT(w->w_req, w->w_tmem, len);
1993                                 if (error != 0)
1994                                         break;
1995                         }
1996                 }
1997                 if (error != 0)
1998                         break;
1999         }
2000         return (error);
2001 }
2002
2003 static int
2004 sysctl_rtsock(SYSCTL_HANDLER_ARGS)
2005 {
2006         RIB_RLOCK_TRACKER;
2007         struct epoch_tracker et;
2008         int     *name = (int *)arg1;
2009         u_int   namelen = arg2;
2010         struct rib_head *rnh = NULL; /* silence compiler. */
2011         int     i, lim, error = EINVAL;
2012         int     fib = 0;
2013         u_char  af;
2014         struct  walkarg w;
2015
2016         name ++;
2017         namelen--;
2018         if (req->newptr)
2019                 return (EPERM);
2020         if (name[1] == NET_RT_DUMP || name[1] == NET_RT_NHOP) {
2021                 if (namelen == 3)
2022                         fib = req->td->td_proc->p_fibnum;
2023                 else if (namelen == 4)
2024                         fib = (name[3] == RT_ALL_FIBS) ?
2025                             req->td->td_proc->p_fibnum : name[3];
2026                 else
2027                         return ((namelen < 3) ? EISDIR : ENOTDIR);
2028                 if (fib < 0 || fib >= rt_numfibs)
2029                         return (EINVAL);
2030         } else if (namelen != 3)
2031                 return ((namelen < 3) ? EISDIR : ENOTDIR);
2032         af = name[0];
2033         if (af > AF_MAX)
2034                 return (EINVAL);
2035         bzero(&w, sizeof(w));
2036         w.w_op = name[1];
2037         w.w_arg = name[2];
2038         w.w_req = req;
2039
2040         error = sysctl_wire_old_buffer(req, 0);
2041         if (error)
2042                 return (error);
2043         
2044         /*
2045          * Allocate reply buffer in advance.
2046          * All rtsock messages has maximum length of u_short.
2047          */
2048         w.w_tmemsize = 65536;
2049         w.w_tmem = malloc(w.w_tmemsize, M_TEMP, M_WAITOK);
2050
2051         NET_EPOCH_ENTER(et);
2052         switch (w.w_op) {
2053         case NET_RT_DUMP:
2054         case NET_RT_FLAGS:
2055                 if (af == 0) {                  /* dump all tables */
2056                         i = 1;
2057                         lim = AF_MAX;
2058                 } else                          /* dump only one table */
2059                         i = lim = af;
2060
2061                 /*
2062                  * take care of llinfo entries, the caller must
2063                  * specify an AF
2064                  */
2065                 if (w.w_op == NET_RT_FLAGS &&
2066                     (w.w_arg == 0 || w.w_arg & RTF_LLINFO)) {
2067                         if (af != 0)
2068                                 error = lltable_sysctl_dumparp(af, w.w_req);
2069                         else
2070                                 error = EINVAL;
2071                         break;
2072                 }
2073                 /*
2074                  * take care of routing entries
2075                  */
2076                 for (error = 0; error == 0 && i <= lim; i++) {
2077                         rnh = rt_tables_get_rnh(fib, i);
2078                         if (rnh != NULL) {
2079                                 RIB_RLOCK(rnh); 
2080                                 error = rnh->rnh_walktree(&rnh->head,
2081                                     sysctl_dumpentry, &w);
2082                                 RIB_RUNLOCK(rnh);
2083                         } else if (af != 0)
2084                                 error = EAFNOSUPPORT;
2085                 }
2086                 break;
2087         case NET_RT_NHOP:
2088                 /* Allow dumping one specific af/fib at a time */
2089                 if (namelen < 4) {
2090                         error = EINVAL;
2091                         break;
2092                 }
2093                 fib = name[3];
2094                 if (fib < 0 || fib > rt_numfibs) {
2095                         error = EINVAL;
2096                         break;
2097                 }
2098                 rnh = rt_tables_get_rnh(fib, af);
2099                 if (rnh == NULL) {
2100                         error = EAFNOSUPPORT;
2101                         break;
2102                 }
2103                 if (w.w_op == NET_RT_NHOP)
2104                         error = nhops_dump_sysctl(rnh, w.w_req);
2105                 break;
2106         case NET_RT_IFLIST:
2107         case NET_RT_IFLISTL:
2108                 error = sysctl_iflist(af, &w);
2109                 break;
2110
2111         case NET_RT_IFMALIST:
2112                 error = sysctl_ifmalist(af, &w);
2113                 break;
2114         }
2115         NET_EPOCH_EXIT(et);
2116
2117         free(w.w_tmem, M_TEMP);
2118         return (error);
2119 }
2120
2121 static SYSCTL_NODE(_net, PF_ROUTE, routetable, CTLFLAG_RD | CTLFLAG_MPSAFE,
2122     sysctl_rtsock, "Return route tables and interface/address lists");
2123
2124 /*
2125  * Definitions of protocols supported in the ROUTE domain.
2126  */
2127
2128 static struct domain routedomain;               /* or at least forward */
2129
2130 static struct protosw routesw[] = {
2131 {
2132         .pr_type =              SOCK_RAW,
2133         .pr_domain =            &routedomain,
2134         .pr_flags =             PR_ATOMIC|PR_ADDR,
2135         .pr_output =            route_output,
2136         .pr_ctlinput =          raw_ctlinput,
2137         .pr_init =              raw_init,
2138         .pr_usrreqs =           &route_usrreqs
2139 }
2140 };
2141
2142 static struct domain routedomain = {
2143         .dom_family =           PF_ROUTE,
2144         .dom_name =              "route",
2145         .dom_protosw =          routesw,
2146         .dom_protoswNPROTOSW =  &routesw[nitems(routesw)]
2147 };
2148
2149 VNET_DOMAIN_SET(route);
2150