Introduce experimental MPLS over ethernet support. Add 'options MPLS'
[dragonfly.git] / sys / net / rtsock.c
CommitLineData
f3ed2586
JH
1/*
2 * Copyright (c) 2004, 2005 The DragonFly Project. All rights reserved.
3 *
4 * This code is derived from software contributed to The DragonFly Project
5 * by Jeffrey M. Hsu.
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 DragonFly Project nor the names of its
16 * contributors may be used to endorse or promote products derived
17 * from this software without specific, prior written permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
21 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
22 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
23 * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
24 * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING,
25 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
26 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
27 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
28 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
29 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30 * SUCH DAMAGE.
31 */
32
984263bc
MD
33/*
34 * Copyright (c) 1988, 1991, 1993
35 * The Regents of the University of California. All rights reserved.
36 *
37 * Redistribution and use in source and binary forms, with or without
38 * modification, are permitted provided that the following conditions
39 * are met:
40 * 1. Redistributions of source code must retain the above copyright
41 * notice, this list of conditions and the following disclaimer.
42 * 2. Redistributions in binary form must reproduce the above copyright
43 * notice, this list of conditions and the following disclaimer in the
44 * documentation and/or other materials provided with the distribution.
45 * 3. All advertising materials mentioning features or use of this software
46 * must display the following acknowledgement:
47 * This product includes software developed by the University of
48 * California, Berkeley and its contributors.
49 * 4. Neither the name of the University nor the names of its contributors
50 * may be used to endorse or promote products derived from this software
51 * without specific prior written permission.
52 *
53 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
54 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
55 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
56 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
57 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
58 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
59 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
60 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
61 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
62 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
63 * SUCH DAMAGE.
64 *
65 * @(#)rtsock.c 8.7 (Berkeley) 10/12/95
66 * $FreeBSD: src/sys/net/rtsock.c,v 1.44.2.11 2002/12/04 14:05:41 ru Exp $
9b42cabe 67 * $DragonFly: src/sys/net/rtsock.c,v 1.44 2008/07/07 22:02:10 nant Exp $
984263bc
MD
68 */
69
78812139
EN
70#include "opt_sctp.h"
71
984263bc
MD
72#include <sys/param.h>
73#include <sys/systm.h>
74#include <sys/kernel.h>
75#include <sys/sysctl.h>
76#include <sys/proc.h>
77#include <sys/malloc.h>
78#include <sys/mbuf.h>
47e78ae8 79#include <sys/protosw.h>
984263bc
MD
80#include <sys/socket.h>
81#include <sys/socketvar.h>
82#include <sys/domain.h>
a49aa710 83#include <sys/thread2.h>
deffea2e 84
984263bc
MD
85#include <net/if.h>
86#include <net/route.h>
87#include <net/raw_cb.h>
47db7f9b 88#include <net/netmsg2.h>
984263bc 89
78812139
EN
90#ifdef SCTP
91extern void sctp_add_ip_address(struct ifaddr *ifa);
92extern void sctp_delete_ip_address(struct ifaddr *ifa);
93#endif /* SCTP */
94
984263bc
MD
95MALLOC_DEFINE(M_RTABLE, "routetbl", "routing tables");
96
f23061d4
JH
97static struct route_cb {
98 int ip_count;
99 int ip6_count;
100 int ipx_count;
101 int ns_count;
102 int any_count;
103} route_cb;
104
590b8cd4 105static const struct sockaddr route_src = { 2, PF_ROUTE, };
984263bc
MD
106
107struct walkarg {
108 int w_tmemsize;
109 int w_op, w_arg;
8e63efec 110 void *w_tmem;
984263bc
MD
111 struct sysctl_req *w_req;
112};
113
114static struct mbuf *
590b8cd4
JH
115 rt_msg_mbuf (int, struct rt_addrinfo *);
116static void rt_msg_buffer (int, struct rt_addrinfo *, void *buf, int len);
117static int rt_msgsize (int type, struct rt_addrinfo *rtinfo);
ef87f48d 118static int rt_xaddrs (char *, char *, struct rt_addrinfo *);
158abb01
RG
119static int sysctl_dumpentry (struct radix_node *rn, void *vw);
120static int sysctl_iflist (int af, struct walkarg *w);
deffea2e 121static int route_output(struct mbuf *, struct socket *, ...);
47e78ae8 122static void rt_setmetrics (u_long, struct rt_metrics *,
f23061d4 123 struct rt_metrics *);
984263bc 124
984263bc
MD
125/*
126 * It really doesn't make any sense at all for this code to share much
127 * with raw_usrreq.c, since its functionality is so restricted. XXX
128 */
129static int
130rts_abort(struct socket *so)
131{
a49aa710 132 int error;
f23061d4 133
a49aa710 134 crit_enter();
984263bc 135 error = raw_usrreqs.pru_abort(so);
a49aa710 136 crit_exit();
984263bc
MD
137 return error;
138}
139
140/* pru_accept is EOPNOTSUPP */
141
142static int
e4700d00 143rts_attach(struct socket *so, int proto, struct pru_attach_info *ai)
984263bc
MD
144{
145 struct rawcb *rp;
a49aa710 146 int error;
984263bc 147
ef87f48d 148 if (sotorawcb(so) != NULL)
984263bc 149 return EISCONN; /* XXX panic? */
f23061d4 150
efda3bd0 151 rp = kmalloc(sizeof *rp, M_PCB, M_WAITOK | M_ZERO);
984263bc
MD
152
153 /*
a49aa710 154 * The critical section is necessary to block protocols from sending
984263bc
MD
155 * error notifications (like RTM_REDIRECT or RTM_LOSING) while
156 * this PCB is extant but incompletely initialized.
157 * Probably we should try to do more of this work beforehand and
a49aa710 158 * eliminate the critical section.
984263bc 159 */
a49aa710 160 crit_enter();
ef87f48d 161 so->so_pcb = rp;
e4700d00 162 error = raw_attach(so, proto, ai->sb_rlimit);
984263bc
MD
163 rp = sotorawcb(so);
164 if (error) {
a49aa710 165 crit_exit();
efda3bd0 166 kfree(rp, M_PCB);
984263bc
MD
167 return error;
168 }
169 switch(rp->rcb_proto.sp_protocol) {
170 case AF_INET:
171 route_cb.ip_count++;
172 break;
173 case AF_INET6:
174 route_cb.ip6_count++;
175 break;
176 case AF_IPX:
177 route_cb.ipx_count++;
178 break;
179 case AF_NS:
180 route_cb.ns_count++;
181 break;
182 }
183 rp->rcb_faddr = &route_src;
184 route_cb.any_count++;
185 soisconnected(so);
186 so->so_options |= SO_USELOOPBACK;
a49aa710 187 crit_exit();
984263bc
MD
188 return 0;
189}
190
191static int
dadab5e9 192rts_bind(struct socket *so, struct sockaddr *nam, struct thread *td)
984263bc 193{
a49aa710 194 int error;
f23061d4 195
a49aa710 196 crit_enter();
dadab5e9 197 error = raw_usrreqs.pru_bind(so, nam, td); /* xxx just EINVAL */
a49aa710 198 crit_exit();
984263bc
MD
199 return error;
200}
201
202static int
dadab5e9 203rts_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
984263bc 204{
a49aa710 205 int error;
f23061d4 206
a49aa710 207 crit_enter();
dadab5e9 208 error = raw_usrreqs.pru_connect(so, nam, td); /* XXX just EINVAL */
a49aa710 209 crit_exit();
984263bc
MD
210 return error;
211}
212
213/* pru_connect2 is EOPNOTSUPP */
214/* pru_control is EOPNOTSUPP */
215
216static int
217rts_detach(struct socket *so)
218{
219 struct rawcb *rp = sotorawcb(so);
a49aa710 220 int error;
984263bc 221
a49aa710 222 crit_enter();
ef87f48d 223 if (rp != NULL) {
984263bc
MD
224 switch(rp->rcb_proto.sp_protocol) {
225 case AF_INET:
226 route_cb.ip_count--;
227 break;
228 case AF_INET6:
229 route_cb.ip6_count--;
230 break;
231 case AF_IPX:
232 route_cb.ipx_count--;
233 break;
234 case AF_NS:
235 route_cb.ns_count--;
236 break;
237 }
238 route_cb.any_count--;
239 }
240 error = raw_usrreqs.pru_detach(so);
a49aa710 241 crit_exit();
984263bc
MD
242 return error;
243}
244
245static int
246rts_disconnect(struct socket *so)
247{
a49aa710 248 int error;
f23061d4 249
a49aa710 250 crit_enter();
984263bc 251 error = raw_usrreqs.pru_disconnect(so);
a49aa710 252 crit_exit();
984263bc
MD
253 return error;
254}
255
256/* pru_listen is EOPNOTSUPP */
257
258static int
259rts_peeraddr(struct socket *so, struct sockaddr **nam)
260{
a49aa710 261 int error;
f23061d4 262
a49aa710 263 crit_enter();
984263bc 264 error = raw_usrreqs.pru_peeraddr(so, nam);
a49aa710 265 crit_exit();
984263bc
MD
266 return error;
267}
268
269/* pru_rcvd is EOPNOTSUPP */
270/* pru_rcvoob is EOPNOTSUPP */
271
272static int
273rts_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *nam,
dadab5e9 274 struct mbuf *control, struct thread *td)
984263bc 275{
a49aa710 276 int error;
f23061d4 277
a49aa710 278 crit_enter();
dadab5e9 279 error = raw_usrreqs.pru_send(so, flags, m, nam, control, td);
a49aa710 280 crit_exit();
984263bc
MD
281 return error;
282}
283
284/* pru_sense is null */
285
286static int
287rts_shutdown(struct socket *so)
288{
a49aa710 289 int error;
f23061d4 290
a49aa710 291 crit_enter();
984263bc 292 error = raw_usrreqs.pru_shutdown(so);
a49aa710 293 crit_exit();
984263bc
MD
294 return error;
295}
296
297static int
298rts_sockaddr(struct socket *so, struct sockaddr **nam)
299{
a49aa710 300 int error;
f23061d4 301
a49aa710 302 crit_enter();
984263bc 303 error = raw_usrreqs.pru_sockaddr(so, nam);
a49aa710 304 crit_exit();
984263bc
MD
305 return error;
306}
307
308static struct pr_usrreqs route_usrreqs = {
fa5e758c
MD
309 .pru_abort = rts_abort,
310 .pru_accept = pru_accept_notsupp,
311 .pru_attach = rts_attach,
312 .pru_bind = rts_bind,
313 .pru_connect = rts_connect,
314 .pru_connect2 = pru_connect2_notsupp,
315 .pru_control = pru_control_notsupp,
316 .pru_detach = rts_detach,
317 .pru_disconnect = rts_disconnect,
318 .pru_listen = pru_listen_notsupp,
319 .pru_peeraddr = rts_peeraddr,
320 .pru_rcvd = pru_rcvd_notsupp,
321 .pru_rcvoob = pru_rcvoob_notsupp,
322 .pru_send = rts_send,
323 .pru_sense = pru_sense_null,
324 .pru_shutdown = rts_shutdown,
325 .pru_sockaddr = rts_sockaddr,
326 .pru_sosend = sosend,
327 .pru_soreceive = soreceive,
328 .pru_sopoll = sopoll
984263bc
MD
329};
330
590b8cd4
JH
331static __inline sa_family_t
332familyof(struct sockaddr *sa)
333{
334 return (sa != NULL ? sa->sa_family : 0);
335}
336
47db7f9b
MD
337/*
338 * Routing socket input function. The packet must be serialized onto cpu 0.
339 * We use the cpu0_soport() netisr processing loop to handle it.
340 *
341 * This looks messy but it means that anyone, including interrupt code,
342 * can send a message to the routing socket.
343 */
590b8cd4 344static void
47db7f9b 345rts_input_handler(struct netmsg *msg)
590b8cd4
JH
346{
347 static const struct sockaddr route_dst = { 2, PF_ROUTE, };
47db7f9b
MD
348 struct sockproto route_proto;
349 struct netmsg_packet *pmsg;
350 struct mbuf *m;
351 sa_family_t family;
352
353 pmsg = (void *)msg;
354 m = pmsg->nm_packet;
355 family = pmsg->nm_netmsg.nm_lmsg.u.ms_result;
356 route_proto.sp_family = PF_ROUTE;
357 route_proto.sp_protocol = family;
590b8cd4
JH
358
359 raw_input(m, &route_proto, &route_src, &route_dst);
360}
361
47db7f9b
MD
362static void
363rts_input(struct mbuf *m, sa_family_t family)
364{
365 struct netmsg_packet *pmsg;
366 lwkt_port_t port;
367
934c6849 368 port = cpu0_soport(NULL, NULL, NULL, 0);
47db7f9b
MD
369 pmsg = &m->m_hdr.mh_netmsg;
370 netmsg_init(&pmsg->nm_netmsg, &netisr_apanic_rport,
371 0, rts_input_handler);
372 pmsg->nm_packet = m;
373 pmsg->nm_netmsg.nm_lmsg.u.ms_result = family;
374 lwkt_sendmsg(port, &pmsg->nm_netmsg.nm_lmsg);
375}
376
590b8cd4
JH
377static void *
378reallocbuf(void *ptr, size_t len, size_t olen)
379{
380 void *newptr;
381
efda3bd0 382 newptr = kmalloc(len, M_RTABLE, M_INTWAIT | M_NULLOK);
590b8cd4
JH
383 if (newptr == NULL)
384 return NULL;
385 bcopy(ptr, newptr, olen);
efda3bd0 386 kfree(ptr, M_RTABLE);
590b8cd4
JH
387 return (newptr);
388}
389
8e63efec
JH
390/*
391 * Internal helper routine for route_output().
392 */
590b8cd4
JH
393static int
394fillrtmsg(struct rt_msghdr **prtm, struct rtentry *rt,
395 struct rt_addrinfo *rtinfo)
396{
397 int msglen;
398 struct rt_msghdr *rtm = *prtm;
399
400 /* Fill in rt_addrinfo for call to rt_msg_buffer(). */
401 rtinfo->rti_dst = rt_key(rt);
402 rtinfo->rti_gateway = rt->rt_gateway;
403 rtinfo->rti_netmask = rt_mask(rt); /* might be NULL */
404 rtinfo->rti_genmask = rt->rt_genmask; /* might be NULL */
405 if (rtm->rtm_addrs & (RTA_IFP | RTA_IFA)) {
406 if (rt->rt_ifp != NULL) {
407 rtinfo->rti_ifpaddr =
b2632176
SZ
408 TAILQ_FIRST(&rt->rt_ifp->if_addrheads[mycpuid])
409 ->ifa->ifa_addr;
590b8cd4
JH
410 rtinfo->rti_ifaaddr = rt->rt_ifa->ifa_addr;
411 if (rt->rt_ifp->if_flags & IFF_POINTOPOINT)
412 rtinfo->rti_bcastaddr = rt->rt_ifa->ifa_dstaddr;
413 rtm->rtm_index = rt->rt_ifp->if_index;
414 } else {
415 rtinfo->rti_ifpaddr = NULL;
416 rtinfo->rti_ifaaddr = NULL;
417 }
418 }
419
420 msglen = rt_msgsize(rtm->rtm_type, rtinfo);
421 if (rtm->rtm_msglen < msglen) {
422 rtm = reallocbuf(rtm, msglen, rtm->rtm_msglen);
423 if (rtm == NULL)
424 return (ENOBUFS);
425 *prtm = rtm;
426 }
427 rt_msg_buffer(rtm->rtm_type, rtinfo, rtm, msglen);
428
429 rtm->rtm_flags = rt->rt_flags;
430 rtm->rtm_rmx = rt->rt_rmx;
431 rtm->rtm_addrs = rtinfo->rti_addrs;
432
433 return (0);
434}
435
ecdefdda
MD
436static void route_output_add_callback(int, int, struct rt_addrinfo *,
437 struct rtentry *, void *);
438static void route_output_delete_callback(int, int, struct rt_addrinfo *,
439 struct rtentry *, void *);
440static void route_output_change_callback(int, int, struct rt_addrinfo *,
441 struct rtentry *, void *);
442static void route_output_lock_callback(int, int, struct rt_addrinfo *,
443 struct rtentry *, void *);
444
984263bc
MD
445/*ARGSUSED*/
446static int
deffea2e 447route_output(struct mbuf *m, struct socket *so, ...)
984263bc 448{
2e9572df 449 struct rt_msghdr *rtm = NULL;
ecdefdda 450 struct rtentry *rt;
984263bc 451 struct radix_node_head *rnh;
f23061d4 452 struct rawcb *rp = NULL;
deffea2e 453 struct pr_output_info *oi;
590b8cd4 454 struct rt_addrinfo rtinfo;
ef87f48d 455 int len, error = 0;
deffea2e
JS
456 __va_list ap;
457
458 __va_start(ap, so);
459 oi = __va_arg(ap, struct pr_output_info *);
460 __va_end(ap);
984263bc 461
ef87f48d 462#define gotoerr(e) { error = e; goto flush;}
590b8cd4
JH
463
464 if (m == NULL ||
465 (m->m_len < sizeof(long) &&
466 (m = m_pullup(m, sizeof(long))) == NULL))
984263bc 467 return (ENOBUFS);
ef87f48d 468 if (!(m->m_flags & M_PKTHDR))
984263bc
MD
469 panic("route_output");
470 len = m->m_pkthdr.len;
590b8cd4 471 if (len < sizeof(struct rt_msghdr) ||
984263bc 472 len != mtod(m, struct rt_msghdr *)->rtm_msglen) {
590b8cd4 473 rtinfo.rti_dst = NULL;
ef87f48d 474 gotoerr(EINVAL);
984263bc 475 }
efda3bd0 476 rtm = kmalloc(len, M_RTABLE, M_INTWAIT | M_NULLOK);
ef87f48d 477 if (rtm == NULL) {
590b8cd4 478 rtinfo.rti_dst = NULL;
ef87f48d 479 gotoerr(ENOBUFS);
984263bc
MD
480 }
481 m_copydata(m, 0, len, (caddr_t)rtm);
482 if (rtm->rtm_version != RTM_VERSION) {
590b8cd4 483 rtinfo.rti_dst = NULL;
ef87f48d 484 gotoerr(EPROTONOSUPPORT);
984263bc 485 }
47e78ae8 486 rtm->rtm_pid = oi->p_pid;
590b8cd4
JH
487 bzero(&rtinfo, sizeof(struct rt_addrinfo));
488 rtinfo.rti_addrs = rtm->rtm_addrs;
489 if (rt_xaddrs((char *)(rtm + 1), (char *)rtm + len, &rtinfo) != 0) {
490 rtinfo.rti_dst = NULL;
ef87f48d 491 gotoerr(EINVAL);
984263bc 492 }
590b8cd4
JH
493 rtinfo.rti_flags = rtm->rtm_flags;
494 if (rtinfo.rti_dst == NULL || rtinfo.rti_dst->sa_family >= AF_MAX ||
495 (rtinfo.rti_gateway && rtinfo.rti_gateway->sa_family >= AF_MAX))
ef87f48d
JH
496 gotoerr(EINVAL);
497
590b8cd4
JH
498 if (rtinfo.rti_genmask != NULL) {
499 struct radix_node *n;
ef87f48d 500
590b8cd4
JH
501#define clen(s) (*(u_char *)(s))
502 n = rn_addmask((char *)rtinfo.rti_genmask, TRUE, 1);
503 if (n != NULL &&
504 rtinfo.rti_genmask->sa_len >= clen(n->rn_key) &&
505 bcmp((char *)rtinfo.rti_genmask + 1,
506 (char *)n->rn_key + 1, clen(n->rn_key) - 1) == 0)
507 rtinfo.rti_genmask = (struct sockaddr *)n->rn_key;
984263bc 508 else
ef87f48d 509 gotoerr(ENOBUFS);
984263bc
MD
510 }
511
512 /*
513 * Verify that the caller has the appropriate privilege; RTM_GET
514 * is the only operation the non-superuser is allowed.
515 */
dadab5e9 516 if (rtm->rtm_type != RTM_GET && suser_cred(so->so_cred, 0) != 0)
ef87f48d 517 gotoerr(EPERM);
984263bc
MD
518
519 switch (rtm->rtm_type) {
984263bc 520 case RTM_ADD:
ecdefdda
MD
521 if (rtinfo.rti_gateway == NULL) {
522 error = EINVAL;
523 } else {
524 error = rtrequest1_global(RTM_ADD, &rtinfo,
525 route_output_add_callback, rtm);
984263bc
MD
526 }
527 break;
984263bc 528 case RTM_DELETE:
ecdefdda
MD
529 /*
530 * note: &rtm passed as argument so 'rtm' can be replaced.
531 */
532 error = rtrequest1_global(RTM_DELETE, &rtinfo,
533 route_output_delete_callback, &rtm);
984263bc 534 break;
984263bc 535 case RTM_GET:
ecdefdda
MD
536 rnh = rt_tables[mycpuid][rtinfo.rti_dst->sa_family];
537 if (rnh == NULL) {
538 error = EAFNOSUPPORT;
539 break;
540 }
590b8cd4
JH
541 rt = (struct rtentry *)
542 rnh->rnh_lookup((char *)rtinfo.rti_dst,
543 (char *)rtinfo.rti_netmask, rnh);
ecdefdda
MD
544 if (rt == NULL) {
545 error = ESRCH;
984263bc
MD
546 break;
547 }
ecdefdda
MD
548 rt->rt_refcnt++;
549 if (fillrtmsg(&rtm, rt, &rtinfo) != 0)
550 gotoerr(ENOBUFS);
551 --rt->rt_refcnt;
552 break;
553 case RTM_CHANGE:
554 error = rtrequest1_global(RTM_GET, &rtinfo,
555 route_output_change_callback, rtm);
556 break;
557 case RTM_LOCK:
558 error = rtrequest1_global(RTM_GET, &rtinfo,
559 route_output_lock_callback, rtm);
590b8cd4 560 break;
984263bc 561 default:
ecdefdda
MD
562 error = EOPNOTSUPP;
563 break;
984263bc
MD
564 }
565
566flush:
590b8cd4
JH
567 if (rtm != NULL) {
568 if (error != 0)
984263bc
MD
569 rtm->rtm_errno = error;
570 else
571 rtm->rtm_flags |= RTF_DONE;
572 }
ecdefdda 573
984263bc
MD
574 /*
575 * Check to see if we don't want our own messages.
576 */
ef87f48d 577 if (!(so->so_options & SO_USELOOPBACK)) {
984263bc 578 if (route_cb.any_count <= 1) {
590b8cd4 579 if (rtm != NULL)
efda3bd0 580 kfree(rtm, M_RTABLE);
984263bc
MD
581 m_freem(m);
582 return (error);
583 }
584 /* There is another listener, so construct message */
585 rp = sotorawcb(so);
586 }
590b8cd4 587 if (rtm != NULL) {
984263bc
MD
588 m_copyback(m, 0, rtm->rtm_msglen, (caddr_t)rtm);
589 if (m->m_pkthdr.len < rtm->rtm_msglen) {
590 m_freem(m);
591 m = NULL;
592 } else if (m->m_pkthdr.len > rtm->rtm_msglen)
593 m_adj(m, rtm->rtm_msglen - m->m_pkthdr.len);
efda3bd0 594 kfree(rtm, M_RTABLE);
984263bc 595 }
ef87f48d 596 if (rp != NULL)
984263bc 597 rp->rcb_proto.sp_family = 0; /* Avoid us */
ef87f48d 598 if (m != NULL)
590b8cd4 599 rts_input(m, familyof(rtinfo.rti_dst));
ef87f48d 600 if (rp != NULL)
984263bc 601 rp->rcb_proto.sp_family = PF_ROUTE;
984263bc
MD
602 return (error);
603}
604
ecdefdda
MD
605static void
606route_output_add_callback(int cmd, int error, struct rt_addrinfo *rtinfo,
607 struct rtentry *rt, void *arg)
608{
609 struct rt_msghdr *rtm = arg;
610
611 if (error == 0 && rt != NULL) {
612 rt_setmetrics(rtm->rtm_inits, &rtm->rtm_rmx,
613 &rt->rt_rmx);
614 rt->rt_rmx.rmx_locks &= ~(rtm->rtm_inits);
615 rt->rt_rmx.rmx_locks |=
616 (rtm->rtm_inits & rtm->rtm_rmx.rmx_locks);
617 rt->rt_genmask = rtinfo->rti_genmask;
618 }
619}
620
621static void
622route_output_delete_callback(int cmd, int error, struct rt_addrinfo *rtinfo,
623 struct rtentry *rt, void *arg)
624{
625 struct rt_msghdr **rtm = arg;
626
627 if (error == 0 && rt) {
628 ++rt->rt_refcnt;
629 if (fillrtmsg(rtm, rt, rtinfo) != 0) {
630 error = ENOBUFS;
631 /* XXX no way to return the error */
632 }
633 --rt->rt_refcnt;
634 }
635}
636
637static void
638route_output_change_callback(int cmd, int error, struct rt_addrinfo *rtinfo,
639 struct rtentry *rt, void *arg)
640{
641 struct rt_msghdr *rtm = arg;
642 struct ifaddr *ifa;
643
644 if (error)
645 goto done;
646
647 /*
648 * new gateway could require new ifaddr, ifp;
649 * flags may also be different; ifp may be specified
650 * by ll sockaddr when protocol address is ambiguous
651 */
652 if (((rt->rt_flags & RTF_GATEWAY) && rtinfo->rti_gateway != NULL) ||
653 rtinfo->rti_ifpaddr != NULL || (rtinfo->rti_ifaaddr != NULL &&
654 sa_equal(rtinfo->rti_ifaaddr, rt->rt_ifa->ifa_addr))
655 ) {
656 error = rt_getifa(rtinfo);
657 if (error != 0)
658 goto done;
659 }
660 if (rtinfo->rti_gateway != NULL) {
661 error = rt_setgate(rt, rt_key(rt), rtinfo->rti_gateway);
662 if (error != 0)
663 goto done;
664 }
665 if ((ifa = rtinfo->rti_ifa) != NULL) {
666 struct ifaddr *oifa = rt->rt_ifa;
667
668 if (oifa != ifa) {
669 if (oifa && oifa->ifa_rtrequest)
670 oifa->ifa_rtrequest(RTM_DELETE, rt, rtinfo);
671 IFAFREE(rt->rt_ifa);
672 IFAREF(ifa);
673 rt->rt_ifa = ifa;
674 rt->rt_ifp = rtinfo->rti_ifp;
675 }
676 }
677 rt_setmetrics(rtm->rtm_inits, &rtm->rtm_rmx, &rt->rt_rmx);
678 if (rt->rt_ifa && rt->rt_ifa->ifa_rtrequest)
679 rt->rt_ifa->ifa_rtrequest(RTM_ADD, rt, rtinfo);
680 if (rtinfo->rti_genmask != NULL)
681 rt->rt_genmask = rtinfo->rti_genmask;
682done:
683 /* XXX no way to return error */
684 ;
685}
686
687static void
688route_output_lock_callback(int cmd, int error, struct rt_addrinfo *rtinfo,
689 struct rtentry *rt, void *arg)
690{
691 struct rt_msghdr *rtm = arg;
692
693 rt->rt_rmx.rmx_locks &= ~(rtm->rtm_inits);
694 rt->rt_rmx.rmx_locks |=
695 (rtm->rtm_inits & rtm->rtm_rmx.rmx_locks);
696}
697
984263bc 698static void
ef87f48d 699rt_setmetrics(u_long which, struct rt_metrics *in, struct rt_metrics *out)
984263bc 700{
2e9572df
JH
701#define setmetric(flag, elt) if (which & (flag)) out->elt = in->elt;
702 setmetric(RTV_RPIPE, rmx_recvpipe);
703 setmetric(RTV_SPIPE, rmx_sendpipe);
704 setmetric(RTV_SSTHRESH, rmx_ssthresh);
705 setmetric(RTV_RTT, rmx_rtt);
706 setmetric(RTV_RTTVAR, rmx_rttvar);
707 setmetric(RTV_HOPCOUNT, rmx_hopcount);
708 setmetric(RTV_MTU, rmx_mtu);
709 setmetric(RTV_EXPIRE, rmx_expire);
710#undef setmetric
984263bc
MD
711}
712
713#define ROUNDUP(a) \
714 ((a) > 0 ? (1 + (((a) - 1) | (sizeof(long) - 1))) : sizeof(long))
984263bc 715
984263bc
MD
716/*
717 * Extract the addresses of the passed sockaddrs.
718 * Do a little sanity checking so as to avoid bad memory references.
719 * This data is derived straight from userland.
720 */
721static int
ef87f48d 722rt_xaddrs(char *cp, char *cplim, struct rt_addrinfo *rtinfo)
984263bc 723{
82ed7fc2
RG
724 struct sockaddr *sa;
725 int i;
984263bc
MD
726
727 for (i = 0; (i < RTAX_MAX) && (cp < cplim); i++) {
728 if ((rtinfo->rti_addrs & (1 << i)) == 0)
729 continue;
730 sa = (struct sockaddr *)cp;
731 /*
732 * It won't fit.
733 */
0c3c561c 734 if ((cp + sa->sa_len) > cplim) {
984263bc
MD
735 return (EINVAL);
736 }
737
738 /*
ef87f48d 739 * There are no more... Quit now.
984263bc 740 * If there are more bits, they are in error.
ef87f48d 741 * I've seen this. route(1) can evidently generate these.
984263bc 742 * This causes kernel to core dump.
ef87f48d 743 * For compatibility, if we see this, point to a safe address.
984263bc
MD
744 */
745 if (sa->sa_len == 0) {
590b8cd4
JH
746 static struct sockaddr sa_zero = {
747 sizeof sa_zero, AF_INET,
748 };
749
984263bc 750 rtinfo->rti_info[i] = &sa_zero;
9b42cabe 751 kprintf("rtsock: received more addr bits than sockaddrs.\n");
984263bc
MD
752 return (0); /* should be EINVAL but for compat */
753 }
754
ef87f48d 755 /* Accept the sockaddr. */
984263bc 756 rtinfo->rti_info[i] = sa;
590b8cd4 757 cp += ROUNDUP(sa->sa_len);
984263bc
MD
758 }
759 return (0);
760}
761
590b8cd4
JH
762static int
763rt_msghdrsize(int type)
984263bc 764{
984263bc 765 switch (type) {
984263bc
MD
766 case RTM_DELADDR:
767 case RTM_NEWADDR:
590b8cd4 768 return sizeof(struct ifa_msghdr);
984263bc
MD
769 case RTM_DELMADDR:
770 case RTM_NEWMADDR:
590b8cd4 771 return sizeof(struct ifma_msghdr);
984263bc 772 case RTM_IFINFO:
590b8cd4 773 return sizeof(struct if_msghdr);
984263bc 774 case RTM_IFANNOUNCE:
841ab66c 775 case RTM_IEEE80211:
590b8cd4 776 return sizeof(struct if_announcemsghdr);
984263bc 777 default:
590b8cd4 778 return sizeof(struct rt_msghdr);
984263bc 779 }
590b8cd4
JH
780}
781
782static int
783rt_msgsize(int type, struct rt_addrinfo *rtinfo)
784{
785 int len, i;
786
787 len = rt_msghdrsize(type);
788 for (i = 0; i < RTAX_MAX; i++) {
789 if (rtinfo->rti_info[i] != NULL)
790 len += ROUNDUP(rtinfo->rti_info[i]->sa_len);
984263bc 791 }
590b8cd4
JH
792 len = ALIGN(len);
793 return len;
794}
795
796/*
797 * Build a routing message in a buffer.
798 * Copy the addresses in the rtinfo->rti_info[] sockaddr array
799 * to the end of the buffer after the message header.
800 *
801 * Set the rtinfo->rti_addrs bitmask of addresses present in rtinfo->rti_info[].
802 * This side-effect can be avoided if we reorder the addrs bitmask field in all
803 * the route messages to line up so we can set it here instead of back in the
804 * calling routine.
805 */
806static void
807rt_msg_buffer(int type, struct rt_addrinfo *rtinfo, void *buf, int msglen)
808{
809 struct rt_msghdr *rtm;
810 char *cp;
811 int dlen, i;
812
813 rtm = (struct rt_msghdr *) buf;
814 rtm->rtm_version = RTM_VERSION;
815 rtm->rtm_type = type;
816 rtm->rtm_msglen = msglen;
817
818 cp = (char *)buf + rt_msghdrsize(type);
819 rtinfo->rti_addrs = 0;
984263bc 820 for (i = 0; i < RTAX_MAX; i++) {
590b8cd4
JH
821 struct sockaddr *sa;
822
984263bc
MD
823 if ((sa = rtinfo->rti_info[i]) == NULL)
824 continue;
825 rtinfo->rti_addrs |= (1 << i);
826 dlen = ROUNDUP(sa->sa_len);
590b8cd4
JH
827 bcopy(sa, cp, dlen);
828 cp += dlen;
984263bc 829 }
984263bc
MD
830}
831
590b8cd4
JH
832/*
833 * Build a routing message in a mbuf chain.
834 * Copy the addresses in the rtinfo->rti_info[] sockaddr array
835 * to the end of the mbuf after the message header.
836 *
837 * Set the rtinfo->rti_addrs bitmask of addresses present in rtinfo->rti_info[].
838 * This side-effect can be avoided if we reorder the addrs bitmask field in all
839 * the route messages to line up so we can set it here instead of back in the
840 * calling routine.
841 */
842static struct mbuf *
843rt_msg_mbuf(int type, struct rt_addrinfo *rtinfo)
984263bc 844{
590b8cd4
JH
845 struct mbuf *m;
846 struct rt_msghdr *rtm;
847 int hlen, len;
82ed7fc2 848 int i;
984263bc 849
590b8cd4
JH
850 hlen = rt_msghdrsize(type);
851 KASSERT(hlen <= MCLBYTES, ("rt_msg_mbuf: hlen %d doesn't fit", hlen));
984263bc 852
50503f0f 853 m = m_getl(hlen, MB_DONTWAIT, MT_DATA, M_PKTHDR, NULL);
590b8cd4
JH
854 if (m == NULL)
855 return (NULL);
e9fa4b60 856 mbuftrackid(m, 32);
590b8cd4
JH
857 m->m_pkthdr.len = m->m_len = hlen;
858 m->m_pkthdr.rcvif = NULL;
859 rtinfo->rti_addrs = 0;
860 len = hlen;
984263bc 861 for (i = 0; i < RTAX_MAX; i++) {
82ed7fc2 862 struct sockaddr *sa;
590b8cd4 863 int dlen;
984263bc 864
ef87f48d 865 if ((sa = rtinfo->rti_info[i]) == NULL)
984263bc
MD
866 continue;
867 rtinfo->rti_addrs |= (1 << i);
868 dlen = ROUNDUP(sa->sa_len);
590b8cd4 869 m_copyback(m, len, dlen, (caddr_t)sa); /* can grow mbuf chain */
984263bc
MD
870 len += dlen;
871 }
590b8cd4
JH
872 if (m->m_pkthdr.len != len) { /* one of the m_copyback() calls failed */
873 m_freem(m);
874 return (NULL);
984263bc 875 }
590b8cd4
JH
876 rtm = mtod(m, struct rt_msghdr *);
877 bzero(rtm, hlen);
878 rtm->rtm_msglen = len;
879 rtm->rtm_version = RTM_VERSION;
880 rtm->rtm_type = type;
881 return (m);
984263bc
MD
882}
883
884/*
885 * This routine is called to generate a message from the routing
f23061d4 886 * socket indicating that a redirect has occurred, a routing lookup
984263bc
MD
887 * has failed, or that a protocol has detected timeouts to a particular
888 * destination.
889 */
890void
f23061d4 891rt_missmsg(int type, struct rt_addrinfo *rtinfo, int flags, int error)
984263bc 892{
0c3c561c 893 struct sockaddr *dst = rtinfo->rti_info[RTAX_DST];
82ed7fc2
RG
894 struct rt_msghdr *rtm;
895 struct mbuf *m;
984263bc
MD
896
897 if (route_cb.any_count == 0)
898 return;
590b8cd4 899 m = rt_msg_mbuf(type, rtinfo);
ef87f48d 900 if (m == NULL)
984263bc
MD
901 return;
902 rtm = mtod(m, struct rt_msghdr *);
903 rtm->rtm_flags = RTF_DONE | flags;
904 rtm->rtm_errno = error;
905 rtm->rtm_addrs = rtinfo->rti_addrs;
590b8cd4 906 rts_input(m, familyof(dst));
984263bc
MD
907}
908
f3ed2586
JH
909void
910rt_dstmsg(int type, struct sockaddr *dst, int error)
911{
912 struct rt_msghdr *rtm;
913 struct rt_addrinfo addrs;
914 struct mbuf *m;
915
916 if (route_cb.any_count == 0)
917 return;
918 bzero(&addrs, sizeof(struct rt_addrinfo));
919 addrs.rti_info[RTAX_DST] = dst;
590b8cd4 920 m = rt_msg_mbuf(type, &addrs);
f3ed2586
JH
921 if (m == NULL)
922 return;
923 rtm = mtod(m, struct rt_msghdr *);
924 rtm->rtm_flags = RTF_DONE;
925 rtm->rtm_errno = error;
926 rtm->rtm_addrs = addrs.rti_addrs;
590b8cd4 927 rts_input(m, familyof(dst));
f3ed2586
JH
928}
929
984263bc
MD
930/*
931 * This routine is called to generate a message from the routing
932 * socket indicating that the status of a network interface has changed.
933 */
934void
0c3c561c 935rt_ifmsg(struct ifnet *ifp)
984263bc 936{
82ed7fc2 937 struct if_msghdr *ifm;
984263bc 938 struct mbuf *m;
590b8cd4 939 struct rt_addrinfo rtinfo;
984263bc
MD
940
941 if (route_cb.any_count == 0)
942 return;
590b8cd4
JH
943 bzero(&rtinfo, sizeof(struct rt_addrinfo));
944 m = rt_msg_mbuf(RTM_IFINFO, &rtinfo);
ef87f48d 945 if (m == NULL)
984263bc
MD
946 return;
947 ifm = mtod(m, struct if_msghdr *);
948 ifm->ifm_index = ifp->if_index;
9c095379 949 ifm->ifm_flags = ifp->if_flags;
984263bc 950 ifm->ifm_data = ifp->if_data;
590b8cd4
JH
951 ifm->ifm_addrs = 0;
952 rts_input(m, 0);
984263bc
MD
953}
954
372316d9
JH
955static void
956rt_ifamsg(int cmd, struct ifaddr *ifa)
957{
958 struct ifa_msghdr *ifam;
590b8cd4 959 struct rt_addrinfo rtinfo;
372316d9 960 struct mbuf *m;
372316d9
JH
961 struct ifnet *ifp = ifa->ifa_ifp;
962
590b8cd4
JH
963 bzero(&rtinfo, sizeof(struct rt_addrinfo));
964 rtinfo.rti_ifaaddr = ifa->ifa_addr;
b2632176
SZ
965 rtinfo.rti_ifpaddr =
966 TAILQ_FIRST(&ifp->if_addrheads[mycpuid])->ifa->ifa_addr;
590b8cd4
JH
967 rtinfo.rti_netmask = ifa->ifa_netmask;
968 rtinfo.rti_bcastaddr = ifa->ifa_dstaddr;
f23061d4 969
590b8cd4 970 m = rt_msg_mbuf(cmd, &rtinfo);
f23061d4 971 if (m == NULL)
372316d9 972 return;
f23061d4 973
372316d9
JH
974 ifam = mtod(m, struct ifa_msghdr *);
975 ifam->ifam_index = ifp->if_index;
976 ifam->ifam_metric = ifa->ifa_metric;
977 ifam->ifam_flags = ifa->ifa_flags;
590b8cd4 978 ifam->ifam_addrs = rtinfo.rti_addrs;
f23061d4 979
590b8cd4 980 rts_input(m, familyof(ifa->ifa_addr));
372316d9
JH
981}
982
f3ed2586
JH
983void
984rt_rtmsg(int cmd, struct rtentry *rt, struct ifnet *ifp, int error)
372316d9
JH
985{
986 struct rt_msghdr *rtm;
590b8cd4 987 struct rt_addrinfo rtinfo;
372316d9 988 struct mbuf *m;
f3ed2586 989 struct sockaddr *dst;
372316d9
JH
990
991 if (rt == NULL)
992 return;
f23061d4 993
590b8cd4
JH
994 bzero(&rtinfo, sizeof(struct rt_addrinfo));
995 rtinfo.rti_dst = dst = rt_key(rt);
996 rtinfo.rti_gateway = rt->rt_gateway;
997 rtinfo.rti_netmask = rt_mask(rt);
b2632176
SZ
998 if (ifp != NULL) {
999 rtinfo.rti_ifpaddr =
1000 TAILQ_FIRST(&ifp->if_addrheads[mycpuid])->ifa->ifa_addr;
1001 }
590b8cd4 1002 rtinfo.rti_ifaaddr = rt->rt_ifa->ifa_addr;
f23061d4 1003
590b8cd4 1004 m = rt_msg_mbuf(cmd, &rtinfo);
f23061d4 1005 if (m == NULL)
372316d9 1006 return;
f23061d4 1007
372316d9 1008 rtm = mtod(m, struct rt_msghdr *);
f3ed2586
JH
1009 if (ifp != NULL)
1010 rtm->rtm_index = ifp->if_index;
372316d9
JH
1011 rtm->rtm_flags |= rt->rt_flags;
1012 rtm->rtm_errno = error;
590b8cd4 1013 rtm->rtm_addrs = rtinfo.rti_addrs;
f23061d4 1014
590b8cd4 1015 rts_input(m, familyof(dst));
372316d9
JH
1016}
1017
984263bc
MD
1018/*
1019 * This is called to generate messages from the routing socket
1020 * indicating a network interface has had addresses associated with it.
1021 * if we ever reverse the logic and replace messages TO the routing
1022 * socket indicate a request to configure interfaces, then it will
1023 * be unnecessary as the routing socket will automatically generate
1024 * copies of it.
1025 */
1026void
0c3c561c 1027rt_newaddrmsg(int cmd, struct ifaddr *ifa, int error, struct rtentry *rt)
984263bc 1028{
78812139
EN
1029#ifdef SCTP
1030 /*
1031 * notify the SCTP stack
1032 * this will only get called when an address is added/deleted
1033 * XXX pass the ifaddr struct instead if ifa->ifa_addr...
1034 */
1035 if (cmd == RTM_ADD)
1036 sctp_add_ip_address(ifa);
1037 else if (cmd == RTM_DELETE)
1038 sctp_delete_ip_address(ifa);
1039#endif /* SCTP */
1040
984263bc
MD
1041 if (route_cb.any_count == 0)
1042 return;
984263bc 1043
372316d9
JH
1044 if (cmd == RTM_ADD) {
1045 rt_ifamsg(RTM_NEWADDR, ifa);
f3ed2586 1046 rt_rtmsg(RTM_ADD, rt, ifa->ifa_ifp, error);
372316d9
JH
1047 } else {
1048 KASSERT((cmd == RTM_DELETE), ("unknown cmd %d", cmd));
f3ed2586 1049 rt_rtmsg(RTM_DELETE, rt, ifa->ifa_ifp, error);
372316d9 1050 rt_ifamsg(RTM_DELADDR, ifa);
984263bc
MD
1051 }
1052}
1053
1054/*
1055 * This is the analogue to the rt_newaddrmsg which performs the same
1056 * function but for multicast group memberhips. This is easier since
1057 * there is no route state to worry about.
1058 */
1059void
0c3c561c 1060rt_newmaddrmsg(int cmd, struct ifmultiaddr *ifma)
984263bc 1061{
590b8cd4 1062 struct rt_addrinfo rtinfo;
ef87f48d 1063 struct mbuf *m = NULL;
984263bc
MD
1064 struct ifnet *ifp = ifma->ifma_ifp;
1065 struct ifma_msghdr *ifmam;
1066
1067 if (route_cb.any_count == 0)
1068 return;
1069
590b8cd4
JH
1070 bzero(&rtinfo, sizeof(struct rt_addrinfo));
1071 rtinfo.rti_ifaaddr = ifma->ifma_addr;
b2632176
SZ
1072 if (ifp != NULL && !TAILQ_EMPTY(&ifp->if_addrheads[mycpuid])) {
1073 rtinfo.rti_ifpaddr =
1074 TAILQ_FIRST(&ifp->if_addrheads[mycpuid])->ifa->ifa_addr;
1075 }
984263bc
MD
1076 /*
1077 * If a link-layer address is present, present it as a ``gateway''
1078 * (similarly to how ARP entries, e.g., are presented).
1079 */
590b8cd4 1080 rtinfo.rti_gateway = ifma->ifma_lladdr;
f23061d4 1081
590b8cd4 1082 m = rt_msg_mbuf(cmd, &rtinfo);
f23061d4 1083 if (m == NULL)
984263bc 1084 return;
f23061d4 1085
984263bc
MD
1086 ifmam = mtod(m, struct ifma_msghdr *);
1087 ifmam->ifmam_index = ifp->if_index;
590b8cd4 1088 ifmam->ifmam_addrs = rtinfo.rti_addrs;
f23061d4 1089
590b8cd4 1090 rts_input(m, familyof(ifma->ifma_addr));
984263bc
MD
1091}
1092
841ab66c
SZ
1093static struct mbuf *
1094rt_makeifannouncemsg(struct ifnet *ifp, int type, int what,
1095 struct rt_addrinfo *info)
984263bc 1096{
590b8cd4 1097 struct if_announcemsghdr *ifan;
841ab66c 1098 struct mbuf *m;
984263bc
MD
1099
1100 if (route_cb.any_count == 0)
841ab66c 1101 return NULL;
f23061d4 1102
841ab66c
SZ
1103 bzero(info, sizeof(*info));
1104 m = rt_msg_mbuf(type, info);
984263bc 1105 if (m == NULL)
841ab66c 1106 return NULL;
f23061d4 1107
984263bc
MD
1108 ifan = mtod(m, struct if_announcemsghdr *);
1109 ifan->ifan_index = ifp->if_index;
5fe66e68 1110 strlcpy(ifan->ifan_name, ifp->if_xname, sizeof ifan->ifan_name);
984263bc 1111 ifan->ifan_what = what;
841ab66c
SZ
1112 return m;
1113}
1114
1115/*
1116 * This is called to generate routing socket messages indicating
1117 * IEEE80211 wireless events.
1118 * XXX we piggyback on the RTM_IFANNOUNCE msg format in a clumsy way.
1119 */
1120void
1121rt_ieee80211msg(struct ifnet *ifp, int what, void *data, size_t data_len)
1122{
1123 struct rt_addrinfo info;
1124 struct mbuf *m;
f23061d4 1125
841ab66c
SZ
1126 m = rt_makeifannouncemsg(ifp, RTM_IEEE80211, what, &info);
1127 if (m == NULL)
1128 return;
1129
1130 /*
1131 * Append the ieee80211 data. Try to stick it in the
1132 * mbuf containing the ifannounce msg; otherwise allocate
1133 * a new mbuf and append.
1134 *
1135 * NB: we assume m is a single mbuf.
1136 */
1137 if (data_len > M_TRAILINGSPACE(m)) {
b11e1686 1138 struct mbuf *n = m_get(MB_DONTWAIT, MT_DATA);
841ab66c
SZ
1139 if (n == NULL) {
1140 m_freem(m);
1141 return;
1142 }
1143 bcopy(data, mtod(n, void *), data_len);
1144 n->m_len = data_len;
1145 m->m_next = n;
1146 } else if (data_len > 0) {
1147 bcopy(data, mtod(m, u_int8_t *) + m->m_len, data_len);
1148 m->m_len += data_len;
1149 }
e9fa4b60 1150 mbuftrackid(m, 33);
841ab66c
SZ
1151 if (m->m_flags & M_PKTHDR)
1152 m->m_pkthdr.len += data_len;
1153 mtod(m, struct if_announcemsghdr *)->ifan_msglen += data_len;
590b8cd4 1154 rts_input(m, 0);
841ab66c
SZ
1155}
1156
1157/*
1158 * This is called to generate routing socket messages indicating
1159 * network interface arrival and departure.
1160 */
1161void
1162rt_ifannouncemsg(struct ifnet *ifp, int what)
1163{
1164 struct rt_addrinfo addrinfo;
1165 struct mbuf *m;
1166
1167 m = rt_makeifannouncemsg(ifp, RTM_IFANNOUNCE, what, &addrinfo);
1168 if (m != NULL)
1169 rts_input(m, 0);
590b8cd4 1170}
f23061d4 1171
590b8cd4
JH
1172static int
1173resizewalkarg(struct walkarg *w, int len)
1174{
1175 void *newptr;
1176
efda3bd0 1177 newptr = kmalloc(len, M_RTABLE, M_INTWAIT | M_NULLOK);
590b8cd4
JH
1178 if (newptr == NULL)
1179 return (ENOMEM);
1180 if (w->w_tmem != NULL)
efda3bd0 1181 kfree(w->w_tmem, M_RTABLE);
590b8cd4
JH
1182 w->w_tmem = newptr;
1183 w->w_tmemsize = len;
1184 return (0);
1185}
984263bc
MD
1186
1187/*
1188 * This is used in dumping the kernel table via sysctl().
1189 */
1190int
590b8cd4 1191sysctl_dumpentry(struct radix_node *rn, void *vw)
984263bc 1192{
82ed7fc2
RG
1193 struct walkarg *w = vw;
1194 struct rtentry *rt = (struct rtentry *)rn;
590b8cd4
JH
1195 struct rt_addrinfo rtinfo;
1196 int error, msglen;
984263bc
MD
1197
1198 if (w->w_op == NET_RT_FLAGS && !(rt->rt_flags & w->w_arg))
1199 return 0;
f23061d4 1200
590b8cd4
JH
1201 bzero(&rtinfo, sizeof(struct rt_addrinfo));
1202 rtinfo.rti_dst = rt_key(rt);
1203 rtinfo.rti_gateway = rt->rt_gateway;
1204 rtinfo.rti_netmask = rt_mask(rt);
1205 rtinfo.rti_genmask = rt->rt_genmask;
ef87f48d 1206 if (rt->rt_ifp != NULL) {
590b8cd4 1207 rtinfo.rti_ifpaddr =
b2632176 1208 TAILQ_FIRST(&rt->rt_ifp->if_addrheads[mycpuid])->ifa->ifa_addr;
590b8cd4 1209 rtinfo.rti_ifaaddr = rt->rt_ifa->ifa_addr;
984263bc 1210 if (rt->rt_ifp->if_flags & IFF_POINTOPOINT)
590b8cd4 1211 rtinfo.rti_bcastaddr = rt->rt_ifa->ifa_dstaddr;
984263bc 1212 }
590b8cd4
JH
1213 msglen = rt_msgsize(RTM_GET, &rtinfo);
1214 if (w->w_tmemsize < msglen && resizewalkarg(w, msglen) != 0)
1215 return (ENOMEM);
1216 rt_msg_buffer(RTM_GET, &rtinfo, w->w_tmem, msglen);
1217 if (w->w_req != NULL) {
8e63efec 1218 struct rt_msghdr *rtm = w->w_tmem;
984263bc
MD
1219
1220 rtm->rtm_flags = rt->rt_flags;
1221 rtm->rtm_use = rt->rt_use;
1222 rtm->rtm_rmx = rt->rt_rmx;
1223 rtm->rtm_index = rt->rt_ifp->if_index;
1224 rtm->rtm_errno = rtm->rtm_pid = rtm->rtm_seq = 0;
590b8cd4
JH
1225 rtm->rtm_addrs = rtinfo.rti_addrs;
1226 error = SYSCTL_OUT(w->w_req, rtm, msglen);
984263bc
MD
1227 return (error);
1228 }
590b8cd4 1229 return (0);
984263bc
MD
1230}
1231
590b8cd4
JH
1232static int
1233sysctl_iflist(int af, struct walkarg *w)
984263bc 1234{
82ed7fc2 1235 struct ifnet *ifp;
590b8cd4
JH
1236 struct rt_addrinfo rtinfo;
1237 int msglen, error;
984263bc 1238
590b8cd4 1239 bzero(&rtinfo, sizeof(struct rt_addrinfo));
984263bc 1240 TAILQ_FOREACH(ifp, &ifnet, if_link) {
b2632176
SZ
1241 struct ifaddr_container *ifac;
1242 struct ifaddr *ifa;
1243
984263bc
MD
1244 if (w->w_arg && w->w_arg != ifp->if_index)
1245 continue;
b2632176
SZ
1246 ifac = TAILQ_FIRST(&ifp->if_addrheads[mycpuid]);
1247 ifa = ifac->ifa;
590b8cd4
JH
1248 rtinfo.rti_ifpaddr = ifa->ifa_addr;
1249 msglen = rt_msgsize(RTM_IFINFO, &rtinfo);
1250 if (w->w_tmemsize < msglen && resizewalkarg(w, msglen) != 0)
1251 return (ENOMEM);
1252 rt_msg_buffer(RTM_IFINFO, &rtinfo, w->w_tmem, msglen);
1253 rtinfo.rti_ifpaddr = NULL;
ef87f48d 1254 if (w->w_req != NULL && w->w_tmem != NULL) {
8e63efec 1255 struct if_msghdr *ifm = w->w_tmem;
984263bc 1256
984263bc 1257 ifm->ifm_index = ifp->if_index;
9c095379 1258 ifm->ifm_flags = ifp->if_flags;
984263bc 1259 ifm->ifm_data = ifp->if_data;
590b8cd4
JH
1260 ifm->ifm_addrs = rtinfo.rti_addrs;
1261 error = SYSCTL_OUT(w->w_req, ifm, msglen);
984263bc
MD
1262 if (error)
1263 return (error);
1264 }
b2632176
SZ
1265 while ((ifac = TAILQ_NEXT(ifac, ifa_link)) != NULL) {
1266 ifa = ifac->ifa;
1267
984263bc
MD
1268 if (af && af != ifa->ifa_addr->sa_family)
1269 continue;
590b8cd4 1270 if (curproc->p_ucred->cr_prison &&
87de5057 1271 prison_if(curproc->p_ucred, ifa->ifa_addr))
984263bc 1272 continue;
590b8cd4
JH
1273 rtinfo.rti_ifaaddr = ifa->ifa_addr;
1274 rtinfo.rti_netmask = ifa->ifa_netmask;
1275 rtinfo.rti_bcastaddr = ifa->ifa_dstaddr;
1276 msglen = rt_msgsize(RTM_NEWADDR, &rtinfo);
1277 if (w->w_tmemsize < msglen &&
1278 resizewalkarg(w, msglen) != 0)
1279 return (ENOMEM);
1280 rt_msg_buffer(RTM_NEWADDR, &rtinfo, w->w_tmem, msglen);
1281 if (w->w_req != NULL) {
8e63efec 1282 struct ifa_msghdr *ifam = w->w_tmem;
984263bc 1283
984263bc
MD
1284 ifam->ifam_index = ifa->ifa_ifp->if_index;
1285 ifam->ifam_flags = ifa->ifa_flags;
1286 ifam->ifam_metric = ifa->ifa_metric;
590b8cd4
JH
1287 ifam->ifam_addrs = rtinfo.rti_addrs;
1288 error = SYSCTL_OUT(w->w_req, w->w_tmem, msglen);
984263bc
MD
1289 if (error)
1290 return (error);
1291 }
1292 }
590b8cd4
JH
1293 rtinfo.rti_netmask = NULL;
1294 rtinfo.rti_ifaaddr = NULL;
1295 rtinfo.rti_bcastaddr = NULL;
984263bc
MD
1296 }
1297 return (0);
1298}
1299
1300static int
1301sysctl_rtsock(SYSCTL_HANDLER_ARGS)
1302{
1303 int *name = (int *)arg1;
1304 u_int namelen = arg2;
82ed7fc2 1305 struct radix_node_head *rnh;
a49aa710 1306 int i, error = EINVAL;
ecdefdda 1307 int origcpu;
984263bc
MD
1308 u_char af;
1309 struct walkarg w;
1310
1311 name ++;
1312 namelen--;
1313 if (req->newptr)
1314 return (EPERM);
ecdefdda 1315 if (namelen != 3 && namelen != 4)
984263bc
MD
1316 return (EINVAL);
1317 af = name[0];
5fe66e68 1318 bzero(&w, sizeof w);
984263bc
MD
1319 w.w_op = name[1];
1320 w.w_arg = name[2];
1321 w.w_req = req;
1322
ecdefdda
MD
1323 /*
1324 * Optional third argument specifies cpu, used primarily for
1325 * debugging the route table.
1326 */
1327 if (namelen == 4) {
1328 if (name[3] < 0 || name[3] >= ncpus)
1329 return (EINVAL);
1330 origcpu = mycpuid;
1331 lwkt_migratecpu(name[3]);
1332 } else {
1333 origcpu = -1;
1334 }
a49aa710 1335 crit_enter();
984263bc 1336 switch (w.w_op) {
984263bc
MD
1337 case NET_RT_DUMP:
1338 case NET_RT_FLAGS:
1339 for (i = 1; i <= AF_MAX; i++)
ecdefdda
MD
1340 if ((rnh = rt_tables[mycpuid][i]) &&
1341 (af == 0 || af == i) &&
984263bc 1342 (error = rnh->rnh_walktree(rnh,
f23061d4 1343 sysctl_dumpentry, &w)))
984263bc
MD
1344 break;
1345 break;
1346
1347 case NET_RT_IFLIST:
1348 error = sysctl_iflist(af, &w);
1349 }
a49aa710 1350 crit_exit();
590b8cd4 1351 if (w.w_tmem != NULL)
efda3bd0 1352 kfree(w.w_tmem, M_RTABLE);
ecdefdda
MD
1353 if (origcpu >= 0)
1354 lwkt_migratecpu(origcpu);
984263bc
MD
1355 return (error);
1356}
1357
1358SYSCTL_NODE(_net, PF_ROUTE, routetable, CTLFLAG_RD, sysctl_rtsock, "");
1359
1360/*
1361 * Definitions of protocols supported in the ROUTE domain.
1362 */
1363
ba4257b8 1364static struct domain routedomain; /* or at least forward */
984263bc
MD
1365
1366static struct protosw routesw[] = {
1367{ SOCK_RAW, &routedomain, 0, PR_ATOMIC|PR_ADDR,
1368 0, route_output, raw_ctlinput, 0,
9eeaa8a9 1369 cpu0_soport,
984263bc
MD
1370 raw_init, 0, 0, 0,
1371 &route_usrreqs
1372}
1373};
1374
ba4257b8 1375static struct domain routedomain = {
9c70fe43
JH
1376 PF_ROUTE, "route", NULL, NULL, NULL,
1377 routesw, &routesw[(sizeof routesw)/(sizeof routesw[0])],
1378};
984263bc
MD
1379
1380DOMAIN_SET(route);
47db7f9b 1381