Home | History | Annotate | Line # | Download | only in net
raw_usrreq.c revision 1.24
      1 /*	$NetBSD: raw_usrreq.c,v 1.24 2005/12/11 12:24:52 christos Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 1980, 1986, 1993
      5  *	The Regents of the University of California.  All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  * 3. Neither the name of the University nor the names of its contributors
     16  *    may be used to endorse or promote products derived from this software
     17  *    without specific prior written permission.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     22  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     23  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29  * SUCH DAMAGE.
     30  *
     31  *	@(#)raw_usrreq.c	8.1 (Berkeley) 6/10/93
     32  */
     33 
     34 #include <sys/cdefs.h>
     35 __KERNEL_RCSID(0, "$NetBSD: raw_usrreq.c,v 1.24 2005/12/11 12:24:52 christos Exp $");
     36 
     37 #include <sys/param.h>
     38 #include <sys/mbuf.h>
     39 #include <sys/domain.h>
     40 #include <sys/protosw.h>
     41 #include <sys/socket.h>
     42 #include <sys/socketvar.h>
     43 #include <sys/errno.h>
     44 #include <sys/systm.h>
     45 #include <sys/proc.h>
     46 
     47 #include <net/if.h>
     48 #include <net/route.h>
     49 #include <net/netisr.h>
     50 #include <net/raw_cb.h>
     51 
     52 #include <machine/stdarg.h>
     53 /*
     54  * Initialize raw connection block q.
     55  */
     56 void
     57 raw_init()
     58 {
     59 
     60 	LIST_INIT(&rawcb);
     61 }
     62 
     63 
     64 /*
     65  * Raw protocol input routine.  Find the socket
     66  * associated with the packet(s) and move them over.  If
     67  * nothing exists for this packet, drop it.
     68  */
     69 /*
     70  * Raw protocol interface.
     71  */
     72 void
     73 raw_input(struct mbuf *m0, ...)
     74 {
     75 	struct rawcb *rp;
     76 	struct mbuf *m = m0;
     77 	int sockets = 0;
     78 	struct socket *last;
     79 	va_list ap;
     80 	struct sockproto *proto;
     81 	struct sockaddr *src, *dst;
     82 
     83 	va_start(ap, m0);
     84 	proto = va_arg(ap, struct sockproto *);
     85 	src = va_arg(ap, struct sockaddr *);
     86 	dst = va_arg(ap, struct sockaddr *);
     87 	va_end(ap);
     88 
     89 	last = 0;
     90 	LIST_FOREACH(rp, &rawcb, rcb_list) {
     91 		if (rp->rcb_proto.sp_family != proto->sp_family)
     92 			continue;
     93 		if (rp->rcb_proto.sp_protocol  &&
     94 		    rp->rcb_proto.sp_protocol != proto->sp_protocol)
     95 			continue;
     96 		/*
     97 		 * We assume the lower level routines have
     98 		 * placed the address in a canonical format
     99 		 * suitable for a structure comparison.
    100 		 *
    101 		 * Note that if the lengths are not the same
    102 		 * the comparison will fail at the first byte.
    103 		 */
    104 #define	equal(a1, a2) \
    105   (bcmp((caddr_t)(a1), (caddr_t)(a2), a1->sa_len) == 0)
    106 		if (rp->rcb_laddr && !equal(rp->rcb_laddr, dst))
    107 			continue;
    108 		if (rp->rcb_faddr && !equal(rp->rcb_faddr, src))
    109 			continue;
    110 		if (last) {
    111 			struct mbuf *n;
    112 			if ((n = m_copy(m, 0, (int)M_COPYALL)) != NULL) {
    113 				if (sbappendaddr(&last->so_rcv, src,
    114 				    n, (struct mbuf *)0) == 0)
    115 					/* should notify about lost packet */
    116 					m_freem(n);
    117 				else {
    118 					sorwakeup(last);
    119 					sockets++;
    120 				}
    121 			}
    122 		}
    123 		last = rp->rcb_socket;
    124 	}
    125 	if (last) {
    126 		if (sbappendaddr(&last->so_rcv, src,
    127 		    m, (struct mbuf *)0) == 0)
    128 			m_freem(m);
    129 		else {
    130 			sorwakeup(last);
    131 			sockets++;
    132 		}
    133 	} else
    134 		m_freem(m);
    135 }
    136 
    137 /*ARGSUSED*/
    138 void *
    139 raw_ctlinput(cmd, arg, d)
    140 	int cmd;
    141 	struct sockaddr *arg;
    142 	void *d;
    143 {
    144 
    145 	if ((unsigned)cmd >= PRC_NCMDS)
    146 		return NULL;
    147 	return NULL;
    148 	/* INCOMPLETE */
    149 }
    150 
    151 void
    152 raw_setsockaddr(rp, nam)
    153 	struct rawcb *rp;
    154 	struct mbuf *nam;
    155 {
    156 
    157 	nam->m_len = rp->rcb_laddr->sa_len;
    158 	bcopy(rp->rcb_laddr, mtod(nam, caddr_t), (size_t)nam->m_len);
    159 }
    160 
    161 void
    162 raw_setpeeraddr(rp, nam)
    163 	struct rawcb *rp;
    164 	struct mbuf *nam;
    165 {
    166 
    167 	nam->m_len = rp->rcb_faddr->sa_len;
    168 	bcopy(rp->rcb_faddr, mtod(nam, caddr_t), (size_t)nam->m_len);
    169 }
    170 
    171 /*ARGSUSED*/
    172 int
    173 raw_usrreq(so, req, m, nam, control, l)
    174 	struct socket *so;
    175 	int req;
    176 	struct mbuf *m, *nam, *control;
    177 	struct lwp *l;
    178 {
    179 	struct rawcb *rp;
    180 	struct proc *p;
    181 	int s;
    182 	int error = 0;
    183 
    184 	if (req == PRU_CONTROL)
    185 		return (EOPNOTSUPP);
    186 
    187 	p = l ? l->l_proc : NULL;
    188 	s = splsoftnet();
    189 	rp = sotorawcb(so);
    190 #ifdef DIAGNOSTIC
    191 	if (req != PRU_SEND && req != PRU_SENDOOB && control)
    192 		panic("raw_usrreq: unexpected control mbuf");
    193 #endif
    194 	if (rp == 0 && req != PRU_ATTACH) {
    195 		error = EINVAL;
    196 		goto release;
    197 	}
    198 
    199 	switch (req) {
    200 
    201 	/*
    202 	 * Allocate a raw control block and fill in the
    203 	 * necessary info to allow packets to be routed to
    204 	 * the appropriate raw interface routine.
    205 	 */
    206 	case PRU_ATTACH:
    207 		if (p == 0 || (error = suser(p->p_ucred, &p->p_acflag))) {
    208 			error = EACCES;
    209 			break;
    210 		}
    211 		error = raw_attach(so, (int)(long)nam);
    212 		break;
    213 
    214 	/*
    215 	 * Destroy state just before socket deallocation.
    216 	 * Flush data or not depending on the options.
    217 	 */
    218 	case PRU_DETACH:
    219 		raw_detach(rp);
    220 		break;
    221 
    222 	/*
    223 	 * If a socket isn't bound to a single address,
    224 	 * the raw input routine will hand it anything
    225 	 * within that protocol family (assuming there's
    226 	 * nothing else around it should go to).
    227 	 */
    228 	case PRU_BIND:
    229 	case PRU_LISTEN:
    230 	case PRU_CONNECT:
    231 	case PRU_CONNECT2:
    232 		error = EOPNOTSUPP;
    233 		break;
    234 
    235 	case PRU_DISCONNECT:
    236 		soisdisconnected(so);
    237 		raw_disconnect(rp);
    238 		break;
    239 
    240 	/*
    241 	 * Mark the connection as being incapable of further input.
    242 	 */
    243 	case PRU_SHUTDOWN:
    244 		socantsendmore(so);
    245 		break;
    246 
    247 	case PRU_RCVD:
    248 		error = EOPNOTSUPP;
    249 		break;
    250 
    251 	/*
    252 	 * Ship a packet out.  The appropriate raw output
    253 	 * routine handles any massaging necessary.
    254 	 */
    255 	case PRU_SEND:
    256 		if (control && control->m_len) {
    257 			m_freem(control);
    258 			m_freem(m);
    259 			error = EINVAL;
    260 			break;
    261 		}
    262 		if (nam) {
    263 			if ((so->so_state & SS_ISCONNECTED) != 0) {
    264 				error = EISCONN;
    265 				goto die;
    266 			}
    267 			error = (*so->so_proto->pr_usrreq)(so, PRU_CONNECT,
    268 			    (struct mbuf *)0, nam, (struct mbuf *)0, l);
    269 			if (error) {
    270 			die:
    271 				m_freem(m);
    272 				break;
    273 			}
    274 		} else {
    275 			if ((so->so_state & SS_ISCONNECTED) == 0) {
    276 				error = ENOTCONN;
    277 				goto die;
    278 			}
    279 		}
    280 		error = (*so->so_proto->pr_output)(m, so);
    281 		if (nam)
    282 			raw_disconnect(rp);
    283 		break;
    284 
    285 	case PRU_SENSE:
    286 		/*
    287 		 * stat: don't bother with a blocksize.
    288 		 */
    289 		return (0);
    290 
    291 	/*
    292 	 * Not supported.
    293 	 */
    294 	case PRU_RCVOOB:
    295 		error = EOPNOTSUPP;
    296 		break;
    297 
    298 	case PRU_SENDOOB:
    299 		m_freem(control);
    300 		m_freem(m);
    301 		error = EOPNOTSUPP;
    302 		break;
    303 
    304 	case PRU_SOCKADDR:
    305 		if (rp->rcb_laddr == 0) {
    306 			error = EINVAL;
    307 			break;
    308 		}
    309 		raw_setsockaddr(rp, nam);
    310 		break;
    311 
    312 	case PRU_PEERADDR:
    313 		if (rp->rcb_faddr == 0) {
    314 			error = ENOTCONN;
    315 			break;
    316 		}
    317 		raw_setpeeraddr(rp, nam);
    318 		break;
    319 
    320 	default:
    321 		panic("raw_usrreq");
    322 	}
    323 
    324 release:
    325 	splx(s);
    326 	return (error);
    327 }
    328