raw_usrreq.c revision 1.41 1 /* $NetBSD: raw_usrreq.c,v 1.41 2014/07/06 03:33:33 rtr 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 /*
35 * Raw protocol interface.
36 */
37
38 #include <sys/cdefs.h>
39 __KERNEL_RCSID(0, "$NetBSD: raw_usrreq.c,v 1.41 2014/07/06 03:33:33 rtr Exp $");
40
41 #include <sys/param.h>
42 #include <sys/mbuf.h>
43 #include <sys/domain.h>
44 #include <sys/protosw.h>
45 #include <sys/socket.h>
46 #include <sys/socketvar.h>
47 #include <sys/errno.h>
48 #include <sys/systm.h>
49 #include <sys/proc.h>
50 #include <sys/kauth.h>
51
52 #include <net/if.h>
53 #include <net/route.h>
54 #include <net/netisr.h>
55 #include <net/raw_cb.h>
56
57 void
58 raw_init(void)
59 {
60 LIST_INIT(&rawcb);
61 }
62
63 static inline int
64 equal(const struct sockaddr *a1, const struct sockaddr *a2)
65 {
66 return memcmp(a1, a2, a1->sa_len) == 0;
67 }
68
69 /*
70 * raw_input: find the socket associated with the packet and move it over.
71 * If nothing exists for this packet, drop it.
72 */
73 void
74 raw_input(struct mbuf *m0, ...)
75 {
76 struct rawcb *rp;
77 struct mbuf *m = m0;
78 struct socket *last;
79 va_list ap;
80 struct sockproto *proto;
81 struct sockaddr *src, *dst;
82
83 KASSERT(mutex_owned(softnet_lock));
84
85 va_start(ap, m0);
86 proto = va_arg(ap, struct sockproto *);
87 src = va_arg(ap, struct sockaddr *);
88 dst = va_arg(ap, struct sockaddr *);
89 va_end(ap);
90
91 last = NULL;
92 LIST_FOREACH(rp, &rawcb, rcb_list) {
93 if (rp->rcb_proto.sp_family != proto->sp_family)
94 continue;
95 if (rp->rcb_proto.sp_protocol &&
96 rp->rcb_proto.sp_protocol != proto->sp_protocol)
97 continue;
98 /*
99 * We assume the lower level routines have
100 * placed the address in a canonical format
101 * suitable for a structure comparison.
102 *
103 * Note that if the lengths are not the same
104 * the comparison will fail at the first byte.
105 */
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 != NULL) {
111 struct mbuf *n;
112 if ((n = m_copy(m, 0, M_COPYALL)) == NULL)
113 ;
114 else if (sbappendaddr(&last->so_rcv, src, n, NULL) == 0)
115 /* should notify about lost packet */
116 m_freem(n);
117 else {
118 sorwakeup(last);
119 }
120 }
121 last = rp->rcb_socket;
122 }
123 if (last == NULL || sbappendaddr(&last->so_rcv, src, m, NULL) == 0)
124 m_freem(m);
125 else {
126 sorwakeup(last);
127 }
128 }
129
130 void *
131 raw_ctlinput(int cmd, const struct sockaddr *arg, void *d)
132 {
133
134 if ((unsigned)cmd >= PRC_NCMDS)
135 return NULL;
136 return NULL;
137 /* INCOMPLETE */
138 }
139
140 void
141 raw_setsockaddr(struct rawcb *rp, struct mbuf *nam)
142 {
143
144 nam->m_len = rp->rcb_laddr->sa_len;
145 memcpy(mtod(nam, void *), rp->rcb_laddr, (size_t)nam->m_len);
146 }
147
148 void
149 raw_setpeeraddr(struct rawcb *rp, struct mbuf *nam)
150 {
151
152 nam->m_len = rp->rcb_faddr->sa_len;
153 memcpy(mtod(nam, void *), rp->rcb_faddr, (size_t)nam->m_len);
154 }
155
156 int
157 raw_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam,
158 struct mbuf *control, struct lwp *l)
159 {
160 struct rawcb *rp = sotorawcb(so);
161 int s, error = 0;
162
163 KASSERT(req != PRU_ATTACH);
164 KASSERT(req != PRU_DETACH);
165 KASSERT(req != PRU_CONTROL);
166 KASSERT(req != PRU_SENSE);
167
168 s = splsoftnet();
169 KERNEL_LOCK(1, NULL);
170
171 KASSERT(!control || (req == PRU_SEND || req == PRU_SENDOOB));
172 if (rp == NULL) {
173 error = EINVAL;
174 goto release;
175 }
176
177 switch (req) {
178 /*
179 * If a socket isn't bound to a single address,
180 * the raw input routine will hand it anything
181 * within that protocol family (assuming there's
182 * nothing else around it should go to).
183 */
184 case PRU_BIND:
185 case PRU_LISTEN:
186 case PRU_CONNECT:
187 case PRU_CONNECT2:
188 error = EOPNOTSUPP;
189 break;
190
191 case PRU_DISCONNECT:
192 soisdisconnected(so);
193 raw_disconnect(rp);
194 break;
195
196 /*
197 * Mark the connection as being incapable of further input.
198 */
199 case PRU_SHUTDOWN:
200 socantsendmore(so);
201 break;
202
203 case PRU_RCVD:
204 error = EOPNOTSUPP;
205 break;
206
207 /*
208 * Ship a packet out. The appropriate raw output
209 * routine handles any massaging necessary.
210 */
211 case PRU_SEND:
212 if (control && control->m_len) {
213 m_freem(control);
214 m_freem(m);
215 error = EINVAL;
216 break;
217 }
218 if (nam) {
219 if ((so->so_state & SS_ISCONNECTED) != 0) {
220 error = EISCONN;
221 goto die;
222 }
223 error = (*so->so_proto->pr_usrreqs->pr_generic)(so,
224 PRU_CONNECT, NULL, nam, NULL, l);
225 if (error) {
226 die:
227 m_freem(m);
228 break;
229 }
230 } else {
231 if ((so->so_state & SS_ISCONNECTED) == 0) {
232 error = ENOTCONN;
233 goto die;
234 }
235 }
236 error = (*so->so_proto->pr_output)(m, so);
237 if (nam)
238 raw_disconnect(rp);
239 break;
240
241 /*
242 * Not supported.
243 */
244 case PRU_RCVOOB:
245 error = EOPNOTSUPP;
246 break;
247
248 case PRU_SENDOOB:
249 m_freem(control);
250 m_freem(m);
251 error = EOPNOTSUPP;
252 break;
253
254 case PRU_SOCKADDR:
255 if (rp->rcb_laddr == NULL) {
256 error = EINVAL;
257 break;
258 }
259 raw_setsockaddr(rp, nam);
260 break;
261
262 case PRU_PEERADDR:
263 if (rp->rcb_faddr == NULL) {
264 error = ENOTCONN;
265 break;
266 }
267 raw_setpeeraddr(rp, nam);
268 break;
269
270 default:
271 panic("raw_usrreq");
272 }
273
274 release:
275 KERNEL_UNLOCK_ONE(NULL);
276 splx(s);
277 return (error);
278 }
279