Merge branch 'master' into kq_devices
[dragonfly.git] / sys / netproto / natm / natm.c
1 /*      $NetBSD: natm.c,v 1.5 1996/11/09 03:26:26 chuck Exp $   */
2 /* $FreeBSD: src/sys/netnatm/natm.c,v 1.12 2000/02/13 03:32:03 peter Exp $ */
3 /* $DragonFly: src/sys/netproto/natm/natm.c,v 1.31 2008/09/24 14:26:39 sephe Exp $ */
4
5 /*
6  *
7  * Copyright (c) 1996 Charles D. Cranor and Washington University.
8  * All rights reserved.
9  *
10  * Redistribution and use in source and binary forms, with or without
11  * modification, are permitted provided that the following conditions
12  * are met:
13  * 1. Redistributions of source code must retain the above copyright
14  *    notice, this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in the
17  *    documentation and/or other materials provided with the distribution.
18  * 3. All advertising materials mentioning features or use of this software
19  *    must display the following acknowledgement:
20  *      This product includes software developed by Charles D. Cranor and
21  *      Washington University.
22  * 4. The name of the author may not be used to endorse or promote products
23  *    derived from this software without specific prior written permission.
24  *
25  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
26  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
27  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
28  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
29  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
30  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
31  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
32  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
33  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
34  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
35  */
36
37 /*
38  * natm.c: native mode ATM access (both aal0 and aal5).
39  */
40
41 #include <sys/param.h>
42 #include <sys/systm.h>
43 #include <sys/kernel.h>
44 #include <sys/proc.h>
45 #include <sys/sockio.h>
46 #include <sys/protosw.h>
47 #include <sys/malloc.h>
48 #include <sys/mbuf.h>
49 #include <sys/socket.h>
50 #include <sys/socketvar.h>
51
52 #include <sys/thread2.h>
53 #include <sys/msgport2.h>
54
55 #include <net/if.h>
56 #include <net/if_atm.h>
57 #include <net/netisr.h>
58
59 #include <netinet/in.h>
60
61 #include "natm.h"
62
63 static u_long natm5_sendspace = 16*1024;
64 static u_long natm5_recvspace = 16*1024;
65
66 static u_long natm0_sendspace = 16*1024;
67 static u_long natm0_recvspace = 16*1024;
68
69 /*
70  * user requests
71  */
72 #ifdef FREEBSD_USRREQS
73 /*
74  * FreeBSD new usrreqs supersedes pr_usrreq.
75  */
76 static int natm_usr_attach (struct socket *, int, struct pru_attach_info *);
77 static int natm_usr_detach (struct socket *);
78 static int natm_usr_connect (struct socket *, struct sockaddr *,
79                                  struct thread *);
80 static int natm_usr_disconnect (struct socket *);
81 static int natm_usr_shutdown (struct socket *);
82 static int natm_usr_send (struct socket *, int, struct mbuf *,
83                               struct sockaddr *, struct mbuf *, 
84                               struct thread *);
85 static int natm_usr_peeraddr (struct socket *, struct sockaddr **);
86 static int natm_usr_control (struct socket *, u_long, caddr_t,
87                                  struct ifnet *, struct thread *);
88 static int natm_usr_abort (struct socket *);
89 static int natm_usr_bind (struct socket *, struct sockaddr *, 
90                               struct thread *);
91 static int natm_usr_sockaddr (struct socket *, struct sockaddr **);
92
93 static int
94 natm_usr_attach(struct socket *so, int proto, struct pru_attach_info *ai)
95 {
96     struct natmpcb *npcb;
97     int error = 0;
98
99     crit_enter();
100     npcb = (struct natmpcb *) so->so_pcb;
101
102     if (npcb) {
103         error = EISCONN;
104         goto out;
105     }
106
107     if (so->so_snd.ssb_hiwat == 0 || so->so_rcv.ssb_hiwat == 0) {
108         if (proto == PROTO_NATMAAL5) 
109             error = soreserve(so, natm5_sendspace, natm5_recvspace,
110                               ai->sb_rlimit);
111         else
112             error = soreserve(so, natm0_sendspace, natm0_recvspace,
113                               ai->sb_rlimit);
114         if (error)
115           goto out;
116     }
117
118     so->so_pcb = (caddr_t) (npcb = npcb_alloc(M_WAITOK));
119     npcb->npcb_socket = so;
120  out:
121     crit_exit();
122     return (error);
123 }
124
125 static int
126 natm_usr_detach(struct socket *so)
127 {
128     struct natmpcb *npcb;
129     int error = 0;
130
131     crit_enter();
132     npcb = (struct natmpcb *) so->so_pcb;
133     if (npcb == NULL) {
134         error = EINVAL;
135         goto out;
136     }
137
138     /*
139      * we turn on 'drain' *before* we sofree.
140      */
141     npcb_free(npcb, NPCB_DESTROY);      /* drain */
142     so->so_pcb = NULL;
143     sofree(so);
144  out:
145     crit_exit();
146     return (error);
147 }
148
149 static int
150 natm_usr_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
151 {
152     struct natmpcb *npcb;
153     struct sockaddr_natm *snatm;
154     struct atm_pseudoioctl api;
155     struct ifnet *ifp;
156     int error = 0;
157     int proto;
158
159     crit_enter();
160     proto = so->so_proto->pr_protocol;
161     npcb = (struct natmpcb *) so->so_pcb;
162     if (npcb == NULL) {
163         error = EINVAL;
164         goto out;
165     }
166
167     /*
168      * validate nam and npcb
169      */
170
171     snatm = (struct sockaddr_natm *)nam;
172     if (snatm->snatm_len != sizeof(*snatm) ||
173         (npcb->npcb_flags & NPCB_FREE) == 0) {
174         error = EINVAL;
175         goto out;
176     }
177     if (snatm->snatm_family != AF_NATM) {
178         error = EAFNOSUPPORT;
179         goto out;
180     }
181
182     snatm->snatm_if[IFNAMSIZ-1] = '\0';  /* XXX ensure null termination
183                                             since ifunit() uses strcmp */
184
185     /*
186      * convert interface string to ifp, validate.
187      */
188
189     ifp = ifunit(snatm->snatm_if);
190     if (ifp == NULL || (ifp->if_flags & IFF_RUNNING) == 0) {
191         error = ENXIO;
192         goto out;
193     }
194     if (ifp->if_output != atm_output) {
195         error = EAFNOSUPPORT;
196         goto out;
197     }
198
199     /*
200      * register us with the NATM PCB layer
201      */
202
203     if (npcb_add(npcb, ifp, snatm->snatm_vci, snatm->snatm_vpi) != npcb) {
204         error = EADDRINUSE;
205         goto out;
206     }
207
208     /*
209      * enable rx
210      */
211
212     ATM_PH_FLAGS(&api.aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
213     ATM_PH_VPI(&api.aph) = npcb->npcb_vpi;
214     ATM_PH_SETVCI(&api.aph, npcb->npcb_vci);
215     api.rxhand = npcb;
216     ifnet_serialize_all(ifp);
217     if (ifp->if_ioctl == NULL || 
218         ifp->if_ioctl(ifp, SIOCATMENA, (caddr_t) &api,
219                       td->td_proc->p_ucred) != 0) {
220         ifnet_deserialize_all(ifp);
221         npcb_free(npcb, NPCB_REMOVE);
222         error = EIO;
223         goto out;
224     }
225     ifnet_deserialize_all(ifp);
226
227     soisconnected(so);
228
229  out:
230     crit_exit();
231     return (error);
232 }
233
234 static int
235 natm_usr_disconnect(struct socket *so)
236 {
237     struct natmpcb *npcb;
238     struct atm_pseudoioctl api;
239     struct ifnet *ifp;
240     int error = 0;
241
242     crit_enter();
243     npcb = (struct natmpcb *) so->so_pcb;
244     if (npcb == NULL) {
245         error = EINVAL;
246         goto out;
247     }
248
249     if ((npcb->npcb_flags & NPCB_CONNECTED) == 0) {
250         kprintf("natm: disconnected check\n");
251         error = EIO;
252         goto out;
253     }
254     ifp = npcb->npcb_ifp;
255
256     /*
257      * disable rx
258      */
259
260     ATM_PH_FLAGS(&api.aph) = ATM_PH_AAL5;
261     ATM_PH_VPI(&api.aph) = npcb->npcb_vpi;
262     ATM_PH_SETVCI(&api.aph, npcb->npcb_vci);
263     api.rxhand = npcb;
264     if (ifp->if_ioctl != NULL) {
265         ifnet_serialize_all(ifp);
266         ifp->if_ioctl(ifp, SIOCATMDIS, (caddr_t) &api, NULL);
267         ifnet_deserialize_all(ifp);
268     }
269
270     npcb_free(npcb, NPCB_REMOVE);
271     soisdisconnected(so);
272
273  out:
274     crit_exit();
275     return (error);
276 }
277
278 static int
279 natm_usr_shutdown(struct socket *so)
280 {
281     socantsendmore(so);
282     return 0;
283 }
284
285 static int
286 natm_usr_send(struct socket *so, int flags, struct mbuf *m, 
287               struct sockaddr *nam, struct mbuf *control, struct thread *td)
288 {
289     struct natmpcb *npcb;
290     struct atm_pseudohdr *aph;
291     int error = 0;
292     int proto = so->so_proto->pr_protocol;
293
294     crit_enter();
295
296     npcb = (struct natmpcb *) so->so_pcb;
297     if (npcb == NULL) {
298         error = EINVAL;
299         goto out;
300     }
301
302     if (control && control->m_len) {
303         m_freem(control);
304         m_freem(m);
305         error = EINVAL;
306         goto out;
307     }
308
309     /*
310      * send the data.   we must put an atm_pseudohdr on first
311      */
312
313     M_PREPEND(m, sizeof(*aph), M_WAITOK);
314     if (m == NULL) {
315         error = ENOBUFS;
316         goto out;
317     }
318     aph = mtod(m, struct atm_pseudohdr *);
319     ATM_PH_VPI(aph) = npcb->npcb_vpi;
320     ATM_PH_SETVCI(aph, npcb->npcb_vci);
321     ATM_PH_FLAGS(aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
322
323     error = atm_output(npcb->npcb_ifp, m, NULL, NULL);
324
325  out:
326     crit_exit();
327     return (error);
328 }
329
330 static int
331 natm_usr_peeraddr(struct socket *so, struct sockaddr **nam)
332 {
333     struct natmpcb *npcb;
334     struct sockaddr_natm *snatm, ssnatm;
335     int error = 0;
336
337     crit_enter();
338     npcb = (struct natmpcb *) so->so_pcb;
339     if (npcb == NULL) {
340         error = EINVAL;
341         goto out;
342     }
343
344     snatm = &ssnatm;
345     bzero(snatm, sizeof(*snatm));
346     snatm->snatm_len = sizeof(*snatm);
347     snatm->snatm_family = AF_NATM;
348     strlcpy(snatm->snatm_if, npcb->npcb_ifp->if_xname,
349         sizeof(snatm->snatm_if));
350     snatm->snatm_vci = npcb->npcb_vci;
351     snatm->snatm_vpi = npcb->npcb_vpi;
352     *nam = dup_sockaddr((struct sockaddr *)snatm);
353
354  out:
355     crit_exit();
356     return (error);
357 }
358
359 static int
360 natm_usr_control(struct socket *so, u_long cmd, caddr_t arg,
361                  struct ifnet *ifp, struct thread *td)
362 {
363     struct natmpcb *npcb;
364     struct atm_rawioctl ario;
365     int error = 0;
366
367     npcb = (struct natmpcb *) so->so_pcb;
368     if (npcb == NULL) {
369         error = EINVAL;
370         goto out;
371     }
372
373     /*
374      * raw atm ioctl.   comes in as a SIOCRAWATM.   we convert it to
375      * SIOCXRAWATM and pass it to the driver.
376      */
377     if (cmd == SIOCRAWATM) {
378         if (npcb->npcb_ifp == NULL) {
379             error = ENOTCONN;
380             goto out;
381         }
382         ario.npcb = npcb;
383         ario.rawvalue = *((int *)arg);
384         ifnet_serialize_all(npcb->npcb_ifp);
385         error = npcb->npcb_ifp->if_ioctl(npcb->npcb_ifp, 
386                                          SIOCXRAWATM, (caddr_t) &ario,
387                                          td->td_proc->p_ucred);
388         ifnet_deserialize_all(npcb->npcb_ifp);
389         if (!error) {
390             if (ario.rawvalue) 
391                 npcb->npcb_flags |= NPCB_RAW;
392             else
393                 npcb->npcb_flags &= ~(NPCB_RAW);
394         }
395     }
396     else
397         error = EOPNOTSUPP;
398  out:
399     return (error);
400 }
401
402 static int
403 natm_usr_abort(struct socket *so)
404 {
405     return natm_usr_shutdown(so);
406 }
407
408 static int
409 natm_usr_bind(struct socket *so, struct sockaddr *nam, struct thread *td)
410 {
411     return EOPNOTSUPP;
412 }
413
414 static int
415 natm_usr_sockaddr(struct socket *so, struct sockaddr **nam)
416 {
417     return EOPNOTSUPP;
418 }
419
420 /* xxx - should be const */
421 struct pr_usrreqs natm_usrreqs = {
422         .pru_abort = natm_usr_abort,
423         .pru_accept = pru_accept_notsupp,
424         .pru_attach = natm_usr_attach,
425         .pru_bind = natm_usr_bind,
426         .pru_connect = natm_usr_connect,
427         .pru_connect2 = pru_connect2_notsupp,
428         .pru_control = natm_usr_control,
429         .pru_detach = natm_usr_detach,
430         .pru_disconnect = natm_usr_disconnect,
431         .pru_listen = pru_listen_notsupp,
432         .pru_peeraddr = natm_usr_peeraddr,
433         .pru_rcvd = pru_rcvd_notsupp,
434         .pru_rcvoob = pru_rcvoob_notsupp,
435         .pru_send = natm_usr_send,
436         .pru_sense = pru_sense_null,
437         .pru_shutdown = natm_usr_shutdown,
438         .pru_sockaddr = natm_usr_sockaddr,
439         .pru_sosend = sosend,
440         .pru_soreceive = soreceive
441 };
442
443 #else  /* !FREEBSD_USRREQS */
444
445 #if defined(__NetBSD__) || defined(__OpenBSD__)
446 int
447 natm_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam,
448             struct mbuf *control, struct proc *p)
449 #elif defined(__DragonFly__)
450 int
451 natm_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam,
452             struct mbuf *control)
453 #endif
454 {
455   int error = 0;
456   struct natmpcb *npcb;
457   struct sockaddr_natm *snatm;
458   struct atm_pseudoioctl api;
459   struct atm_pseudohdr *aph;
460   struct atm_rawioctl ario;
461   struct ifnet *ifp;
462   int proto = so->so_proto->pr_protocol;
463
464   crit_enter();
465
466   npcb = (struct natmpcb *) so->so_pcb;
467
468   if (npcb == NULL && req != PRU_ATTACH) {
469     error = EINVAL;
470     goto done;
471   }
472     
473
474   switch (req) {
475     case PRU_ATTACH:                    /* attach protocol to up */
476
477       if (npcb) {
478         error = EISCONN;
479         break;
480       }
481
482       if (so->so_snd.ssb_hiwat == 0 || so->so_rcv.ssb_hiwat == 0) {
483         if (proto == PROTO_NATMAAL5) 
484           error = soreserve(so, natm5_sendspace, natm5_recvspace);
485         else
486           error = soreserve(so, natm0_sendspace, natm0_recvspace);
487         if (error)
488           break;
489       }
490
491       so->so_pcb = (caddr_t) (npcb = npcb_alloc(M_WAITOK));
492       npcb->npcb_socket = so;
493
494       break;
495
496     case PRU_DETACH:                    /* detach protocol from up */
497
498       /*
499        * we turn on 'drain' *before* we sofree.
500        */
501
502       npcb_free(npcb, NPCB_DESTROY);    /* drain */
503       so->so_pcb = NULL;
504       sofree(so);
505
506       break;
507
508     case PRU_CONNECT:                   /* establish connection to peer */
509
510       /*
511        * validate nam and npcb
512        */
513
514       if (nam->m_len != sizeof(*snatm)) {
515         error = EINVAL;
516         break;
517       }
518       snatm = mtod(nam, struct sockaddr_natm *);
519       if (snatm->snatm_len != sizeof(*snatm) ||
520                 (npcb->npcb_flags & NPCB_FREE) == 0) {
521         error = EINVAL;
522         break;
523       }
524       if (snatm->snatm_family != AF_NATM) {
525         error = EAFNOSUPPORT;
526         break;
527       }
528
529       snatm->snatm_if[IFNAMSIZ-1] = '\0';  /* XXX ensure null termination
530                                                 since ifunit() uses strcmp */
531
532       /*
533        * convert interface string to ifp, validate.
534        */
535
536       ifp = ifunit(snatm->snatm_if);
537       if (ifp == NULL || (ifp->if_flags & IFF_RUNNING) == 0) {
538         error = ENXIO;
539         break;
540       }
541       if (ifp->if_output != atm_output) {
542         error = EAFNOSUPPORT;
543         break;
544       }
545
546
547       /*
548        * register us with the NATM PCB layer
549        */
550
551       if (npcb_add(npcb, ifp, snatm->snatm_vci, snatm->snatm_vpi) != npcb) {
552         error = EADDRINUSE;
553         break;
554       }
555
556       /*
557        * enable rx
558        */
559
560       ATM_PH_FLAGS(&api.aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
561       ATM_PH_VPI(&api.aph) = npcb->npcb_vpi;
562       ATM_PH_SETVCI(&api.aph, npcb->npcb_vci);
563       api.rxhand = npcb;
564       ifnet_serialize_all(ifp);
565       if (ifp->if_ioctl == NULL || 
566           ifp->if_ioctl(ifp, SIOCATMENA, (caddr_t) &api, NULL) != 0) {
567         ifnet_deserialize_all(ifp);
568         npcb_free(npcb, NPCB_REMOVE);
569         error = EIO;
570         break;
571       }
572       ifnet_deserialize_all(ifp);
573
574       soisconnected(so);
575
576       break;
577
578     case PRU_DISCONNECT:                /* disconnect from peer */
579
580       if ((npcb->npcb_flags & NPCB_CONNECTED) == 0) {
581         kprintf("natm: disconnected check\n");
582         error = EIO;
583         break;
584       }
585       ifp = npcb->npcb_ifp;
586
587       /*
588        * disable rx
589        */
590
591       ATM_PH_FLAGS(&api.aph) = ATM_PH_AAL5;
592       ATM_PH_VPI(&api.aph) = npcb->npcb_vpi;
593       ATM_PH_SETVCI(&api.aph, npcb->npcb_vci);
594       api.rxhand = npcb;
595       ifnet_serialize_all(ifp);
596       if (ifp->if_ioctl != NULL)
597           ifp->if_ioctl(ifp, SIOCATMDIS, (caddr_t) &api, NULL);
598       ifnet_deserialize_all(ifp);
599
600       npcb_free(npcb, NPCB_REMOVE);
601       soisdisconnected(so);
602
603       break;
604
605     case PRU_SHUTDOWN:                  /* won't send any more data */
606       socantsendmore(so);
607       break;
608
609     case PRU_SEND:                      /* send this data */
610       if (control && control->m_len) {
611         m_freem(control);
612         m_freem(m);
613         error = EINVAL;
614         break;
615       }
616
617       /*
618        * send the data.   we must put an atm_pseudohdr on first
619        */
620
621       M_PREPEND(m, sizeof(*aph), M_WAITOK);
622       if (m == NULL) {
623         error = ENOBUFS;
624         break;
625       }
626       aph = mtod(m, struct atm_pseudohdr *);
627       ATM_PH_VPI(aph) = npcb->npcb_vpi;
628       ATM_PH_SETVCI(aph, npcb->npcb_vci);
629       ATM_PH_FLAGS(aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
630
631       error = atm_output(npcb->npcb_ifp, m, NULL, NULL);
632
633       break;
634
635     case PRU_SENSE:                     /* return status into m */
636       /* return zero? */
637       break;
638
639     case PRU_PEERADDR:                  /* fetch peer's address */
640       snatm = mtod(nam, struct sockaddr_natm *);
641       bzero(snatm, sizeof(*snatm));
642       nam->m_len = snatm->snatm_len = sizeof(*snatm);
643       snatm->snatm_family = AF_NATM;
644 #if defined(__NetBSD__) || defined(__OpenBSD__) || defined(__DragonFly__)
645       bcopy(npcb->npcb_ifp->if_xname, snatm->snatm_if, sizeof(snatm->snatm_if));
646 #elif defined(__DragonFly__)
647       ksnprintf(snatm->snatm_if, sizeof(snatm->snatm_if),
648         "%s%d", npcb->npcb_ifp->if_name, npcb->npcb_ifp->if_unit);
649 #endif
650       snatm->snatm_vci = npcb->npcb_vci;
651       snatm->snatm_vpi = npcb->npcb_vpi;
652       break;
653
654     case PRU_CONTROL:                   /* control operations on protocol */
655       /*
656        * raw atm ioctl.   comes in as a SIOCRAWATM.   we convert it to
657        * SIOCXRAWATM and pass it to the driver.
658        */
659       if ((u_long)m == SIOCRAWATM) {
660         if (npcb->npcb_ifp == NULL) {
661           error = ENOTCONN;
662           break;
663         }
664         ario.npcb = npcb;
665         ario.rawvalue = *((int *)nam);
666         ifnet_serialize_all(npcb->npcb_ifp);
667         error = npcb->npcb_ifp->if_ioctl(npcb->npcb_ifp, SIOCXRAWATM,
668                                          (caddr_t) &ario, NULL);
669         ifnet_deserialize_all(npcb->npcb_ifp);
670         if (!error) {
671           if (ario.rawvalue) 
672             npcb->npcb_flags |= NPCB_RAW;
673           else
674             npcb->npcb_flags &= ~(NPCB_RAW);
675         }
676
677         break;
678       }
679
680       error = EOPNOTSUPP;
681       break;
682
683     case PRU_BIND:                      /* bind socket to address */
684     case PRU_LISTEN:                    /* listen for connection */
685     case PRU_ACCEPT:                    /* accept connection from peer */
686     case PRU_CONNECT2:                  /* connect two sockets */
687     case PRU_ABORT:                     /* abort (fast DISCONNECT, DETATCH) */
688                                         /* (only happens if LISTEN socket) */
689     case PRU_RCVD:                      /* have taken data; more room now */
690     case PRU_FASTTIMO:                  /* 200ms timeout */
691     case PRU_SLOWTIMO:                  /* 500ms timeout */
692     case PRU_RCVOOB:                    /* retrieve out of band data */
693     case PRU_SENDOOB:                   /* send out of band data */
694     case PRU_PROTORCV:                  /* receive from below */
695     case PRU_PROTOSEND:                 /* send to below */
696     case PRU_SOCKADDR:                  /* fetch socket's address */
697 #ifdef DIAGNOSTIC
698       kprintf("natm: PRU #%d unsupported\n", req);
699 #endif
700       error = EOPNOTSUPP;
701       break;
702    
703     default: panic("natm usrreq");
704   }
705
706 done:
707   crit_exit();
708   return(error);
709 }
710
711 #endif  /* !FREEBSD_USRREQS */
712
713 /* 
714  * natm0_sysctl: not used, but here in case we want to add something
715  * later...
716  */
717
718 int
719 natm0_sysctl(int *name, u_int namelen, void *oldp, size_t *oldlenp,
720              void *newp, size_t newlen)
721 {
722   /* All sysctl names at this level are terminal. */
723   if (namelen != 1)
724     return (ENOTDIR);
725   return (ENOPROTOOPT);
726 }
727
728 /* 
729  * natm5_sysctl: not used, but here in case we want to add something
730  * later...
731  */
732
733 int
734 natm5_sysctl(int *name, u_int namelen, void *oldp, size_t *oldlenp,
735              void *newp, size_t newlen)
736 {
737   /* All sysctl names at this level are terminal. */
738   if (namelen != 1)
739     return (ENOTDIR);
740   return (ENOPROTOOPT);
741 }
742
743 static void natmintr(struct netmsg *);
744
745 #if defined(__DragonFly__)
746 static void
747 netisr_natm_setup(void *dummy __unused)
748 {
749         netisr_register(NETISR_NATM, cpu0_portfn, pktinfo_portfn_cpu0,
750                         natmintr, NETISR_FLAG_NOTMPSAFE);
751 }
752 SYSINIT(natm_setup, SI_BOOT2_KLD, SI_ORDER_ANY, netisr_natm_setup, NULL);
753 #endif
754
755 void
756 natm_init(void)
757 {
758   LIST_INIT(&natm_pcbs);
759
760   netisr_register(NETISR_NATM, cpu0_portfn, pktinfo_portfn_cpu0,
761                   natmintr, NETISR_FLAG_NOTMPSAFE);
762 }
763
764 /*
765  * natmintr: software interrupt
766  *
767  * note: we expect a socket pointer in rcvif rather than an interface
768  * pointer.    we can get the interface pointer from the so's PCB if
769  * we really need it.
770  */
771 static void
772 natmintr(struct netmsg *msg)
773 {
774   struct mbuf *m = ((struct netmsg_packet *)msg)->nm_packet;
775   struct socket *so;
776   struct natmpcb *npcb;
777
778 #ifdef DIAGNOSTIC
779   if ((m->m_flags & M_PKTHDR) == 0)
780     panic("natmintr no HDR");
781 #endif
782
783   npcb = (struct natmpcb *) m->m_pkthdr.rcvif; /* XXX: overloaded */
784   so = npcb->npcb_socket;
785
786   crit_enter();
787   npcb->npcb_inq--;
788   crit_exit();
789
790   if (npcb->npcb_flags & NPCB_DRAIN) {
791     m_freem(m);
792     if (npcb->npcb_inq == 0)
793       FREE(npcb, M_PCB);                        /* done! */
794     goto out;
795   }
796
797   if (npcb->npcb_flags & NPCB_FREE) {
798     m_freem(m);                                 /* drop */
799     goto out;
800   }
801
802 #ifdef NEED_TO_RESTORE_IFP
803   m->m_pkthdr.rcvif = npcb->npcb_ifp;
804 #else
805 #ifdef DIAGNOSTIC
806 m->m_pkthdr.rcvif = NULL;       /* null it out to be safe */
807 #endif
808 #endif
809
810   if (ssb_space(&so->so_rcv) > m->m_pkthdr.len ||
811      ((npcb->npcb_flags & NPCB_RAW) != 0 && so->so_rcv.ssb_cc < NPCB_RAWCC) ) {
812 #ifdef NATM_STAT
813     natm_sookcnt++;
814     natm_sookbytes += m->m_pkthdr.len;
815 #endif
816     sbappendrecord(&so->so_rcv.sb, m);
817     sorwakeup(so);
818   } else {
819 #ifdef NATM_STAT
820     natm_sodropcnt++;
821     natm_sodropbytes += m->m_pkthdr.len;
822 #endif
823     m_freem(m);
824   }
825 out:
826   ;
827   /* msg was embedded in the mbuf, do not reply! */
828 }
829