Merge from vendor branch LIBSTDC++:
[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.5 2003/09/06 21:51:12 drhodus Exp $
36  */
37
38 #include <sys/param.h>
39 #include <sys/systm.h>
40 #include <sys/mbuf.h>
41 #include <sys/errno.h>
42 #include <sys/socket.h>
43 #include <sys/socketvar.h>
44 #include <sys/protosw.h>
45
46 #include <net/if.h>
47 #include <net/route.h>
48
49 #include "ns.h"
50 #include "ns_if.h"
51 #include "ns_pcb.h"
52
53 struct  ns_addr zerons_addr;
54
55 int
56 ns_pcballoc(so, head)
57         struct socket *so;
58         struct nspcb *head;
59 {
60         struct mbuf *m;
61         struct nspcb *nsp;
62
63         m = m_getclr(M_DONTWAIT, MT_CONTROL); /*protocol private PCB */
64         if (m == NULL)
65                 return (ENOBUFS);
66         nsp = mtod(m, struct nspcb *);
67         nsp->nsp_socket = so;
68         insque(nsp, head);
69         so->so_pcb = (caddr_t)nsp;
70         return (0);
71 }
72
73 int
74 ns_pcbbind(nsp, nam)
75         struct nspcb *nsp;
76         struct mbuf *nam;
77 {
78         struct sockaddr_ns *sns;
79         u_short lport = 0;
80
81         if (nsp->nsp_lport || !ns_nullhost(nsp->nsp_laddr))
82                 return (EINVAL);
83         if (nam == 0)
84                 goto noname;
85         sns = mtod(nam, struct sockaddr_ns *);
86         if (nam->m_len != sizeof (*sns))
87                 return (EINVAL);
88         if (!ns_nullhost(sns->sns_addr)) {
89                 int tport = sns->sns_port;
90
91                 sns->sns_port = 0;              /* yech... */
92                 if (ifa_ifwithaddr((struct sockaddr *)sns) == 0)
93                         return (EADDRNOTAVAIL);
94                 sns->sns_port = tport;
95         }
96         lport = sns->sns_port;
97         if (lport) {
98                 u_short aport = ntohs(lport);
99
100 #ifdef  NS_PRIV_SOCKETS
101                 if (aport < NSPORT_RESERVED &&
102                     (nsp->nsp_socket->so_state & SS_PRIV) == 0)
103                         return (EACCES);
104 #endif  /* NS_PRIV_SOCKETS */
105
106                 if (ns_pcblookup(&zerons_addr, lport, 0))
107                         return (EADDRINUSE);
108         }
109         nsp->nsp_laddr = sns->sns_addr;
110 noname:
111         if (lport == 0)
112                 do {
113                         if (nspcb.nsp_lport++ < NSPORT_RESERVED)
114                                 nspcb.nsp_lport = NSPORT_RESERVED;
115                         lport = htons(nspcb.nsp_lport);
116                 } while (ns_pcblookup(&zerons_addr, lport, 0));
117         nsp->nsp_lport = lport;
118         return (0);
119 }
120
121 /*
122  * Connect from a socket to a specified address.
123  * Both address and port must be specified in argument sns.
124  * If don't have a local address for this socket yet,
125  * then pick one.
126  */
127 int
128 ns_pcbconnect(nsp, nam)
129         struct nspcb *nsp;
130         struct mbuf *nam;
131 {
132         struct ns_ifaddr *ia;
133         struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
134         struct ns_addr *dst;
135         struct route *ro;
136         struct ifnet *ifp;
137
138         if (nam->m_len != sizeof (*sns))
139                 return (EINVAL);
140         if (sns->sns_family != AF_NS)
141                 return (EAFNOSUPPORT);
142         if (sns->sns_port==0 || ns_nullhost(sns->sns_addr))
143                 return (EADDRNOTAVAIL);
144         /*
145          * If we haven't bound which network number to use as ours,
146          * we will use the number of the outgoing interface.
147          * This depends on having done a routing lookup, which
148          * we will probably have to do anyway, so we might
149          * as well do it now.  On the other hand if we are
150          * sending to multiple destinations we may have already
151          * done the lookup, so see if we can use the route
152          * from before.  In any case, we only
153          * chose a port number once, even if sending to multiple
154          * destinations.
155          */
156         ro = &nsp->nsp_route;
157         dst = &satons_addr(ro->ro_dst);
158         if (nsp->nsp_socket->so_options & SO_DONTROUTE)
159                 goto flush;
160         if (!ns_neteq(nsp->nsp_lastdst, sns->sns_addr))
161                 goto flush;
162         if (!ns_hosteq(nsp->nsp_lastdst, sns->sns_addr)) {
163                 if (ro->ro_rt && ! (ro->ro_rt->rt_flags & RTF_HOST)) {
164                         /* can patch route to avoid rtalloc */
165                         *dst = sns->sns_addr;
166                 } else {
167         flush:
168                         if (ro->ro_rt)
169                                 RTFREE(ro->ro_rt);
170                         ro->ro_rt = (struct rtentry *)0;
171                         nsp->nsp_laddr.x_net = ns_zeronet;
172                 }
173         }/* else cached route is ok; do nothing */
174         nsp->nsp_lastdst = sns->sns_addr;
175         if ((nsp->nsp_socket->so_options & SO_DONTROUTE) == 0 && /*XXX*/
176             (ro->ro_rt == (struct rtentry *)0 ||
177              ro->ro_rt->rt_ifp == (struct ifnet *)0)) {
178                     /* No route yet, so try to acquire one */
179                     ro->ro_dst.sa_family = AF_NS;
180                     ro->ro_dst.sa_len = sizeof(ro->ro_dst);
181                     *dst = sns->sns_addr;
182                     dst->x_port = 0;
183                     rtalloc(ro);
184         }
185         if (ns_neteqnn(nsp->nsp_laddr.x_net, ns_zeronet)) {
186                 /*
187                  * If route is known or can be allocated now,
188                  * our src addr is taken from the i/f, else punt.
189                  */
190
191                 ia = (struct ns_ifaddr *)0;
192                 /*
193                  * If we found a route, use the address
194                  * corresponding to the outgoing interface
195                  */
196                 if (ro->ro_rt && (ifp = ro->ro_rt->rt_ifp))
197                         for (ia = ns_ifaddr; ia; ia = ia->ia_next)
198                                 if (ia->ia_ifp == ifp)
199                                         break;
200                 if (ia == 0) {
201                         u_short fport = sns->sns_addr.x_port;
202                         sns->sns_addr.x_port = 0;
203                         ia = (struct ns_ifaddr *)
204                                 ifa_ifwithdstaddr((struct sockaddr *)sns);
205                         sns->sns_addr.x_port = fport;
206                         if (ia == 0)
207                                 ia = ns_iaonnetof(&sns->sns_addr);
208                         if (ia == 0)
209                                 ia = ns_ifaddr;
210                         if (ia == 0)
211                                 return (EADDRNOTAVAIL);
212                 }
213                 nsp->nsp_laddr.x_net = satons_addr(ia->ia_addr).x_net;
214         }
215         if (ns_pcblookup(&sns->sns_addr, nsp->nsp_lport, 0))
216                 return (EADDRINUSE);
217         if (ns_nullhost(nsp->nsp_laddr)) {
218                 if (nsp->nsp_lport == 0)
219                         (void) ns_pcbbind(nsp, (struct mbuf *)0);
220                 nsp->nsp_laddr.x_host = ns_thishost;
221         }
222         nsp->nsp_faddr = sns->sns_addr;
223         /* Includes nsp->nsp_fport = sns->sns_port; */
224         return (0);
225 }
226
227 void
228 ns_pcbdisconnect(nsp)
229         struct nspcb *nsp;
230 {
231
232         nsp->nsp_faddr = zerons_addr;
233         if (nsp->nsp_socket->so_state & SS_NOFDREF)
234                 ns_pcbdetach(nsp);
235 }
236
237 void
238 ns_pcbdetach(nsp)
239         struct nspcb *nsp;
240 {
241         struct socket *so = nsp->nsp_socket;
242
243         so->so_pcb = 0;
244         sofree(so);
245         if (nsp->nsp_route.ro_rt)
246                 rtfree(nsp->nsp_route.ro_rt);
247         remque(nsp);
248         (void) m_free(dtom(nsp));
249 }
250
251 void
252 ns_setsockaddr(nsp, nam)
253         struct nspcb *nsp;
254         struct mbuf *nam;
255 {
256         struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
257
258         nam->m_len = sizeof (*sns);
259         sns = mtod(nam, struct sockaddr_ns *);
260         bzero((caddr_t)sns, sizeof (*sns));
261         sns->sns_len = sizeof(*sns);
262         sns->sns_family = AF_NS;
263         sns->sns_addr = nsp->nsp_laddr;
264 }
265
266 void
267 ns_setpeeraddr(nsp, nam)
268         struct nspcb *nsp;
269         struct mbuf *nam;
270 {
271         struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
272
273         nam->m_len = sizeof (*sns);
274         sns = mtod(nam, struct sockaddr_ns *);
275         bzero((caddr_t)sns, sizeof (*sns));
276         sns->sns_len = sizeof(*sns);
277         sns->sns_family = AF_NS;
278         sns->sns_addr  = nsp->nsp_faddr;
279 }
280
281 /*
282  * Pass some notification to all connections of a protocol
283  * associated with address dst.  Call the
284  * protocol specific routine to handle each connection.
285  * Also pass an extra paramter via the nspcb. (which may in fact
286  * be a parameter list!)
287  */
288 void
289 ns_pcbnotify(dst, errno, notify, param)
290         struct ns_addr *dst;
291         long param;
292         void (*notify)(struct nspcb *);
293         int errno;
294 {
295         struct nspcb *nsp, *oinp;
296         int s = splimp();
297
298         for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb);) {
299                 if (!ns_hosteq(*dst,nsp->nsp_faddr)) {
300         next:
301                         nsp = nsp->nsp_next;
302                         continue;
303                 }
304                 if (nsp->nsp_socket == 0)
305                         goto next;
306                 if (errno)
307                         nsp->nsp_socket->so_error = errno;
308                 oinp = nsp;
309                 nsp = nsp->nsp_next;
310                 oinp->nsp_notify_param = param;
311                 (*notify)(oinp);
312         }
313         splx(s);
314 }
315
316 #ifdef notdef
317 /*
318  * After a routing change, flush old routing
319  * and allocate a (hopefully) better one.
320  */
321 ns_rtchange(nsp)
322         struct nspcb *nsp;
323 {
324         if (nsp->nsp_route.ro_rt) {
325                 rtfree(nsp->nsp_route.ro_rt);
326                 nsp->nsp_route.ro_rt = 0;
327                 /*
328                  * A new route can be allocated the next time
329                  * output is attempted.
330                  */
331         }
332         /* SHOULD NOTIFY HIGHER-LEVEL PROTOCOLS */
333 }
334 #endif
335
336 struct nspcb *
337 ns_pcblookup(faddr, lport, wildp)
338         struct ns_addr *faddr;
339         u_short lport;
340 {
341         struct nspcb *nsp, *match = 0;
342         int matchwild = 3, wildcard;
343         u_short fport;
344
345         fport = faddr->x_port;
346         for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb); nsp = nsp->nsp_next) {
347                 if (nsp->nsp_lport != lport)
348                         continue;
349                 wildcard = 0;
350                 if (ns_nullhost(nsp->nsp_faddr)) {
351                         if (!ns_nullhost(*faddr))
352                                 wildcard++;
353                 } else {
354                         if (ns_nullhost(*faddr))
355                                 wildcard++;
356                         else {
357                                 if (!ns_hosteq(nsp->nsp_faddr, *faddr))
358                                         continue;
359                                 if (nsp->nsp_fport != fport) {
360                                         if (nsp->nsp_fport != 0)
361                                                 continue;
362                                         else
363                                                 wildcard++;
364                                 }
365                         }
366                 }
367                 if (wildcard && wildp==0)
368                         continue;
369                 if (wildcard < matchwild) {
370                         match = nsp;
371                         matchwild = wildcard;
372                         if (wildcard == 0)
373                                 break;
374                 }
375         }
376         return (match);
377 }