raw_usrreq.c revision 1.25 1 /* $NetBSD: raw_usrreq.c,v 1.25 2005/12/11 23:05:25 thorpej 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.25 2005/12/11 23:05:25 thorpej 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(void)
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(int cmd, struct sockaddr *arg, void *d)
140 {
141
142 if ((unsigned)cmd >= PRC_NCMDS)
143 return NULL;
144 return NULL;
145 /* INCOMPLETE */
146 }
147
148 void
149 raw_setsockaddr(struct rawcb *rp, struct mbuf *nam)
150 {
151
152 nam->m_len = rp->rcb_laddr->sa_len;
153 bcopy(rp->rcb_laddr, mtod(nam, caddr_t), (size_t)nam->m_len);
154 }
155
156 void
157 raw_setpeeraddr(struct rawcb *rp, struct mbuf *nam)
158 {
159
160 nam->m_len = rp->rcb_faddr->sa_len;
161 bcopy(rp->rcb_faddr, mtod(nam, caddr_t), (size_t)nam->m_len);
162 }
163
164 /*ARGSUSED*/
165 int
166 raw_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam,
167 struct mbuf *control, struct lwp *l)
168 {
169 struct rawcb *rp;
170 struct proc *p;
171 int s;
172 int error = 0;
173
174 if (req == PRU_CONTROL)
175 return (EOPNOTSUPP);
176
177 p = l ? l->l_proc : NULL;
178 s = splsoftnet();
179 rp = sotorawcb(so);
180 #ifdef DIAGNOSTIC
181 if (req != PRU_SEND && req != PRU_SENDOOB && control)
182 panic("raw_usrreq: unexpected control mbuf");
183 #endif
184 if (rp == 0 && req != PRU_ATTACH) {
185 error = EINVAL;
186 goto release;
187 }
188
189 switch (req) {
190
191 /*
192 * Allocate a raw control block and fill in the
193 * necessary info to allow packets to be routed to
194 * the appropriate raw interface routine.
195 */
196 case PRU_ATTACH:
197 if (p == 0 || (error = suser(p->p_ucred, &p->p_acflag))) {
198 error = EACCES;
199 break;
200 }
201 error = raw_attach(so, (int)(long)nam);
202 break;
203
204 /*
205 * Destroy state just before socket deallocation.
206 * Flush data or not depending on the options.
207 */
208 case PRU_DETACH:
209 raw_detach(rp);
210 break;
211
212 /*
213 * If a socket isn't bound to a single address,
214 * the raw input routine will hand it anything
215 * within that protocol family (assuming there's
216 * nothing else around it should go to).
217 */
218 case PRU_BIND:
219 case PRU_LISTEN:
220 case PRU_CONNECT:
221 case PRU_CONNECT2:
222 error = EOPNOTSUPP;
223 break;
224
225 case PRU_DISCONNECT:
226 soisdisconnected(so);
227 raw_disconnect(rp);
228 break;
229
230 /*
231 * Mark the connection as being incapable of further input.
232 */
233 case PRU_SHUTDOWN:
234 socantsendmore(so);
235 break;
236
237 case PRU_RCVD:
238 error = EOPNOTSUPP;
239 break;
240
241 /*
242 * Ship a packet out. The appropriate raw output
243 * routine handles any massaging necessary.
244 */
245 case PRU_SEND:
246 if (control && control->m_len) {
247 m_freem(control);
248 m_freem(m);
249 error = EINVAL;
250 break;
251 }
252 if (nam) {
253 if ((so->so_state & SS_ISCONNECTED) != 0) {
254 error = EISCONN;
255 goto die;
256 }
257 error = (*so->so_proto->pr_usrreq)(so, PRU_CONNECT,
258 (struct mbuf *)0, nam, (struct mbuf *)0, l);
259 if (error) {
260 die:
261 m_freem(m);
262 break;
263 }
264 } else {
265 if ((so->so_state & SS_ISCONNECTED) == 0) {
266 error = ENOTCONN;
267 goto die;
268 }
269 }
270 error = (*so->so_proto->pr_output)(m, so);
271 if (nam)
272 raw_disconnect(rp);
273 break;
274
275 case PRU_SENSE:
276 /*
277 * stat: don't bother with a blocksize.
278 */
279 return (0);
280
281 /*
282 * Not supported.
283 */
284 case PRU_RCVOOB:
285 error = EOPNOTSUPP;
286 break;
287
288 case PRU_SENDOOB:
289 m_freem(control);
290 m_freem(m);
291 error = EOPNOTSUPP;
292 break;
293
294 case PRU_SOCKADDR:
295 if (rp->rcb_laddr == 0) {
296 error = EINVAL;
297 break;
298 }
299 raw_setsockaddr(rp, nam);
300 break;
301
302 case PRU_PEERADDR:
303 if (rp->rcb_faddr == 0) {
304 error = ENOTCONN;
305 break;
306 }
307 raw_setpeeraddr(rp, nam);
308 break;
309
310 default:
311 panic("raw_usrreq");
312 }
313
314 release:
315 splx(s);
316 return (error);
317 }
318