Use MPIPE instead of misusing m_getclr() (i.e. m_get) for NETNS's
[dragonfly.git] / sys / netproto / ns / ns_pcb.c
1 /*
2  * Copyright (c) 1984, 1985, 1986, 1987, 1993
3  *      The Regents of the University of California.  All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  * 3. All advertising materials mentioning features or use of this software
14  *    must display the following acknowledgement:
15  *      This product includes software developed by the University of
16  *      California, Berkeley and its contributors.
17  * 4. Neither the name of the University nor the names of its contributors
18  *    may be used to endorse or promote products derived from this software
19  *    without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31  * SUCH DAMAGE.
32  *
33  *      @(#)ns_pcb.c    8.1 (Berkeley) 6/10/93
34  * $FreeBSD: src/sys/netns/ns_pcb.c,v 1.9 1999/08/28 00:49:51 peter Exp $
35  * $DragonFly: src/sys/netproto/ns/ns_pcb.c,v 1.10 2004/06/04 04:59:57 dillon Exp $
36  */
37
38 #include <sys/param.h>
39 #include <sys/systm.h>
40 #include <sys/kernel.h>
41 #include <sys/mbuf.h>
42 #include <sys/errno.h>
43 #include <sys/socket.h>
44 #include <sys/socketvar.h>
45 #include <sys/protosw.h>
46 #include <sys/module.h>
47 #include <sys/malloc.h>
48 #include <sys/mpipe.h>
49
50 #include <net/if.h>
51 #include <net/route.h>
52
53 #include "ns.h"
54 #include "ns_if.h"
55 #include "ns_pcb.h"
56
57 struct  ns_addr zerons_addr;
58 struct nspcb nspcb;             /* head of list */
59
60 static MALLOC_DEFINE(M_NSPCB, "nspcb", "NS PCB Management");
61 static struct malloc_pipe nspcb_mpipe;
62
63 void
64 ns_pcb_init(void)
65 {
66         mpipe_init(&nspcb_mpipe, M_NSPCB, sizeof(struct nspcb),
67                         32, -1, 0, NULL);
68 }
69
70 int
71 ns_pcballoc(struct socket *so, struct nspcb *head)
72 {
73         struct nspcb *nsp;
74
75         if ((nsp = mpipe_alloc_nowait(&nspcb_mpipe)) == NULL)
76                 return (ENOBUFS);
77         nsp->nsp_socket = so;
78         insque(nsp, head);
79         so->so_pcb = (caddr_t)nsp;
80         return (0);
81 }
82
83 int
84 ns_pcbbind(struct nspcb *nsp, struct mbuf *nam)
85 {
86         struct sockaddr_ns *sns;
87         u_short lport = 0;
88
89         if (nsp->nsp_lport || !ns_nullhost(nsp->nsp_laddr))
90                 return (EINVAL);
91         if (nam == 0)
92                 goto noname;
93         sns = mtod(nam, struct sockaddr_ns *);
94         if (nam->m_len != sizeof (*sns))
95                 return (EINVAL);
96         if (!ns_nullhost(sns->sns_addr)) {
97                 int tport = sns->sns_port;
98
99                 sns->sns_port = 0;              /* yech... */
100                 if (ifa_ifwithaddr((struct sockaddr *)sns) == 0)
101                         return (EADDRNOTAVAIL);
102                 sns->sns_port = tport;
103         }
104         lport = sns->sns_port;
105         if (lport) {
106 #ifdef  NS_PRIV_SOCKETS
107                 u_short aport = ntohs(lport);
108
109                 if (aport < NSPORT_RESERVED &&
110                     (nsp->nsp_socket->so_state & SS_PRIV) == 0)
111                         return (EACCES);
112 #endif  /* NS_PRIV_SOCKETS */
113
114                 if (ns_pcblookup(&zerons_addr, lport, 0))
115                         return (EADDRINUSE);
116         }
117         nsp->nsp_laddr = sns->sns_addr;
118 noname:
119         if (lport == 0)
120                 do {
121                         if (nspcb.nsp_lport++ < NSPORT_RESERVED)
122                                 nspcb.nsp_lport = NSPORT_RESERVED;
123                         lport = htons(nspcb.nsp_lport);
124                 } while (ns_pcblookup(&zerons_addr, lport, 0));
125         nsp->nsp_lport = lport;
126         return (0);
127 }
128
129 /*
130  * Connect from a socket to a specified address.
131  * Both address and port must be specified in argument sns.
132  * If don't have a local address for this socket yet,
133  * then pick one.
134  */
135 int
136 ns_pcbconnect(struct nspcb *nsp, struct mbuf *nam)
137 {
138         struct ns_ifaddr *ia;
139         struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
140         struct ns_addr *dst;
141         struct route *ro;
142         struct ifnet *ifp;
143
144         if (nam->m_len != sizeof (*sns))
145                 return (EINVAL);
146         if (sns->sns_family != AF_NS)
147                 return (EAFNOSUPPORT);
148         if (sns->sns_port==0 || ns_nullhost(sns->sns_addr))
149                 return (EADDRNOTAVAIL);
150         /*
151          * If we haven't bound which network number to use as ours,
152          * we will use the number of the outgoing interface.
153          * This depends on having done a routing lookup, which
154          * we will probably have to do anyway, so we might
155          * as well do it now.  On the other hand if we are
156          * sending to multiple destinations we may have already
157          * done the lookup, so see if we can use the route
158          * from before.  In any case, we only
159          * chose a port number once, even if sending to multiple
160          * destinations.
161          */
162         ro = &nsp->nsp_route;
163         dst = &satons_addr(ro->ro_dst);
164         if (nsp->nsp_socket->so_options & SO_DONTROUTE)
165                 goto flush;
166         if (!ns_neteq(nsp->nsp_lastdst, sns->sns_addr))
167                 goto flush;
168         if (!ns_hosteq(nsp->nsp_lastdst, sns->sns_addr)) {
169                 if (ro->ro_rt && ! (ro->ro_rt->rt_flags & RTF_HOST)) {
170                         /* can patch route to avoid rtalloc */
171                         *dst = sns->sns_addr;
172                 } else {
173         flush:
174                         if (ro->ro_rt)
175                                 RTFREE(ro->ro_rt);
176                         ro->ro_rt = (struct rtentry *)0;
177                         nsp->nsp_laddr.x_net = ns_zeronet;
178                 }
179         }/* else cached route is ok; do nothing */
180         nsp->nsp_lastdst = sns->sns_addr;
181         if ((nsp->nsp_socket->so_options & SO_DONTROUTE) == 0 && /*XXX*/
182             (ro->ro_rt == (struct rtentry *)0 ||
183              ro->ro_rt->rt_ifp == (struct ifnet *)0)) {
184                     /* No route yet, so try to acquire one */
185                     ro->ro_dst.sa_family = AF_NS;
186                     ro->ro_dst.sa_len = sizeof(ro->ro_dst);
187                     *dst = sns->sns_addr;
188                     dst->x_port = 0;
189                     rtalloc(ro);
190         }
191         if (ns_neteqnn(nsp->nsp_laddr.x_net, ns_zeronet)) {
192                 /*
193                  * If route is known or can be allocated now,
194                  * our src addr is taken from the i/f, else punt.
195                  */
196
197                 ia = (struct ns_ifaddr *)0;
198                 /*
199                  * If we found a route, use the address
200                  * corresponding to the outgoing interface
201                  */
202                 if (ro->ro_rt && (ifp = ro->ro_rt->rt_ifp))
203                         for (ia = ns_ifaddr; ia; ia = ia->ia_next)
204                                 if (ia->ia_ifp == ifp)
205                                         break;
206                 if (ia == 0) {
207                         u_short fport = sns->sns_addr.x_port;
208                         sns->sns_addr.x_port = 0;
209                         ia = (struct ns_ifaddr *)
210                                 ifa_ifwithdstaddr((struct sockaddr *)sns);
211                         sns->sns_addr.x_port = fport;
212                         if (ia == 0)
213                                 ia = ns_iaonnetof(&sns->sns_addr);
214                         if (ia == 0)
215                                 ia = ns_ifaddr;
216                         if (ia == 0)
217                                 return (EADDRNOTAVAIL);
218                 }
219                 nsp->nsp_laddr.x_net = satons_addr(ia->ia_addr).x_net;
220         }
221         if (ns_pcblookup(&sns->sns_addr, nsp->nsp_lport, 0))
222                 return (EADDRINUSE);
223         if (ns_nullhost(nsp->nsp_laddr)) {
224                 if (nsp->nsp_lport == 0)
225                         (void) ns_pcbbind(nsp, (struct mbuf *)0);
226                 nsp->nsp_laddr.x_host = ns_thishost;
227         }
228         nsp->nsp_faddr = sns->sns_addr;
229         /* Includes nsp->nsp_fport = sns->sns_port; */
230         return (0);
231 }
232
233 void
234 ns_pcbdisconnect(struct nspcb *nsp)
235 {
236         nsp->nsp_faddr = zerons_addr;
237         if (nsp->nsp_socket->so_state & SS_NOFDREF)
238                 ns_pcbdetach(nsp);
239 }
240
241 void
242 ns_pcbdetach(struct nspcb *nsp)
243 {
244         struct socket *so = nsp->nsp_socket;
245
246         so->so_pcb = 0;
247         sofree(so);
248         if (nsp->nsp_route.ro_rt)
249                 rtfree(nsp->nsp_route.ro_rt);
250         remque(nsp);
251         mpipe_free(&nspcb_mpipe, nsp);
252 }
253
254 void
255 ns_setsockaddr(struct nspcb *nsp, struct mbuf *nam)
256 {
257         struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
258
259         nam->m_len = sizeof (*sns);
260         sns = mtod(nam, struct sockaddr_ns *);
261         bzero((caddr_t)sns, sizeof (*sns));
262         sns->sns_len = sizeof(*sns);
263         sns->sns_family = AF_NS;
264         sns->sns_addr = nsp->nsp_laddr;
265 }
266
267 void
268 ns_setpeeraddr(struct nspcb *nsp, struct mbuf *nam)
269 {
270         struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
271
272         nam->m_len = sizeof (*sns);
273         sns = mtod(nam, struct sockaddr_ns *);
274         bzero((caddr_t)sns, sizeof (*sns));
275         sns->sns_len = sizeof(*sns);
276         sns->sns_family = AF_NS;
277         sns->sns_addr  = nsp->nsp_faddr;
278 }
279
280 /*
281  * Pass some notification to all connections of a protocol
282  * associated with address dst.  Call the
283  * protocol specific routine to handle each connection.
284  * Also pass an extra paramter via the nspcb. (which may in fact
285  * be a parameter list!)
286  */
287 void
288 ns_pcbnotify(struct ns_addr *dst, int errno,
289             void (*notify)(struct nspcb *), long param)
290 {
291         struct nspcb *nsp, *oinp;
292         int s = splimp();
293
294         for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb);) {
295                 if (!ns_hosteq(*dst,nsp->nsp_faddr)) {
296         next:
297                         nsp = nsp->nsp_next;
298                         continue;
299                 }
300                 if (nsp->nsp_socket == 0)
301                         goto next;
302                 if (errno)
303                         nsp->nsp_socket->so_error = errno;
304                 oinp = nsp;
305                 nsp = nsp->nsp_next;
306                 oinp->nsp_notify_param = param;
307                 (*notify)(oinp);
308         }
309         splx(s);
310 }
311
312 #ifdef notdef
313 /*
314  * After a routing change, flush old routing
315  * and allocate a (hopefully) better one.
316  */
317 ns_rtchange(struct nspcb *nsp)
318 {
319         if (nsp->nsp_route.ro_rt) {
320                 rtfree(nsp->nsp_route.ro_rt);
321                 nsp->nsp_route.ro_rt = 0;
322                 /*
323                  * A new route can be allocated the next time
324                  * output is attempted.
325                  */
326         }
327         /* SHOULD NOTIFY HIGHER-LEVEL PROTOCOLS */
328 }
329 #endif
330
331 struct nspcb *
332 ns_pcblookup(struct ns_addr *faddr, u_short lport, int wildp)
333 {
334         struct nspcb *nsp, *match = 0;
335         int matchwild = 3, wildcard;
336         u_short fport;
337
338         fport = faddr->x_port;
339         for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb); nsp = nsp->nsp_next) {
340                 if (nsp->nsp_lport != lport)
341                         continue;
342                 wildcard = 0;
343                 if (ns_nullhost(nsp->nsp_faddr)) {
344                         if (!ns_nullhost(*faddr))
345                                 wildcard++;
346                 } else {
347                         if (ns_nullhost(*faddr))
348                                 wildcard++;
349                         else {
350                                 if (!ns_hosteq(nsp->nsp_faddr, *faddr))
351                                         continue;
352                                 if (nsp->nsp_fport != fport) {
353                                         if (nsp->nsp_fport != 0)
354                                                 continue;
355                                         else
356                                                 wildcard++;
357                                 }
358                         }
359                 }
360                 if (wildcard && wildp==0)
361                         continue;
362                 if (wildcard < matchwild) {
363                         match = nsp;
364                         matchwild = wildcard;
365                         if (wildcard == 0)
366                                 break;
367                 }
368         }
369         return (match);
370 }