1 1.23 msaitoh /* $NetBSD: rtsock_shared.c,v 1.23 2022/10/04 07:06:31 msaitoh Exp $ */ 2 1.2 pgoyette 3 1.2 pgoyette /* 4 1.2 pgoyette * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 5 1.2 pgoyette * All rights reserved. 6 1.2 pgoyette * 7 1.2 pgoyette * Redistribution and use in source and binary forms, with or without 8 1.2 pgoyette * modification, are permitted provided that the following conditions 9 1.2 pgoyette * are met: 10 1.2 pgoyette * 1. Redistributions of source code must retain the above copyright 11 1.2 pgoyette * notice, this list of conditions and the following disclaimer. 12 1.2 pgoyette * 2. Redistributions in binary form must reproduce the above copyright 13 1.2 pgoyette * notice, this list of conditions and the following disclaimer in the 14 1.2 pgoyette * documentation and/or other materials provided with the distribution. 15 1.2 pgoyette * 3. Neither the name of the project nor the names of its contributors 16 1.2 pgoyette * may be used to endorse or promote products derived from this software 17 1.2 pgoyette * without specific prior written permission. 18 1.2 pgoyette * 19 1.2 pgoyette * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 20 1.2 pgoyette * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 21 1.2 pgoyette * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 22 1.2 pgoyette * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 23 1.2 pgoyette * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 24 1.2 pgoyette * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 25 1.2 pgoyette * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26 1.2 pgoyette * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 27 1.2 pgoyette * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28 1.2 pgoyette * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29 1.2 pgoyette * SUCH DAMAGE. 30 1.2 pgoyette */ 31 1.2 pgoyette 32 1.2 pgoyette /* 33 1.2 pgoyette * Copyright (c) 1988, 1991, 1993 34 1.2 pgoyette * The Regents of the University of California. All rights reserved. 35 1.2 pgoyette * 36 1.2 pgoyette * Redistribution and use in source and binary forms, with or without 37 1.2 pgoyette * modification, are permitted provided that the following conditions 38 1.2 pgoyette * are met: 39 1.2 pgoyette * 1. Redistributions of source code must retain the above copyright 40 1.2 pgoyette * notice, this list of conditions and the following disclaimer. 41 1.2 pgoyette * 2. Redistributions in binary form must reproduce the above copyright 42 1.2 pgoyette * notice, this list of conditions and the following disclaimer in the 43 1.2 pgoyette * documentation and/or other materials provided with the distribution. 44 1.2 pgoyette * 3. Neither the name of the University nor the names of its contributors 45 1.2 pgoyette * may be used to endorse or promote products derived from this software 46 1.2 pgoyette * without specific prior written permission. 47 1.2 pgoyette * 48 1.2 pgoyette * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 49 1.2 pgoyette * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 50 1.2 pgoyette * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 51 1.2 pgoyette * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 52 1.2 pgoyette * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 53 1.2 pgoyette * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 54 1.2 pgoyette * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 55 1.2 pgoyette * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 56 1.2 pgoyette * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 57 1.2 pgoyette * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 58 1.2 pgoyette * SUCH DAMAGE. 59 1.2 pgoyette * 60 1.2 pgoyette * @(#)rtsock.c 8.7 (Berkeley) 10/12/95 61 1.2 pgoyette */ 62 1.2 pgoyette 63 1.2 pgoyette #include <sys/cdefs.h> 64 1.23 msaitoh __KERNEL_RCSID(0, "$NetBSD: rtsock_shared.c,v 1.23 2022/10/04 07:06:31 msaitoh Exp $"); 65 1.2 pgoyette 66 1.2 pgoyette #ifdef _KERNEL_OPT 67 1.2 pgoyette #include "opt_inet.h" 68 1.2 pgoyette #include "opt_net_mpsafe.h" 69 1.2 pgoyette #endif 70 1.2 pgoyette 71 1.2 pgoyette #include <sys/param.h> 72 1.2 pgoyette #include <sys/systm.h> 73 1.2 pgoyette #include <sys/proc.h> 74 1.2 pgoyette #include <sys/socket.h> 75 1.2 pgoyette #include <sys/socketvar.h> 76 1.2 pgoyette #include <sys/domain.h> 77 1.2 pgoyette #include <sys/protosw.h> 78 1.2 pgoyette #include <sys/sysctl.h> 79 1.2 pgoyette #include <sys/kauth.h> 80 1.2 pgoyette #include <sys/kmem.h> 81 1.2 pgoyette #include <sys/intr.h> 82 1.2 pgoyette #include <sys/condvar.h> 83 1.2 pgoyette #include <sys/compat_stub.h> 84 1.2 pgoyette 85 1.2 pgoyette #include <net/if.h> 86 1.2 pgoyette #include <net/if_llatbl.h> 87 1.2 pgoyette #include <net/if_types.h> 88 1.2 pgoyette #include <net/route.h> 89 1.2 pgoyette #include <net/raw_cb.h> 90 1.2 pgoyette 91 1.2 pgoyette #include <netinet/in_var.h> 92 1.2 pgoyette #include <netinet/if_inarp.h> 93 1.2 pgoyette 94 1.2 pgoyette #include <netmpls/mpls.h> 95 1.2 pgoyette 96 1.2 pgoyette #include <compat/net/if.h> 97 1.2 pgoyette #include <compat/net/route.h> 98 1.2 pgoyette 99 1.19 roy /* sa_family is after sa_len, rest is data */ 100 1.19 roy #define _SA_MINSIZE (offsetof(struct sockaddr, sa_family) + \ 101 1.19 roy sizeof(((struct sockaddr *)0)->sa_family)) 102 1.18 roy 103 1.2 pgoyette #ifdef COMPAT_RTSOCK 104 1.2 pgoyette /* 105 1.2 pgoyette * These are used when #include-d from compat/common/rtsock_50.c 106 1.2 pgoyette */ 107 1.2 pgoyette #define RTM_XVERSION RTM_OVERSION 108 1.2 pgoyette #define RTM_XNEWADDR RTM_ONEWADDR 109 1.2 pgoyette #define RTM_XDELADDR RTM_ODELADDR 110 1.2 pgoyette #define RTM_XCHGADDR RTM_OCHGADDR 111 1.2 pgoyette #define RT_XADVANCE(a,b) RT_OADVANCE(a,b) 112 1.2 pgoyette #define RT_XROUNDUP(n) RT_OROUNDUP(n) 113 1.2 pgoyette #define PF_XROUTE PF_OROUTE 114 1.2 pgoyette #define rt_xmsghdr rt_msghdr50 115 1.2 pgoyette #define if_xmsghdr if_msghdr /* if_msghdr50 is for RTM_OIFINFO */ 116 1.2 pgoyette #define ifa_xmsghdr ifa_msghdr50 117 1.2 pgoyette #define if_xannouncemsghdr if_announcemsghdr50 118 1.2 pgoyette #define COMPATNAME(x) compat_50_ ## x 119 1.2 pgoyette #define DOMAINNAME "oroute" 120 1.2 pgoyette #define COMPATCALL(name, args) \ 121 1.4 pgoyette MODULE_HOOK_CALL_VOID(rtsock_ ## name ## _50_hook, args, __nothing); 122 1.2 pgoyette #define RTS_CTASSERT(x) __nothing 123 1.2 pgoyette CTASSERT(sizeof(struct ifa_xmsghdr) == 20); 124 1.2 pgoyette DOMAIN_DEFINE(compat_50_routedomain); /* forward declare and add to link set */ 125 1.2 pgoyette #else /* COMPAT_RTSOCK */ 126 1.2 pgoyette /* 127 1.23 msaitoh * These are used normally, when not #include-d from compat/common/rtsock_50.c 128 1.2 pgoyette */ 129 1.2 pgoyette #define RTM_XVERSION RTM_VERSION 130 1.2 pgoyette #define RTM_XNEWADDR RTM_NEWADDR 131 1.2 pgoyette #define RTM_XDELADDR RTM_DELADDR 132 1.2 pgoyette #define RTM_XCHGADDR RTM_CHGADDR 133 1.2 pgoyette #define RT_XADVANCE(a,b) RT_ADVANCE(a,b) 134 1.2 pgoyette #define RT_XROUNDUP(n) RT_ROUNDUP(n) 135 1.2 pgoyette #define PF_XROUTE PF_ROUTE 136 1.2 pgoyette #define rt_xmsghdr rt_msghdr 137 1.2 pgoyette #define if_xmsghdr if_msghdr 138 1.2 pgoyette #define ifa_xmsghdr ifa_msghdr 139 1.2 pgoyette #define if_xannouncemsghdr if_announcemsghdr 140 1.2 pgoyette #define COMPATNAME(x) x 141 1.2 pgoyette #define DOMAINNAME "route" 142 1.2 pgoyette #define COMPATCALL(name, args) __nothing; 143 1.2 pgoyette #define RTS_CTASSERT(x) CTASSERT(x) 144 1.2 pgoyette CTASSERT(sizeof(struct ifa_xmsghdr) == 32); 145 1.2 pgoyette DOMAIN_DEFINE(routedomain); /* forward declare and add to link set */ 146 1.2 pgoyette #endif /* COMPAT_RTSOCK */ 147 1.2 pgoyette 148 1.2 pgoyette #ifdef RTSOCK_DEBUG 149 1.2 pgoyette #define RT_IN_PRINT(info, b, a) (in_print((b), sizeof(b), \ 150 1.2 pgoyette &((const struct sockaddr_in *)(info)->rti_info[(a)])->sin_addr), (b)) 151 1.2 pgoyette #endif /* RTSOCK_DEBUG */ 152 1.2 pgoyette 153 1.2 pgoyette struct route_info COMPATNAME(route_info) = { 154 1.2 pgoyette .ri_dst = { .sa_len = 2, .sa_family = PF_XROUTE, }, 155 1.2 pgoyette .ri_src = { .sa_len = 2, .sa_family = PF_XROUTE, }, 156 1.2 pgoyette .ri_maxqlen = IFQ_MAXLEN, 157 1.2 pgoyette }; 158 1.2 pgoyette 159 1.2 pgoyette static void COMPATNAME(route_init)(void); 160 1.2 pgoyette static int COMPATNAME(route_output)(struct mbuf *, struct socket *); 161 1.2 pgoyette 162 1.2 pgoyette static int rt_xaddrs(u_char, const char *, const char *, struct rt_addrinfo *); 163 1.2 pgoyette static struct mbuf *rt_makeifannouncemsg(struct ifnet *, int, int, 164 1.2 pgoyette struct rt_addrinfo *); 165 1.2 pgoyette static int rt_msg2(int, struct rt_addrinfo *, void *, struct rt_walkarg *, int *); 166 1.2 pgoyette static void _rt_setmetrics(int, const struct rt_xmsghdr *, struct rtentry *); 167 1.2 pgoyette static void rtm_setmetrics(const struct rtentry *, struct rt_xmsghdr *); 168 1.2 pgoyette static void rt_adjustcount(int, int); 169 1.2 pgoyette 170 1.2 pgoyette static const struct protosw COMPATNAME(route_protosw)[]; 171 1.2 pgoyette 172 1.2 pgoyette struct routecb { 173 1.2 pgoyette struct rawcb rocb_rcb; 174 1.2 pgoyette unsigned int rocb_msgfilter; 175 1.2 pgoyette #define RTMSGFILTER(m) (1U << (m)) 176 1.13 roy char *rocb_missfilter; 177 1.13 roy size_t rocb_missfilterlen; 178 1.2 pgoyette }; 179 1.2 pgoyette #define sotoroutecb(so) ((struct routecb *)(so)->so_pcb) 180 1.2 pgoyette 181 1.2 pgoyette static struct rawcbhead rt_rawcb; 182 1.2 pgoyette #ifdef NET_MPSAFE 183 1.2 pgoyette static kmutex_t *rt_so_mtx; 184 1.2 pgoyette 185 1.2 pgoyette static bool rt_updating = false; 186 1.2 pgoyette static kcondvar_t rt_update_cv; 187 1.2 pgoyette #endif 188 1.2 pgoyette 189 1.2 pgoyette static void 190 1.2 pgoyette rt_adjustcount(int af, int cnt) 191 1.2 pgoyette { 192 1.2 pgoyette struct route_cb * const cb = &COMPATNAME(route_info).ri_cb; 193 1.2 pgoyette 194 1.2 pgoyette cb->any_count += cnt; 195 1.2 pgoyette 196 1.2 pgoyette switch (af) { 197 1.2 pgoyette case AF_INET: 198 1.2 pgoyette cb->ip_count += cnt; 199 1.2 pgoyette return; 200 1.2 pgoyette #ifdef INET6 201 1.2 pgoyette case AF_INET6: 202 1.2 pgoyette cb->ip6_count += cnt; 203 1.2 pgoyette return; 204 1.2 pgoyette #endif 205 1.2 pgoyette case AF_MPLS: 206 1.2 pgoyette cb->mpls_count += cnt; 207 1.2 pgoyette return; 208 1.2 pgoyette } 209 1.2 pgoyette } 210 1.2 pgoyette 211 1.2 pgoyette static int 212 1.2 pgoyette COMPATNAME(route_filter)(struct mbuf *m, struct sockproto *proto, 213 1.2 pgoyette struct rawcb *rp) 214 1.2 pgoyette { 215 1.2 pgoyette struct routecb *rop = (struct routecb *)rp; 216 1.22 riastrad struct rt_xmsghdr rtm; 217 1.2 pgoyette 218 1.2 pgoyette KASSERT(m != NULL); 219 1.2 pgoyette KASSERT(proto != NULL); 220 1.2 pgoyette KASSERT(rp != NULL); 221 1.2 pgoyette 222 1.2 pgoyette /* Wrong family for this socket. */ 223 1.2 pgoyette if (proto->sp_family != PF_ROUTE) 224 1.2 pgoyette return ENOPROTOOPT; 225 1.2 pgoyette 226 1.2 pgoyette /* If no filter set, just return. */ 227 1.13 roy if (rop->rocb_msgfilter == 0 && rop->rocb_missfilterlen == 0) 228 1.2 pgoyette return 0; 229 1.2 pgoyette 230 1.2 pgoyette /* Ensure we can access rtm_type */ 231 1.2 pgoyette if (m->m_len < 232 1.22 riastrad offsetof(struct rt_xmsghdr, rtm_type) + sizeof(rtm.rtm_type)) 233 1.2 pgoyette return EINVAL; 234 1.2 pgoyette 235 1.22 riastrad m_copydata(m, offsetof(struct rt_xmsghdr, rtm_type), 236 1.22 riastrad sizeof(rtm.rtm_type), &rtm.rtm_type); 237 1.22 riastrad if (rtm.rtm_type >= sizeof(rop->rocb_msgfilter) * CHAR_BIT) 238 1.11 maxv return EINVAL; 239 1.2 pgoyette /* If the rtm type is filtered out, return a positive. */ 240 1.13 roy if (rop->rocb_msgfilter != 0 && 241 1.22 riastrad !(rop->rocb_msgfilter & RTMSGFILTER(rtm.rtm_type))) 242 1.2 pgoyette return EEXIST; 243 1.2 pgoyette 244 1.22 riastrad if (rop->rocb_missfilterlen != 0 && rtm.rtm_type == RTM_MISS) { 245 1.14 roy __CTASSERT(RTAX_DST == 0); 246 1.14 roy struct sockaddr_storage ss; 247 1.14 roy struct sockaddr *dst = (struct sockaddr *)&ss, *sa; 248 1.13 roy char *cp = rop->rocb_missfilter; 249 1.13 roy char *ep = cp + rop->rocb_missfilterlen; 250 1.13 roy 251 1.14 roy /* Ensure we can access sa_len */ 252 1.22 riastrad if (m->m_pkthdr.len < sizeof(rtm) + _SA_MINSIZE) 253 1.14 roy return EINVAL; 254 1.22 riastrad m_copydata(m, sizeof(rtm) + offsetof(struct sockaddr, sa_len), 255 1.15 maxv sizeof(ss.ss_len), &ss.ss_len); 256 1.18 roy if (ss.ss_len < _SA_MINSIZE || 257 1.18 roy ss.ss_len > sizeof(ss) || 258 1.22 riastrad m->m_pkthdr.len < sizeof(rtm) + ss.ss_len) 259 1.14 roy return EINVAL; 260 1.14 roy /* Copy out the destination sockaddr */ 261 1.22 riastrad m_copydata(m, sizeof(rtm), ss.ss_len, &ss); 262 1.14 roy 263 1.14 roy /* Find a matching sockaddr in the filter */ 264 1.13 roy while (cp < ep) { 265 1.13 roy sa = (struct sockaddr *)cp; 266 1.13 roy if (sa->sa_len == dst->sa_len && 267 1.13 roy memcmp(sa, dst, sa->sa_len) == 0) 268 1.13 roy break; 269 1.13 roy cp += RT_XROUNDUP(sa->sa_len); 270 1.13 roy } 271 1.13 roy if (cp == ep) 272 1.13 roy return EEXIST; 273 1.13 roy } 274 1.13 roy 275 1.2 pgoyette /* Passed the filter. */ 276 1.2 pgoyette return 0; 277 1.2 pgoyette } 278 1.2 pgoyette 279 1.2 pgoyette static void 280 1.2 pgoyette rt_pr_init(void) 281 1.2 pgoyette { 282 1.2 pgoyette 283 1.2 pgoyette LIST_INIT(&rt_rawcb); 284 1.2 pgoyette } 285 1.2 pgoyette 286 1.2 pgoyette static int 287 1.2 pgoyette COMPATNAME(route_attach)(struct socket *so, int proto) 288 1.2 pgoyette { 289 1.2 pgoyette struct rawcb *rp; 290 1.2 pgoyette struct routecb *rop; 291 1.2 pgoyette int s, error; 292 1.2 pgoyette 293 1.2 pgoyette KASSERT(sotorawcb(so) == NULL); 294 1.2 pgoyette rop = kmem_zalloc(sizeof(*rop), KM_SLEEP); 295 1.2 pgoyette rp = &rop->rocb_rcb; 296 1.2 pgoyette rp->rcb_len = sizeof(*rop); 297 1.2 pgoyette so->so_pcb = rp; 298 1.2 pgoyette 299 1.2 pgoyette s = splsoftnet(); 300 1.2 pgoyette 301 1.2 pgoyette #ifdef NET_MPSAFE 302 1.2 pgoyette KASSERT(so->so_lock == NULL); 303 1.2 pgoyette mutex_obj_hold(rt_so_mtx); 304 1.2 pgoyette so->so_lock = rt_so_mtx; 305 1.2 pgoyette solock(so); 306 1.2 pgoyette #endif 307 1.2 pgoyette 308 1.2 pgoyette if ((error = raw_attach(so, proto, &rt_rawcb)) == 0) { 309 1.2 pgoyette rt_adjustcount(rp->rcb_proto.sp_protocol, 1); 310 1.2 pgoyette rp->rcb_laddr = &COMPATNAME(route_info).ri_src; 311 1.2 pgoyette rp->rcb_faddr = &COMPATNAME(route_info).ri_dst; 312 1.2 pgoyette rp->rcb_filter = COMPATNAME(route_filter); 313 1.2 pgoyette } 314 1.2 pgoyette splx(s); 315 1.2 pgoyette 316 1.2 pgoyette if (error) { 317 1.2 pgoyette kmem_free(rop, sizeof(*rop)); 318 1.2 pgoyette so->so_pcb = NULL; 319 1.2 pgoyette return error; 320 1.2 pgoyette } 321 1.2 pgoyette 322 1.2 pgoyette soisconnected(so); 323 1.2 pgoyette so->so_options |= SO_USELOOPBACK; 324 1.2 pgoyette KASSERT(solocked(so)); 325 1.2 pgoyette 326 1.2 pgoyette return error; 327 1.2 pgoyette } 328 1.2 pgoyette 329 1.2 pgoyette static void 330 1.2 pgoyette COMPATNAME(route_detach)(struct socket *so) 331 1.2 pgoyette { 332 1.2 pgoyette struct rawcb *rp = sotorawcb(so); 333 1.13 roy struct routecb *rop = (struct routecb *)rp; 334 1.2 pgoyette int s; 335 1.2 pgoyette 336 1.2 pgoyette KASSERT(rp != NULL); 337 1.2 pgoyette KASSERT(solocked(so)); 338 1.2 pgoyette 339 1.2 pgoyette s = splsoftnet(); 340 1.13 roy if (rop->rocb_missfilterlen != 0) 341 1.13 roy kmem_free(rop->rocb_missfilter, rop->rocb_missfilterlen); 342 1.2 pgoyette rt_adjustcount(rp->rcb_proto.sp_protocol, -1); 343 1.2 pgoyette raw_detach(so); 344 1.2 pgoyette splx(s); 345 1.2 pgoyette } 346 1.2 pgoyette 347 1.2 pgoyette static int 348 1.2 pgoyette COMPATNAME(route_accept)(struct socket *so, struct sockaddr *nam) 349 1.2 pgoyette { 350 1.2 pgoyette KASSERT(solocked(so)); 351 1.2 pgoyette 352 1.2 pgoyette panic("route_accept"); 353 1.2 pgoyette 354 1.2 pgoyette return EOPNOTSUPP; 355 1.2 pgoyette } 356 1.2 pgoyette 357 1.2 pgoyette static int 358 1.2 pgoyette COMPATNAME(route_bind)(struct socket *so, struct sockaddr *nam, struct lwp *l) 359 1.2 pgoyette { 360 1.2 pgoyette KASSERT(solocked(so)); 361 1.2 pgoyette 362 1.2 pgoyette return EOPNOTSUPP; 363 1.2 pgoyette } 364 1.2 pgoyette 365 1.2 pgoyette static int 366 1.2 pgoyette COMPATNAME(route_listen)(struct socket *so, struct lwp *l) 367 1.2 pgoyette { 368 1.2 pgoyette KASSERT(solocked(so)); 369 1.2 pgoyette 370 1.2 pgoyette return EOPNOTSUPP; 371 1.2 pgoyette } 372 1.2 pgoyette 373 1.2 pgoyette static int 374 1.2 pgoyette COMPATNAME(route_connect)(struct socket *so, struct sockaddr *nam, struct lwp *l) 375 1.2 pgoyette { 376 1.2 pgoyette KASSERT(solocked(so)); 377 1.2 pgoyette 378 1.2 pgoyette return EOPNOTSUPP; 379 1.2 pgoyette } 380 1.2 pgoyette 381 1.2 pgoyette static int 382 1.2 pgoyette COMPATNAME(route_connect2)(struct socket *so, struct socket *so2) 383 1.2 pgoyette { 384 1.2 pgoyette KASSERT(solocked(so)); 385 1.2 pgoyette 386 1.2 pgoyette return EOPNOTSUPP; 387 1.2 pgoyette } 388 1.2 pgoyette 389 1.2 pgoyette static int 390 1.2 pgoyette COMPATNAME(route_disconnect)(struct socket *so) 391 1.2 pgoyette { 392 1.2 pgoyette struct rawcb *rp = sotorawcb(so); 393 1.2 pgoyette int s; 394 1.2 pgoyette 395 1.2 pgoyette KASSERT(solocked(so)); 396 1.2 pgoyette KASSERT(rp != NULL); 397 1.2 pgoyette 398 1.2 pgoyette s = splsoftnet(); 399 1.2 pgoyette soisdisconnected(so); 400 1.2 pgoyette raw_disconnect(rp); 401 1.2 pgoyette splx(s); 402 1.2 pgoyette 403 1.2 pgoyette return 0; 404 1.2 pgoyette } 405 1.2 pgoyette 406 1.2 pgoyette static int 407 1.2 pgoyette COMPATNAME(route_shutdown)(struct socket *so) 408 1.2 pgoyette { 409 1.2 pgoyette int s; 410 1.2 pgoyette 411 1.2 pgoyette KASSERT(solocked(so)); 412 1.2 pgoyette 413 1.2 pgoyette /* 414 1.2 pgoyette * Mark the connection as being incapable of further input. 415 1.2 pgoyette */ 416 1.2 pgoyette s = splsoftnet(); 417 1.2 pgoyette socantsendmore(so); 418 1.2 pgoyette splx(s); 419 1.2 pgoyette return 0; 420 1.2 pgoyette } 421 1.2 pgoyette 422 1.2 pgoyette static int 423 1.2 pgoyette COMPATNAME(route_abort)(struct socket *so) 424 1.2 pgoyette { 425 1.2 pgoyette KASSERT(solocked(so)); 426 1.2 pgoyette 427 1.2 pgoyette panic("route_abort"); 428 1.2 pgoyette 429 1.2 pgoyette return EOPNOTSUPP; 430 1.2 pgoyette } 431 1.2 pgoyette 432 1.2 pgoyette static int 433 1.2 pgoyette COMPATNAME(route_ioctl)(struct socket *so, u_long cmd, void *nam, 434 1.2 pgoyette struct ifnet * ifp) 435 1.2 pgoyette { 436 1.2 pgoyette return EOPNOTSUPP; 437 1.2 pgoyette } 438 1.2 pgoyette 439 1.2 pgoyette static int 440 1.2 pgoyette COMPATNAME(route_stat)(struct socket *so, struct stat *ub) 441 1.2 pgoyette { 442 1.2 pgoyette KASSERT(solocked(so)); 443 1.2 pgoyette 444 1.2 pgoyette return 0; 445 1.2 pgoyette } 446 1.2 pgoyette 447 1.2 pgoyette static int 448 1.2 pgoyette COMPATNAME(route_peeraddr)(struct socket *so, struct sockaddr *nam) 449 1.2 pgoyette { 450 1.2 pgoyette struct rawcb *rp = sotorawcb(so); 451 1.2 pgoyette 452 1.2 pgoyette KASSERT(solocked(so)); 453 1.2 pgoyette KASSERT(rp != NULL); 454 1.2 pgoyette KASSERT(nam != NULL); 455 1.2 pgoyette 456 1.2 pgoyette if (rp->rcb_faddr == NULL) 457 1.2 pgoyette return ENOTCONN; 458 1.2 pgoyette 459 1.2 pgoyette raw_setpeeraddr(rp, nam); 460 1.2 pgoyette return 0; 461 1.2 pgoyette } 462 1.2 pgoyette 463 1.2 pgoyette static int 464 1.2 pgoyette COMPATNAME(route_sockaddr)(struct socket *so, struct sockaddr *nam) 465 1.2 pgoyette { 466 1.2 pgoyette struct rawcb *rp = sotorawcb(so); 467 1.2 pgoyette 468 1.2 pgoyette KASSERT(solocked(so)); 469 1.2 pgoyette KASSERT(rp != NULL); 470 1.2 pgoyette KASSERT(nam != NULL); 471 1.2 pgoyette 472 1.2 pgoyette if (rp->rcb_faddr == NULL) 473 1.2 pgoyette return ENOTCONN; 474 1.2 pgoyette 475 1.2 pgoyette raw_setsockaddr(rp, nam); 476 1.2 pgoyette return 0; 477 1.2 pgoyette } 478 1.2 pgoyette 479 1.2 pgoyette static int 480 1.2 pgoyette COMPATNAME(route_rcvd)(struct socket *so, int flags, struct lwp *l) 481 1.2 pgoyette { 482 1.2 pgoyette KASSERT(solocked(so)); 483 1.2 pgoyette 484 1.2 pgoyette return EOPNOTSUPP; 485 1.2 pgoyette } 486 1.2 pgoyette 487 1.2 pgoyette static int 488 1.2 pgoyette COMPATNAME(route_recvoob)(struct socket *so, struct mbuf *m, int flags) 489 1.2 pgoyette { 490 1.2 pgoyette KASSERT(solocked(so)); 491 1.2 pgoyette 492 1.2 pgoyette return EOPNOTSUPP; 493 1.2 pgoyette } 494 1.2 pgoyette 495 1.2 pgoyette static int 496 1.2 pgoyette COMPATNAME(route_send)(struct socket *so, struct mbuf *m, 497 1.2 pgoyette struct sockaddr *nam, struct mbuf *control, struct lwp *l) 498 1.2 pgoyette { 499 1.2 pgoyette int error = 0; 500 1.2 pgoyette int s; 501 1.2 pgoyette 502 1.2 pgoyette KASSERT(solocked(so)); 503 1.2 pgoyette KASSERT(so->so_proto == &COMPATNAME(route_protosw)[0]); 504 1.2 pgoyette 505 1.2 pgoyette s = splsoftnet(); 506 1.2 pgoyette error = raw_send(so, m, nam, control, l, &COMPATNAME(route_output)); 507 1.2 pgoyette splx(s); 508 1.2 pgoyette 509 1.2 pgoyette return error; 510 1.2 pgoyette } 511 1.2 pgoyette 512 1.2 pgoyette static int 513 1.2 pgoyette COMPATNAME(route_sendoob)(struct socket *so, struct mbuf *m, 514 1.2 pgoyette struct mbuf *control) 515 1.2 pgoyette { 516 1.2 pgoyette KASSERT(solocked(so)); 517 1.2 pgoyette 518 1.2 pgoyette m_freem(m); 519 1.2 pgoyette m_freem(control); 520 1.2 pgoyette 521 1.2 pgoyette return EOPNOTSUPP; 522 1.2 pgoyette } 523 1.2 pgoyette static int 524 1.2 pgoyette COMPATNAME(route_purgeif)(struct socket *so, struct ifnet *ifp) 525 1.2 pgoyette { 526 1.2 pgoyette 527 1.2 pgoyette panic("route_purgeif"); 528 1.2 pgoyette 529 1.2 pgoyette return EOPNOTSUPP; 530 1.2 pgoyette } 531 1.2 pgoyette 532 1.2 pgoyette #if defined(INET) || defined(INET6) 533 1.2 pgoyette static int 534 1.2 pgoyette route_get_sdl_index(struct rt_addrinfo *info, int *sdl_index) 535 1.2 pgoyette { 536 1.2 pgoyette struct rtentry *nrt; 537 1.2 pgoyette int error; 538 1.2 pgoyette 539 1.2 pgoyette error = rtrequest1(RTM_GET, info, &nrt); 540 1.2 pgoyette if (error != 0) 541 1.2 pgoyette return error; 542 1.2 pgoyette /* 543 1.2 pgoyette * nrt->rt_ifp->if_index may not be correct 544 1.2 pgoyette * due to changing to ifplo0. 545 1.2 pgoyette */ 546 1.2 pgoyette *sdl_index = satosdl(nrt->rt_gateway)->sdl_index; 547 1.2 pgoyette rt_unref(nrt); 548 1.2 pgoyette 549 1.2 pgoyette return 0; 550 1.2 pgoyette } 551 1.2 pgoyette #endif 552 1.2 pgoyette 553 1.2 pgoyette static void 554 1.2 pgoyette route_get_sdl(const struct ifnet *ifp, const struct sockaddr *dst, 555 1.2 pgoyette struct sockaddr_dl *sdl, int *flags) 556 1.2 pgoyette { 557 1.2 pgoyette struct llentry *la; 558 1.2 pgoyette 559 1.2 pgoyette KASSERT(ifp != NULL); 560 1.2 pgoyette 561 1.2 pgoyette IF_AFDATA_RLOCK(ifp); 562 1.2 pgoyette switch (dst->sa_family) { 563 1.2 pgoyette case AF_INET: 564 1.2 pgoyette la = lla_lookup(LLTABLE(ifp), 0, dst); 565 1.2 pgoyette break; 566 1.2 pgoyette case AF_INET6: 567 1.2 pgoyette la = lla_lookup(LLTABLE6(ifp), 0, dst); 568 1.2 pgoyette break; 569 1.2 pgoyette default: 570 1.2 pgoyette la = NULL; 571 1.2 pgoyette KASSERTMSG(0, "Invalid AF=%d\n", dst->sa_family); 572 1.2 pgoyette break; 573 1.2 pgoyette } 574 1.2 pgoyette IF_AFDATA_RUNLOCK(ifp); 575 1.2 pgoyette 576 1.2 pgoyette void *a = (LLE_IS_VALID(la) && (la->la_flags & LLE_VALID) == LLE_VALID) 577 1.2 pgoyette ? &la->ll_addr : NULL; 578 1.2 pgoyette 579 1.2 pgoyette a = sockaddr_dl_init(sdl, sizeof(*sdl), ifp->if_index, ifp->if_type, 580 1.2 pgoyette NULL, 0, a, ifp->if_addrlen); 581 1.2 pgoyette KASSERT(a != NULL); 582 1.2 pgoyette 583 1.2 pgoyette if (la != NULL) { 584 1.2 pgoyette *flags = la->la_flags; 585 1.2 pgoyette LLE_RUNLOCK(la); 586 1.2 pgoyette } 587 1.2 pgoyette } 588 1.2 pgoyette 589 1.2 pgoyette static int 590 1.2 pgoyette route_output_report(struct rtentry *rt, struct rt_addrinfo *info, 591 1.2 pgoyette struct rt_xmsghdr *rtm, struct rt_xmsghdr **new_rtm) 592 1.2 pgoyette { 593 1.5 thorpej int len, error; 594 1.2 pgoyette 595 1.2 pgoyette if (rtm->rtm_addrs & (RTA_IFP | RTA_IFA)) { 596 1.2 pgoyette const struct ifaddr *rtifa; 597 1.2 pgoyette const struct ifnet *ifp = rt->rt_ifp; 598 1.2 pgoyette 599 1.2 pgoyette info->rti_info[RTAX_IFP] = ifp->if_dl->ifa_addr; 600 1.2 pgoyette /* rtifa used to be simply rt->rt_ifa. 601 1.2 pgoyette * If rt->rt_ifa != NULL, then 602 1.2 pgoyette * rt_get_ifa() != NULL. So this 603 1.2 pgoyette * ought to still be safe. --dyoung 604 1.2 pgoyette */ 605 1.2 pgoyette rtifa = rt_get_ifa(rt); 606 1.2 pgoyette info->rti_info[RTAX_IFA] = rtifa->ifa_addr; 607 1.2 pgoyette #ifdef RTSOCK_DEBUG 608 1.2 pgoyette if (info->rti_info[RTAX_IFA]->sa_family == AF_INET) { 609 1.2 pgoyette char ibuf[INET_ADDRSTRLEN]; 610 1.2 pgoyette char abuf[INET_ADDRSTRLEN]; 611 1.2 pgoyette printf("%s: copying out RTAX_IFA %s " 612 1.2 pgoyette "for info->rti_info[RTAX_DST] %s " 613 1.2 pgoyette "ifa_getifa %p ifa_seqno %p\n", 614 1.2 pgoyette __func__, 615 1.2 pgoyette RT_IN_PRINT(info, ibuf, RTAX_IFA), 616 1.2 pgoyette RT_IN_PRINT(info, abuf, RTAX_DST), 617 1.2 pgoyette (void *)rtifa->ifa_getifa, 618 1.2 pgoyette rtifa->ifa_seqno); 619 1.2 pgoyette } 620 1.2 pgoyette #endif /* RTSOCK_DEBUG */ 621 1.2 pgoyette if (ifp->if_flags & IFF_POINTOPOINT) 622 1.2 pgoyette info->rti_info[RTAX_BRD] = rtifa->ifa_dstaddr; 623 1.2 pgoyette else 624 1.2 pgoyette info->rti_info[RTAX_BRD] = NULL; 625 1.2 pgoyette rtm->rtm_index = ifp->if_index; 626 1.2 pgoyette } 627 1.5 thorpej error = rt_msg2(rtm->rtm_type, info, NULL, NULL, &len); 628 1.5 thorpej if (error) 629 1.5 thorpej return error; 630 1.2 pgoyette if (len > rtm->rtm_msglen) { 631 1.2 pgoyette struct rt_xmsghdr *old_rtm = rtm; 632 1.2 pgoyette R_Malloc(*new_rtm, struct rt_xmsghdr *, len); 633 1.2 pgoyette if (*new_rtm == NULL) 634 1.2 pgoyette return ENOBUFS; 635 1.2 pgoyette (void)memcpy(*new_rtm, old_rtm, old_rtm->rtm_msglen); 636 1.2 pgoyette rtm = *new_rtm; 637 1.2 pgoyette } 638 1.2 pgoyette (void)rt_msg2(rtm->rtm_type, info, rtm, NULL, 0); 639 1.2 pgoyette rtm->rtm_flags = rt->rt_flags; 640 1.2 pgoyette rtm_setmetrics(rt, rtm); 641 1.2 pgoyette rtm->rtm_addrs = info->rti_addrs; 642 1.2 pgoyette 643 1.2 pgoyette return 0; 644 1.2 pgoyette } 645 1.2 pgoyette 646 1.2 pgoyette /*ARGSUSED*/ 647 1.2 pgoyette int 648 1.2 pgoyette COMPATNAME(route_output)(struct mbuf *m, struct socket *so) 649 1.2 pgoyette { 650 1.2 pgoyette struct sockproto proto = { .sp_family = PF_XROUTE, }; 651 1.21 riastrad struct rt_xmsghdr hdr; 652 1.2 pgoyette struct rt_xmsghdr *rtm = NULL; 653 1.2 pgoyette struct rt_xmsghdr *old_rtm = NULL, *new_rtm = NULL; 654 1.2 pgoyette struct rtentry *rt = NULL; 655 1.2 pgoyette struct rtentry *saved_nrt = NULL; 656 1.2 pgoyette struct rt_addrinfo info; 657 1.2 pgoyette int len, error = 0; 658 1.2 pgoyette sa_family_t family; 659 1.2 pgoyette struct sockaddr_dl sdl; 660 1.2 pgoyette int bound = curlwp_bind(); 661 1.2 pgoyette bool do_rt_free = false; 662 1.2 pgoyette struct sockaddr_storage netmask; 663 1.2 pgoyette 664 1.2 pgoyette #define senderr(e) do { error = e; goto flush;} while (/*CONSTCOND*/ 0) 665 1.2 pgoyette if (m == NULL || ((m->m_len < sizeof(int32_t)) && 666 1.2 pgoyette (m = m_pullup(m, sizeof(int32_t))) == NULL)) { 667 1.2 pgoyette error = ENOBUFS; 668 1.2 pgoyette goto out; 669 1.2 pgoyette } 670 1.2 pgoyette if ((m->m_flags & M_PKTHDR) == 0) 671 1.2 pgoyette panic("%s", __func__); 672 1.2 pgoyette len = m->m_pkthdr.len; 673 1.20 riastrad if (len < sizeof(*rtm)) { 674 1.20 riastrad info.rti_info[RTAX_DST] = NULL; 675 1.20 riastrad senderr(EINVAL); 676 1.20 riastrad } 677 1.21 riastrad m_copydata(m, 0, sizeof(hdr), &hdr); 678 1.21 riastrad if (len != hdr.rtm_msglen) { 679 1.2 pgoyette info.rti_info[RTAX_DST] = NULL; 680 1.2 pgoyette senderr(EINVAL); 681 1.2 pgoyette } 682 1.2 pgoyette R_Malloc(rtm, struct rt_xmsghdr *, len); 683 1.2 pgoyette if (rtm == NULL) { 684 1.2 pgoyette info.rti_info[RTAX_DST] = NULL; 685 1.2 pgoyette senderr(ENOBUFS); 686 1.2 pgoyette } 687 1.2 pgoyette m_copydata(m, 0, len, rtm); 688 1.2 pgoyette if (rtm->rtm_version != RTM_XVERSION) { 689 1.2 pgoyette info.rti_info[RTAX_DST] = NULL; 690 1.2 pgoyette senderr(EPROTONOSUPPORT); 691 1.2 pgoyette } 692 1.2 pgoyette rtm->rtm_pid = curproc->p_pid; 693 1.2 pgoyette memset(&info, 0, sizeof(info)); 694 1.2 pgoyette info.rti_addrs = rtm->rtm_addrs; 695 1.2 pgoyette if (rt_xaddrs(rtm->rtm_type, (const char *)(rtm + 1), len + (char *)rtm, 696 1.2 pgoyette &info)) { 697 1.2 pgoyette senderr(EINVAL); 698 1.2 pgoyette } 699 1.2 pgoyette info.rti_flags = rtm->rtm_flags; 700 1.16 christos if (info.rti_info[RTAX_DST] == NULL || 701 1.16 christos (info.rti_info[RTAX_DST]->sa_family >= AF_MAX)) { 702 1.16 christos senderr(EINVAL); 703 1.16 christos } 704 1.2 pgoyette #ifdef RTSOCK_DEBUG 705 1.2 pgoyette if (info.rti_info[RTAX_DST]->sa_family == AF_INET) { 706 1.2 pgoyette char abuf[INET_ADDRSTRLEN]; 707 1.2 pgoyette printf("%s: extracted info.rti_info[RTAX_DST] %s\n", __func__, 708 1.2 pgoyette RT_IN_PRINT(&info, abuf, RTAX_DST)); 709 1.2 pgoyette } 710 1.2 pgoyette #endif /* RTSOCK_DEBUG */ 711 1.2 pgoyette if (info.rti_info[RTAX_GATEWAY] != NULL && 712 1.2 pgoyette (info.rti_info[RTAX_GATEWAY]->sa_family >= AF_MAX)) { 713 1.2 pgoyette senderr(EINVAL); 714 1.2 pgoyette } 715 1.2 pgoyette 716 1.2 pgoyette /* 717 1.17 christos * Verify that the socket has the appropriate privilege; RTM_GET 718 1.2 pgoyette * is the only operation the non-superuser is allowed. 719 1.2 pgoyette */ 720 1.17 christos if (kauth_authorize_network(so->so_cred, KAUTH_NETWORK_ROUTE, 721 1.2 pgoyette 0, rtm, NULL, NULL) != 0) 722 1.2 pgoyette senderr(EACCES); 723 1.2 pgoyette 724 1.2 pgoyette /* 725 1.2 pgoyette * route(8) passes a sockaddr truncated with prefixlen. 726 1.2 pgoyette * The kernel doesn't expect such sockaddr and need to 727 1.2 pgoyette * use a buffer that is big enough for the sockaddr expected 728 1.2 pgoyette * (padded with 0's). We keep the original length of the sockaddr. 729 1.2 pgoyette */ 730 1.2 pgoyette if (info.rti_info[RTAX_NETMASK]) { 731 1.2 pgoyette /* 732 1.2 pgoyette * Use the family of RTAX_DST, because RTAX_NETMASK 733 1.2 pgoyette * can have a zero family if it comes from the radix 734 1.2 pgoyette * tree via rt_mask(). 735 1.2 pgoyette */ 736 1.2 pgoyette socklen_t sa_len = sockaddr_getsize_by_family( 737 1.2 pgoyette info.rti_info[RTAX_DST]->sa_family); 738 1.2 pgoyette socklen_t masklen = sockaddr_getlen( 739 1.2 pgoyette info.rti_info[RTAX_NETMASK]); 740 1.2 pgoyette if (sa_len != 0 && sa_len > masklen) { 741 1.2 pgoyette KASSERT(sa_len <= sizeof(netmask)); 742 1.2 pgoyette memcpy(&netmask, info.rti_info[RTAX_NETMASK], masklen); 743 1.2 pgoyette memset((char *)&netmask + masklen, 0, sa_len - masklen); 744 1.2 pgoyette info.rti_info[RTAX_NETMASK] = sstocsa(&netmask); 745 1.2 pgoyette } 746 1.2 pgoyette } 747 1.2 pgoyette 748 1.2 pgoyette switch (rtm->rtm_type) { 749 1.2 pgoyette 750 1.2 pgoyette case RTM_ADD: 751 1.2 pgoyette if (info.rti_info[RTAX_GATEWAY] == NULL) { 752 1.2 pgoyette senderr(EINVAL); 753 1.2 pgoyette } 754 1.2 pgoyette #if defined(INET) || defined(INET6) 755 1.2 pgoyette /* support for new ARP/NDP code with keeping backcompat */ 756 1.2 pgoyette if (info.rti_info[RTAX_GATEWAY]->sa_family == AF_LINK) { 757 1.2 pgoyette const struct sockaddr_dl *sdlp = 758 1.2 pgoyette satocsdl(info.rti_info[RTAX_GATEWAY]); 759 1.2 pgoyette 760 1.2 pgoyette /* Allow routing requests by interface index */ 761 1.2 pgoyette if (sdlp->sdl_nlen == 0 && sdlp->sdl_alen == 0 762 1.2 pgoyette && sdlp->sdl_slen == 0) 763 1.2 pgoyette goto fallback; 764 1.2 pgoyette /* 765 1.2 pgoyette * Old arp binaries don't set the sdl_index 766 1.2 pgoyette * so we have to complement it. 767 1.2 pgoyette */ 768 1.2 pgoyette int sdl_index = sdlp->sdl_index; 769 1.2 pgoyette if (sdl_index == 0) { 770 1.2 pgoyette error = route_get_sdl_index(&info, &sdl_index); 771 1.2 pgoyette if (error != 0) 772 1.2 pgoyette goto fallback; 773 1.2 pgoyette } else if ( 774 1.2 pgoyette info.rti_info[RTAX_DST]->sa_family == AF_INET) { 775 1.2 pgoyette /* 776 1.2 pgoyette * XXX workaround for SIN_PROXY case; proxy arp 777 1.2 pgoyette * entry should be in an interface that has 778 1.2 pgoyette * a network route including the destination, 779 1.2 pgoyette * not a local (link) route that may not be a 780 1.2 pgoyette * desired place, for example a tap. 781 1.2 pgoyette */ 782 1.2 pgoyette const struct sockaddr_inarp *sina = 783 1.2 pgoyette (const struct sockaddr_inarp *) 784 1.2 pgoyette info.rti_info[RTAX_DST]; 785 1.2 pgoyette if (sina->sin_other & SIN_PROXY) { 786 1.2 pgoyette error = route_get_sdl_index(&info, 787 1.2 pgoyette &sdl_index); 788 1.2 pgoyette if (error != 0) 789 1.2 pgoyette goto fallback; 790 1.2 pgoyette } 791 1.2 pgoyette } 792 1.2 pgoyette error = lla_rt_output(rtm->rtm_type, rtm->rtm_flags, 793 1.2 pgoyette rtm->rtm_rmx.rmx_expire, &info, sdl_index); 794 1.2 pgoyette break; 795 1.2 pgoyette } 796 1.2 pgoyette fallback: 797 1.2 pgoyette #endif /* defined(INET) || defined(INET6) */ 798 1.2 pgoyette error = rtrequest1(rtm->rtm_type, &info, &saved_nrt); 799 1.2 pgoyette if (error == 0) { 800 1.2 pgoyette _rt_setmetrics(rtm->rtm_inits, rtm, saved_nrt); 801 1.2 pgoyette rt_unref(saved_nrt); 802 1.2 pgoyette } 803 1.2 pgoyette break; 804 1.2 pgoyette 805 1.2 pgoyette case RTM_DELETE: 806 1.2 pgoyette #if defined(INET) || defined(INET6) 807 1.2 pgoyette /* support for new ARP/NDP code */ 808 1.2 pgoyette if (info.rti_info[RTAX_GATEWAY] && 809 1.2 pgoyette (info.rti_info[RTAX_GATEWAY]->sa_family == AF_LINK) && 810 1.2 pgoyette (rtm->rtm_flags & RTF_LLDATA) != 0) { 811 1.2 pgoyette const struct sockaddr_dl *sdlp = 812 1.2 pgoyette satocsdl(info.rti_info[RTAX_GATEWAY]); 813 1.2 pgoyette error = lla_rt_output(rtm->rtm_type, rtm->rtm_flags, 814 1.2 pgoyette rtm->rtm_rmx.rmx_expire, &info, sdlp->sdl_index); 815 1.2 pgoyette rtm->rtm_flags &= ~RTF_UP; 816 1.2 pgoyette break; 817 1.2 pgoyette } 818 1.2 pgoyette #endif 819 1.2 pgoyette error = rtrequest1(rtm->rtm_type, &info, &saved_nrt); 820 1.2 pgoyette if (error != 0) 821 1.2 pgoyette break; 822 1.2 pgoyette 823 1.2 pgoyette rt = saved_nrt; 824 1.2 pgoyette do_rt_free = true; 825 1.2 pgoyette info.rti_info[RTAX_DST] = rt_getkey(rt); 826 1.2 pgoyette info.rti_info[RTAX_GATEWAY] = rt->rt_gateway; 827 1.2 pgoyette info.rti_info[RTAX_NETMASK] = rt_mask(rt); 828 1.2 pgoyette info.rti_info[RTAX_TAG] = rt_gettag(rt); 829 1.2 pgoyette error = route_output_report(rt, &info, rtm, &new_rtm); 830 1.2 pgoyette if (error) 831 1.2 pgoyette senderr(error); 832 1.2 pgoyette if (new_rtm != NULL) { 833 1.2 pgoyette old_rtm = rtm; 834 1.2 pgoyette rtm = new_rtm; 835 1.2 pgoyette } 836 1.2 pgoyette break; 837 1.2 pgoyette 838 1.2 pgoyette case RTM_GET: 839 1.2 pgoyette case RTM_CHANGE: 840 1.2 pgoyette case RTM_LOCK: 841 1.2 pgoyette /* XXX This will mask info.rti_info[RTAX_DST] with 842 1.2 pgoyette * info.rti_info[RTAX_NETMASK] before 843 1.2 pgoyette * searching. It did not used to do that. --dyoung 844 1.2 pgoyette */ 845 1.2 pgoyette rt = NULL; 846 1.2 pgoyette error = rtrequest1(RTM_GET, &info, &rt); 847 1.2 pgoyette if (error != 0) 848 1.2 pgoyette senderr(error); 849 1.2 pgoyette if (rtm->rtm_type != RTM_GET) {/* XXX: too grotty */ 850 1.2 pgoyette if (memcmp(info.rti_info[RTAX_DST], rt_getkey(rt), 851 1.2 pgoyette info.rti_info[RTAX_DST]->sa_len) != 0) 852 1.2 pgoyette senderr(ESRCH); 853 1.2 pgoyette if (info.rti_info[RTAX_NETMASK] == NULL && 854 1.2 pgoyette rt_mask(rt) != NULL) 855 1.2 pgoyette senderr(ETOOMANYREFS); 856 1.2 pgoyette } 857 1.2 pgoyette 858 1.2 pgoyette /* 859 1.2 pgoyette * XXX if arp/ndp requests an L2 entry, we have to obtain 860 1.2 pgoyette * it from lltable while for the route command we have to 861 1.2 pgoyette * return a route as it is. How to distinguish them? 862 1.2 pgoyette * For newer arp/ndp, RTF_LLDATA flag set by arp/ndp 863 1.2 pgoyette * indicates an L2 entry is requested. For old arp/ndp 864 1.2 pgoyette * binaries, we check RTF_UP flag is NOT set; it works 865 1.2 pgoyette * by the fact that arp/ndp don't set it while the route 866 1.2 pgoyette * command sets it. 867 1.2 pgoyette */ 868 1.2 pgoyette if (((rtm->rtm_flags & RTF_LLDATA) != 0 || 869 1.2 pgoyette (rtm->rtm_flags & RTF_UP) == 0) && 870 1.2 pgoyette rtm->rtm_type == RTM_GET && 871 1.2 pgoyette sockaddr_cmp(rt_getkey(rt), info.rti_info[RTAX_DST]) != 0) { 872 1.2 pgoyette int ll_flags = 0; 873 1.2 pgoyette route_get_sdl(rt->rt_ifp, info.rti_info[RTAX_DST], &sdl, 874 1.2 pgoyette &ll_flags); 875 1.2 pgoyette info.rti_info[RTAX_GATEWAY] = sstocsa(&sdl); 876 1.2 pgoyette error = route_output_report(rt, &info, rtm, &new_rtm); 877 1.2 pgoyette if (error) 878 1.2 pgoyette senderr(error); 879 1.2 pgoyette if (new_rtm != NULL) { 880 1.2 pgoyette old_rtm = rtm; 881 1.2 pgoyette rtm = new_rtm; 882 1.2 pgoyette } 883 1.2 pgoyette rtm->rtm_flags |= RTF_LLDATA; 884 1.2 pgoyette rtm->rtm_flags &= ~RTF_CONNECTED; 885 1.2 pgoyette rtm->rtm_flags |= (ll_flags & LLE_STATIC) ? RTF_STATIC : 0; 886 1.2 pgoyette break; 887 1.2 pgoyette } 888 1.2 pgoyette 889 1.2 pgoyette switch (rtm->rtm_type) { 890 1.2 pgoyette case RTM_GET: 891 1.2 pgoyette info.rti_info[RTAX_DST] = rt_getkey(rt); 892 1.2 pgoyette info.rti_info[RTAX_GATEWAY] = rt->rt_gateway; 893 1.2 pgoyette info.rti_info[RTAX_NETMASK] = rt_mask(rt); 894 1.2 pgoyette info.rti_info[RTAX_TAG] = rt_gettag(rt); 895 1.2 pgoyette error = route_output_report(rt, &info, rtm, &new_rtm); 896 1.2 pgoyette if (error) 897 1.2 pgoyette senderr(error); 898 1.2 pgoyette if (new_rtm != NULL) { 899 1.2 pgoyette old_rtm = rtm; 900 1.2 pgoyette rtm = new_rtm; 901 1.2 pgoyette } 902 1.2 pgoyette break; 903 1.2 pgoyette 904 1.2 pgoyette case RTM_CHANGE: 905 1.2 pgoyette #ifdef NET_MPSAFE 906 1.2 pgoyette /* 907 1.2 pgoyette * Release rt_so_mtx to avoid a deadlock with route_intr 908 1.2 pgoyette * and also serialize updating routes to avoid another. 909 1.2 pgoyette */ 910 1.2 pgoyette if (rt_updating) { 911 1.2 pgoyette /* Release to allow the updater to proceed */ 912 1.2 pgoyette rt_unref(rt); 913 1.2 pgoyette rt = NULL; 914 1.2 pgoyette } 915 1.2 pgoyette while (rt_updating) { 916 1.2 pgoyette error = cv_wait_sig(&rt_update_cv, rt_so_mtx); 917 1.2 pgoyette if (error != 0) 918 1.2 pgoyette goto flush; 919 1.2 pgoyette } 920 1.2 pgoyette if (rt == NULL) { 921 1.2 pgoyette error = rtrequest1(RTM_GET, &info, &rt); 922 1.2 pgoyette if (error != 0) 923 1.2 pgoyette goto flush; 924 1.2 pgoyette } 925 1.2 pgoyette rt_updating = true; 926 1.2 pgoyette mutex_exit(rt_so_mtx); 927 1.2 pgoyette 928 1.2 pgoyette error = rt_update_prepare(rt); 929 1.2 pgoyette if (error == 0) { 930 1.2 pgoyette error = rt_update(rt, &info, rtm); 931 1.2 pgoyette rt_update_finish(rt); 932 1.2 pgoyette } 933 1.2 pgoyette 934 1.2 pgoyette mutex_enter(rt_so_mtx); 935 1.2 pgoyette rt_updating = false; 936 1.2 pgoyette cv_broadcast(&rt_update_cv); 937 1.2 pgoyette #else 938 1.2 pgoyette error = rt_update(rt, &info, rtm); 939 1.2 pgoyette #endif 940 1.2 pgoyette if (error != 0) 941 1.2 pgoyette goto flush; 942 1.2 pgoyette /*FALLTHROUGH*/ 943 1.2 pgoyette case RTM_LOCK: 944 1.2 pgoyette rt->rt_rmx.rmx_locks &= ~(rtm->rtm_inits); 945 1.2 pgoyette rt->rt_rmx.rmx_locks |= 946 1.2 pgoyette (rtm->rtm_inits & rtm->rtm_rmx.rmx_locks); 947 1.2 pgoyette break; 948 1.2 pgoyette } 949 1.2 pgoyette break; 950 1.2 pgoyette 951 1.2 pgoyette default: 952 1.2 pgoyette senderr(EOPNOTSUPP); 953 1.2 pgoyette } 954 1.2 pgoyette 955 1.2 pgoyette flush: 956 1.2 pgoyette if (rtm) { 957 1.2 pgoyette if (error) 958 1.2 pgoyette rtm->rtm_errno = error; 959 1.2 pgoyette else 960 1.2 pgoyette rtm->rtm_flags |= RTF_DONE; 961 1.2 pgoyette } 962 1.2 pgoyette family = info.rti_info[RTAX_DST] ? info.rti_info[RTAX_DST]->sa_family : 963 1.2 pgoyette 0; 964 1.2 pgoyette /* We cannot free old_rtm until we have stopped using the 965 1.2 pgoyette * pointers in info, some of which may point to sockaddrs 966 1.2 pgoyette * in old_rtm. 967 1.2 pgoyette */ 968 1.2 pgoyette if (old_rtm != NULL) 969 1.2 pgoyette Free(old_rtm); 970 1.2 pgoyette if (rt) { 971 1.2 pgoyette if (do_rt_free) { 972 1.2 pgoyette #ifdef NET_MPSAFE 973 1.2 pgoyette /* 974 1.2 pgoyette * Release rt_so_mtx to avoid a deadlock with 975 1.2 pgoyette * route_intr. 976 1.2 pgoyette */ 977 1.2 pgoyette mutex_exit(rt_so_mtx); 978 1.2 pgoyette rt_free(rt); 979 1.2 pgoyette mutex_enter(rt_so_mtx); 980 1.2 pgoyette #else 981 1.2 pgoyette rt_free(rt); 982 1.2 pgoyette #endif 983 1.2 pgoyette } else 984 1.2 pgoyette rt_unref(rt); 985 1.2 pgoyette } 986 1.2 pgoyette { 987 1.2 pgoyette struct rawcb *rp = NULL; 988 1.2 pgoyette /* 989 1.2 pgoyette * Check to see if we don't want our own messages. 990 1.2 pgoyette */ 991 1.2 pgoyette if ((so->so_options & SO_USELOOPBACK) == 0) { 992 1.2 pgoyette if (COMPATNAME(route_info).ri_cb.any_count <= 1) { 993 1.2 pgoyette if (rtm) 994 1.2 pgoyette Free(rtm); 995 1.2 pgoyette m_freem(m); 996 1.2 pgoyette goto out; 997 1.2 pgoyette } 998 1.2 pgoyette /* There is another listener, so construct message */ 999 1.2 pgoyette rp = sotorawcb(so); 1000 1.2 pgoyette } 1001 1.2 pgoyette if (rtm) { 1002 1.2 pgoyette m_copyback(m, 0, rtm->rtm_msglen, rtm); 1003 1.2 pgoyette if (m->m_pkthdr.len < rtm->rtm_msglen) { 1004 1.2 pgoyette m_freem(m); 1005 1.2 pgoyette m = NULL; 1006 1.2 pgoyette } else if (m->m_pkthdr.len > rtm->rtm_msglen) 1007 1.2 pgoyette m_adj(m, rtm->rtm_msglen - m->m_pkthdr.len); 1008 1.2 pgoyette Free(rtm); 1009 1.2 pgoyette } 1010 1.2 pgoyette if (rp) 1011 1.2 pgoyette rp->rcb_proto.sp_family = 0; /* Avoid us */ 1012 1.2 pgoyette if (family) 1013 1.2 pgoyette proto.sp_protocol = family; 1014 1.2 pgoyette if (m) 1015 1.2 pgoyette raw_input(m, &proto, &COMPATNAME(route_info).ri_src, 1016 1.2 pgoyette &COMPATNAME(route_info).ri_dst, &rt_rawcb); 1017 1.2 pgoyette if (rp) 1018 1.2 pgoyette rp->rcb_proto.sp_family = PF_XROUTE; 1019 1.2 pgoyette } 1020 1.2 pgoyette out: 1021 1.2 pgoyette curlwp_bindx(bound); 1022 1.2 pgoyette return error; 1023 1.2 pgoyette } 1024 1.2 pgoyette 1025 1.2 pgoyette static int 1026 1.2 pgoyette route_ctloutput(int op, struct socket *so, struct sockopt *sopt) 1027 1.2 pgoyette { 1028 1.2 pgoyette struct routecb *rop = sotoroutecb(so); 1029 1.2 pgoyette int error = 0; 1030 1.13 roy unsigned char *rtm_type, *cp, *ep; 1031 1.2 pgoyette size_t len; 1032 1.2 pgoyette unsigned int msgfilter; 1033 1.13 roy struct sockaddr *sa; 1034 1.2 pgoyette 1035 1.2 pgoyette KASSERT(solocked(so)); 1036 1.2 pgoyette 1037 1.2 pgoyette if (sopt->sopt_level != AF_ROUTE) { 1038 1.2 pgoyette error = ENOPROTOOPT; 1039 1.2 pgoyette } else switch (op) { 1040 1.2 pgoyette case PRCO_SETOPT: 1041 1.2 pgoyette switch (sopt->sopt_name) { 1042 1.2 pgoyette case RO_MSGFILTER: 1043 1.2 pgoyette msgfilter = 0; 1044 1.2 pgoyette for (rtm_type = sopt->sopt_data, len = sopt->sopt_size; 1045 1.2 pgoyette len != 0; 1046 1.2 pgoyette rtm_type++, len -= sizeof(*rtm_type)) 1047 1.2 pgoyette { 1048 1.2 pgoyette /* Guard against overflowing our storage. */ 1049 1.2 pgoyette if (*rtm_type >= sizeof(msgfilter) * CHAR_BIT) { 1050 1.2 pgoyette error = EOVERFLOW; 1051 1.2 pgoyette break; 1052 1.2 pgoyette } 1053 1.2 pgoyette msgfilter |= RTMSGFILTER(*rtm_type); 1054 1.2 pgoyette } 1055 1.2 pgoyette if (error == 0) 1056 1.2 pgoyette rop->rocb_msgfilter = msgfilter; 1057 1.2 pgoyette break; 1058 1.13 roy case RO_MISSFILTER: 1059 1.13 roy /* Validate the data */ 1060 1.13 roy len = 0; 1061 1.13 roy cp = sopt->sopt_data; 1062 1.13 roy ep = cp + sopt->sopt_size; 1063 1.13 roy while (cp < ep) { 1064 1.13 roy if (ep - cp < 1065 1.13 roy offsetof(struct sockaddr, sa_len) + 1066 1.13 roy sizeof(sa->sa_len)) 1067 1.13 roy break; 1068 1.13 roy if (++len > RO_FILTSA_MAX) { 1069 1.13 roy error = ENOBUFS; 1070 1.13 roy break; 1071 1.13 roy } 1072 1.13 roy sa = (struct sockaddr *)cp; 1073 1.18 roy if (sa->sa_len < _SA_MINSIZE || 1074 1.18 roy sa->sa_len >sizeof(struct sockaddr_storage)) 1075 1.18 roy return EINVAL; 1076 1.13 roy cp += RT_XROUNDUP(sa->sa_len); 1077 1.13 roy } 1078 1.13 roy if (cp != ep) { 1079 1.13 roy if (error == 0) 1080 1.13 roy error = EINVAL; 1081 1.13 roy break; 1082 1.13 roy } 1083 1.13 roy if (rop->rocb_missfilterlen != 0) 1084 1.13 roy kmem_free(rop->rocb_missfilter, 1085 1.13 roy rop->rocb_missfilterlen); 1086 1.13 roy if (sopt->sopt_size != 0) { 1087 1.13 roy rop->rocb_missfilter = 1088 1.13 roy kmem_alloc(sopt->sopt_size, KM_SLEEP); 1089 1.13 roy if (rop->rocb_missfilter == NULL) { 1090 1.13 roy rop->rocb_missfilterlen = 0; 1091 1.13 roy error = ENOBUFS; 1092 1.13 roy break; 1093 1.13 roy } 1094 1.13 roy } else 1095 1.13 roy rop->rocb_missfilter = NULL; 1096 1.13 roy rop->rocb_missfilterlen = sopt->sopt_size; 1097 1.13 roy if (rop->rocb_missfilterlen != 0) 1098 1.13 roy memcpy(rop->rocb_missfilter, sopt->sopt_data, 1099 1.13 roy rop->rocb_missfilterlen); 1100 1.13 roy break; 1101 1.2 pgoyette default: 1102 1.2 pgoyette error = ENOPROTOOPT; 1103 1.2 pgoyette break; 1104 1.2 pgoyette } 1105 1.2 pgoyette break; 1106 1.2 pgoyette case PRCO_GETOPT: 1107 1.2 pgoyette switch (sopt->sopt_name) { 1108 1.2 pgoyette case RO_MSGFILTER: 1109 1.2 pgoyette error = ENOTSUP; 1110 1.2 pgoyette break; 1111 1.2 pgoyette default: 1112 1.2 pgoyette error = ENOPROTOOPT; 1113 1.2 pgoyette break; 1114 1.2 pgoyette } 1115 1.2 pgoyette } 1116 1.2 pgoyette return error; 1117 1.2 pgoyette } 1118 1.2 pgoyette 1119 1.2 pgoyette static void 1120 1.2 pgoyette _rt_setmetrics(int which, const struct rt_xmsghdr *in, struct rtentry *out) 1121 1.2 pgoyette { 1122 1.2 pgoyette #define metric(f, e) if (which & (f)) out->rt_rmx.e = in->rtm_rmx.e; 1123 1.2 pgoyette metric(RTV_RPIPE, rmx_recvpipe); 1124 1.2 pgoyette metric(RTV_SPIPE, rmx_sendpipe); 1125 1.2 pgoyette metric(RTV_SSTHRESH, rmx_ssthresh); 1126 1.2 pgoyette metric(RTV_RTT, rmx_rtt); 1127 1.2 pgoyette metric(RTV_RTTVAR, rmx_rttvar); 1128 1.2 pgoyette metric(RTV_HOPCOUNT, rmx_hopcount); 1129 1.2 pgoyette metric(RTV_MTU, rmx_mtu); 1130 1.2 pgoyette #undef metric 1131 1.2 pgoyette if (which & RTV_EXPIRE) { 1132 1.2 pgoyette out->rt_rmx.rmx_expire = in->rtm_rmx.rmx_expire ? 1133 1.2 pgoyette time_wall_to_mono(in->rtm_rmx.rmx_expire) : 0; 1134 1.2 pgoyette } 1135 1.2 pgoyette } 1136 1.2 pgoyette 1137 1.2 pgoyette static void 1138 1.2 pgoyette rtm_setmetrics(const struct rtentry *in, struct rt_xmsghdr *out) 1139 1.2 pgoyette { 1140 1.2 pgoyette #define metric(e) out->rtm_rmx.e = in->rt_rmx.e; 1141 1.2 pgoyette metric(rmx_recvpipe); 1142 1.2 pgoyette metric(rmx_sendpipe); 1143 1.2 pgoyette metric(rmx_ssthresh); 1144 1.2 pgoyette metric(rmx_rtt); 1145 1.2 pgoyette metric(rmx_rttvar); 1146 1.2 pgoyette metric(rmx_hopcount); 1147 1.2 pgoyette metric(rmx_mtu); 1148 1.2 pgoyette metric(rmx_locks); 1149 1.2 pgoyette #undef metric 1150 1.2 pgoyette out->rtm_rmx.rmx_expire = in->rt_rmx.rmx_expire ? 1151 1.2 pgoyette time_mono_to_wall(in->rt_rmx.rmx_expire) : 0; 1152 1.2 pgoyette } 1153 1.2 pgoyette 1154 1.2 pgoyette static int 1155 1.2 pgoyette rt_xaddrs(u_char rtmtype, const char *cp, const char *cplim, 1156 1.2 pgoyette struct rt_addrinfo *rtinfo) 1157 1.2 pgoyette { 1158 1.2 pgoyette const struct sockaddr *sa = NULL; /* Quell compiler warning */ 1159 1.2 pgoyette int i; 1160 1.2 pgoyette 1161 1.2 pgoyette for (i = 0; i < RTAX_MAX && cp < cplim; i++) { 1162 1.2 pgoyette if ((rtinfo->rti_addrs & (1 << i)) == 0) 1163 1.2 pgoyette continue; 1164 1.2 pgoyette rtinfo->rti_info[i] = sa = (const struct sockaddr *)cp; 1165 1.2 pgoyette RT_XADVANCE(cp, sa); 1166 1.2 pgoyette } 1167 1.2 pgoyette 1168 1.2 pgoyette /* 1169 1.2 pgoyette * Check for extra addresses specified, except RTM_GET asking 1170 1.2 pgoyette * for interface info. 1171 1.2 pgoyette */ 1172 1.2 pgoyette if (rtmtype == RTM_GET) { 1173 1.2 pgoyette if (((rtinfo->rti_addrs & 1174 1.2 pgoyette (~((1 << RTAX_IFP) | (1 << RTAX_IFA)))) & (~0U << i)) != 0) 1175 1.2 pgoyette return 1; 1176 1.2 pgoyette } else if ((rtinfo->rti_addrs & (~0U << i)) != 0) 1177 1.2 pgoyette return 1; 1178 1.2 pgoyette /* Check for bad data length. */ 1179 1.2 pgoyette if (cp != cplim) { 1180 1.2 pgoyette if (i == RTAX_NETMASK + 1 && sa != NULL && 1181 1.2 pgoyette cp - RT_XROUNDUP(sa->sa_len) + sa->sa_len == cplim) 1182 1.2 pgoyette /* 1183 1.2 pgoyette * The last sockaddr was info.rti_info[RTAX_NETMASK]. 1184 1.2 pgoyette * We accept this for now for the sake of old 1185 1.2 pgoyette * binaries or third party softwares. 1186 1.2 pgoyette */ 1187 1.2 pgoyette ; 1188 1.2 pgoyette else 1189 1.2 pgoyette return 1; 1190 1.2 pgoyette } 1191 1.2 pgoyette return 0; 1192 1.2 pgoyette } 1193 1.2 pgoyette 1194 1.2 pgoyette static int 1195 1.2 pgoyette rt_getlen(int type) 1196 1.2 pgoyette { 1197 1.2 pgoyette RTS_CTASSERT(__alignof(struct ifa_msghdr) >= sizeof(uint64_t)); 1198 1.2 pgoyette RTS_CTASSERT(__alignof(struct if_msghdr) >= sizeof(uint64_t)); 1199 1.2 pgoyette RTS_CTASSERT(__alignof(struct if_announcemsghdr) >= sizeof(uint64_t)); 1200 1.2 pgoyette RTS_CTASSERT(__alignof(struct rt_msghdr) >= sizeof(uint64_t)); 1201 1.2 pgoyette 1202 1.2 pgoyette switch (type) { 1203 1.2 pgoyette case RTM_ODELADDR: 1204 1.2 pgoyette case RTM_ONEWADDR: 1205 1.2 pgoyette case RTM_OCHGADDR: 1206 1.3 pgoyette if (rtsock_iflist_70_hook.hooked) 1207 1.2 pgoyette return sizeof(struct ifa_msghdr70); 1208 1.2 pgoyette else { 1209 1.2 pgoyette #ifdef RTSOCK_DEBUG 1210 1.2 pgoyette printf("%s: unsupported RTM type %d\n", __func__, type); 1211 1.2 pgoyette #endif 1212 1.2 pgoyette return -1; 1213 1.2 pgoyette } 1214 1.2 pgoyette 1215 1.2 pgoyette case RTM_DELADDR: 1216 1.2 pgoyette case RTM_NEWADDR: 1217 1.2 pgoyette case RTM_CHGADDR: 1218 1.2 pgoyette return sizeof(struct ifa_xmsghdr); 1219 1.2 pgoyette 1220 1.2 pgoyette case RTM_OOIFINFO: 1221 1.3 pgoyette if (rtsock_iflist_14_hook.hooked) 1222 1.2 pgoyette return sizeof(struct if_msghdr14); 1223 1.2 pgoyette else { 1224 1.2 pgoyette #ifdef RTSOCK_DEBUG 1225 1.2 pgoyette printf("%s: unsupported RTM type RTM_OOIFINFO\n", 1226 1.2 pgoyette __func__); 1227 1.2 pgoyette #endif 1228 1.2 pgoyette return -1; 1229 1.2 pgoyette } 1230 1.2 pgoyette 1231 1.2 pgoyette case RTM_OIFINFO: 1232 1.3 pgoyette if (rtsock_iflist_50_hook.hooked) 1233 1.2 pgoyette return sizeof(struct if_msghdr50); 1234 1.2 pgoyette else { 1235 1.2 pgoyette #ifdef RTSOCK_DEBUG 1236 1.2 pgoyette printf("%s: unsupported RTM type RTM_OIFINFO\n", 1237 1.2 pgoyette __func__); 1238 1.2 pgoyette #endif 1239 1.2 pgoyette return -1; 1240 1.2 pgoyette } 1241 1.2 pgoyette 1242 1.2 pgoyette case RTM_IFINFO: 1243 1.2 pgoyette return sizeof(struct if_xmsghdr); 1244 1.2 pgoyette 1245 1.2 pgoyette case RTM_IFANNOUNCE: 1246 1.2 pgoyette case RTM_IEEE80211: 1247 1.2 pgoyette return sizeof(struct if_xannouncemsghdr); 1248 1.2 pgoyette 1249 1.2 pgoyette default: 1250 1.2 pgoyette return sizeof(struct rt_xmsghdr); 1251 1.2 pgoyette } 1252 1.2 pgoyette } 1253 1.2 pgoyette 1254 1.2 pgoyette 1255 1.2 pgoyette struct mbuf * 1256 1.2 pgoyette COMPATNAME(rt_msg1)(int type, struct rt_addrinfo *rtinfo, void *data, int datalen) 1257 1.2 pgoyette { 1258 1.2 pgoyette struct rt_xmsghdr *rtm; 1259 1.2 pgoyette struct mbuf *m; 1260 1.2 pgoyette int i; 1261 1.2 pgoyette const struct sockaddr *sa; 1262 1.2 pgoyette int len, dlen; 1263 1.2 pgoyette 1264 1.2 pgoyette m = m_gethdr(M_DONTWAIT, MT_DATA); 1265 1.2 pgoyette if (m == NULL) 1266 1.2 pgoyette return m; 1267 1.2 pgoyette MCLAIM(m, &COMPATNAME(routedomain).dom_mowner); 1268 1.2 pgoyette 1269 1.2 pgoyette if ((len = rt_getlen(type)) == -1) 1270 1.2 pgoyette goto out; 1271 1.2 pgoyette if (len > MHLEN + MLEN) 1272 1.2 pgoyette panic("%s: message too long", __func__); 1273 1.2 pgoyette else if (len > MHLEN) { 1274 1.2 pgoyette m->m_next = m_get(M_DONTWAIT, MT_DATA); 1275 1.2 pgoyette if (m->m_next == NULL) 1276 1.2 pgoyette goto out; 1277 1.2 pgoyette MCLAIM(m->m_next, m->m_owner); 1278 1.2 pgoyette m->m_pkthdr.len = len; 1279 1.2 pgoyette m->m_len = MHLEN; 1280 1.2 pgoyette m->m_next->m_len = len - MHLEN; 1281 1.2 pgoyette } else { 1282 1.2 pgoyette m->m_pkthdr.len = m->m_len = len; 1283 1.2 pgoyette } 1284 1.2 pgoyette m_reset_rcvif(m); 1285 1.2 pgoyette m_copyback(m, 0, datalen, data); 1286 1.2 pgoyette if (len > datalen) 1287 1.2 pgoyette (void)memset(mtod(m, char *) + datalen, 0, len - datalen); 1288 1.2 pgoyette rtm = mtod(m, struct rt_xmsghdr *); 1289 1.2 pgoyette for (i = 0; i < RTAX_MAX; i++) { 1290 1.2 pgoyette if ((sa = rtinfo->rti_info[i]) == NULL) 1291 1.2 pgoyette continue; 1292 1.2 pgoyette rtinfo->rti_addrs |= (1 << i); 1293 1.2 pgoyette dlen = RT_XROUNDUP(sa->sa_len); 1294 1.2 pgoyette m_copyback(m, len, sa->sa_len, sa); 1295 1.2 pgoyette if (dlen != sa->sa_len) { 1296 1.2 pgoyette /* 1297 1.2 pgoyette * Up to 7 + 1 nul's since roundup is to 1298 1.2 pgoyette * sizeof(uint64_t) (8 bytes) 1299 1.2 pgoyette */ 1300 1.2 pgoyette m_copyback(m, len + sa->sa_len, 1301 1.2 pgoyette dlen - sa->sa_len, "\0\0\0\0\0\0\0"); 1302 1.2 pgoyette } 1303 1.2 pgoyette len += dlen; 1304 1.2 pgoyette } 1305 1.2 pgoyette if (m->m_pkthdr.len != len) 1306 1.2 pgoyette goto out; 1307 1.2 pgoyette rtm->rtm_msglen = len; 1308 1.2 pgoyette rtm->rtm_version = RTM_XVERSION; 1309 1.2 pgoyette rtm->rtm_type = type; 1310 1.2 pgoyette return m; 1311 1.2 pgoyette out: 1312 1.2 pgoyette m_freem(m); 1313 1.2 pgoyette return NULL; 1314 1.2 pgoyette } 1315 1.2 pgoyette 1316 1.2 pgoyette /* 1317 1.2 pgoyette * rt_msg2 1318 1.2 pgoyette * 1319 1.2 pgoyette * fills 'cp' or 'w'.w_tmem with the routing socket message and 1320 1.2 pgoyette * returns the length of the message in 'lenp'. 1321 1.2 pgoyette * 1322 1.2 pgoyette * if walkarg is 0, cp is expected to be 0 or a buffer large enough to hold 1323 1.2 pgoyette * the message 1324 1.2 pgoyette * otherwise walkarg's w_needed is updated and if the user buffer is 1325 1.2 pgoyette * specified and w_needed indicates space exists the information is copied 1326 1.2 pgoyette * into the temp space (w_tmem). w_tmem is [re]allocated if necessary, 1327 1.2 pgoyette * if the allocation fails ENOBUFS is returned. 1328 1.2 pgoyette */ 1329 1.2 pgoyette static int 1330 1.2 pgoyette rt_msg2(int type, struct rt_addrinfo *rtinfo, void *cpv, struct rt_walkarg *w, 1331 1.2 pgoyette int *lenp) 1332 1.2 pgoyette { 1333 1.2 pgoyette int i; 1334 1.2 pgoyette int len, dlen, second_time = 0; 1335 1.2 pgoyette char *cp0, *cp = cpv; 1336 1.2 pgoyette 1337 1.2 pgoyette rtinfo->rti_addrs = 0; 1338 1.2 pgoyette again: 1339 1.2 pgoyette if ((len = rt_getlen(type)) == -1) 1340 1.2 pgoyette return EINVAL; 1341 1.2 pgoyette 1342 1.2 pgoyette if ((cp0 = cp) != NULL) 1343 1.2 pgoyette cp += len; 1344 1.2 pgoyette for (i = 0; i < RTAX_MAX; i++) { 1345 1.2 pgoyette const struct sockaddr *sa; 1346 1.2 pgoyette 1347 1.2 pgoyette if ((sa = rtinfo->rti_info[i]) == NULL) 1348 1.2 pgoyette continue; 1349 1.2 pgoyette rtinfo->rti_addrs |= (1 << i); 1350 1.2 pgoyette dlen = RT_XROUNDUP(sa->sa_len); 1351 1.2 pgoyette if (cp) { 1352 1.2 pgoyette int diff = dlen - sa->sa_len; 1353 1.2 pgoyette (void)memcpy(cp, sa, (size_t)sa->sa_len); 1354 1.2 pgoyette cp += sa->sa_len; 1355 1.2 pgoyette if (diff > 0) { 1356 1.2 pgoyette (void)memset(cp, 0, (size_t)diff); 1357 1.2 pgoyette cp += diff; 1358 1.2 pgoyette } 1359 1.2 pgoyette } 1360 1.2 pgoyette len += dlen; 1361 1.2 pgoyette } 1362 1.2 pgoyette if (cp == NULL && w != NULL && !second_time) { 1363 1.2 pgoyette struct rt_walkarg *rw = w; 1364 1.2 pgoyette 1365 1.2 pgoyette rw->w_needed += len; 1366 1.2 pgoyette if (rw->w_needed <= 0 && rw->w_where) { 1367 1.2 pgoyette if (rw->w_tmemsize < len) { 1368 1.2 pgoyette if (rw->w_tmem) 1369 1.2 pgoyette kmem_free(rw->w_tmem, rw->w_tmemsize); 1370 1.2 pgoyette rw->w_tmem = kmem_zalloc(len, KM_SLEEP); 1371 1.2 pgoyette rw->w_tmemsize = len; 1372 1.2 pgoyette } 1373 1.2 pgoyette if (rw->w_tmem) { 1374 1.2 pgoyette cp = rw->w_tmem; 1375 1.2 pgoyette second_time = 1; 1376 1.2 pgoyette goto again; 1377 1.2 pgoyette } else { 1378 1.2 pgoyette rw->w_tmemneeded = len; 1379 1.2 pgoyette return ENOBUFS; 1380 1.2 pgoyette } 1381 1.2 pgoyette } 1382 1.2 pgoyette } 1383 1.2 pgoyette if (cp) { 1384 1.2 pgoyette struct rt_xmsghdr *rtm = (struct rt_xmsghdr *)cp0; 1385 1.2 pgoyette 1386 1.2 pgoyette rtm->rtm_version = RTM_XVERSION; 1387 1.2 pgoyette rtm->rtm_type = type; 1388 1.2 pgoyette rtm->rtm_msglen = len; 1389 1.2 pgoyette } 1390 1.2 pgoyette if (lenp) 1391 1.2 pgoyette *lenp = len; 1392 1.2 pgoyette return 0; 1393 1.2 pgoyette } 1394 1.2 pgoyette 1395 1.2 pgoyette /* 1396 1.2 pgoyette * This routine is called to generate a message from the routing 1397 1.2 pgoyette * socket indicating that a redirect has occurred, a routing lookup 1398 1.2 pgoyette * has failed, or that a protocol has detected timeouts to a particular 1399 1.2 pgoyette * destination. 1400 1.2 pgoyette */ 1401 1.2 pgoyette void 1402 1.2 pgoyette COMPATNAME(rt_missmsg)(int type, const struct rt_addrinfo *rtinfo, int flags, 1403 1.2 pgoyette int error) 1404 1.2 pgoyette { 1405 1.2 pgoyette struct rt_xmsghdr rtm; 1406 1.2 pgoyette struct mbuf *m; 1407 1.2 pgoyette const struct sockaddr *sa = rtinfo->rti_info[RTAX_DST]; 1408 1.2 pgoyette struct rt_addrinfo info = *rtinfo; 1409 1.2 pgoyette 1410 1.2 pgoyette COMPATCALL(rt_missmsg, (type, rtinfo, flags, error)); 1411 1.2 pgoyette if (COMPATNAME(route_info).ri_cb.any_count == 0) 1412 1.2 pgoyette return; 1413 1.2 pgoyette memset(&rtm, 0, sizeof(rtm)); 1414 1.2 pgoyette rtm.rtm_pid = curproc->p_pid; 1415 1.2 pgoyette rtm.rtm_flags = RTF_DONE | flags; 1416 1.2 pgoyette rtm.rtm_errno = error; 1417 1.2 pgoyette m = COMPATNAME(rt_msg1)(type, &info, &rtm, sizeof(rtm)); 1418 1.2 pgoyette if (m == NULL) 1419 1.2 pgoyette return; 1420 1.2 pgoyette mtod(m, struct rt_xmsghdr *)->rtm_addrs = info.rti_addrs; 1421 1.2 pgoyette COMPATNAME(route_enqueue)(m, sa ? sa->sa_family : 0); 1422 1.2 pgoyette } 1423 1.2 pgoyette 1424 1.2 pgoyette /* 1425 1.2 pgoyette * This routine is called to generate a message from the routing 1426 1.2 pgoyette * socket indicating that the status of a network interface has changed. 1427 1.2 pgoyette */ 1428 1.2 pgoyette void 1429 1.2 pgoyette COMPATNAME(rt_ifmsg)(struct ifnet *ifp) 1430 1.2 pgoyette { 1431 1.2 pgoyette struct if_xmsghdr ifm; 1432 1.2 pgoyette struct mbuf *m; 1433 1.2 pgoyette struct rt_addrinfo info; 1434 1.2 pgoyette 1435 1.2 pgoyette COMPATCALL(rt_ifmsg, (ifp)); 1436 1.2 pgoyette if (COMPATNAME(route_info).ri_cb.any_count == 0) 1437 1.2 pgoyette return; 1438 1.2 pgoyette (void)memset(&info, 0, sizeof(info)); 1439 1.2 pgoyette (void)memset(&ifm, 0, sizeof(ifm)); 1440 1.2 pgoyette ifm.ifm_index = ifp->if_index; 1441 1.2 pgoyette ifm.ifm_flags = ifp->if_flags; 1442 1.12 thorpej if_export_if_data(ifp, &ifm.ifm_data, false); 1443 1.2 pgoyette ifm.ifm_addrs = 0; 1444 1.2 pgoyette m = COMPATNAME(rt_msg1)(RTM_IFINFO, &info, &ifm, sizeof(ifm)); 1445 1.2 pgoyette if (m == NULL) 1446 1.2 pgoyette return; 1447 1.2 pgoyette COMPATNAME(route_enqueue)(m, 0); 1448 1.4 pgoyette MODULE_HOOK_CALL_VOID(rtsock_oifmsg_14_hook, (ifp), __nothing); 1449 1.4 pgoyette MODULE_HOOK_CALL_VOID(rtsock_oifmsg_50_hook, (ifp), __nothing); 1450 1.2 pgoyette } 1451 1.2 pgoyette 1452 1.2 pgoyette /* 1453 1.2 pgoyette * This is called to generate messages from the routing socket 1454 1.2 pgoyette * indicating a network interface has had addresses associated with it. 1455 1.2 pgoyette * if we ever reverse the logic and replace messages TO the routing 1456 1.2 pgoyette * socket indicate a request to configure interfaces, then it will 1457 1.2 pgoyette * be unnecessary as the routing socket will automatically generate 1458 1.2 pgoyette * copies of it. 1459 1.2 pgoyette */ 1460 1.8 roy static void 1461 1.8 roy COMPATNAME(rt_addrmsg0)(int cmd, struct ifaddr *ifa, int error, 1462 1.8 roy struct rtentry *rt, const struct sockaddr *src) 1463 1.2 pgoyette { 1464 1.2 pgoyette #define cmdpass(__cmd, __pass) (((__cmd) << 2) | (__pass)) 1465 1.2 pgoyette struct rt_addrinfo info; 1466 1.2 pgoyette const struct sockaddr *sa; 1467 1.2 pgoyette int pass; 1468 1.2 pgoyette struct mbuf *m; 1469 1.2 pgoyette struct ifnet *ifp; 1470 1.2 pgoyette struct rt_xmsghdr rtm; 1471 1.2 pgoyette struct ifa_xmsghdr ifam; 1472 1.2 pgoyette int ncmd; 1473 1.2 pgoyette 1474 1.2 pgoyette KASSERT(ifa != NULL); 1475 1.2 pgoyette KASSERT(ifa->ifa_addr != NULL); 1476 1.2 pgoyette ifp = ifa->ifa_ifp; 1477 1.2 pgoyette if (cmd == RTM_ADD && vec_sctp_add_ip_address != NULL) { 1478 1.2 pgoyette (*vec_sctp_add_ip_address)(ifa); 1479 1.2 pgoyette } else if (cmd == RTM_DELETE && vec_sctp_delete_ip_address != NULL) { 1480 1.2 pgoyette (*vec_sctp_delete_ip_address)(ifa); 1481 1.2 pgoyette } 1482 1.2 pgoyette 1483 1.7 roy COMPATCALL(rt_addrmsg_rt, (cmd, ifa, error, rt)); 1484 1.2 pgoyette if (COMPATNAME(route_info).ri_cb.any_count == 0) 1485 1.2 pgoyette return; 1486 1.2 pgoyette for (pass = 1; pass < 3; pass++) { 1487 1.2 pgoyette memset(&info, 0, sizeof(info)); 1488 1.2 pgoyette switch (cmdpass(cmd, pass)) { 1489 1.2 pgoyette case cmdpass(RTM_ADD, 1): 1490 1.2 pgoyette case cmdpass(RTM_CHANGE, 1): 1491 1.2 pgoyette case cmdpass(RTM_DELETE, 2): 1492 1.2 pgoyette case cmdpass(RTM_NEWADDR, 1): 1493 1.2 pgoyette case cmdpass(RTM_DELADDR, 1): 1494 1.2 pgoyette case cmdpass(RTM_CHGADDR, 1): 1495 1.2 pgoyette switch (cmd) { 1496 1.2 pgoyette case RTM_ADD: 1497 1.2 pgoyette ncmd = RTM_XNEWADDR; 1498 1.2 pgoyette break; 1499 1.2 pgoyette case RTM_DELETE: 1500 1.2 pgoyette ncmd = RTM_XDELADDR; 1501 1.2 pgoyette break; 1502 1.2 pgoyette case RTM_CHANGE: 1503 1.2 pgoyette ncmd = RTM_XCHGADDR; 1504 1.2 pgoyette break; 1505 1.2 pgoyette case RTM_NEWADDR: 1506 1.2 pgoyette ncmd = RTM_XNEWADDR; 1507 1.2 pgoyette break; 1508 1.2 pgoyette case RTM_DELADDR: 1509 1.2 pgoyette ncmd = RTM_XDELADDR; 1510 1.2 pgoyette break; 1511 1.2 pgoyette case RTM_CHGADDR: 1512 1.2 pgoyette ncmd = RTM_XCHGADDR; 1513 1.2 pgoyette break; 1514 1.2 pgoyette default: 1515 1.2 pgoyette panic("%s: unknown command %d", __func__, cmd); 1516 1.2 pgoyette } 1517 1.4 pgoyette MODULE_HOOK_CALL_VOID(rtsock_newaddr_70_hook, 1518 1.2 pgoyette (ncmd, ifa), __nothing); 1519 1.2 pgoyette info.rti_info[RTAX_IFA] = sa = ifa->ifa_addr; 1520 1.2 pgoyette KASSERT(ifp->if_dl != NULL); 1521 1.2 pgoyette info.rti_info[RTAX_IFP] = ifp->if_dl->ifa_addr; 1522 1.2 pgoyette info.rti_info[RTAX_NETMASK] = ifa->ifa_netmask; 1523 1.2 pgoyette info.rti_info[RTAX_BRD] = ifa->ifa_dstaddr; 1524 1.8 roy info.rti_info[RTAX_AUTHOR] = src; 1525 1.2 pgoyette memset(&ifam, 0, sizeof(ifam)); 1526 1.2 pgoyette ifam.ifam_index = ifp->if_index; 1527 1.2 pgoyette ifam.ifam_metric = ifa->ifa_metric; 1528 1.2 pgoyette ifam.ifam_flags = ifa->ifa_flags; 1529 1.2 pgoyette #ifndef COMPAT_RTSOCK 1530 1.2 pgoyette ifam.ifam_pid = curproc->p_pid; 1531 1.2 pgoyette ifam.ifam_addrflags = if_addrflags(ifa); 1532 1.2 pgoyette #endif 1533 1.2 pgoyette m = COMPATNAME(rt_msg1)(ncmd, &info, &ifam, sizeof(ifam)); 1534 1.2 pgoyette if (m == NULL) 1535 1.2 pgoyette continue; 1536 1.2 pgoyette mtod(m, struct ifa_xmsghdr *)->ifam_addrs = 1537 1.2 pgoyette info.rti_addrs; 1538 1.2 pgoyette break; 1539 1.2 pgoyette case cmdpass(RTM_ADD, 2): 1540 1.2 pgoyette case cmdpass(RTM_CHANGE, 2): 1541 1.2 pgoyette case cmdpass(RTM_DELETE, 1): 1542 1.2 pgoyette if (rt == NULL) 1543 1.2 pgoyette continue; 1544 1.2 pgoyette info.rti_info[RTAX_NETMASK] = rt_mask(rt); 1545 1.2 pgoyette info.rti_info[RTAX_DST] = sa = rt_getkey(rt); 1546 1.2 pgoyette info.rti_info[RTAX_GATEWAY] = rt->rt_gateway; 1547 1.2 pgoyette memset(&rtm, 0, sizeof(rtm)); 1548 1.2 pgoyette rtm.rtm_pid = curproc->p_pid; 1549 1.2 pgoyette rtm.rtm_index = ifp->if_index; 1550 1.2 pgoyette rtm.rtm_flags |= rt->rt_flags; 1551 1.2 pgoyette rtm.rtm_errno = error; 1552 1.2 pgoyette m = COMPATNAME(rt_msg1)(cmd, &info, &rtm, sizeof(rtm)); 1553 1.2 pgoyette if (m == NULL) 1554 1.2 pgoyette continue; 1555 1.2 pgoyette mtod(m, struct rt_xmsghdr *)->rtm_addrs = info.rti_addrs; 1556 1.2 pgoyette break; 1557 1.2 pgoyette default: 1558 1.2 pgoyette continue; 1559 1.2 pgoyette } 1560 1.2 pgoyette KASSERTMSG(m != NULL, "called with wrong command"); 1561 1.2 pgoyette COMPATNAME(route_enqueue)(m, sa ? sa->sa_family : 0); 1562 1.2 pgoyette } 1563 1.2 pgoyette #undef cmdpass 1564 1.2 pgoyette } 1565 1.2 pgoyette 1566 1.7 roy void 1567 1.7 roy COMPATNAME(rt_addrmsg)(int cmd, struct ifaddr *ifa) 1568 1.7 roy { 1569 1.7 roy 1570 1.8 roy COMPATNAME(rt_addrmsg0)(cmd, ifa, 0, NULL, NULL); 1571 1.8 roy } 1572 1.8 roy 1573 1.8 roy void 1574 1.8 roy COMPATNAME(rt_addrmsg_rt)(int cmd, struct ifaddr *ifa, int error, 1575 1.8 roy struct rtentry *rt) 1576 1.8 roy { 1577 1.8 roy 1578 1.8 roy COMPATNAME(rt_addrmsg0)(cmd, ifa, error, rt, NULL); 1579 1.8 roy } 1580 1.8 roy 1581 1.8 roy void 1582 1.8 roy COMPATNAME(rt_addrmsg_src)(int cmd, struct ifaddr *ifa, 1583 1.8 roy const struct sockaddr *src) 1584 1.8 roy { 1585 1.8 roy 1586 1.8 roy COMPATNAME(rt_addrmsg0)(cmd, ifa, 0, NULL, src); 1587 1.7 roy } 1588 1.7 roy 1589 1.2 pgoyette static struct mbuf * 1590 1.2 pgoyette rt_makeifannouncemsg(struct ifnet *ifp, int type, int what, 1591 1.2 pgoyette struct rt_addrinfo *info) 1592 1.2 pgoyette { 1593 1.2 pgoyette struct if_xannouncemsghdr ifan; 1594 1.2 pgoyette 1595 1.2 pgoyette memset(info, 0, sizeof(*info)); 1596 1.2 pgoyette memset(&ifan, 0, sizeof(ifan)); 1597 1.2 pgoyette ifan.ifan_index = ifp->if_index; 1598 1.2 pgoyette strlcpy(ifan.ifan_name, ifp->if_xname, sizeof(ifan.ifan_name)); 1599 1.2 pgoyette ifan.ifan_what = what; 1600 1.2 pgoyette return COMPATNAME(rt_msg1)(type, info, &ifan, sizeof(ifan)); 1601 1.2 pgoyette } 1602 1.2 pgoyette 1603 1.2 pgoyette /* 1604 1.2 pgoyette * This is called to generate routing socket messages indicating 1605 1.2 pgoyette * network interface arrival and departure. 1606 1.2 pgoyette */ 1607 1.2 pgoyette void 1608 1.2 pgoyette COMPATNAME(rt_ifannouncemsg)(struct ifnet *ifp, int what) 1609 1.2 pgoyette { 1610 1.2 pgoyette struct mbuf *m; 1611 1.2 pgoyette struct rt_addrinfo info; 1612 1.2 pgoyette 1613 1.2 pgoyette COMPATCALL(rt_ifannouncemsg, (ifp, what)); 1614 1.2 pgoyette if (COMPATNAME(route_info).ri_cb.any_count == 0) 1615 1.2 pgoyette return; 1616 1.2 pgoyette m = rt_makeifannouncemsg(ifp, RTM_IFANNOUNCE, what, &info); 1617 1.2 pgoyette if (m == NULL) 1618 1.2 pgoyette return; 1619 1.2 pgoyette COMPATNAME(route_enqueue)(m, 0); 1620 1.2 pgoyette } 1621 1.2 pgoyette 1622 1.2 pgoyette /* 1623 1.2 pgoyette * This is called to generate routing socket messages indicating 1624 1.2 pgoyette * IEEE80211 wireless events. 1625 1.2 pgoyette * XXX we piggyback on the RTM_IFANNOUNCE msg format in a clumsy way. 1626 1.2 pgoyette */ 1627 1.2 pgoyette void 1628 1.2 pgoyette COMPATNAME(rt_ieee80211msg)(struct ifnet *ifp, int what, void *data, 1629 1.2 pgoyette size_t data_len) 1630 1.2 pgoyette { 1631 1.2 pgoyette struct mbuf *m; 1632 1.2 pgoyette struct rt_addrinfo info; 1633 1.2 pgoyette 1634 1.2 pgoyette COMPATCALL(rt_ieee80211msg, (ifp, what, data, data_len)); 1635 1.2 pgoyette if (COMPATNAME(route_info).ri_cb.any_count == 0) 1636 1.2 pgoyette return; 1637 1.2 pgoyette m = rt_makeifannouncemsg(ifp, RTM_IEEE80211, what, &info); 1638 1.2 pgoyette if (m == NULL) 1639 1.2 pgoyette return; 1640 1.2 pgoyette /* 1641 1.2 pgoyette * Append the ieee80211 data. Try to stick it in the 1642 1.2 pgoyette * mbuf containing the ifannounce msg; otherwise allocate 1643 1.2 pgoyette * a new mbuf and append. 1644 1.2 pgoyette * 1645 1.2 pgoyette * NB: we assume m is a single mbuf. 1646 1.2 pgoyette */ 1647 1.2 pgoyette if (data_len > M_TRAILINGSPACE(m)) { 1648 1.2 pgoyette struct mbuf *n = m_get(M_NOWAIT, MT_DATA); 1649 1.2 pgoyette if (n == NULL) { 1650 1.2 pgoyette m_freem(m); 1651 1.2 pgoyette return; 1652 1.2 pgoyette } 1653 1.2 pgoyette (void)memcpy(mtod(n, void *), data, data_len); 1654 1.2 pgoyette n->m_len = data_len; 1655 1.2 pgoyette m->m_next = n; 1656 1.2 pgoyette } else if (data_len > 0) { 1657 1.2 pgoyette (void)memcpy(mtod(m, uint8_t *) + m->m_len, data, data_len); 1658 1.2 pgoyette m->m_len += data_len; 1659 1.2 pgoyette } 1660 1.2 pgoyette if (m->m_flags & M_PKTHDR) 1661 1.2 pgoyette m->m_pkthdr.len += data_len; 1662 1.2 pgoyette mtod(m, struct if_xannouncemsghdr *)->ifan_msglen += data_len; 1663 1.2 pgoyette COMPATNAME(route_enqueue)(m, 0); 1664 1.2 pgoyette } 1665 1.2 pgoyette 1666 1.2 pgoyette /* 1667 1.2 pgoyette * Routing message software interrupt routine 1668 1.2 pgoyette */ 1669 1.2 pgoyette static void 1670 1.2 pgoyette COMPATNAME(route_intr)(void *cookie) 1671 1.2 pgoyette { 1672 1.2 pgoyette struct sockproto proto = { .sp_family = PF_XROUTE, }; 1673 1.2 pgoyette struct route_info * const ri = &COMPATNAME(route_info); 1674 1.2 pgoyette struct mbuf *m; 1675 1.2 pgoyette 1676 1.2 pgoyette SOFTNET_KERNEL_LOCK_UNLESS_NET_MPSAFE(); 1677 1.2 pgoyette for (;;) { 1678 1.2 pgoyette IFQ_LOCK(&ri->ri_intrq); 1679 1.2 pgoyette IF_DEQUEUE(&ri->ri_intrq, m); 1680 1.2 pgoyette IFQ_UNLOCK(&ri->ri_intrq); 1681 1.2 pgoyette if (m == NULL) 1682 1.2 pgoyette break; 1683 1.2 pgoyette proto.sp_protocol = M_GETCTX(m, uintptr_t); 1684 1.2 pgoyette #ifdef NET_MPSAFE 1685 1.2 pgoyette mutex_enter(rt_so_mtx); 1686 1.2 pgoyette #endif 1687 1.2 pgoyette raw_input(m, &proto, &ri->ri_src, &ri->ri_dst, &rt_rawcb); 1688 1.2 pgoyette #ifdef NET_MPSAFE 1689 1.2 pgoyette mutex_exit(rt_so_mtx); 1690 1.2 pgoyette #endif 1691 1.2 pgoyette } 1692 1.2 pgoyette SOFTNET_KERNEL_UNLOCK_UNLESS_NET_MPSAFE(); 1693 1.2 pgoyette } 1694 1.2 pgoyette 1695 1.2 pgoyette /* 1696 1.2 pgoyette * Enqueue a message to the software interrupt routine. 1697 1.2 pgoyette */ 1698 1.2 pgoyette void 1699 1.2 pgoyette COMPATNAME(route_enqueue)(struct mbuf *m, int family) 1700 1.2 pgoyette { 1701 1.2 pgoyette struct route_info * const ri = &COMPATNAME(route_info); 1702 1.2 pgoyette int wasempty; 1703 1.2 pgoyette 1704 1.2 pgoyette IFQ_LOCK(&ri->ri_intrq); 1705 1.2 pgoyette if (IF_QFULL(&ri->ri_intrq)) { 1706 1.2 pgoyette printf("%s: queue full, dropped message\n", __func__); 1707 1.2 pgoyette IF_DROP(&ri->ri_intrq); 1708 1.2 pgoyette IFQ_UNLOCK(&ri->ri_intrq); 1709 1.2 pgoyette m_freem(m); 1710 1.2 pgoyette } else { 1711 1.2 pgoyette wasempty = IF_IS_EMPTY(&ri->ri_intrq); 1712 1.2 pgoyette M_SETCTX(m, (uintptr_t)family); 1713 1.2 pgoyette IF_ENQUEUE(&ri->ri_intrq, m); 1714 1.2 pgoyette IFQ_UNLOCK(&ri->ri_intrq); 1715 1.2 pgoyette if (wasempty) { 1716 1.2 pgoyette kpreempt_disable(); 1717 1.2 pgoyette softint_schedule(ri->ri_sih); 1718 1.2 pgoyette kpreempt_enable(); 1719 1.2 pgoyette } 1720 1.2 pgoyette } 1721 1.2 pgoyette } 1722 1.2 pgoyette 1723 1.2 pgoyette static void 1724 1.2 pgoyette COMPATNAME(route_init)(void) 1725 1.2 pgoyette { 1726 1.2 pgoyette struct route_info * const ri = &COMPATNAME(route_info); 1727 1.2 pgoyette 1728 1.2 pgoyette #ifndef COMPAT_RTSOCK 1729 1.2 pgoyette rt_init(); 1730 1.2 pgoyette #ifdef NET_MPSAFE 1731 1.2 pgoyette rt_so_mtx = mutex_obj_alloc(MUTEX_DEFAULT, IPL_NONE); 1732 1.2 pgoyette 1733 1.2 pgoyette cv_init(&rt_update_cv, "rtsock_cv"); 1734 1.2 pgoyette #endif 1735 1.2 pgoyette 1736 1.6 pgoyette sysctl_net_route_setup(NULL, PF_ROUTE, "rtable"); 1737 1.2 pgoyette #endif 1738 1.2 pgoyette ri->ri_intrq.ifq_maxlen = ri->ri_maxqlen; 1739 1.2 pgoyette ri->ri_sih = softint_establish(SOFTINT_NET | SOFTINT_MPSAFE, 1740 1.2 pgoyette COMPATNAME(route_intr), NULL); 1741 1.2 pgoyette IFQ_LOCK_INIT(&ri->ri_intrq); 1742 1.10 ozaki 1743 1.10 ozaki #ifdef MBUFTRACE 1744 1.10 ozaki MOWNER_ATTACH(&COMPATNAME(routedomain).dom_mowner); 1745 1.10 ozaki #endif 1746 1.2 pgoyette } 1747 1.2 pgoyette 1748 1.2 pgoyette /* 1749 1.2 pgoyette * Definitions of protocols supported in the ROUTE domain. 1750 1.2 pgoyette */ 1751 1.2 pgoyette #ifndef COMPAT_RTSOCK 1752 1.2 pgoyette PR_WRAP_USRREQS(route); 1753 1.2 pgoyette #else 1754 1.2 pgoyette PR_WRAP_USRREQS(compat_50_route); 1755 1.2 pgoyette #endif 1756 1.2 pgoyette 1757 1.2 pgoyette static const struct pr_usrreqs route_usrreqs = { 1758 1.2 pgoyette .pr_attach = COMPATNAME(route_attach_wrapper), 1759 1.2 pgoyette .pr_detach = COMPATNAME(route_detach_wrapper), 1760 1.2 pgoyette .pr_accept = COMPATNAME(route_accept_wrapper), 1761 1.2 pgoyette .pr_bind = COMPATNAME(route_bind_wrapper), 1762 1.2 pgoyette .pr_listen = COMPATNAME(route_listen_wrapper), 1763 1.2 pgoyette .pr_connect = COMPATNAME(route_connect_wrapper), 1764 1.2 pgoyette .pr_connect2 = COMPATNAME(route_connect2_wrapper), 1765 1.2 pgoyette .pr_disconnect = COMPATNAME(route_disconnect_wrapper), 1766 1.2 pgoyette .pr_shutdown = COMPATNAME(route_shutdown_wrapper), 1767 1.2 pgoyette .pr_abort = COMPATNAME(route_abort_wrapper), 1768 1.2 pgoyette .pr_ioctl = COMPATNAME(route_ioctl_wrapper), 1769 1.2 pgoyette .pr_stat = COMPATNAME(route_stat_wrapper), 1770 1.2 pgoyette .pr_peeraddr = COMPATNAME(route_peeraddr_wrapper), 1771 1.2 pgoyette .pr_sockaddr = COMPATNAME(route_sockaddr_wrapper), 1772 1.2 pgoyette .pr_rcvd = COMPATNAME(route_rcvd_wrapper), 1773 1.2 pgoyette .pr_recvoob = COMPATNAME(route_recvoob_wrapper), 1774 1.2 pgoyette .pr_send = COMPATNAME(route_send_wrapper), 1775 1.2 pgoyette .pr_sendoob = COMPATNAME(route_sendoob_wrapper), 1776 1.2 pgoyette .pr_purgeif = COMPATNAME(route_purgeif_wrapper), 1777 1.2 pgoyette }; 1778 1.2 pgoyette 1779 1.2 pgoyette static const struct protosw COMPATNAME(route_protosw)[] = { 1780 1.2 pgoyette { 1781 1.2 pgoyette .pr_type = SOCK_RAW, 1782 1.2 pgoyette .pr_domain = &COMPATNAME(routedomain), 1783 1.2 pgoyette .pr_flags = PR_ATOMIC|PR_ADDR, 1784 1.2 pgoyette .pr_ctlinput = raw_ctlinput, 1785 1.2 pgoyette .pr_ctloutput = route_ctloutput, 1786 1.2 pgoyette .pr_usrreqs = &route_usrreqs, 1787 1.2 pgoyette .pr_init = rt_pr_init, 1788 1.2 pgoyette }, 1789 1.2 pgoyette }; 1790 1.2 pgoyette 1791 1.2 pgoyette struct domain COMPATNAME(routedomain) = { 1792 1.2 pgoyette .dom_family = PF_XROUTE, 1793 1.2 pgoyette .dom_name = DOMAINNAME, 1794 1.2 pgoyette .dom_init = COMPATNAME(route_init), 1795 1.2 pgoyette .dom_protosw = COMPATNAME(route_protosw), 1796 1.2 pgoyette .dom_protoswNPROTOSW = 1797 1.2 pgoyette &COMPATNAME(route_protosw)[__arraycount(COMPATNAME(route_protosw))], 1798 1.10 ozaki #ifdef MBUFTRACE 1799 1.10 ozaki .dom_mowner = MOWNER_INIT("route", "rtm"), 1800 1.10 ozaki #endif 1801 1.2 pgoyette }; 1802