1a363ebe96cd5d47911d80b9e3a016caebafa0dd
[dragonfly.git] / sys / netproto / ns / ns_input.c
1 /*
2  * Copyright (c) 1984, 1985, 1986, 1987, 1993
3  *      The Regents of the University of California.  All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  * 3. All advertising materials mentioning features or use of this software
14  *    must display the following acknowledgement:
15  *      This product includes software developed by the University of
16  *      California, Berkeley and its contributors.
17  * 4. Neither the name of the University nor the names of its contributors
18  *    may be used to endorse or promote products derived from this software
19  *    without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31  * SUCH DAMAGE.
32  *
33  *      @(#)ns_input.c  8.1 (Berkeley) 6/10/93
34  * $FreeBSD: src/sys/netns/ns_input.c,v 1.13 2000/02/13 03:32:04 peter Exp $
35  * $DragonFly: src/sys/netproto/ns/ns_input.c,v 1.7 2003/09/16 05:03:13 hsu Exp $
36  */
37
38 #include <sys/param.h>
39 #include <sys/systm.h>
40 #include <sys/malloc.h>
41 #include <sys/mbuf.h>
42 #include <sys/domain.h>
43 #include <sys/protosw.h>
44 #include <sys/socket.h>
45 #include <sys/socketvar.h>
46 #include <sys/errno.h>
47 #include <sys/time.h>
48 #include <sys/kernel.h>
49
50 #include <net/if.h>
51 #include <net/route.h>
52 #include <net/raw_cb.h>
53 #include <net/netisr.h>
54
55 #include "ns.h"
56 #include "ns_if.h"
57 #include "ns_pcb.h"
58 #include "idp.h"
59 #include "idp_var.h"
60 #include "ns_error.h"
61
62 extern void spp_input(struct mbuf *, struct nspcb *);   /* spp_usrreq.c XXX */
63
64 /*
65  * NS initialization.
66  */
67 union ns_host   ns_thishost;
68 union ns_host   ns_zerohost;
69 union ns_host   ns_broadhost;
70 union ns_net    ns_zeronet;
71 union ns_net    ns_broadnet;
72 struct sockaddr_ns ns_netmask, ns_hostmask;
73
74 static u_short allones[] = {-1, -1, -1};
75
76 static struct ifqueue nsintrq;
77 struct nspcb nsrawpcb;
78
79 int     nsqmaxlen = IFQ_MAXLEN;
80
81 int     idpcksum = 1;
82 long    ns_pexseq;
83
84 const int       nsintrq_present = 1;
85
86 static void nsintr(struct mbuf *m);
87
88 void
89 ns_init()
90 {
91         ns_broadhost = * (union ns_host *) allones;
92         ns_broadnet = * (union ns_net *) allones;
93         nspcb.nsp_next = nspcb.nsp_prev = &nspcb;
94         nsrawpcb.nsp_next = nsrawpcb.nsp_prev = &nsrawpcb;
95         ns_pexseq = tick;
96         ns_netmask.sns_len = 6;
97         ns_netmask.sns_addr.x_net = ns_broadnet;
98         ns_hostmask.sns_len = 12;
99         ns_hostmask.sns_addr.x_net = ns_broadnet;
100         ns_hostmask.sns_addr.x_host = ns_broadhost;
101         nsintrq.ifq_maxlen = nsqmaxlen;
102         netisr_register(NETISR_NS, nsintr, &nsintrq);
103 }
104
105 /*
106  * Idp input routine.  Pass to next level.
107  */
108 int nsintr_getpck = 0;
109 int nsintr_swtch = 0;
110
111 static void
112 nsintr(struct mbuf *m)
113 {
114         struct idp *idp;
115         struct nspcb *nsp;
116         int i;
117         int len, error;
118         char oddpacketp;
119
120         /*
121          * Get IDP header in first mbuf.
122          */
123         nsintr_getpck++;
124         if ((m->m_flags & M_EXT || m->m_len < sizeof (struct idp)) &&
125             (m = m_pullup(m, sizeof (struct idp))) == 0) {
126                 idpstat.idps_toosmall++;
127                 return;
128         }
129
130         /*
131          * Give any raw listeners a crack at the packet
132          */
133         for (nsp = nsrawpcb.nsp_next; nsp != &nsrawpcb; nsp = nsp->nsp_next) {
134                 struct mbuf *m1 = m_copy(m, 0, (int)M_COPYALL);
135                 if (m1) idp_input(m1, nsp);
136         }
137
138         idp = mtod(m, struct idp *);
139         len = ntohs(idp->idp_len);
140         if ((oddpacketp = (len & 1))) {
141                 len++;          /* If this packet is of odd length,
142                                    preserve garbage byte for checksum */
143         }
144
145         /*
146          * Check that the amount of data in the buffers
147          * is as at least much as the IDP header would have us expect.
148          * Trim mbufs if longer than we expect.
149          * Drop packet if shorter than we expect.
150          */
151         if (m->m_pkthdr.len < len) {
152                 idpstat.idps_tooshort++;
153                 goto bad;
154         }
155         if (m->m_pkthdr.len > len) {
156                 if (m->m_len == m->m_pkthdr.len) {
157                         m->m_len = len;
158                         m->m_pkthdr.len = len;
159                 } else
160                         m_adj(m, len - m->m_pkthdr.len);
161         }
162         if (idpcksum && ((i = idp->idp_sum)!=0xffff)) {
163                 idp->idp_sum = 0;
164                 if (i != (idp->idp_sum = ns_cksum(m, len))) {
165                         idpstat.idps_badsum++;
166                         idp->idp_sum = i;
167                         if (ns_hosteqnh(ns_thishost, idp->idp_dna.x_host))
168                                 error = NS_ERR_BADSUM;
169                         else
170                                 error = NS_ERR_BADSUM_T;
171                         ns_error(m, error, 0);
172                         return;
173                 }
174         }
175         /*
176          * Is this a directed broadcast?
177          */
178         if (ns_hosteqnh(ns_broadhost,idp->idp_dna.x_host)) {
179                 if ((!ns_neteq(idp->idp_dna, idp->idp_sna)) &&
180                     (!ns_neteqnn(idp->idp_dna.x_net, ns_broadnet)) &&
181                     (!ns_neteqnn(idp->idp_sna.x_net, ns_zeronet)) &&
182                     (!ns_neteqnn(idp->idp_dna.x_net, ns_zeronet)) ) {
183                         /*
184                          * Look to see if I need to eat this packet.
185                          * Algorithm is to forward all young packets
186                          * and prematurely age any packets which will
187                          * by physically broadcasted.
188                          * Any very old packets eaten without forwarding
189                          * would die anyway.
190                          *
191                          * Suggestion of Bill Nesheim, Cornell U.
192                          */
193                         if (idp->idp_tc < NS_MAXHOPS) {
194                                 idp_forward(m);
195                                 return;
196                         }
197                 }
198         /*
199          * Is this our packet? If not, forward.
200          */
201         } else if (!ns_hosteqnh(ns_thishost,idp->idp_dna.x_host)) {
202                 idp_forward(m);
203                 return;
204         }
205         /*
206          * Locate pcb for datagram.
207          */
208         nsp = ns_pcblookup(&idp->idp_sna, idp->idp_dna.x_port, NS_WILDCARD);
209         /*
210          * Switch out to protocol's input routine.
211          */
212         nsintr_swtch++;
213         if (nsp) {
214                 if (oddpacketp) {
215                         m_adj(m, -1);
216                 }
217                 if ((nsp->nsp_flags & NSP_ALL_PACKETS)==0)
218                         switch (idp->idp_pt) {
219
220                             case NSPROTO_SPP:
221                                     spp_input(m, nsp);
222                                     return;
223
224                             case NSPROTO_ERROR:
225                                     ns_err_input(m);
226                                     return;
227                         }
228                 idp_input(m, nsp);
229         } else {
230                 ns_error(m, NS_ERR_NOSOCK, 0);
231         }
232         return;
233
234 bad:
235         m_freem(m);
236         return;
237 }
238
239 u_char nsctlerrmap[PRC_NCMDS] = {
240         ECONNABORTED,   ECONNABORTED,   0,              0,
241         0,              0,              EHOSTDOWN,      EHOSTUNREACH,
242         ENETUNREACH,    EHOSTUNREACH,   ECONNREFUSED,   ECONNREFUSED,
243         EMSGSIZE,       0,              0,              0,
244         0,              0,              0,              0
245 };
246
247 int idp_donosocks = 1;
248
249 void
250 idp_ctlinput(cmd, arg)
251         int cmd;
252         caddr_t arg;
253 {
254         struct ns_addr *ns;
255         struct nspcb *nsp;
256         struct ns_errp *errp = (struct ns_errp *)arg;   /* XXX */
257         int type;
258
259         if (cmd < 0 || cmd > PRC_NCMDS)
260                 return;
261         if (nsctlerrmap[cmd] == 0)
262                 return;         /* XXX */
263         type = NS_ERR_UNREACH_HOST;
264         switch (cmd) {
265                 struct sockaddr_ns *sns;
266
267         case PRC_IFDOWN:
268         case PRC_HOSTDEAD:
269         case PRC_HOSTUNREACH:
270                 sns = (struct sockaddr_ns *)arg;
271                 if (sns->sns_family != AF_NS)
272                         return;
273                 ns = &sns->sns_addr;
274                 break;
275
276         default:
277                 errp = (struct ns_errp *)arg;
278                 ns = &errp->ns_err_idp.idp_dna;
279                 type = errp->ns_err_num;
280                 type = ntohs((u_short)type);
281         }
282         switch (type) {
283
284         case NS_ERR_UNREACH_HOST:
285                 ns_pcbnotify(ns, (int)nsctlerrmap[cmd], idp_abort, (long)0);
286                 break;
287
288         case NS_ERR_NOSOCK:
289                 nsp = ns_pcblookup(ns, errp->ns_err_idp.idp_sna.x_port,
290                         NS_WILDCARD);
291                 if(nsp && idp_donosocks && ! ns_nullhost(nsp->nsp_faddr))
292                         (void) idp_drop(nsp, (int)nsctlerrmap[cmd]);
293         }
294 }
295
296 int     idpprintfs = 0;
297 int     idpforwarding = 1;
298 /*
299  * Forward a packet.  If some error occurs return the sender
300  * an error packet.  Note we can't always generate a meaningful
301  * error message because the NS errors don't have a large enough repetoire
302  * of codes and types.
303  */
304 struct route idp_droute;
305 struct route idp_sroute;
306
307 void
308 idp_forward(m)
309 struct mbuf *m;
310 {
311         struct idp *idp = mtod(m, struct idp *);
312         int error, type, code;
313         struct mbuf *mcopy = NULL;
314         int agedelta = 1;
315         int flags = NS_FORWARDING;
316         int ok_there = 0;
317         int ok_back = 0;
318
319         if (idpprintfs) {
320                 printf("forward: src ");
321                 ns_printhost(&idp->idp_sna);
322                 printf(", dst ");
323                 ns_printhost(&idp->idp_dna);
324                 printf("hop count %d\n", idp->idp_tc);
325         }
326         if (idpforwarding == 0) {
327                 /* can't tell difference between net and host */
328                 type = NS_ERR_UNREACH_HOST, code = 0;
329                 goto senderror;
330         }
331         idp->idp_tc++;
332         if (idp->idp_tc > NS_MAXHOPS) {
333                 type = NS_ERR_TOO_OLD, code = 0;
334                 goto senderror;
335         }
336         /*
337          * Save at most 42 bytes of the packet in case
338          * we need to generate an NS error message to the src.
339          */
340         mcopy = m_copy(m, 0, imin((int)ntohs(idp->idp_len), 42));
341
342         if ((ok_there = idp_do_route(&idp->idp_dna,&idp_droute))==0) {
343                 type = NS_ERR_UNREACH_HOST, code = 0;
344                 goto senderror;
345         }
346         /*
347          * Here we think about  forwarding  broadcast packets,
348          * so we try to insure that it doesn't go back out
349          * on the interface it came in on.  Also, if we
350          * are going to physically broadcast this, let us
351          * age the packet so we can eat it safely the second time around.
352          */
353         if (idp->idp_dna.x_host.c_host[0] & 0x1) {
354                 struct ns_ifaddr *ia = ns_iaonnetof(&idp->idp_dna);
355                 struct ifnet *ifp;
356                 if (ia) {
357                         /* I'm gonna hafta eat this packet */
358                         agedelta += NS_MAXHOPS - idp->idp_tc;
359                         idp->idp_tc = NS_MAXHOPS;
360                 }
361                 if ((ok_back = idp_do_route(&idp->idp_sna,&idp_sroute))==0) {
362                         /* error = ENETUNREACH; He'll never get it! */
363                         m_freem(m);
364                         goto cleanup;
365                 }
366                 if (idp_droute.ro_rt &&
367                     (ifp=idp_droute.ro_rt->rt_ifp) &&
368                     idp_sroute.ro_rt &&
369                     (ifp!=idp_sroute.ro_rt->rt_ifp)) {
370                         flags |= NS_ALLOWBROADCAST;
371                 } else {
372                         type = NS_ERR_UNREACH_HOST, code = 0;
373                         goto senderror;
374                 }
375         }
376         /* need to adjust checksum */
377         if (idp->idp_sum!=0xffff) {
378                 union bytes {
379                         u_char c[4];
380                         u_short s[2];
381                         long l;
382                 } x;
383                 int shift;
384                 x.l = 0; x.c[0] = agedelta;
385                 shift = (((((int)ntohs(idp->idp_len))+1)>>1)-2) & 0xf;
386                 x.l = idp->idp_sum + (x.s[0] << shift);
387                 x.l = x.s[0] + x.s[1];
388                 x.l = x.s[0] + x.s[1];
389                 if (x.l==0xffff) idp->idp_sum = 0; else idp->idp_sum = x.l;
390         }
391         if ((error = ns_output(m, &idp_droute, flags)) &&
392             (mcopy!=NULL)) {
393                 idp = mtod(mcopy, struct idp *);
394                 type = NS_ERR_UNSPEC_T, code = 0;
395                 switch (error) {
396
397                 case ENETUNREACH:
398                 case EHOSTDOWN:
399                 case EHOSTUNREACH:
400                 case ENETDOWN:
401                 case EPERM:
402                         type = NS_ERR_UNREACH_HOST;
403                         break;
404
405                 case EMSGSIZE:
406                         type = NS_ERR_TOO_BIG;
407                         code = 576; /* too hard to figure out mtu here */
408                         break;
409
410                 case ENOBUFS:
411                         type = NS_ERR_UNSPEC_T;
412                         break;
413                 }
414                 mcopy = NULL;
415         senderror:
416                 ns_error(m, type, code);
417         }
418 cleanup:
419         if (ok_there)
420                 idp_undo_route(&idp_droute);
421         if (ok_back)
422                 idp_undo_route(&idp_sroute);
423         if (mcopy != NULL)
424                 m_freem(mcopy);
425 }
426
427 int
428 idp_do_route(src, ro)
429 struct ns_addr *src;
430 struct route *ro;
431 {
432
433         struct sockaddr_ns *dst;
434
435         bzero((caddr_t)ro, sizeof (*ro));
436         dst = (struct sockaddr_ns *)&ro->ro_dst;
437
438         dst->sns_len = sizeof(*dst);
439         dst->sns_family = AF_NS;
440         dst->sns_addr = *src;
441         dst->sns_addr.x_port = 0;
442         rtalloc(ro);
443         if (ro->ro_rt == 0 || ro->ro_rt->rt_ifp == 0) {
444                 return (0);
445         }
446         ro->ro_rt->rt_use++;
447         return (1);
448 }
449
450 void
451 idp_undo_route(ro)
452 struct route *ro;
453 {
454         if (ro->ro_rt) {RTFREE(ro->ro_rt);}
455 }
456
457 void
458 ns_watch_output(m, ifp)
459 struct mbuf *m;
460 struct ifnet *ifp;
461 {
462         struct nspcb *nsp;
463         struct ifaddr *ifa;
464         /*
465          * Give any raw listeners a crack at the packet
466          */
467         for (nsp = nsrawpcb.nsp_next; nsp != &nsrawpcb; nsp = nsp->nsp_next) {
468                 struct mbuf *m0 = m_copy(m, 0, (int)M_COPYALL);
469                 if (m0) {
470                         struct idp *idp;
471
472                         M_PREPEND(m0, sizeof (*idp), M_DONTWAIT);
473                         if (m0 == NULL)
474                                 continue;
475                         idp = mtod(m0, struct idp *);
476                         idp->idp_sna.x_net = ns_zeronet;
477                         idp->idp_sna.x_host = ns_thishost;
478                         if (ifp && (ifp->if_flags & IFF_POINTOPOINT))
479                                 TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link)
480                                 if (ifa->ifa_addr->sa_family==AF_NS) {
481                                     idp->idp_sna = IA_SNS(ifa)->sns_addr;
482                                     break;
483                                 }
484                         idp->idp_len = ntohl(m0->m_pkthdr.len);
485                         idp_input(m0, nsp);
486                 }
487         }
488 }