1df8bae1dSRodney W. Grimes /* 2df8bae1dSRodney W. Grimes * Copyright (c) 1980, 1986, 1991, 1993 3df8bae1dSRodney W. Grimes * The Regents of the University of California. All rights reserved. 4df8bae1dSRodney W. Grimes * 5df8bae1dSRodney W. Grimes * Redistribution and use in source and binary forms, with or without 6df8bae1dSRodney W. Grimes * modification, are permitted provided that the following conditions 7df8bae1dSRodney W. Grimes * are met: 8df8bae1dSRodney W. Grimes * 1. Redistributions of source code must retain the above copyright 9df8bae1dSRodney W. Grimes * notice, this list of conditions and the following disclaimer. 10df8bae1dSRodney W. Grimes * 2. Redistributions in binary form must reproduce the above copyright 11df8bae1dSRodney W. Grimes * notice, this list of conditions and the following disclaimer in the 12df8bae1dSRodney W. Grimes * documentation and/or other materials provided with the distribution. 13df8bae1dSRodney W. Grimes * 3. All advertising materials mentioning features or use of this software 14df8bae1dSRodney W. Grimes * must display the following acknowledgement: 15df8bae1dSRodney W. Grimes * This product includes software developed by the University of 16df8bae1dSRodney W. Grimes * California, Berkeley and its contributors. 17df8bae1dSRodney W. Grimes * 4. Neither the name of the University nor the names of its contributors 18df8bae1dSRodney W. Grimes * may be used to endorse or promote products derived from this software 19df8bae1dSRodney W. Grimes * without specific prior written permission. 20df8bae1dSRodney W. Grimes * 21df8bae1dSRodney W. Grimes * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 22df8bae1dSRodney W. Grimes * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 23df8bae1dSRodney W. Grimes * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 24df8bae1dSRodney W. Grimes * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 25df8bae1dSRodney W. Grimes * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 26df8bae1dSRodney W. Grimes * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 27df8bae1dSRodney W. Grimes * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 28df8bae1dSRodney W. Grimes * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 29df8bae1dSRodney W. Grimes * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 30df8bae1dSRodney W. Grimes * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31df8bae1dSRodney W. Grimes * SUCH DAMAGE. 32df8bae1dSRodney W. Grimes * 33df8bae1dSRodney W. Grimes * @(#)route.c 8.2 (Berkeley) 11/15/93 34f0068c4aSGarrett Wollman * $Id: route.c,v 1.3 1994/08/02 07:46:40 davidg Exp $ 35df8bae1dSRodney W. Grimes */ 36df8bae1dSRodney W. Grimes 37df8bae1dSRodney W. Grimes #include <sys/param.h> 38df8bae1dSRodney W. Grimes #include <sys/systm.h> 39df8bae1dSRodney W. Grimes #include <sys/proc.h> 40df8bae1dSRodney W. Grimes #include <sys/mbuf.h> 41df8bae1dSRodney W. Grimes #include <sys/socket.h> 42df8bae1dSRodney W. Grimes #include <sys/socketvar.h> 43df8bae1dSRodney W. Grimes #include <sys/domain.h> 44df8bae1dSRodney W. Grimes #include <sys/protosw.h> 45df8bae1dSRodney W. Grimes #include <sys/ioctl.h> 46df8bae1dSRodney W. Grimes 47df8bae1dSRodney W. Grimes #include <net/if.h> 48df8bae1dSRodney W. Grimes #include <net/route.h> 49df8bae1dSRodney W. Grimes #include <net/raw_cb.h> 50df8bae1dSRodney W. Grimes 51df8bae1dSRodney W. Grimes #include <netinet/in.h> 52df8bae1dSRodney W. Grimes #include <netinet/in_var.h> 53df8bae1dSRodney W. Grimes 54df8bae1dSRodney W. Grimes #ifdef NS 55df8bae1dSRodney W. Grimes #include <netns/ns.h> 56df8bae1dSRodney W. Grimes #endif 57df8bae1dSRodney W. Grimes 58df8bae1dSRodney W. Grimes #define SA(p) ((struct sockaddr *)(p)) 59df8bae1dSRodney W. Grimes 60df8bae1dSRodney W. Grimes int rttrash; /* routes not in table but not freed */ 61df8bae1dSRodney W. Grimes struct sockaddr wildcard; /* zero valued cookie for wildcard searches */ 62df8bae1dSRodney W. Grimes 63df8bae1dSRodney W. Grimes void 64df8bae1dSRodney W. Grimes rtable_init(table) 65df8bae1dSRodney W. Grimes void **table; 66df8bae1dSRodney W. Grimes { 67df8bae1dSRodney W. Grimes struct domain *dom; 68df8bae1dSRodney W. Grimes for (dom = domains; dom; dom = dom->dom_next) 69df8bae1dSRodney W. Grimes if (dom->dom_rtattach) 70df8bae1dSRodney W. Grimes dom->dom_rtattach(&table[dom->dom_family], 71df8bae1dSRodney W. Grimes dom->dom_rtoffset); 72df8bae1dSRodney W. Grimes } 73df8bae1dSRodney W. Grimes 74df8bae1dSRodney W. Grimes void 75df8bae1dSRodney W. Grimes route_init() 76df8bae1dSRodney W. Grimes { 77df8bae1dSRodney W. Grimes rn_init(); /* initialize all zeroes, all ones, mask table */ 78df8bae1dSRodney W. Grimes rtable_init((void **)rt_tables); 79df8bae1dSRodney W. Grimes } 80df8bae1dSRodney W. Grimes 81df8bae1dSRodney W. Grimes /* 82df8bae1dSRodney W. Grimes * Packet routing routines. 83df8bae1dSRodney W. Grimes */ 84df8bae1dSRodney W. Grimes void 85df8bae1dSRodney W. Grimes rtalloc(ro) 86df8bae1dSRodney W. Grimes register struct route *ro; 87df8bae1dSRodney W. Grimes { 88df8bae1dSRodney W. Grimes if (ro->ro_rt && ro->ro_rt->rt_ifp && (ro->ro_rt->rt_flags & RTF_UP)) 89df8bae1dSRodney W. Grimes return; /* XXX */ 90df8bae1dSRodney W. Grimes ro->ro_rt = rtalloc1(&ro->ro_dst, 1); 91df8bae1dSRodney W. Grimes } 92df8bae1dSRodney W. Grimes 93df8bae1dSRodney W. Grimes struct rtentry * 94df8bae1dSRodney W. Grimes rtalloc1(dst, report) 95df8bae1dSRodney W. Grimes register struct sockaddr *dst; 96df8bae1dSRodney W. Grimes int report; 97df8bae1dSRodney W. Grimes { 98df8bae1dSRodney W. Grimes register struct radix_node_head *rnh = rt_tables[dst->sa_family]; 99df8bae1dSRodney W. Grimes register struct rtentry *rt; 100df8bae1dSRodney W. Grimes register struct radix_node *rn; 101df8bae1dSRodney W. Grimes struct rtentry *newrt = 0; 102df8bae1dSRodney W. Grimes struct rt_addrinfo info; 103df8bae1dSRodney W. Grimes int s = splnet(), err = 0, msgtype = RTM_MISS; 104df8bae1dSRodney W. Grimes 105df8bae1dSRodney W. Grimes if (rnh && (rn = rnh->rnh_matchaddr((caddr_t)dst, rnh)) && 106df8bae1dSRodney W. Grimes ((rn->rn_flags & RNF_ROOT) == 0)) { 107df8bae1dSRodney W. Grimes newrt = rt = (struct rtentry *)rn; 108df8bae1dSRodney W. Grimes if (report && (rt->rt_flags & RTF_CLONING)) { 109df8bae1dSRodney W. Grimes err = rtrequest(RTM_RESOLVE, dst, SA(0), 110df8bae1dSRodney W. Grimes SA(0), 0, &newrt); 111df8bae1dSRodney W. Grimes if (err) { 112df8bae1dSRodney W. Grimes newrt = rt; 113df8bae1dSRodney W. Grimes rt->rt_refcnt++; 114df8bae1dSRodney W. Grimes goto miss; 115df8bae1dSRodney W. Grimes } 116df8bae1dSRodney W. Grimes if ((rt = newrt) && (rt->rt_flags & RTF_XRESOLVE)) { 117df8bae1dSRodney W. Grimes msgtype = RTM_RESOLVE; 118df8bae1dSRodney W. Grimes goto miss; 119df8bae1dSRodney W. Grimes } 120df8bae1dSRodney W. Grimes } else 121df8bae1dSRodney W. Grimes rt->rt_refcnt++; 122df8bae1dSRodney W. Grimes } else { 123df8bae1dSRodney W. Grimes rtstat.rts_unreach++; 124df8bae1dSRodney W. Grimes miss: if (report) { 125df8bae1dSRodney W. Grimes bzero((caddr_t)&info, sizeof(info)); 126df8bae1dSRodney W. Grimes info.rti_info[RTAX_DST] = dst; 127df8bae1dSRodney W. Grimes rt_missmsg(msgtype, &info, 0, err); 128df8bae1dSRodney W. Grimes } 129df8bae1dSRodney W. Grimes } 130df8bae1dSRodney W. Grimes splx(s); 131df8bae1dSRodney W. Grimes return (newrt); 132df8bae1dSRodney W. Grimes } 133df8bae1dSRodney W. Grimes 134df8bae1dSRodney W. Grimes void 135df8bae1dSRodney W. Grimes rtfree(rt) 136df8bae1dSRodney W. Grimes register struct rtentry *rt; 137df8bae1dSRodney W. Grimes { 138df8bae1dSRodney W. Grimes register struct ifaddr *ifa; 139df8bae1dSRodney W. Grimes 140df8bae1dSRodney W. Grimes if (rt == 0) 141df8bae1dSRodney W. Grimes panic("rtfree"); 142df8bae1dSRodney W. Grimes rt->rt_refcnt--; 143df8bae1dSRodney W. Grimes if (rt->rt_refcnt <= 0 && (rt->rt_flags & RTF_UP) == 0) { 144df8bae1dSRodney W. Grimes if (rt->rt_nodes->rn_flags & (RNF_ACTIVE | RNF_ROOT)) 145df8bae1dSRodney W. Grimes panic ("rtfree 2"); 146df8bae1dSRodney W. Grimes rttrash--; 147df8bae1dSRodney W. Grimes if (rt->rt_refcnt < 0) { 148df8bae1dSRodney W. Grimes printf("rtfree: %x not freed (neg refs)\n", rt); 149df8bae1dSRodney W. Grimes return; 150df8bae1dSRodney W. Grimes } 151df8bae1dSRodney W. Grimes ifa = rt->rt_ifa; 152df8bae1dSRodney W. Grimes IFAFREE(ifa); 153df8bae1dSRodney W. Grimes Free(rt_key(rt)); 154df8bae1dSRodney W. Grimes Free(rt); 155df8bae1dSRodney W. Grimes } 156df8bae1dSRodney W. Grimes } 157df8bae1dSRodney W. Grimes 158df8bae1dSRodney W. Grimes void 159df8bae1dSRodney W. Grimes ifafree(ifa) 160df8bae1dSRodney W. Grimes register struct ifaddr *ifa; 161df8bae1dSRodney W. Grimes { 162df8bae1dSRodney W. Grimes if (ifa == NULL) 163df8bae1dSRodney W. Grimes panic("ifafree"); 164df8bae1dSRodney W. Grimes if (ifa->ifa_refcnt == 0) 165df8bae1dSRodney W. Grimes free(ifa, M_IFADDR); 166df8bae1dSRodney W. Grimes else 167df8bae1dSRodney W. Grimes ifa->ifa_refcnt--; 168df8bae1dSRodney W. Grimes } 169df8bae1dSRodney W. Grimes 170df8bae1dSRodney W. Grimes /* 171df8bae1dSRodney W. Grimes * Force a routing table entry to the specified 172df8bae1dSRodney W. Grimes * destination to go through the given gateway. 173df8bae1dSRodney W. Grimes * Normally called as a result of a routing redirect 174df8bae1dSRodney W. Grimes * message from the network layer. 175df8bae1dSRodney W. Grimes * 176df8bae1dSRodney W. Grimes * N.B.: must be called at splnet 177df8bae1dSRodney W. Grimes * 178df8bae1dSRodney W. Grimes */ 17926f9a767SRodney W. Grimes void 180df8bae1dSRodney W. Grimes rtredirect(dst, gateway, netmask, flags, src, rtp) 181df8bae1dSRodney W. Grimes struct sockaddr *dst, *gateway, *netmask, *src; 182df8bae1dSRodney W. Grimes int flags; 183df8bae1dSRodney W. Grimes struct rtentry **rtp; 184df8bae1dSRodney W. Grimes { 185df8bae1dSRodney W. Grimes register struct rtentry *rt; 186df8bae1dSRodney W. Grimes int error = 0; 187df8bae1dSRodney W. Grimes short *stat = 0; 188df8bae1dSRodney W. Grimes struct rt_addrinfo info; 189df8bae1dSRodney W. Grimes struct ifaddr *ifa; 190df8bae1dSRodney W. Grimes 191df8bae1dSRodney W. Grimes /* verify the gateway is directly reachable */ 192df8bae1dSRodney W. Grimes if ((ifa = ifa_ifwithnet(gateway)) == 0) { 193df8bae1dSRodney W. Grimes error = ENETUNREACH; 194df8bae1dSRodney W. Grimes goto out; 195df8bae1dSRodney W. Grimes } 196df8bae1dSRodney W. Grimes rt = rtalloc1(dst, 0); 197df8bae1dSRodney W. Grimes /* 198df8bae1dSRodney W. Grimes * If the redirect isn't from our current router for this dst, 199df8bae1dSRodney W. Grimes * it's either old or wrong. If it redirects us to ourselves, 200df8bae1dSRodney W. Grimes * we have a routing loop, perhaps as a result of an interface 201df8bae1dSRodney W. Grimes * going down recently. 202df8bae1dSRodney W. Grimes */ 203df8bae1dSRodney W. Grimes #define equal(a1, a2) (bcmp((caddr_t)(a1), (caddr_t)(a2), (a1)->sa_len) == 0) 204df8bae1dSRodney W. Grimes if (!(flags & RTF_DONE) && rt && 205df8bae1dSRodney W. Grimes (!equal(src, rt->rt_gateway) || rt->rt_ifa != ifa)) 206df8bae1dSRodney W. Grimes error = EINVAL; 207df8bae1dSRodney W. Grimes else if (ifa_ifwithaddr(gateway)) 208df8bae1dSRodney W. Grimes error = EHOSTUNREACH; 209df8bae1dSRodney W. Grimes if (error) 210df8bae1dSRodney W. Grimes goto done; 211df8bae1dSRodney W. Grimes /* 212df8bae1dSRodney W. Grimes * Create a new entry if we just got back a wildcard entry 213df8bae1dSRodney W. Grimes * or the the lookup failed. This is necessary for hosts 214df8bae1dSRodney W. Grimes * which use routing redirects generated by smart gateways 215df8bae1dSRodney W. Grimes * to dynamically build the routing tables. 216df8bae1dSRodney W. Grimes */ 217df8bae1dSRodney W. Grimes if ((rt == 0) || (rt_mask(rt) && rt_mask(rt)->sa_len < 2)) 218df8bae1dSRodney W. Grimes goto create; 219df8bae1dSRodney W. Grimes /* 220df8bae1dSRodney W. Grimes * Don't listen to the redirect if it's 221df8bae1dSRodney W. Grimes * for a route to an interface. 222df8bae1dSRodney W. Grimes */ 223df8bae1dSRodney W. Grimes if (rt->rt_flags & RTF_GATEWAY) { 224df8bae1dSRodney W. Grimes if (((rt->rt_flags & RTF_HOST) == 0) && (flags & RTF_HOST)) { 225df8bae1dSRodney W. Grimes /* 226df8bae1dSRodney W. Grimes * Changing from route to net => route to host. 227df8bae1dSRodney W. Grimes * Create new route, rather than smashing route to net. 228df8bae1dSRodney W. Grimes */ 229df8bae1dSRodney W. Grimes create: 230df8bae1dSRodney W. Grimes flags |= RTF_GATEWAY | RTF_DYNAMIC; 231df8bae1dSRodney W. Grimes error = rtrequest((int)RTM_ADD, dst, gateway, 232df8bae1dSRodney W. Grimes netmask, flags, 233df8bae1dSRodney W. Grimes (struct rtentry **)0); 234df8bae1dSRodney W. Grimes stat = &rtstat.rts_dynamic; 235df8bae1dSRodney W. Grimes } else { 236df8bae1dSRodney W. Grimes /* 237df8bae1dSRodney W. Grimes * Smash the current notion of the gateway to 238df8bae1dSRodney W. Grimes * this destination. Should check about netmask!!! 239df8bae1dSRodney W. Grimes */ 240df8bae1dSRodney W. Grimes rt->rt_flags |= RTF_MODIFIED; 241df8bae1dSRodney W. Grimes flags |= RTF_MODIFIED; 242df8bae1dSRodney W. Grimes stat = &rtstat.rts_newgateway; 243df8bae1dSRodney W. Grimes rt_setgate(rt, rt_key(rt), gateway); 244df8bae1dSRodney W. Grimes } 245df8bae1dSRodney W. Grimes } else 246df8bae1dSRodney W. Grimes error = EHOSTUNREACH; 247df8bae1dSRodney W. Grimes done: 248df8bae1dSRodney W. Grimes if (rt) { 249df8bae1dSRodney W. Grimes if (rtp && !error) 250df8bae1dSRodney W. Grimes *rtp = rt; 251df8bae1dSRodney W. Grimes else 252df8bae1dSRodney W. Grimes rtfree(rt); 253df8bae1dSRodney W. Grimes } 254df8bae1dSRodney W. Grimes out: 255df8bae1dSRodney W. Grimes if (error) 256df8bae1dSRodney W. Grimes rtstat.rts_badredirect++; 257df8bae1dSRodney W. Grimes else if (stat != NULL) 258df8bae1dSRodney W. Grimes (*stat)++; 259df8bae1dSRodney W. Grimes bzero((caddr_t)&info, sizeof(info)); 260df8bae1dSRodney W. Grimes info.rti_info[RTAX_DST] = dst; 261df8bae1dSRodney W. Grimes info.rti_info[RTAX_GATEWAY] = gateway; 262df8bae1dSRodney W. Grimes info.rti_info[RTAX_NETMASK] = netmask; 263df8bae1dSRodney W. Grimes info.rti_info[RTAX_AUTHOR] = src; 264df8bae1dSRodney W. Grimes rt_missmsg(RTM_REDIRECT, &info, flags, error); 265df8bae1dSRodney W. Grimes } 266df8bae1dSRodney W. Grimes 267df8bae1dSRodney W. Grimes /* 268df8bae1dSRodney W. Grimes * Routing table ioctl interface. 269df8bae1dSRodney W. Grimes */ 270df8bae1dSRodney W. Grimes int 271df8bae1dSRodney W. Grimes rtioctl(req, data, p) 272df8bae1dSRodney W. Grimes int req; 273df8bae1dSRodney W. Grimes caddr_t data; 274df8bae1dSRodney W. Grimes struct proc *p; 275df8bae1dSRodney W. Grimes { 276f0068c4aSGarrett Wollman #ifdef MULTICAST 277f0068c4aSGarrett Wollman /* Multicast goop, grrr... */ 278f0068c4aSGarrett Wollman return mrt_ioctl(cmd, data, p); 279f0068c4aSGarrett Wollman #else 280df8bae1dSRodney W. Grimes return (EOPNOTSUPP); 281f0068c4aSGarrett Wollman #endif 282df8bae1dSRodney W. Grimes } 283df8bae1dSRodney W. Grimes 284df8bae1dSRodney W. Grimes struct ifaddr * 285df8bae1dSRodney W. Grimes ifa_ifwithroute(flags, dst, gateway) 286df8bae1dSRodney W. Grimes int flags; 287df8bae1dSRodney W. Grimes struct sockaddr *dst, *gateway; 288df8bae1dSRodney W. Grimes { 289df8bae1dSRodney W. Grimes register struct ifaddr *ifa; 290df8bae1dSRodney W. Grimes if ((flags & RTF_GATEWAY) == 0) { 291df8bae1dSRodney W. Grimes /* 292df8bae1dSRodney W. Grimes * If we are adding a route to an interface, 293df8bae1dSRodney W. Grimes * and the interface is a pt to pt link 294df8bae1dSRodney W. Grimes * we should search for the destination 295df8bae1dSRodney W. Grimes * as our clue to the interface. Otherwise 296df8bae1dSRodney W. Grimes * we can use the local address. 297df8bae1dSRodney W. Grimes */ 298df8bae1dSRodney W. Grimes ifa = 0; 299df8bae1dSRodney W. Grimes if (flags & RTF_HOST) 300df8bae1dSRodney W. Grimes ifa = ifa_ifwithdstaddr(dst); 301df8bae1dSRodney W. Grimes if (ifa == 0) 302df8bae1dSRodney W. Grimes ifa = ifa_ifwithaddr(gateway); 303df8bae1dSRodney W. Grimes } else { 304df8bae1dSRodney W. Grimes /* 305df8bae1dSRodney W. Grimes * If we are adding a route to a remote net 306df8bae1dSRodney W. Grimes * or host, the gateway may still be on the 307df8bae1dSRodney W. Grimes * other end of a pt to pt link. 308df8bae1dSRodney W. Grimes */ 309df8bae1dSRodney W. Grimes ifa = ifa_ifwithdstaddr(gateway); 310df8bae1dSRodney W. Grimes } 311df8bae1dSRodney W. Grimes if (ifa == 0) 312df8bae1dSRodney W. Grimes ifa = ifa_ifwithnet(gateway); 313df8bae1dSRodney W. Grimes if (ifa == 0) { 314df8bae1dSRodney W. Grimes struct rtentry *rt = rtalloc1(dst, 0); 315df8bae1dSRodney W. Grimes if (rt == 0) 316df8bae1dSRodney W. Grimes return (0); 317df8bae1dSRodney W. Grimes rt->rt_refcnt--; 318df8bae1dSRodney W. Grimes if ((ifa = rt->rt_ifa) == 0) 319df8bae1dSRodney W. Grimes return (0); 320df8bae1dSRodney W. Grimes } 321df8bae1dSRodney W. Grimes if (ifa->ifa_addr->sa_family != dst->sa_family) { 322df8bae1dSRodney W. Grimes struct ifaddr *oifa = ifa; 323df8bae1dSRodney W. Grimes ifa = ifaof_ifpforaddr(dst, ifa->ifa_ifp); 324df8bae1dSRodney W. Grimes if (ifa == 0) 325df8bae1dSRodney W. Grimes ifa = oifa; 326df8bae1dSRodney W. Grimes } 327df8bae1dSRodney W. Grimes return (ifa); 328df8bae1dSRodney W. Grimes } 329df8bae1dSRodney W. Grimes 330df8bae1dSRodney W. Grimes #define ROUNDUP(a) (a>0 ? (1 + (((a) - 1) | (sizeof(long) - 1))) : sizeof(long)) 331df8bae1dSRodney W. Grimes 332df8bae1dSRodney W. Grimes int 333df8bae1dSRodney W. Grimes rtrequest(req, dst, gateway, netmask, flags, ret_nrt) 334df8bae1dSRodney W. Grimes int req, flags; 335df8bae1dSRodney W. Grimes struct sockaddr *dst, *gateway, *netmask; 336df8bae1dSRodney W. Grimes struct rtentry **ret_nrt; 337df8bae1dSRodney W. Grimes { 338df8bae1dSRodney W. Grimes int s = splnet(); int error = 0; 339df8bae1dSRodney W. Grimes register struct rtentry *rt; 340df8bae1dSRodney W. Grimes register struct radix_node *rn; 341df8bae1dSRodney W. Grimes register struct radix_node_head *rnh; 342df8bae1dSRodney W. Grimes struct ifaddr *ifa; 343df8bae1dSRodney W. Grimes struct sockaddr *ndst; 344df8bae1dSRodney W. Grimes #define senderr(x) { error = x ; goto bad; } 345df8bae1dSRodney W. Grimes 346df8bae1dSRodney W. Grimes if ((rnh = rt_tables[dst->sa_family]) == 0) 347df8bae1dSRodney W. Grimes senderr(ESRCH); 348df8bae1dSRodney W. Grimes if (flags & RTF_HOST) 349df8bae1dSRodney W. Grimes netmask = 0; 350df8bae1dSRodney W. Grimes switch (req) { 351df8bae1dSRodney W. Grimes case RTM_DELETE: 352df8bae1dSRodney W. Grimes if ((rn = rnh->rnh_deladdr(dst, netmask, rnh)) == 0) 353df8bae1dSRodney W. Grimes senderr(ESRCH); 354df8bae1dSRodney W. Grimes if (rn->rn_flags & (RNF_ACTIVE | RNF_ROOT)) 355df8bae1dSRodney W. Grimes panic ("rtrequest delete"); 356df8bae1dSRodney W. Grimes rt = (struct rtentry *)rn; 357df8bae1dSRodney W. Grimes rt->rt_flags &= ~RTF_UP; 358df8bae1dSRodney W. Grimes if (rt->rt_gwroute) { 359df8bae1dSRodney W. Grimes rt = rt->rt_gwroute; RTFREE(rt); 360df8bae1dSRodney W. Grimes (rt = (struct rtentry *)rn)->rt_gwroute = 0; 361df8bae1dSRodney W. Grimes } 362df8bae1dSRodney W. Grimes if ((ifa = rt->rt_ifa) && ifa->ifa_rtrequest) 363df8bae1dSRodney W. Grimes ifa->ifa_rtrequest(RTM_DELETE, rt, SA(0)); 364df8bae1dSRodney W. Grimes rttrash++; 365df8bae1dSRodney W. Grimes if (ret_nrt) 366df8bae1dSRodney W. Grimes *ret_nrt = rt; 367df8bae1dSRodney W. Grimes else if (rt->rt_refcnt <= 0) { 368df8bae1dSRodney W. Grimes rt->rt_refcnt++; 369df8bae1dSRodney W. Grimes rtfree(rt); 370df8bae1dSRodney W. Grimes } 371df8bae1dSRodney W. Grimes break; 372df8bae1dSRodney W. Grimes 373df8bae1dSRodney W. Grimes case RTM_RESOLVE: 374df8bae1dSRodney W. Grimes if (ret_nrt == 0 || (rt = *ret_nrt) == 0) 375df8bae1dSRodney W. Grimes senderr(EINVAL); 376df8bae1dSRodney W. Grimes ifa = rt->rt_ifa; 377df8bae1dSRodney W. Grimes flags = rt->rt_flags & ~RTF_CLONING; 378df8bae1dSRodney W. Grimes gateway = rt->rt_gateway; 379df8bae1dSRodney W. Grimes if ((netmask = rt->rt_genmask) == 0) 380df8bae1dSRodney W. Grimes flags |= RTF_HOST; 381df8bae1dSRodney W. Grimes goto makeroute; 382df8bae1dSRodney W. Grimes 383df8bae1dSRodney W. Grimes case RTM_ADD: 384df8bae1dSRodney W. Grimes if ((ifa = ifa_ifwithroute(flags, dst, gateway)) == 0) 385df8bae1dSRodney W. Grimes senderr(ENETUNREACH); 386df8bae1dSRodney W. Grimes makeroute: 387df8bae1dSRodney W. Grimes R_Malloc(rt, struct rtentry *, sizeof(*rt)); 388df8bae1dSRodney W. Grimes if (rt == 0) 389df8bae1dSRodney W. Grimes senderr(ENOBUFS); 390df8bae1dSRodney W. Grimes Bzero(rt, sizeof(*rt)); 391df8bae1dSRodney W. Grimes rt->rt_flags = RTF_UP | flags; 392df8bae1dSRodney W. Grimes if (rt_setgate(rt, dst, gateway)) { 393df8bae1dSRodney W. Grimes Free(rt); 394df8bae1dSRodney W. Grimes senderr(ENOBUFS); 395df8bae1dSRodney W. Grimes } 396df8bae1dSRodney W. Grimes ndst = rt_key(rt); 397df8bae1dSRodney W. Grimes if (netmask) { 398df8bae1dSRodney W. Grimes rt_maskedcopy(dst, ndst, netmask); 399df8bae1dSRodney W. Grimes } else 400df8bae1dSRodney W. Grimes Bcopy(dst, ndst, dst->sa_len); 401df8bae1dSRodney W. Grimes rn = rnh->rnh_addaddr((caddr_t)ndst, (caddr_t)netmask, 402df8bae1dSRodney W. Grimes rnh, rt->rt_nodes); 403df8bae1dSRodney W. Grimes if (rn == 0) { 404df8bae1dSRodney W. Grimes if (rt->rt_gwroute) 405df8bae1dSRodney W. Grimes rtfree(rt->rt_gwroute); 406df8bae1dSRodney W. Grimes Free(rt_key(rt)); 407df8bae1dSRodney W. Grimes Free(rt); 408df8bae1dSRodney W. Grimes senderr(EEXIST); 409df8bae1dSRodney W. Grimes } 410df8bae1dSRodney W. Grimes ifa->ifa_refcnt++; 411df8bae1dSRodney W. Grimes rt->rt_ifa = ifa; 412df8bae1dSRodney W. Grimes rt->rt_ifp = ifa->ifa_ifp; 413df8bae1dSRodney W. Grimes if (req == RTM_RESOLVE) 414df8bae1dSRodney W. Grimes rt->rt_rmx = (*ret_nrt)->rt_rmx; /* copy metrics */ 415df8bae1dSRodney W. Grimes if (ifa->ifa_rtrequest) 416df8bae1dSRodney W. Grimes ifa->ifa_rtrequest(req, rt, SA(ret_nrt ? *ret_nrt : 0)); 417df8bae1dSRodney W. Grimes if (ret_nrt) { 418df8bae1dSRodney W. Grimes *ret_nrt = rt; 419df8bae1dSRodney W. Grimes rt->rt_refcnt++; 420df8bae1dSRodney W. Grimes } 421df8bae1dSRodney W. Grimes break; 422df8bae1dSRodney W. Grimes } 423df8bae1dSRodney W. Grimes bad: 424df8bae1dSRodney W. Grimes splx(s); 425df8bae1dSRodney W. Grimes return (error); 426df8bae1dSRodney W. Grimes } 427df8bae1dSRodney W. Grimes 428df8bae1dSRodney W. Grimes int 429df8bae1dSRodney W. Grimes rt_setgate(rt0, dst, gate) 430df8bae1dSRodney W. Grimes struct rtentry *rt0; 431df8bae1dSRodney W. Grimes struct sockaddr *dst, *gate; 432df8bae1dSRodney W. Grimes { 433df8bae1dSRodney W. Grimes caddr_t new, old; 434df8bae1dSRodney W. Grimes int dlen = ROUNDUP(dst->sa_len), glen = ROUNDUP(gate->sa_len); 435df8bae1dSRodney W. Grimes register struct rtentry *rt = rt0; 436df8bae1dSRodney W. Grimes 437df8bae1dSRodney W. Grimes if (rt->rt_gateway == 0 || glen > ROUNDUP(rt->rt_gateway->sa_len)) { 438df8bae1dSRodney W. Grimes old = (caddr_t)rt_key(rt); 439df8bae1dSRodney W. Grimes R_Malloc(new, caddr_t, dlen + glen); 440df8bae1dSRodney W. Grimes if (new == 0) 441df8bae1dSRodney W. Grimes return 1; 442df8bae1dSRodney W. Grimes rt->rt_nodes->rn_key = new; 443df8bae1dSRodney W. Grimes } else { 444df8bae1dSRodney W. Grimes new = rt->rt_nodes->rn_key; 445df8bae1dSRodney W. Grimes old = 0; 446df8bae1dSRodney W. Grimes } 447df8bae1dSRodney W. Grimes Bcopy(gate, (rt->rt_gateway = (struct sockaddr *)(new + dlen)), glen); 448df8bae1dSRodney W. Grimes if (old) { 449df8bae1dSRodney W. Grimes Bcopy(dst, new, dlen); 450df8bae1dSRodney W. Grimes Free(old); 451df8bae1dSRodney W. Grimes } 452df8bae1dSRodney W. Grimes if (rt->rt_gwroute) { 453df8bae1dSRodney W. Grimes rt = rt->rt_gwroute; RTFREE(rt); 454df8bae1dSRodney W. Grimes rt = rt0; rt->rt_gwroute = 0; 455df8bae1dSRodney W. Grimes } 456df8bae1dSRodney W. Grimes if (rt->rt_flags & RTF_GATEWAY) { 457df8bae1dSRodney W. Grimes rt->rt_gwroute = rtalloc1(gate, 1); 458df8bae1dSRodney W. Grimes } 459df8bae1dSRodney W. Grimes return 0; 460df8bae1dSRodney W. Grimes } 461df8bae1dSRodney W. Grimes 462df8bae1dSRodney W. Grimes void 463df8bae1dSRodney W. Grimes rt_maskedcopy(src, dst, netmask) 464df8bae1dSRodney W. Grimes struct sockaddr *src, *dst, *netmask; 465df8bae1dSRodney W. Grimes { 466df8bae1dSRodney W. Grimes register u_char *cp1 = (u_char *)src; 467df8bae1dSRodney W. Grimes register u_char *cp2 = (u_char *)dst; 468df8bae1dSRodney W. Grimes register u_char *cp3 = (u_char *)netmask; 469df8bae1dSRodney W. Grimes u_char *cplim = cp2 + *cp3; 470df8bae1dSRodney W. Grimes u_char *cplim2 = cp2 + *cp1; 471df8bae1dSRodney W. Grimes 472df8bae1dSRodney W. Grimes *cp2++ = *cp1++; *cp2++ = *cp1++; /* copies sa_len & sa_family */ 473df8bae1dSRodney W. Grimes cp3 += 2; 474df8bae1dSRodney W. Grimes if (cplim > cplim2) 475df8bae1dSRodney W. Grimes cplim = cplim2; 476df8bae1dSRodney W. Grimes while (cp2 < cplim) 477df8bae1dSRodney W. Grimes *cp2++ = *cp1++ & *cp3++; 478df8bae1dSRodney W. Grimes if (cp2 < cplim2) 479df8bae1dSRodney W. Grimes bzero((caddr_t)cp2, (unsigned)(cplim2 - cp2)); 480df8bae1dSRodney W. Grimes } 481df8bae1dSRodney W. Grimes 482df8bae1dSRodney W. Grimes /* 483df8bae1dSRodney W. Grimes * Set up a routing table entry, normally 484df8bae1dSRodney W. Grimes * for an interface. 485df8bae1dSRodney W. Grimes */ 486df8bae1dSRodney W. Grimes int 487df8bae1dSRodney W. Grimes rtinit(ifa, cmd, flags) 488df8bae1dSRodney W. Grimes register struct ifaddr *ifa; 489df8bae1dSRodney W. Grimes int cmd, flags; 490df8bae1dSRodney W. Grimes { 491df8bae1dSRodney W. Grimes register struct rtentry *rt; 492df8bae1dSRodney W. Grimes register struct sockaddr *dst; 493df8bae1dSRodney W. Grimes register struct sockaddr *deldst; 494df8bae1dSRodney W. Grimes struct mbuf *m = 0; 495df8bae1dSRodney W. Grimes struct rtentry *nrt = 0; 496df8bae1dSRodney W. Grimes int error; 497df8bae1dSRodney W. Grimes 498df8bae1dSRodney W. Grimes dst = flags & RTF_HOST ? ifa->ifa_dstaddr : ifa->ifa_addr; 499df8bae1dSRodney W. Grimes if (cmd == RTM_DELETE) { 500df8bae1dSRodney W. Grimes if ((flags & RTF_HOST) == 0 && ifa->ifa_netmask) { 501df8bae1dSRodney W. Grimes m = m_get(M_WAIT, MT_SONAME); 502df8bae1dSRodney W. Grimes deldst = mtod(m, struct sockaddr *); 503df8bae1dSRodney W. Grimes rt_maskedcopy(dst, deldst, ifa->ifa_netmask); 504df8bae1dSRodney W. Grimes dst = deldst; 505df8bae1dSRodney W. Grimes } 506df8bae1dSRodney W. Grimes if (rt = rtalloc1(dst, 0)) { 507df8bae1dSRodney W. Grimes rt->rt_refcnt--; 508df8bae1dSRodney W. Grimes if (rt->rt_ifa != ifa) { 509df8bae1dSRodney W. Grimes if (m) 510df8bae1dSRodney W. Grimes (void) m_free(m); 511df8bae1dSRodney W. Grimes return (flags & RTF_HOST ? EHOSTUNREACH 512df8bae1dSRodney W. Grimes : ENETUNREACH); 513df8bae1dSRodney W. Grimes } 514df8bae1dSRodney W. Grimes } 515df8bae1dSRodney W. Grimes } 516df8bae1dSRodney W. Grimes error = rtrequest(cmd, dst, ifa->ifa_addr, ifa->ifa_netmask, 517df8bae1dSRodney W. Grimes flags | ifa->ifa_flags, &nrt); 518df8bae1dSRodney W. Grimes if (m) 519df8bae1dSRodney W. Grimes (void) m_free(m); 520df8bae1dSRodney W. Grimes if (cmd == RTM_DELETE && error == 0 && (rt = nrt)) { 521df8bae1dSRodney W. Grimes rt_newaddrmsg(cmd, ifa, error, nrt); 522df8bae1dSRodney W. Grimes if (rt->rt_refcnt <= 0) { 523df8bae1dSRodney W. Grimes rt->rt_refcnt++; 524df8bae1dSRodney W. Grimes rtfree(rt); 525df8bae1dSRodney W. Grimes } 526df8bae1dSRodney W. Grimes } 527df8bae1dSRodney W. Grimes if (cmd == RTM_ADD && error == 0 && (rt = nrt)) { 528df8bae1dSRodney W. Grimes rt->rt_refcnt--; 529df8bae1dSRodney W. Grimes if (rt->rt_ifa != ifa) { 530df8bae1dSRodney W. Grimes printf("rtinit: wrong ifa (%x) was (%x)\n", ifa, 531df8bae1dSRodney W. Grimes rt->rt_ifa); 532df8bae1dSRodney W. Grimes if (rt->rt_ifa->ifa_rtrequest) 533df8bae1dSRodney W. Grimes rt->rt_ifa->ifa_rtrequest(RTM_DELETE, rt, SA(0)); 534df8bae1dSRodney W. Grimes IFAFREE(rt->rt_ifa); 535df8bae1dSRodney W. Grimes rt->rt_ifa = ifa; 536df8bae1dSRodney W. Grimes rt->rt_ifp = ifa->ifa_ifp; 537df8bae1dSRodney W. Grimes ifa->ifa_refcnt++; 538df8bae1dSRodney W. Grimes if (ifa->ifa_rtrequest) 539df8bae1dSRodney W. Grimes ifa->ifa_rtrequest(RTM_ADD, rt, SA(0)); 540df8bae1dSRodney W. Grimes } 541df8bae1dSRodney W. Grimes rt_newaddrmsg(cmd, ifa, error, nrt); 542df8bae1dSRodney W. Grimes } 543df8bae1dSRodney W. Grimes return (error); 544df8bae1dSRodney W. Grimes } 545