cd56285f0a9cc801db11af4ae8c9d0983c0b04e0
[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         .pru_sopoll = sopoll
442 };
443
444 #else  /* !FREEBSD_USRREQS */
445
446 #if defined(__NetBSD__) || defined(__OpenBSD__)
447 int
448 natm_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam,
449             struct mbuf *control, struct proc *p)
450 #elif defined(__DragonFly__)
451 int
452 natm_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam,
453             struct mbuf *control)
454 #endif
455 {
456   int error = 0;
457   struct natmpcb *npcb;
458   struct sockaddr_natm *snatm;
459   struct atm_pseudoioctl api;
460   struct atm_pseudohdr *aph;
461   struct atm_rawioctl ario;
462   struct ifnet *ifp;
463   int proto = so->so_proto->pr_protocol;
464
465   crit_enter();
466
467   npcb = (struct natmpcb *) so->so_pcb;
468
469   if (npcb == NULL && req != PRU_ATTACH) {
470     error = EINVAL;
471     goto done;
472   }
473     
474
475   switch (req) {
476     case PRU_ATTACH:                    /* attach protocol to up */
477
478       if (npcb) {
479         error = EISCONN;
480         break;
481       }
482
483       if (so->so_snd.ssb_hiwat == 0 || so->so_rcv.ssb_hiwat == 0) {
484         if (proto == PROTO_NATMAAL5) 
485           error = soreserve(so, natm5_sendspace, natm5_recvspace);
486         else
487           error = soreserve(so, natm0_sendspace, natm0_recvspace);
488         if (error)
489           break;
490       }
491
492       so->so_pcb = (caddr_t) (npcb = npcb_alloc(M_WAITOK));
493       npcb->npcb_socket = so;
494
495       break;
496
497     case PRU_DETACH:                    /* detach protocol from up */
498
499       /*
500        * we turn on 'drain' *before* we sofree.
501        */
502
503       npcb_free(npcb, NPCB_DESTROY);    /* drain */
504       so->so_pcb = NULL;
505       sofree(so);
506
507       break;
508
509     case PRU_CONNECT:                   /* establish connection to peer */
510
511       /*
512        * validate nam and npcb
513        */
514
515       if (nam->m_len != sizeof(*snatm)) {
516         error = EINVAL;
517         break;
518       }
519       snatm = mtod(nam, struct sockaddr_natm *);
520       if (snatm->snatm_len != sizeof(*snatm) ||
521                 (npcb->npcb_flags & NPCB_FREE) == 0) {
522         error = EINVAL;
523         break;
524       }
525       if (snatm->snatm_family != AF_NATM) {
526         error = EAFNOSUPPORT;
527         break;
528       }
529
530       snatm->snatm_if[IFNAMSIZ-1] = '\0';  /* XXX ensure null termination
531                                                 since ifunit() uses strcmp */
532
533       /*
534        * convert interface string to ifp, validate.
535        */
536
537       ifp = ifunit(snatm->snatm_if);
538       if (ifp == NULL || (ifp->if_flags & IFF_RUNNING) == 0) {
539         error = ENXIO;
540         break;
541       }
542       if (ifp->if_output != atm_output) {
543         error = EAFNOSUPPORT;
544         break;
545       }
546
547
548       /*
549        * register us with the NATM PCB layer
550        */
551
552       if (npcb_add(npcb, ifp, snatm->snatm_vci, snatm->snatm_vpi) != npcb) {
553         error = EADDRINUSE;
554         break;
555       }
556
557       /*
558        * enable rx
559        */
560
561       ATM_PH_FLAGS(&api.aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
562       ATM_PH_VPI(&api.aph) = npcb->npcb_vpi;
563       ATM_PH_SETVCI(&api.aph, npcb->npcb_vci);
564       api.rxhand = npcb;
565       ifnet_serialize_all(ifp);
566       if (ifp->if_ioctl == NULL || 
567           ifp->if_ioctl(ifp, SIOCATMENA, (caddr_t) &api, NULL) != 0) {
568         ifnet_deserialize_all(ifp);
569         npcb_free(npcb, NPCB_REMOVE);
570         error = EIO;
571         break;
572       }
573       ifnet_deserialize_all(ifp);
574
575       soisconnected(so);
576
577       break;
578
579     case PRU_DISCONNECT:                /* disconnect from peer */
580
581       if ((npcb->npcb_flags & NPCB_CONNECTED) == 0) {
582         kprintf("natm: disconnected check\n");
583         error = EIO;
584         break;
585       }
586       ifp = npcb->npcb_ifp;
587
588       /*
589        * disable rx
590        */
591
592       ATM_PH_FLAGS(&api.aph) = ATM_PH_AAL5;
593       ATM_PH_VPI(&api.aph) = npcb->npcb_vpi;
594       ATM_PH_SETVCI(&api.aph, npcb->npcb_vci);
595       api.rxhand = npcb;
596       ifnet_serialize_all(ifp);
597       if (ifp->if_ioctl != NULL)
598           ifp->if_ioctl(ifp, SIOCATMDIS, (caddr_t) &api, NULL);
599       ifnet_deserialize_all(ifp);
600
601       npcb_free(npcb, NPCB_REMOVE);
602       soisdisconnected(so);
603
604       break;
605
606     case PRU_SHUTDOWN:                  /* won't send any more data */
607       socantsendmore(so);
608       break;
609
610     case PRU_SEND:                      /* send this data */
611       if (control && control->m_len) {
612         m_freem(control);
613         m_freem(m);
614         error = EINVAL;
615         break;
616       }
617
618       /*
619        * send the data.   we must put an atm_pseudohdr on first
620        */
621
622       M_PREPEND(m, sizeof(*aph), M_WAITOK);
623       if (m == NULL) {
624         error = ENOBUFS;
625         break;
626       }
627       aph = mtod(m, struct atm_pseudohdr *);
628       ATM_PH_VPI(aph) = npcb->npcb_vpi;
629       ATM_PH_SETVCI(aph, npcb->npcb_vci);
630       ATM_PH_FLAGS(aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
631
632       error = atm_output(npcb->npcb_ifp, m, NULL, NULL);
633
634       break;
635
636     case PRU_SENSE:                     /* return status into m */
637       /* return zero? */
638       break;
639
640     case PRU_PEERADDR:                  /* fetch peer's address */
641       snatm = mtod(nam, struct sockaddr_natm *);
642       bzero(snatm, sizeof(*snatm));
643       nam->m_len = snatm->snatm_len = sizeof(*snatm);
644       snatm->snatm_family = AF_NATM;
645 #if defined(__NetBSD__) || defined(__OpenBSD__) || defined(__DragonFly__)
646       bcopy(npcb->npcb_ifp->if_xname, snatm->snatm_if, sizeof(snatm->snatm_if));
647 #elif defined(__DragonFly__)
648       ksnprintf(snatm->snatm_if, sizeof(snatm->snatm_if),
649         "%s%d", npcb->npcb_ifp->if_name, npcb->npcb_ifp->if_unit);
650 #endif
651       snatm->snatm_vci = npcb->npcb_vci;
652       snatm->snatm_vpi = npcb->npcb_vpi;
653       break;
654
655     case PRU_CONTROL:                   /* control operations on protocol */
656       /*
657        * raw atm ioctl.   comes in as a SIOCRAWATM.   we convert it to
658        * SIOCXRAWATM and pass it to the driver.
659        */
660       if ((u_long)m == SIOCRAWATM) {
661         if (npcb->npcb_ifp == NULL) {
662           error = ENOTCONN;
663           break;
664         }
665         ario.npcb = npcb;
666         ario.rawvalue = *((int *)nam);
667         ifnet_serialize_all(npcb->npcb_ifp);
668         error = npcb->npcb_ifp->if_ioctl(npcb->npcb_ifp, SIOCXRAWATM,
669                                          (caddr_t) &ario, NULL);
670         ifnet_deserialize_all(npcb->npcb_ifp);
671         if (!error) {
672           if (ario.rawvalue) 
673             npcb->npcb_flags |= NPCB_RAW;
674           else
675             npcb->npcb_flags &= ~(NPCB_RAW);
676         }
677
678         break;
679       }
680
681       error = EOPNOTSUPP;
682       break;
683
684     case PRU_BIND:                      /* bind socket to address */
685     case PRU_LISTEN:                    /* listen for connection */
686     case PRU_ACCEPT:                    /* accept connection from peer */
687     case PRU_CONNECT2:                  /* connect two sockets */
688     case PRU_ABORT:                     /* abort (fast DISCONNECT, DETATCH) */
689                                         /* (only happens if LISTEN socket) */
690     case PRU_RCVD:                      /* have taken data; more room now */
691     case PRU_FASTTIMO:                  /* 200ms timeout */
692     case PRU_SLOWTIMO:                  /* 500ms timeout */
693     case PRU_RCVOOB:                    /* retrieve out of band data */
694     case PRU_SENDOOB:                   /* send out of band data */
695     case PRU_PROTORCV:                  /* receive from below */
696     case PRU_PROTOSEND:                 /* send to below */
697     case PRU_SOCKADDR:                  /* fetch socket's address */
698 #ifdef DIAGNOSTIC
699       kprintf("natm: PRU #%d unsupported\n", req);
700 #endif
701       error = EOPNOTSUPP;
702       break;
703    
704     default: panic("natm usrreq");
705   }
706
707 done:
708   crit_exit();
709   return(error);
710 }
711
712 #endif  /* !FREEBSD_USRREQS */
713
714 /* 
715  * natm0_sysctl: not used, but here in case we want to add something
716  * later...
717  */
718
719 int
720 natm0_sysctl(int *name, u_int namelen, void *oldp, size_t *oldlenp,
721              void *newp, size_t newlen)
722 {
723   /* All sysctl names at this level are terminal. */
724   if (namelen != 1)
725     return (ENOTDIR);
726   return (ENOPROTOOPT);
727 }
728
729 /* 
730  * natm5_sysctl: not used, but here in case we want to add something
731  * later...
732  */
733
734 int
735 natm5_sysctl(int *name, u_int namelen, void *oldp, size_t *oldlenp,
736              void *newp, size_t newlen)
737 {
738   /* All sysctl names at this level are terminal. */
739   if (namelen != 1)
740     return (ENOTDIR);
741   return (ENOPROTOOPT);
742 }
743
744 static void natmintr(struct netmsg *);
745
746 #if defined(__DragonFly__)
747 static void
748 netisr_natm_setup(void *dummy __unused)
749 {
750         netisr_register(NETISR_NATM, cpu0_portfn, pktinfo_portfn_cpu0,
751                         natmintr, NETISR_FLAG_NOTMPSAFE);
752 }
753 SYSINIT(natm_setup, SI_BOOT2_KLD, SI_ORDER_ANY, netisr_natm_setup, NULL);
754 #endif
755
756 void
757 natm_init(void)
758 {
759   LIST_INIT(&natm_pcbs);
760
761   netisr_register(NETISR_NATM, cpu0_portfn, pktinfo_portfn_cpu0,
762                   natmintr, NETISR_FLAG_NOTMPSAFE);
763 }
764
765 /*
766  * natmintr: software interrupt
767  *
768  * note: we expect a socket pointer in rcvif rather than an interface
769  * pointer.    we can get the interface pointer from the so's PCB if
770  * we really need it.
771  */
772 static void
773 natmintr(struct netmsg *msg)
774 {
775   struct mbuf *m = ((struct netmsg_packet *)msg)->nm_packet;
776   struct socket *so;
777   struct natmpcb *npcb;
778
779 #ifdef DIAGNOSTIC
780   if ((m->m_flags & M_PKTHDR) == 0)
781     panic("natmintr no HDR");
782 #endif
783
784   npcb = (struct natmpcb *) m->m_pkthdr.rcvif; /* XXX: overloaded */
785   so = npcb->npcb_socket;
786
787   crit_enter();
788   npcb->npcb_inq--;
789   crit_exit();
790
791   if (npcb->npcb_flags & NPCB_DRAIN) {
792     m_freem(m);
793     if (npcb->npcb_inq == 0)
794       FREE(npcb, M_PCB);                        /* done! */
795     goto out;
796   }
797
798   if (npcb->npcb_flags & NPCB_FREE) {
799     m_freem(m);                                 /* drop */
800     goto out;
801   }
802
803 #ifdef NEED_TO_RESTORE_IFP
804   m->m_pkthdr.rcvif = npcb->npcb_ifp;
805 #else
806 #ifdef DIAGNOSTIC
807 m->m_pkthdr.rcvif = NULL;       /* null it out to be safe */
808 #endif
809 #endif
810
811   if (ssb_space(&so->so_rcv) > m->m_pkthdr.len ||
812      ((npcb->npcb_flags & NPCB_RAW) != 0 && so->so_rcv.ssb_cc < NPCB_RAWCC) ) {
813 #ifdef NATM_STAT
814     natm_sookcnt++;
815     natm_sookbytes += m->m_pkthdr.len;
816 #endif
817     sbappendrecord(&so->so_rcv.sb, m);
818     sorwakeup(so);
819   } else {
820 #ifdef NATM_STAT
821     natm_sodropcnt++;
822     natm_sodropbytes += m->m_pkthdr.len;
823 #endif
824     m_freem(m);
825   }
826 out:
827   ;
828   /* msg was embedded in the mbuf, do not reply! */
829 }
830