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.18 2005/06/10 22:34:51 dillon Exp $ */
7 * Copyright (c) 1996 Charles D. Cranor and Washington University.
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
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.
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.
38 * natm.c: native mode ATM access (both aal0 and aal5).
41 #include <sys/param.h>
42 #include <sys/systm.h>
43 #include <sys/kernel.h>
45 #include <sys/sockio.h>
46 #include <sys/protosw.h>
47 #include <sys/malloc.h>
49 #include <sys/socket.h>
50 #include <sys/socketvar.h>
52 #include <sys/thread2.h>
53 #include <sys/msgport2.h>
56 #include <net/if_atm.h>
57 #include <net/netisr.h>
59 #include <netinet/in.h>
63 static u_long natm5_sendspace = 16*1024;
64 static u_long natm5_recvspace = 16*1024;
66 static u_long natm0_sendspace = 16*1024;
67 static u_long natm0_recvspace = 16*1024;
72 #ifdef FREEBSD_USRREQS
74 * FreeBSD new usrreqs supersedes pr_usrreq.
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 *,
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 *,
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 *,
91 static int natm_usr_sockaddr (struct socket *, struct sockaddr **);
94 natm_usr_attach(struct socket *so, int proto, struct pru_attach_info *ai)
100 npcb = (struct natmpcb *) so->so_pcb;
107 if (so->so_snd.sb_hiwat == 0 || so->so_rcv.sb_hiwat == 0) {
108 if (proto == PROTO_NATMAAL5)
109 error = soreserve(so, natm5_sendspace, natm5_recvspace,
112 error = soreserve(so, natm0_sendspace, natm0_recvspace,
118 so->so_pcb = (caddr_t) (npcb = npcb_alloc(M_WAITOK));
119 npcb->npcb_socket = so;
126 natm_usr_detach(struct socket *so)
128 struct natmpcb *npcb;
132 npcb = (struct natmpcb *) so->so_pcb;
139 * we turn on 'drain' *before* we sofree.
141 npcb_free(npcb, NPCB_DESTROY); /* drain */
150 natm_usr_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
152 struct natmpcb *npcb;
153 struct sockaddr_natm *snatm;
154 struct atm_pseudoioctl api;
160 proto = so->so_proto->pr_protocol;
161 npcb = (struct natmpcb *) so->so_pcb;
168 * validate nam and npcb
171 snatm = (struct sockaddr_natm *)nam;
172 if (snatm->snatm_len != sizeof(*snatm) ||
173 (npcb->npcb_flags & NPCB_FREE) == 0) {
177 if (snatm->snatm_family != AF_NATM) {
178 error = EAFNOSUPPORT;
182 snatm->snatm_if[IFNAMSIZ-1] = '\0'; /* XXX ensure null termination
183 since ifunit() uses strcmp */
186 * convert interface string to ifp, validate.
189 ifp = ifunit(snatm->snatm_if);
190 if (ifp == NULL || (ifp->if_flags & IFF_RUNNING) == 0) {
194 if (ifp->if_output != atm_output) {
195 error = EAFNOSUPPORT;
200 * register us with the NATM PCB layer
203 if (npcb_add(npcb, ifp, snatm->snatm_vci, snatm->snatm_vpi) != npcb) {
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);
217 if (ifp->if_ioctl == NULL ||
218 ifp->if_ioctl(ifp, SIOCATMENA, (caddr_t) &api,
219 td->td_proc->p_ucred) != 0) {
221 npcb_free(npcb, NPCB_REMOVE);
235 natm_usr_disconnect(struct socket *so)
237 struct natmpcb *npcb;
238 struct atm_pseudoioctl api;
243 npcb = (struct natmpcb *) so->so_pcb;
249 if ((npcb->npcb_flags & NPCB_CONNECTED) == 0) {
250 printf("natm: disconnected check\n");
254 ifp = npcb->npcb_ifp;
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);
265 if (ifp->if_ioctl != NULL)
266 ifp->if_ioctl(ifp, SIOCATMDIS, (caddr_t) &api, (struct ucred *)NULL);
269 npcb_free(npcb, NPCB_REMOVE);
270 soisdisconnected(so);
278 natm_usr_shutdown(struct socket *so)
285 natm_usr_send(struct socket *so, int flags, struct mbuf *m,
286 struct sockaddr *nam, struct mbuf *control, struct thread *td)
288 struct natmpcb *npcb;
289 struct atm_pseudohdr *aph;
291 int proto = so->so_proto->pr_protocol;
295 npcb = (struct natmpcb *) so->so_pcb;
301 if (control && control->m_len) {
309 * send the data. we must put an atm_pseudohdr on first
312 M_PREPEND(m, sizeof(*aph), M_WAITOK);
317 aph = mtod(m, struct atm_pseudohdr *);
318 ATM_PH_VPI(aph) = npcb->npcb_vpi;
319 ATM_PH_SETVCI(aph, npcb->npcb_vci);
320 ATM_PH_FLAGS(aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
322 error = atm_output(npcb->npcb_ifp, m, NULL, NULL);
330 natm_usr_peeraddr(struct socket *so, struct sockaddr **nam)
332 struct natmpcb *npcb;
333 struct sockaddr_natm *snatm, ssnatm;
337 npcb = (struct natmpcb *) so->so_pcb;
344 bzero(snatm, sizeof(*snatm));
345 snatm->snatm_len = sizeof(*snatm);
346 snatm->snatm_family = AF_NATM;
347 strlcpy(snatm->snatm_if, npcb->npcb_ifp->if_xname,
348 sizeof(snatm->snatm_if));
349 snatm->snatm_vci = npcb->npcb_vci;
350 snatm->snatm_vpi = npcb->npcb_vpi;
351 *nam = dup_sockaddr((struct sockaddr *)snatm);
359 natm_usr_control(struct socket *so, u_long cmd, caddr_t arg,
360 struct ifnet *ifp, struct thread *td)
362 struct natmpcb *npcb;
363 struct atm_rawioctl ario;
368 npcb = (struct natmpcb *) so->so_pcb;
375 * raw atm ioctl. comes in as a SIOCRAWATM. we convert it to
376 * SIOCXRAWATM and pass it to the driver.
378 if (cmd == SIOCRAWATM) {
379 if (npcb->npcb_ifp == NULL) {
384 ario.rawvalue = *((int *)arg);
385 error = npcb->npcb_ifp->if_ioctl(npcb->npcb_ifp,
386 SIOCXRAWATM, (caddr_t) &ario,
387 td->td_proc->p_ucred);
390 npcb->npcb_flags |= NPCB_RAW;
392 npcb->npcb_flags &= ~(NPCB_RAW);
404 natm_usr_abort(struct socket *so)
406 return natm_usr_shutdown(so);
410 natm_usr_bind(struct socket *so, struct sockaddr *nam, struct thread *td)
416 natm_usr_sockaddr(struct socket *so, struct sockaddr **nam)
421 /* xxx - should be const */
422 struct pr_usrreqs natm_usrreqs = {
423 natm_usr_abort, pru_accept_notsupp, natm_usr_attach, natm_usr_bind,
424 natm_usr_connect, pru_connect2_notsupp, natm_usr_control,
425 natm_usr_detach, natm_usr_disconnect, pru_listen_notsupp,
426 natm_usr_peeraddr, pru_rcvd_notsupp, pru_rcvoob_notsupp,
427 natm_usr_send, pru_sense_null, natm_usr_shutdown,
428 natm_usr_sockaddr, sosend, soreceive, sopoll
431 #else /* !FREEBSD_USRREQS */
433 #if defined(__NetBSD__) || defined(__OpenBSD__)
434 int natm_usrreq(so, req, m, nam, control, p)
435 #elif defined(__DragonFly__)
436 int natm_usrreq(so, req, m, nam, control)
441 struct mbuf *m, *nam, *control;
442 #if defined(__NetBSD__) || defined(__OpenBSD__)
448 struct natmpcb *npcb;
449 struct sockaddr_natm *snatm;
450 struct atm_pseudoioctl api;
451 struct atm_pseudohdr *aph;
452 struct atm_rawioctl ario;
454 int proto = so->so_proto->pr_protocol;
458 npcb = (struct natmpcb *) so->so_pcb;
460 if (npcb == NULL && req != PRU_ATTACH) {
467 case PRU_ATTACH: /* attach protocol to up */
474 if (so->so_snd.sb_hiwat == 0 || so->so_rcv.sb_hiwat == 0) {
475 if (proto == PROTO_NATMAAL5)
476 error = soreserve(so, natm5_sendspace, natm5_recvspace);
478 error = soreserve(so, natm0_sendspace, natm0_recvspace);
483 so->so_pcb = (caddr_t) (npcb = npcb_alloc(M_WAITOK));
484 npcb->npcb_socket = so;
488 case PRU_DETACH: /* detach protocol from up */
491 * we turn on 'drain' *before* we sofree.
494 npcb_free(npcb, NPCB_DESTROY); /* drain */
500 case PRU_CONNECT: /* establish connection to peer */
503 * validate nam and npcb
506 if (nam->m_len != sizeof(*snatm)) {
510 snatm = mtod(nam, struct sockaddr_natm *);
511 if (snatm->snatm_len != sizeof(*snatm) ||
512 (npcb->npcb_flags & NPCB_FREE) == 0) {
516 if (snatm->snatm_family != AF_NATM) {
517 error = EAFNOSUPPORT;
521 snatm->snatm_if[IFNAMSIZ-1] = '\0'; /* XXX ensure null termination
522 since ifunit() uses strcmp */
525 * convert interface string to ifp, validate.
528 ifp = ifunit(snatm->snatm_if);
529 if (ifp == NULL || (ifp->if_flags & IFF_RUNNING) == 0) {
533 if (ifp->if_output != atm_output) {
534 error = EAFNOSUPPORT;
540 * register us with the NATM PCB layer
543 if (npcb_add(npcb, ifp, snatm->snatm_vci, snatm->snatm_vpi) != npcb) {
552 ATM_PH_FLAGS(&api.aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
553 ATM_PH_VPI(&api.aph) = npcb->npcb_vpi;
554 ATM_PH_SETVCI(&api.aph, npcb->npcb_vci);
557 if (ifp->if_ioctl == NULL ||
558 ifp->if_ioctl(ifp, SIOCATMENA, (caddr_t) &api,
559 (struct ucred *)NULL) != 0) {
561 npcb_free(npcb, NPCB_REMOVE);
571 case PRU_DISCONNECT: /* disconnect from peer */
573 if ((npcb->npcb_flags & NPCB_CONNECTED) == 0) {
574 printf("natm: disconnected check\n");
578 ifp = npcb->npcb_ifp;
584 ATM_PH_FLAGS(&api.aph) = ATM_PH_AAL5;
585 ATM_PH_VPI(&api.aph) = npcb->npcb_vpi;
586 ATM_PH_SETVCI(&api.aph, npcb->npcb_vci);
589 if (ifp->if_ioctl != NULL)
590 ifp->if_ioctl(ifp, SIOCATMDIS, (caddr_t) &api, (struct ucred *)NULL);
593 npcb_free(npcb, NPCB_REMOVE);
594 soisdisconnected(so);
598 case PRU_SHUTDOWN: /* won't send any more data */
602 case PRU_SEND: /* send this data */
603 if (control && control->m_len) {
611 * send the data. we must put an atm_pseudohdr on first
614 M_PREPEND(m, sizeof(*aph), M_WAITOK);
619 aph = mtod(m, struct atm_pseudohdr *);
620 ATM_PH_VPI(aph) = npcb->npcb_vpi;
621 ATM_PH_SETVCI(aph, npcb->npcb_vci);
622 ATM_PH_FLAGS(aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
624 error = atm_output(npcb->npcb_ifp, m, NULL, NULL);
628 case PRU_SENSE: /* return status into m */
632 case PRU_PEERADDR: /* fetch peer's address */
633 snatm = mtod(nam, struct sockaddr_natm *);
634 bzero(snatm, sizeof(*snatm));
635 nam->m_len = snatm->snatm_len = sizeof(*snatm);
636 snatm->snatm_family = AF_NATM;
637 #if defined(__NetBSD__) || defined(__OpenBSD__) || defined(__DragonFly__)
638 bcopy(npcb->npcb_ifp->if_xname, snatm->snatm_if, sizeof(snatm->snatm_if));
639 #elif defined(__DragonFly__)
640 snprintf(snatm->snatm_if, sizeof(snatm->snatm_if),
641 "%s%d", npcb->npcb_ifp->if_name, npcb->npcb_ifp->if_unit);
643 snatm->snatm_vci = npcb->npcb_vci;
644 snatm->snatm_vpi = npcb->npcb_vpi;
647 case PRU_CONTROL: /* control operations on protocol */
649 * raw atm ioctl. comes in as a SIOCRAWATM. we convert it to
650 * SIOCXRAWATM and pass it to the driver.
652 if ((u_long)m == SIOCRAWATM) {
653 if (npcb->npcb_ifp == NULL) {
658 ario.rawvalue = *((int *)nam);
659 error = npcb->npcb_ifp->if_ioctl(npcb->npcb_ifp, SIOCXRAWATM,
660 (caddr_t) &ario, (struct ucred *)NULL);
663 npcb->npcb_flags |= NPCB_RAW;
665 npcb->npcb_flags &= ~(NPCB_RAW);
674 case PRU_BIND: /* bind socket to address */
675 case PRU_LISTEN: /* listen for connection */
676 case PRU_ACCEPT: /* accept connection from peer */
677 case PRU_CONNECT2: /* connect two sockets */
678 case PRU_ABORT: /* abort (fast DISCONNECT, DETATCH) */
679 /* (only happens if LISTEN socket) */
680 case PRU_RCVD: /* have taken data; more room now */
681 case PRU_FASTTIMO: /* 200ms timeout */
682 case PRU_SLOWTIMO: /* 500ms timeout */
683 case PRU_RCVOOB: /* retrieve out of band data */
684 case PRU_SENDOOB: /* send out of band data */
685 case PRU_PROTORCV: /* receive from below */
686 case PRU_PROTOSEND: /* send to below */
687 case PRU_SOCKADDR: /* fetch socket's address */
689 printf("natm: PRU #%d unsupported\n", req);
694 default: panic("natm usrreq");
702 #endif /* !FREEBSD_USRREQS */
705 * natm0_sysctl: not used, but here in case we want to add something
709 int natm0_sysctl(int *name, u_int namelen, void *oldp, size_t *oldlenp,
710 void *newp, size_t newlen)
712 /* All sysctl names at this level are terminal. */
715 return (ENOPROTOOPT);
719 * natm5_sysctl: not used, but here in case we want to add something
723 int natm5_sysctl(int *name, u_int namelen, void *oldp, size_t *oldlenp,
724 void *newp, size_t newlen)
726 /* All sysctl names at this level are terminal. */
729 return (ENOPROTOOPT);
732 static int natmintr(struct netmsg *);
734 #if defined(__DragonFly__)
736 netisr_natm_setup(void *dummy __unused)
739 netisr_register(NETISR_NATM, cpu0_portfn, natmintr);
741 SYSINIT(natm_setup, SI_SUB_CPU, SI_ORDER_ANY, netisr_natm_setup, NULL);
747 LIST_INIT(&natm_pcbs);
749 netisr_register(NETISR_NATM, cpu0_portfn, natmintr);
753 * natmintr: software interrupt
755 * note: we expect a socket pointer in rcvif rather than an interface
756 * pointer. we can get the interface pointer from the so's PCB if
760 natmintr(struct netmsg *msg)
762 struct mbuf *m = ((struct netmsg_packet *)msg)->nm_packet;
764 struct natmpcb *npcb;
767 if ((m->m_flags & M_PKTHDR) == 0)
768 panic("natmintr no HDR");
771 npcb = (struct natmpcb *) m->m_pkthdr.rcvif; /* XXX: overloaded */
772 so = npcb->npcb_socket;
778 if (npcb->npcb_flags & NPCB_DRAIN) {
780 if (npcb->npcb_inq == 0)
781 FREE(npcb, M_PCB); /* done! */
785 if (npcb->npcb_flags & NPCB_FREE) {
786 m_freem(m); /* drop */
790 #ifdef NEED_TO_RESTORE_IFP
791 m->m_pkthdr.rcvif = npcb->npcb_ifp;
794 m->m_pkthdr.rcvif = NULL; /* null it out to be safe */
798 if (sbspace(&so->so_rcv) > m->m_pkthdr.len ||
799 ((npcb->npcb_flags & NPCB_RAW) != 0 && so->so_rcv.sb_cc < NPCB_RAWCC) ) {
802 natm_sookbytes += m->m_pkthdr.len;
804 sbappendrecord(&so->so_rcv, m);
809 natm_sodropbytes += m->m_pkthdr.len;
814 lwkt_replymsg(&msg->nm_lmsg, 0);