136352Ssklower /*
263211Sbostic * Copyright (c) 1988, 1991, 1993
363211Sbostic * The Regents of the University of California. All rights reserved.
436352Ssklower *
544466Sbostic * %sccs.include.redist.c%
636352Ssklower *
7*68437Ssklower * @(#)rtsock.c 8.6.1.1 (Berkeley) 02/23/95
836352Ssklower */
936352Ssklower
1056529Sbostic #include <sys/param.h>
1156529Sbostic #include <sys/systm.h>
1256529Sbostic #include <sys/proc.h>
1356529Sbostic #include <sys/mbuf.h>
1456529Sbostic #include <sys/socket.h>
1556529Sbostic #include <sys/socketvar.h>
1656529Sbostic #include <sys/domain.h>
1756529Sbostic #include <sys/protosw.h>
1836352Ssklower
1956529Sbostic #include <net/if.h>
2056529Sbostic #include <net/route.h>
2156529Sbostic #include <net/raw_cb.h>
2236352Ssklower
2352564Ssklower struct sockaddr route_dst = { 2, PF_ROUTE, };
2452564Ssklower struct sockaddr route_src = { 2, PF_ROUTE, };
2552564Ssklower struct sockproto route_proto = { PF_ROUTE, };
2637472Ssklower
2752564Ssklower struct walkarg {
2852564Ssklower int w_op, w_arg, w_given, w_needed, w_tmemsize;
2952564Ssklower caddr_t w_where, w_tmem;
3052564Ssklower };
3152564Ssklower
3261339Sbostic static struct mbuf *
3361339Sbostic rt_msg1 __P((int, struct rt_addrinfo *));
3461339Sbostic static int rt_msg2 __P((int,
3561339Sbostic struct rt_addrinfo *, caddr_t, struct walkarg *));
36*68437Ssklower void rt_xaddrs __P((caddr_t, caddr_t, struct rt_addrinfo *));
37*68437Ssklower void m_copyback __P((struct mbuf *, int, int, caddr_t));
3852564Ssklower
3952564Ssklower /* Sleazy use of local variables throughout file, warning!!!! */
4052564Ssklower #define dst info.rti_info[RTAX_DST]
4152564Ssklower #define gate info.rti_info[RTAX_GATEWAY]
4252564Ssklower #define netmask info.rti_info[RTAX_NETMASK]
4352564Ssklower #define genmask info.rti_info[RTAX_GENMASK]
4452564Ssklower #define ifpaddr info.rti_info[RTAX_IFP]
4552564Ssklower #define ifaaddr info.rti_info[RTAX_IFA]
4652564Ssklower #define brdaddr info.rti_info[RTAX_BRD]
4752564Ssklower
4836352Ssklower /*ARGSUSED*/
4961339Sbostic int
route_usrreq(so,req,m,nam,control)5040446Ssklower route_usrreq(so, req, m, nam, control)
5136352Ssklower register struct socket *so;
5236352Ssklower int req;
5340446Ssklower struct mbuf *m, *nam, *control;
5436352Ssklower {
5536352Ssklower register int error = 0;
5636352Ssklower register struct rawcb *rp = sotorawcb(so);
5744949Ssklower int s;
5868288Ssklower
5937472Ssklower if (req == PRU_ATTACH) {
6037472Ssklower MALLOC(rp, struct rawcb *, sizeof(*rp), M_PCB, M_WAITOK);
6137472Ssklower if (so->so_pcb = (caddr_t)rp)
6237472Ssklower bzero(so->so_pcb, sizeof(*rp));
6337472Ssklower
6437472Ssklower }
6536352Ssklower if (req == PRU_DETACH && rp) {
6636352Ssklower int af = rp->rcb_proto.sp_protocol;
6736352Ssklower if (af == AF_INET)
6836352Ssklower route_cb.ip_count--;
6936352Ssklower else if (af == AF_NS)
7036352Ssklower route_cb.ns_count--;
7136352Ssklower else if (af == AF_ISO)
7236352Ssklower route_cb.iso_count--;
7336352Ssklower route_cb.any_count--;
7436352Ssklower }
7544949Ssklower s = splnet();
7640446Ssklower error = raw_usrreq(so, req, m, nam, control);
7736352Ssklower rp = sotorawcb(so);
7837472Ssklower if (req == PRU_ATTACH && rp) {
7936352Ssklower int af = rp->rcb_proto.sp_protocol;
8037472Ssklower if (error) {
8137472Ssklower free((caddr_t)rp, M_PCB);
8244949Ssklower splx(s);
8337472Ssklower return (error);
8437472Ssklower }
8536352Ssklower if (af == AF_INET)
8636352Ssklower route_cb.ip_count++;
8736352Ssklower else if (af == AF_NS)
8836352Ssklower route_cb.ns_count++;
8936352Ssklower else if (af == AF_ISO)
9036352Ssklower route_cb.iso_count++;
9137472Ssklower rp->rcb_faddr = &route_src;
9236352Ssklower route_cb.any_count++;
9336352Ssklower soisconnected(so);
9442356Ssklower so->so_options |= SO_USELOOPBACK;
9536352Ssklower }
9644949Ssklower splx(s);
9736352Ssklower return (error);
9836352Ssklower }
9936352Ssklower
10037472Ssklower /*ARGSUSED*/
10161339Sbostic int
route_output(m,so)10236352Ssklower route_output(m, so)
10336352Ssklower register struct mbuf *m;
10436352Ssklower struct socket *so;
10536352Ssklower {
10644949Ssklower register struct rt_msghdr *rtm = 0;
10736352Ssklower register struct rtentry *rt = 0;
10840446Ssklower struct rtentry *saved_nrt = 0;
10968288Ssklower struct radix_node_head *rnh;
11052564Ssklower struct rt_addrinfo info;
11137472Ssklower int len, error = 0;
11243336Ssklower struct ifnet *ifp = 0;
11347465Ssklower struct ifaddr *ifa = 0;
11436352Ssklower
11540446Ssklower #define senderr(e) { error = e; goto flush;}
11658497Ssklower if (m == 0 || ((m->m_len < sizeof(long)) &&
11758497Ssklower (m = m_pullup(m, sizeof(long))) == 0))
11838847Ssklower return (ENOBUFS);
11936352Ssklower if ((m->m_flags & M_PKTHDR) == 0)
12038847Ssklower panic("route_output");
12136352Ssklower len = m->m_pkthdr.len;
12244949Ssklower if (len < sizeof(*rtm) ||
12352808Sralph len != mtod(m, struct rt_msghdr *)->rtm_msglen) {
12452808Sralph dst = 0;
12540446Ssklower senderr(EINVAL);
12652808Sralph }
12736352Ssklower R_Malloc(rtm, struct rt_msghdr *, len);
12852808Sralph if (rtm == 0) {
12952808Sralph dst = 0;
13040446Ssklower senderr(ENOBUFS);
13152808Sralph }
13236352Ssklower m_copydata(m, 0, len, (caddr_t)rtm);
13352808Sralph if (rtm->rtm_version != RTM_VERSION) {
13452808Sralph dst = 0;
13540446Ssklower senderr(EPROTONOSUPPORT);
13652808Sralph }
13748729Ssklower rtm->rtm_pid = curproc->p_pid;
13852564Ssklower info.rti_addrs = rtm->rtm_addrs;
13968288Ssklower rt_xaddrs((caddr_t)(rtm + 1), len + (caddr_t)rtm, &info);
140*68437Ssklower info.rti_flags = rtm->rtm_flags;
14152564Ssklower if (dst == 0)
14240786Ssklower senderr(EINVAL);
14352564Ssklower if (genmask) {
14461339Sbostic struct radix_node *t;
14568288Ssklower t = rn_addmask((caddr_t)genmask, 0, 1);
14643336Ssklower if (t && Bcmp(genmask, t->rn_key, *(u_char *)genmask) == 0)
14743336Ssklower genmask = (struct sockaddr *)(t->rn_key);
14843336Ssklower else
14943336Ssklower senderr(ENOBUFS);
15036352Ssklower }
15136352Ssklower switch (rtm->rtm_type) {
15252564Ssklower
153*68437Ssklower case RTM_ADDPKT:
15436352Ssklower case RTM_ADD:
15540786Ssklower if (gate == 0)
15640786Ssklower senderr(EINVAL);
157*68437Ssklower error = rtrequest1(rtm->rtm_type, &info, &saved_nrt);
15840786Ssklower if (error == 0 && saved_nrt) {
15940786Ssklower rt_setmetrics(rtm->rtm_inits,
16040786Ssklower &rtm->rtm_rmx, &saved_nrt->rt_rmx);
16140446Ssklower saved_nrt->rt_refcnt--;
16243336Ssklower saved_nrt->rt_genmask = genmask;
16340786Ssklower }
16436352Ssklower break;
16536352Ssklower
166*68437Ssklower case RTM_DELPKT:
16736352Ssklower case RTM_DELETE:
168*68437Ssklower error = rtrequest1(rtm->rtm_type, &info, &saved_nrt);
16968288Ssklower if (error == 0) {
17068288Ssklower (rt = saved_nrt)->rt_refcnt++;
17168288Ssklower goto report;
17268288Ssklower }
17336352Ssklower break;
17436352Ssklower
17568288Ssklower case RTM_GET:
17668026Ssklower case RTM_CHANGE:
17736352Ssklower case RTM_LOCK:
17868288Ssklower if ((rnh = rt_tables[dst->sa_family]) == 0) {
17968288Ssklower senderr(EAFNOSUPPORT);
18068288Ssklower } else if (rt = (struct rtentry *)
18168288Ssklower rnh->rnh_lookup(dst, netmask, rnh))
18268288Ssklower rt->rt_refcnt++;
18368288Ssklower else
18440446Ssklower senderr(ESRCH);
18536352Ssklower switch(rtm->rtm_type) {
18636352Ssklower
18736352Ssklower case RTM_GET:
18868288Ssklower report:
18952564Ssklower dst = rt_key(rt);
19052564Ssklower gate = rt->rt_gateway;
19152564Ssklower netmask = rt_mask(rt);
19252564Ssklower genmask = rt->rt_genmask;
19345656Ssklower if (rtm->rtm_addrs & (RTA_IFP | RTA_IFA)) {
19452564Ssklower if (ifp = rt->rt_ifp) {
19552564Ssklower ifpaddr = ifp->if_addrlist->ifa_addr;
19645656Ssklower ifaaddr = rt->rt_ifa->ifa_addr;
19768288Ssklower if (ifp->if_flags & IFF_POINTOPOINT)
19868288Ssklower brdaddr = rt->rt_ifa->ifa_dstaddr;
19968288Ssklower else
20068288Ssklower brdaddr = 0;
20152564Ssklower rtm->rtm_index = ifp->if_index;
20245656Ssklower } else {
20352564Ssklower ifpaddr = 0;
20452564Ssklower ifaaddr = 0;
20552564Ssklower }
20645656Ssklower }
20768288Ssklower len = rt_msg2(rtm->rtm_type, &info, (caddr_t)0,
20852564Ssklower (struct walkarg *)0);
20936352Ssklower if (len > rtm->rtm_msglen) {
21036352Ssklower struct rt_msghdr *new_rtm;
21136352Ssklower R_Malloc(new_rtm, struct rt_msghdr *, len);
21236352Ssklower if (new_rtm == 0)
21340446Ssklower senderr(ENOBUFS);
21436352Ssklower Bcopy(rtm, new_rtm, rtm->rtm_msglen);
21536352Ssklower Free(rtm); rtm = new_rtm;
21636352Ssklower }
21768288Ssklower (void)rt_msg2(rtm->rtm_type, &info, (caddr_t)rtm,
21852564Ssklower (struct walkarg *)0);
21945183Ssklower rtm->rtm_flags = rt->rt_flags;
22045183Ssklower rtm->rtm_rmx = rt->rt_rmx;
22158495Ssklower rtm->rtm_addrs = info.rti_addrs;
22236352Ssklower break;
22336352Ssklower
22436352Ssklower case RTM_CHANGE:
22543336Ssklower /* new gateway could require new ifaddr, ifp;
22643336Ssklower flags may also be different; ifp may be specified
22743336Ssklower by ll sockaddr when protocol address is ambiguous */
228*68437Ssklower if (error = rt_getifa(&info))
229*68437Ssklower senderr(error);
230*68437Ssklower if (gate && rt_setgate(rt, rt_key(rt), gate))
231*68437Ssklower senderr(EDQUOT);
232*68437Ssklower if (ifa = info.rti_ifa) {
23347465Ssklower register struct ifaddr *oifa = rt->rt_ifa;
23447465Ssklower if (oifa != ifa) {
23547465Ssklower if (oifa && oifa->ifa_rtrequest)
23647465Ssklower oifa->ifa_rtrequest(RTM_DELETE,
237*68437Ssklower rt, &info);
23859064Ssklower IFAFREE(rt->rt_ifa);
23943336Ssklower rt->rt_ifa = ifa;
24059064Ssklower ifa->ifa_refcnt++;
241*68437Ssklower rt->rt_ifp = info.rti_ifp;
24243336Ssklower }
24343336Ssklower }
24447465Ssklower rt_setmetrics(rtm->rtm_inits, &rtm->rtm_rmx,
24547465Ssklower &rt->rt_rmx);
24643336Ssklower if (rt->rt_ifa && rt->rt_ifa->ifa_rtrequest)
247*68437Ssklower rt->rt_ifa->ifa_rtrequest(RTM_ADD, rt, &info);
24843336Ssklower if (genmask)
24943336Ssklower rt->rt_genmask = genmask;
25036352Ssklower /*
25136352Ssklower * Fall into
25236352Ssklower */
25340786Ssklower case RTM_LOCK:
25450811Ssklower rt->rt_rmx.rmx_locks &= ~(rtm->rtm_inits);
25540786Ssklower rt->rt_rmx.rmx_locks |=
25640786Ssklower (rtm->rtm_inits & rtm->rtm_rmx.rmx_locks);
25736352Ssklower break;
25836352Ssklower }
25952564Ssklower break;
26036352Ssklower
26136352Ssklower default:
26240446Ssklower senderr(EOPNOTSUPP);
26336352Ssklower }
26436352Ssklower
26536352Ssklower flush:
26636352Ssklower if (rtm) {
26736352Ssklower if (error)
26836352Ssklower rtm->rtm_errno = error;
26936352Ssklower else
27036352Ssklower rtm->rtm_flags |= RTF_DONE;
27136352Ssklower }
27236352Ssklower if (rt)
27336352Ssklower rtfree(rt);
27442356Ssklower {
27542356Ssklower register struct rawcb *rp = 0;
27642356Ssklower /*
27742356Ssklower * Check to see if we don't want our own messages.
27842356Ssklower */
27942356Ssklower if ((so->so_options & SO_USELOOPBACK) == 0) {
28042356Ssklower if (route_cb.any_count <= 1) {
28142356Ssklower if (rtm)
28242356Ssklower Free(rtm);
28342356Ssklower m_freem(m);
28442356Ssklower return (error);
28542356Ssklower }
28642356Ssklower /* There is another listener, so construct message */
28742356Ssklower rp = sotorawcb(so);
28842356Ssklower }
28945656Ssklower if (rtm) {
29045656Ssklower m_copyback(m, 0, rtm->rtm_msglen, (caddr_t)rtm);
29138847Ssklower Free(rtm);
29238847Ssklower }
29342356Ssklower if (rp)
29442356Ssklower rp->rcb_proto.sp_family = 0; /* Avoid us */
29545183Ssklower if (dst)
29645183Ssklower route_proto.sp_protocol = dst->sa_family;
29738847Ssklower raw_input(m, &route_proto, &route_src, &route_dst);
29842356Ssklower if (rp)
29942356Ssklower rp->rcb_proto.sp_family = PF_ROUTE;
30042356Ssklower }
30136352Ssklower return (error);
30236352Ssklower }
30336352Ssklower
30461339Sbostic void
rt_setmetrics(which,in,out)30543336Ssklower rt_setmetrics(which, in, out)
30640786Ssklower u_long which;
30740786Ssklower register struct rt_metrics *in, *out;
30840786Ssklower {
30940786Ssklower #define metric(f, e) if (which & (f)) out->e = in->e;
31040786Ssklower metric(RTV_RPIPE, rmx_recvpipe);
31140786Ssklower metric(RTV_SPIPE, rmx_sendpipe);
31240786Ssklower metric(RTV_SSTHRESH, rmx_ssthresh);
31340786Ssklower metric(RTV_RTT, rmx_rtt);
31440786Ssklower metric(RTV_RTTVAR, rmx_rttvar);
31540786Ssklower metric(RTV_HOPCOUNT, rmx_hopcount);
31640786Ssklower metric(RTV_MTU, rmx_mtu);
31750228Ssklower metric(RTV_EXPIRE, rmx_expire);
31840786Ssklower #undef metric
31940786Ssklower }
32040786Ssklower
32152564Ssklower #define ROUNDUP(a) \
32252564Ssklower ((a) > 0 ? (1 + (((a) - 1) | (sizeof(long) - 1))) : sizeof(long))
32352564Ssklower #define ADVANCE(x, n) (x += ROUNDUP((n)->sa_len))
32452564Ssklower
325*68437Ssklower void
rt_xaddrs(cp,cplim,rtinfo)32652564Ssklower rt_xaddrs(cp, cplim, rtinfo)
32752564Ssklower register caddr_t cp, cplim;
32852564Ssklower register struct rt_addrinfo *rtinfo;
32952564Ssklower {
33052564Ssklower register struct sockaddr *sa;
331*68437Ssklower register int i, addrs = rtinfo->rti_addrs;
33252564Ssklower
333*68437Ssklower bzero(rtinfo, sizeof(*rtinfo));
334*68437Ssklower rtinfo->rti_addrs = addrs;
33552564Ssklower for (i = 0; (i < RTAX_MAX) && (cp < cplim); i++) {
336*68437Ssklower if ((addrs & (1 << i)) == 0)
33752564Ssklower continue;
33852564Ssklower rtinfo->rti_info[i] = sa = (struct sockaddr *)cp;
33952564Ssklower ADVANCE(cp, sa);
34052564Ssklower }
341*68437Ssklower rtinfo->rti_pkthdr = cp;
34252564Ssklower }
34352808Sralph
34436352Ssklower /*
34536352Ssklower * Copy data from a buffer back into the indicated mbuf chain,
34636352Ssklower * starting "off" bytes from the beginning, extending the mbuf
34736352Ssklower * chain if necessary.
34836352Ssklower */
34961339Sbostic void
m_copyback(m0,off,len,cp)35036352Ssklower m_copyback(m0, off, len, cp)
35136352Ssklower struct mbuf *m0;
35236352Ssklower register int off;
35336352Ssklower register int len;
35436352Ssklower caddr_t cp;
35536352Ssklower {
35636352Ssklower register int mlen;
35736352Ssklower register struct mbuf *m = m0, *n;
35836352Ssklower int totlen = 0;
35936352Ssklower
36036352Ssklower if (m0 == 0)
36136352Ssklower return;
36248729Ssklower while (off > (mlen = m->m_len)) {
36336352Ssklower off -= mlen;
36436352Ssklower totlen += mlen;
36536352Ssklower if (m->m_next == 0) {
36636352Ssklower n = m_getclr(M_DONTWAIT, m->m_type);
36736352Ssklower if (n == 0)
36836352Ssklower goto out;
36936352Ssklower n->m_len = min(MLEN, len + off);
37036352Ssklower m->m_next = n;
37136352Ssklower }
37236352Ssklower m = m->m_next;
37336352Ssklower }
37436352Ssklower while (len > 0) {
37536352Ssklower mlen = min (m->m_len - off, len);
37637472Ssklower bcopy(cp, off + mtod(m, caddr_t), (unsigned)mlen);
37736352Ssklower cp += mlen;
37836352Ssklower len -= mlen;
37936352Ssklower mlen += off;
38036352Ssklower off = 0;
38136352Ssklower totlen += mlen;
38236352Ssklower if (len == 0)
38336352Ssklower break;
38436352Ssklower if (m->m_next == 0) {
38536352Ssklower n = m_get(M_DONTWAIT, m->m_type);
38636352Ssklower if (n == 0)
38736352Ssklower break;
38836352Ssklower n->m_len = min(MLEN, len);
38936352Ssklower m->m_next = n;
39036352Ssklower }
39136352Ssklower m = m->m_next;
39236352Ssklower }
39336352Ssklower out: if (((m = m0)->m_flags & M_PKTHDR) && (m->m_pkthdr.len < totlen))
39436352Ssklower m->m_pkthdr.len = totlen;
39536352Ssklower }
39636352Ssklower
39752564Ssklower static struct mbuf *
rt_msg1(type,rtinfo)39852564Ssklower rt_msg1(type, rtinfo)
39952564Ssklower int type;
40052564Ssklower register struct rt_addrinfo *rtinfo;
40136352Ssklower {
40236352Ssklower register struct rt_msghdr *rtm;
40336352Ssklower register struct mbuf *m;
40452564Ssklower register int i;
40552564Ssklower register struct sockaddr *sa;
40652564Ssklower int len, dlen;
40736352Ssklower
40836352Ssklower m = m_gethdr(M_DONTWAIT, MT_DATA);
40936352Ssklower if (m == 0)
41052564Ssklower return (m);
41152564Ssklower switch (type) {
41252564Ssklower
41352564Ssklower case RTM_DELADDR:
41452564Ssklower case RTM_NEWADDR:
41552564Ssklower len = sizeof(struct ifa_msghdr);
41652564Ssklower break;
41752564Ssklower
41852564Ssklower case RTM_IFINFO:
41952564Ssklower len = sizeof(struct if_msghdr);
42052564Ssklower break;
42152564Ssklower
42252564Ssklower default:
42352564Ssklower len = sizeof(struct rt_msghdr);
42452564Ssklower }
42552564Ssklower if (len > MHLEN)
42652564Ssklower panic("rt_msg1");
42752564Ssklower m->m_pkthdr.len = m->m_len = len;
42836352Ssklower m->m_pkthdr.rcvif = 0;
42936352Ssklower rtm = mtod(m, struct rt_msghdr *);
43052564Ssklower bzero((caddr_t)rtm, len);
43152564Ssklower for (i = 0; i < RTAX_MAX; i++) {
43252564Ssklower if ((sa = rtinfo->rti_info[i]) == NULL)
43352564Ssklower continue;
43452564Ssklower rtinfo->rti_addrs |= (1 << i);
43552564Ssklower dlen = ROUNDUP(sa->sa_len);
43652564Ssklower m_copyback(m, len, dlen, (caddr_t)sa);
43752564Ssklower len += dlen;
43852564Ssklower }
43952564Ssklower if (m->m_pkthdr.len != len) {
44052564Ssklower m_freem(m);
44152564Ssklower return (NULL);
44252564Ssklower }
44336352Ssklower rtm->rtm_msglen = len;
44440786Ssklower rtm->rtm_version = RTM_VERSION;
44536352Ssklower rtm->rtm_type = type;
44652564Ssklower return (m);
44752564Ssklower }
44852564Ssklower
44952564Ssklower static int
rt_msg2(type,rtinfo,cp,w)45052564Ssklower rt_msg2(type, rtinfo, cp, w)
45152564Ssklower int type;
45252564Ssklower register struct rt_addrinfo *rtinfo;
45352564Ssklower caddr_t cp;
45452564Ssklower struct walkarg *w;
45552564Ssklower {
45652564Ssklower register int i;
45752564Ssklower int len, dlen, second_time = 0;
45852564Ssklower caddr_t cp0;
45952564Ssklower
46052564Ssklower rtinfo->rti_addrs = 0;
46152564Ssklower again:
46252564Ssklower switch (type) {
46352564Ssklower
46452564Ssklower case RTM_DELADDR:
46552564Ssklower case RTM_NEWADDR:
46652564Ssklower len = sizeof(struct ifa_msghdr);
46752564Ssklower break;
46852564Ssklower
46952564Ssklower case RTM_IFINFO:
47052564Ssklower len = sizeof(struct if_msghdr);
47152564Ssklower break;
47252564Ssklower
47352564Ssklower default:
47452564Ssklower len = sizeof(struct rt_msghdr);
47536352Ssklower }
47652564Ssklower if (cp0 = cp)
47752564Ssklower cp += len;
47852564Ssklower for (i = 0; i < RTAX_MAX; i++) {
47952564Ssklower register struct sockaddr *sa;
48052564Ssklower
48152564Ssklower if ((sa = rtinfo->rti_info[i]) == 0)
48252564Ssklower continue;
48352564Ssklower rtinfo->rti_addrs |= (1 << i);
48452564Ssklower dlen = ROUNDUP(sa->sa_len);
48552564Ssklower if (cp) {
48652564Ssklower bcopy((caddr_t)sa, cp, (unsigned)dlen);
48752564Ssklower cp += dlen;
48852564Ssklower }
48936352Ssklower len += dlen;
49036352Ssklower }
49152564Ssklower if (cp == 0 && w != NULL && !second_time) {
49252564Ssklower register struct walkarg *rw = w;
49352564Ssklower
49452564Ssklower rw->w_needed += len;
49552564Ssklower if (rw->w_needed <= 0 && rw->w_where) {
49652564Ssklower if (rw->w_tmemsize < len) {
49752564Ssklower if (rw->w_tmem)
49852564Ssklower free(rw->w_tmem, M_RTABLE);
49952564Ssklower if (rw->w_tmem = (caddr_t)
50052564Ssklower malloc(len, M_RTABLE, M_NOWAIT))
50152564Ssklower rw->w_tmemsize = len;
50252564Ssklower }
50352564Ssklower if (rw->w_tmem) {
50452564Ssklower cp = rw->w_tmem;
50552564Ssklower second_time = 1;
50652564Ssklower goto again;
50752564Ssklower } else
50852564Ssklower rw->w_where = 0;
50952564Ssklower }
51036352Ssklower }
51152564Ssklower if (cp) {
51252564Ssklower register struct rt_msghdr *rtm = (struct rt_msghdr *)cp0;
51352564Ssklower
51452564Ssklower rtm->rtm_version = RTM_VERSION;
51552564Ssklower rtm->rtm_type = type;
51652564Ssklower rtm->rtm_msglen = len;
51736352Ssklower }
51852564Ssklower return (len);
51952564Ssklower }
52052564Ssklower
52152564Ssklower /*
52252564Ssklower * This routine is called to generate a message from the routing
52352564Ssklower * socket indicating that a redirect has occured, a routing lookup
52452564Ssklower * has failed, or that a protocol has detected timeouts to a particular
52552564Ssklower * destination.
52652564Ssklower */
52761339Sbostic void
rt_missmsg(type,rtinfo,flags,error)52852564Ssklower rt_missmsg(type, rtinfo, flags, error)
52952564Ssklower int type, flags, error;
53052564Ssklower register struct rt_addrinfo *rtinfo;
53152564Ssklower {
53252564Ssklower register struct rt_msghdr *rtm;
53352564Ssklower register struct mbuf *m;
53452564Ssklower struct sockaddr *sa = rtinfo->rti_info[RTAX_DST];
53552564Ssklower
53652564Ssklower if (route_cb.any_count == 0)
53736352Ssklower return;
53852564Ssklower m = rt_msg1(type, rtinfo);
53952564Ssklower if (m == 0)
54052564Ssklower return;
54152564Ssklower rtm = mtod(m, struct rt_msghdr *);
54252564Ssklower rtm->rtm_flags = RTF_DONE | flags;
54337472Ssklower rtm->rtm_errno = error;
54452564Ssklower rtm->rtm_addrs = rtinfo->rti_addrs;
54552564Ssklower route_proto.sp_protocol = sa ? sa->sa_family : 0;
54636352Ssklower raw_input(m, &route_proto, &route_src, &route_dst);
54736352Ssklower }
54836352Ssklower
54952564Ssklower /*
55052564Ssklower * This routine is called to generate a message from the routing
55152564Ssklower * socket indicating that the status of a network interface has changed.
55252564Ssklower */
55361339Sbostic void
rt_ifmsg(ifp)55452564Ssklower rt_ifmsg(ifp)
55552564Ssklower register struct ifnet *ifp;
55652564Ssklower {
55752564Ssklower register struct if_msghdr *ifm;
55852564Ssklower struct mbuf *m;
55952564Ssklower struct rt_addrinfo info;
56052564Ssklower
56152564Ssklower if (route_cb.any_count == 0)
56252564Ssklower return;
56352564Ssklower bzero((caddr_t)&info, sizeof(info));
56452564Ssklower m = rt_msg1(RTM_IFINFO, &info);
56552564Ssklower if (m == 0)
56652564Ssklower return;
56752564Ssklower ifm = mtod(m, struct if_msghdr *);
56852564Ssklower ifm->ifm_index = ifp->if_index;
56952564Ssklower ifm->ifm_flags = ifp->if_flags;
57052564Ssklower ifm->ifm_data = ifp->if_data;
57152564Ssklower ifm->ifm_addrs = 0;
57252564Ssklower route_proto.sp_protocol = 0;
57352564Ssklower raw_input(m, &route_proto, &route_src, &route_dst);
57452564Ssklower }
57552564Ssklower
57652564Ssklower /*
57752564Ssklower * This is called to generate messages from the routing socket
57852564Ssklower * indicating a network interface has had addresses associated with it.
57952564Ssklower * if we ever reverse the logic and replace messages TO the routing
58052564Ssklower * socket indicate a request to configure interfaces, then it will
58152564Ssklower * be unnecessary as the routing socket will automatically generate
58252564Ssklower * copies of it.
58352564Ssklower */
58461339Sbostic void
rt_newaddrmsg(cmd,ifa,error,rt)58552564Ssklower rt_newaddrmsg(cmd, ifa, error, rt)
58652564Ssklower int cmd, error;
58752564Ssklower register struct ifaddr *ifa;
58852564Ssklower register struct rtentry *rt;
58952564Ssklower {
59052564Ssklower struct rt_addrinfo info;
59152564Ssklower struct sockaddr *sa;
59252564Ssklower int pass;
59352564Ssklower struct mbuf *m;
59452564Ssklower struct ifnet *ifp = ifa->ifa_ifp;
59552564Ssklower
59652564Ssklower if (route_cb.any_count == 0)
59752564Ssklower return;
59852564Ssklower for (pass = 1; pass < 3; pass++) {
59952564Ssklower bzero((caddr_t)&info, sizeof(info));
60052564Ssklower if ((cmd == RTM_ADD && pass == 1) ||
60152564Ssklower (cmd == RTM_DELETE && pass == 2)) {
60252564Ssklower register struct ifa_msghdr *ifam;
60352564Ssklower int ncmd = cmd == RTM_ADD ? RTM_NEWADDR : RTM_DELADDR;
60452564Ssklower
60552564Ssklower ifaaddr = sa = ifa->ifa_addr;
60652564Ssklower ifpaddr = ifp->if_addrlist->ifa_addr;
60752564Ssklower netmask = ifa->ifa_netmask;
60852564Ssklower brdaddr = ifa->ifa_dstaddr;
60952564Ssklower if ((m = rt_msg1(ncmd, &info)) == NULL)
61052564Ssklower continue;
61152564Ssklower ifam = mtod(m, struct ifa_msghdr *);
61252564Ssklower ifam->ifam_index = ifp->if_index;
61352564Ssklower ifam->ifam_metric = ifa->ifa_metric;
61454077Ssklower ifam->ifam_flags = ifa->ifa_flags;
61552564Ssklower ifam->ifam_addrs = info.rti_addrs;
61652564Ssklower }
61752564Ssklower if ((cmd == RTM_ADD && pass == 2) ||
61852564Ssklower (cmd == RTM_DELETE && pass == 1)) {
61952564Ssklower register struct rt_msghdr *rtm;
62052564Ssklower
62152564Ssklower if (rt == 0)
62252564Ssklower continue;
62352564Ssklower netmask = rt_mask(rt);
62452564Ssklower dst = sa = rt_key(rt);
62552564Ssklower gate = rt->rt_gateway;
62652564Ssklower if ((m = rt_msg1(cmd, &info)) == NULL)
62752564Ssklower continue;
62852564Ssklower rtm = mtod(m, struct rt_msghdr *);
62952564Ssklower rtm->rtm_index = ifp->if_index;
63052564Ssklower rtm->rtm_flags |= rt->rt_flags;
63152564Ssklower rtm->rtm_errno = error;
63252564Ssklower rtm->rtm_addrs = info.rti_addrs;
63352564Ssklower }
63452564Ssklower route_proto.sp_protocol = sa ? sa->sa_family : 0;
63552564Ssklower raw_input(m, &route_proto, &route_src, &route_dst);
63652564Ssklower }
63752564Ssklower }
63852564Ssklower
63936352Ssklower /*
64057836Smckusick * This is used in dumping the kernel table via sysctl().
64140446Ssklower */
64261339Sbostic int
sysctl_dumpentry(rn,w)64357836Smckusick sysctl_dumpentry(rn, w)
64440446Ssklower struct radix_node *rn;
64540446Ssklower register struct walkarg *w;
64640446Ssklower {
64740446Ssklower register struct rtentry *rt = (struct rtentry *)rn;
64868288Ssklower int error = 0, size;
64952564Ssklower struct rt_addrinfo info;
65040446Ssklower
65157836Smckusick if (w->w_op == NET_RT_FLAGS && !(rt->rt_flags & w->w_arg))
65250812Ssklower return 0;
65352564Ssklower bzero((caddr_t)&info, sizeof(info));
65452564Ssklower dst = rt_key(rt);
65552564Ssklower gate = rt->rt_gateway;
65652564Ssklower netmask = rt_mask(rt);
65752564Ssklower genmask = rt->rt_genmask;
65868288Ssklower if (rt->rt_ifp) {
65968288Ssklower ifpaddr = rt->rt_ifp->if_addrlist->ifa_addr;
66068288Ssklower ifaaddr = rt->rt_ifa->ifa_addr;
66168288Ssklower if (rt->rt_ifp->if_flags & IFF_POINTOPOINT)
66268288Ssklower brdaddr = rt->rt_ifa->ifa_dstaddr;
66368288Ssklower }
66452564Ssklower size = rt_msg2(RTM_GET, &info, 0, w);
66552564Ssklower if (w->w_where && w->w_tmem) {
66652564Ssklower register struct rt_msghdr *rtm = (struct rt_msghdr *)w->w_tmem;
66740446Ssklower
66852564Ssklower rtm->rtm_flags = rt->rt_flags;
66952564Ssklower rtm->rtm_use = rt->rt_use;
67052564Ssklower rtm->rtm_rmx = rt->rt_rmx;
67152564Ssklower rtm->rtm_index = rt->rt_ifp->if_index;
67252564Ssklower rtm->rtm_errno = rtm->rtm_pid = rtm->rtm_seq = 0;
67352564Ssklower rtm->rtm_addrs = info.rti_addrs;
67452564Ssklower if (error = copyout((caddr_t)rtm, w->w_where, size))
67552564Ssklower w->w_where = NULL;
67652564Ssklower else
67752564Ssklower w->w_where += size;
67840446Ssklower }
67952564Ssklower return (error);
68052564Ssklower }
68152564Ssklower
68261339Sbostic int
sysctl_iflist(af,w)68357836Smckusick sysctl_iflist(af, w)
68452564Ssklower int af;
68552564Ssklower register struct walkarg *w;
68652564Ssklower {
68752564Ssklower register struct ifnet *ifp;
68852564Ssklower register struct ifaddr *ifa;
68952564Ssklower struct rt_addrinfo info;
69052564Ssklower int len, error = 0;
69152564Ssklower
69252564Ssklower bzero((caddr_t)&info, sizeof(info));
69352564Ssklower for (ifp = ifnet; ifp; ifp = ifp->if_next) {
69452631Ssklower if (w->w_arg && w->w_arg != ifp->if_index)
69552631Ssklower continue;
69652564Ssklower ifa = ifp->if_addrlist;
69752564Ssklower ifpaddr = ifa->ifa_addr;
69852564Ssklower len = rt_msg2(RTM_IFINFO, &info, (caddr_t)0, w);
69952564Ssklower ifpaddr = 0;
70052564Ssklower if (w->w_where && w->w_tmem) {
70152564Ssklower register struct if_msghdr *ifm;
70252564Ssklower
70352564Ssklower ifm = (struct if_msghdr *)w->w_tmem;
70452564Ssklower ifm->ifm_index = ifp->if_index;
70552564Ssklower ifm->ifm_flags = ifp->if_flags;
70652564Ssklower ifm->ifm_data = ifp->if_data;
70752564Ssklower ifm->ifm_addrs = info.rti_addrs;
70852564Ssklower if (error = copyout((caddr_t)ifm, w->w_where, len))
70952564Ssklower return (error);
71052564Ssklower w->w_where += len;
71152564Ssklower }
71252564Ssklower while (ifa = ifa->ifa_next) {
71352631Ssklower if (af && af != ifa->ifa_addr->sa_family)
71452631Ssklower continue;
71552564Ssklower ifaaddr = ifa->ifa_addr;
71652564Ssklower netmask = ifa->ifa_netmask;
71752564Ssklower brdaddr = ifa->ifa_dstaddr;
71852564Ssklower len = rt_msg2(RTM_NEWADDR, &info, 0, w);
71952564Ssklower if (w->w_where && w->w_tmem) {
72052564Ssklower register struct ifa_msghdr *ifam;
72152564Ssklower
72252564Ssklower ifam = (struct ifa_msghdr *)w->w_tmem;
72352564Ssklower ifam->ifam_index = ifa->ifa_ifp->if_index;
72452564Ssklower ifam->ifam_flags = ifa->ifa_flags;
72552564Ssklower ifam->ifam_metric = ifa->ifa_metric;
72652564Ssklower ifam->ifam_addrs = info.rti_addrs;
72752564Ssklower if (error = copyout(w->w_tmem, w->w_where, len))
72852564Ssklower return (error);
72952564Ssklower w->w_where += len;
73052564Ssklower }
73152564Ssklower }
73252631Ssklower ifaaddr = netmask = brdaddr = 0;
73352564Ssklower }
73440446Ssklower return (0);
73540446Ssklower }
73640446Ssklower
73761339Sbostic int
sysctl_rtable(name,namelen,where,given,new,newlen)73857836Smckusick sysctl_rtable(name, namelen, where, given, new, newlen)
73957836Smckusick int *name;
74057836Smckusick int namelen;
74140446Ssklower caddr_t where;
74258496Sbostic size_t *given;
74357836Smckusick caddr_t *new;
74458496Sbostic size_t newlen;
74540446Ssklower {
74640446Ssklower register struct radix_node_head *rnh;
74752564Ssklower int i, s, error = EINVAL;
74857836Smckusick u_char af;
74940446Ssklower struct walkarg w;
75040446Ssklower
75157836Smckusick if (new)
75257836Smckusick return (EPERM);
75357836Smckusick if (namelen != 3)
75457836Smckusick return (EINVAL);
75557836Smckusick af = name[0];
75640446Ssklower Bzero(&w, sizeof(w));
75757836Smckusick w.w_where = where;
75857836Smckusick w.w_given = *given;
75940446Ssklower w.w_needed = 0 - w.w_given;
76057836Smckusick w.w_op = name[1];
76157836Smckusick w.w_arg = name[2];
76240446Ssklower
76340446Ssklower s = splnet();
76457836Smckusick switch (w.w_op) {
76552564Ssklower
76657836Smckusick case NET_RT_DUMP:
76757836Smckusick case NET_RT_FLAGS:
76852564Ssklower for (i = 1; i <= AF_MAX; i++)
76952564Ssklower if ((rnh = rt_tables[i]) && (af == 0 || af == i) &&
77059007Ssklower (error = rnh->rnh_walktree(rnh,
77159007Ssklower sysctl_dumpentry, &w)))
77252564Ssklower break;
77352564Ssklower break;
77452564Ssklower
77557836Smckusick case NET_RT_IFLIST:
77657836Smckusick error = sysctl_iflist(af, &w);
77740446Ssklower }
77852564Ssklower splx(s);
77952564Ssklower if (w.w_tmem)
78052564Ssklower free(w.w_tmem, M_RTABLE);
78140446Ssklower w.w_needed += w.w_given;
78257836Smckusick if (where) {
78340446Ssklower *given = w.w_where - where;
78457836Smckusick if (*given < w.w_needed)
78557836Smckusick return (ENOMEM);
78657836Smckusick } else {
78757836Smckusick *given = (11 * w.w_needed) / 10;
78857836Smckusick }
78940446Ssklower return (error);
79040446Ssklower }
79140446Ssklower
79240446Ssklower /*
79336352Ssklower * Definitions of protocols supported in the ROUTE domain.
79436352Ssklower */
79536352Ssklower
79636352Ssklower extern struct domain routedomain; /* or at least forward */
79736352Ssklower
79836352Ssklower struct protosw routesw[] = {
79936352Ssklower { SOCK_RAW, &routedomain, 0, PR_ATOMIC|PR_ADDR,
80036352Ssklower raw_input, route_output, raw_ctlinput, 0,
80136352Ssklower route_usrreq,
80236352Ssklower raw_init, 0, 0, 0,
80357836Smckusick sysctl_rtable,
80436352Ssklower }
80536352Ssklower };
80636352Ssklower
80736352Ssklower struct domain routedomain =
80854824Ssklower { PF_ROUTE, "route", route_init, 0, 0,
80936352Ssklower routesw, &routesw[sizeof(routesw)/sizeof(routesw[0])] };
810