bluetooth(4): Fix loading bluetooth without pf.
[dragonfly.git] / sys / netproto / ns / ns.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.c        8.2 (Berkeley) 11/15/93
34  * $FreeBSD: src/sys/netns/ns.c,v 1.9 1999/08/28 00:49:47 peter Exp $
35  * $DragonFly: src/sys/netproto/ns/ns.c,v 1.17 2008/03/07 11:34:21 sephe Exp $
36  */
37
38 #include <sys/param.h>
39 #include <sys/systm.h>
40 #include <sys/malloc.h>
41 #include <sys/mbuf.h>
42 #include <sys/sockio.h>
43 #include <sys/protosw.h>
44 #include <sys/errno.h>
45 #include <sys/socket.h>
46 #include <sys/socketvar.h>
47 #include <sys/thread2.h>
48
49 #include <net/if.h>
50 #include <net/route.h>
51
52 #include "ns.h"
53 #include "ns_if.h"
54
55 #include "opt_ns.h"
56
57 #ifdef NS
58
59 struct ns_ifaddr *ns_ifaddr;
60 int ns_interfaces;
61
62 extern struct sockaddr_ns ns_netmask, ns_hostmask;
63
64 /*
65  * Generic internet control operations (ioctl's).
66  */
67 /* ARGSUSED */
68 int
69 ns_control(struct socket *so, u_long cmd, caddr_t data, struct ifnet *ifp,
70         struct thread *td)
71 {
72         struct ifreq *ifr = (struct ifreq *)data;
73         struct ns_aliasreq *ifra = (struct ns_aliasreq *)data;
74         struct ns_ifaddr *ia;
75         struct ns_ifaddr *oia;
76         int dstIsNew, hostIsNew;
77         int error = 0; /* initalize because of scoping */
78
79         /*
80          * Find address for this interface, if it exists.
81          */
82         if (ifp == 0)
83                 return (EADDRNOTAVAIL);
84         for (ia = ns_ifaddr; ia; ia = ia->ia_next)
85                 if (ia->ia_ifp == ifp)
86                         break;
87
88         switch (cmd) {
89
90         case SIOCGIFADDR:
91                 if (ia == NULL)
92                         return (EADDRNOTAVAIL);
93                 *(struct sockaddr_ns *)&ifr->ifr_addr = ia->ia_addr;
94                 return (0);
95
96
97         case SIOCGIFBRDADDR:
98                 if (ia == NULL)
99                         return (EADDRNOTAVAIL);
100                 if ((ifp->if_flags & IFF_BROADCAST) == 0)
101                         return (EINVAL);
102                 *(struct sockaddr_ns *)&ifr->ifr_dstaddr = ia->ia_broadaddr;
103                 return (0);
104
105         case SIOCGIFDSTADDR:
106                 if (ia == NULL)
107                         return (EADDRNOTAVAIL);
108                 if ((ifp->if_flags & IFF_POINTOPOINT) == 0)
109                         return (EINVAL);
110                 *(struct sockaddr_ns *)&ifr->ifr_dstaddr = ia->ia_dstaddr;
111                 return (0);
112         }
113
114 #ifdef NS_PRIV_SOCKETS
115         if ((so->so_state & SS_PRIV) == 0)
116                 return (EPERM);
117 #endif
118
119         switch (cmd) {
120         case SIOCAIFADDR:
121         case SIOCDIFADDR:
122                 if (ifra->ifra_addr.sns_family == AF_NS)
123                     for (oia = ia; ia; ia = ia->ia_next) {
124                         if (ia->ia_ifp == ifp  &&
125                             ns_neteq(ia->ia_addr.sns_addr,
126                                   ifra->ifra_addr.sns_addr))
127                             break;
128                     }
129                 if (cmd == SIOCDIFADDR && ia == 0)
130                         return (EADDRNOTAVAIL);
131                 /* FALLTHROUGH */
132
133         case SIOCSIFADDR:
134         case SIOCSIFDSTADDR:
135                 if (ia == NULL) {
136                         oia = ifa_create(sizeof(*ia), M_WAITOK);
137                         if ((ia = ns_ifaddr) != NULL) {
138                                 for ( ; ia->ia_next; ia = ia->ia_next)
139                                         ;
140                                 ia->ia_next = oia;
141                         } else
142                                 ns_ifaddr = oia;
143                         ia = oia;
144
145                         ifa_iflink(&ia->ia_ifa, ifp, 1);
146                         ia->ia_ifp = ifp;
147                         ia->ia_ifa.ifa_addr = (struct sockaddr *)&ia->ia_addr;
148
149                         ia->ia_ifa.ifa_netmask =
150                                 (struct sockaddr *)&ns_netmask;
151
152                         ia->ia_ifa.ifa_dstaddr =
153                                 (struct sockaddr *)&ia->ia_dstaddr;
154                         if (ifp->if_flags & IFF_BROADCAST) {
155                                 ia->ia_broadaddr.sns_family = AF_NS;
156                                 ia->ia_broadaddr.sns_len = sizeof(ia->ia_addr);
157                                 ia->ia_broadaddr.sns_addr.x_host = ns_broadhost;
158                         }
159                         ns_interfaces++;
160                 }
161         }
162
163         switch (cmd) {
164         case SIOCSIFDSTADDR:
165                 if ((ifp->if_flags & IFF_POINTOPOINT) == 0)
166                         return (EINVAL);
167                 if (ia->ia_flags & IFA_ROUTE) {
168                         rtinit(&(ia->ia_ifa), (int)RTM_DELETE, RTF_HOST);
169                         ia->ia_flags &= ~IFA_ROUTE;
170                 }
171                 if (ifp->if_ioctl) {
172                         ifnet_serialize_all(ifp);
173                         error = ifp->if_ioctl(ifp, SIOCSIFDSTADDR, (caddr_t)ia,
174                                               NULL);
175                         ifnet_deserialize_all(ifp);
176                         if (error)
177                                 return (error);
178                 }
179                 *(struct sockaddr *)&ia->ia_dstaddr = ifr->ifr_dstaddr;
180                 return (0);
181
182         case SIOCSIFADDR:
183                 return (ns_ifinit(ifp, (struct ns_ifaddr *)ia,
184                                 (struct sockaddr_ns *)&ifr->ifr_addr, 1));
185
186         case SIOCDIFADDR:
187                 ns_ifscrub(ifp, (struct ns_ifaddr *)ia);
188                 /* XXX not on list */
189                 oia = ia;
190                 ifa_ifunlink(&ia->ia_ifa, ifp);
191                 if (oia == (ia = ns_ifaddr)) {
192                         ns_ifaddr = ia->ia_next;
193                 } else {
194                         while (ia->ia_next && (ia->ia_next != oia)) {
195                                 ia = ia->ia_next;
196                         }
197                         if (ia->ia_next)
198                             ia->ia_next = oia->ia_next;
199                         else
200                                 kprintf("Didn't unlink nsifadr from list\n");
201                 }
202                 ifa_destroy(&oia->ia_ifa);
203                 if (0 == --ns_interfaces) {
204                         /*
205                          * We reset to virginity and start all over again
206                          */
207                         ns_thishost = ns_zerohost;
208                 }
209                 return (0);
210
211         case SIOCAIFADDR:
212                 dstIsNew = 0; hostIsNew = 1;
213                 if (ia->ia_addr.sns_family == AF_NS) {
214                         if (ifra->ifra_addr.sns_len == 0) {
215                                 ifra->ifra_addr = ia->ia_addr;
216                                 hostIsNew = 0;
217                         } else if (ns_neteq(ifra->ifra_addr.sns_addr,
218                                          ia->ia_addr.sns_addr))
219                                 hostIsNew = 0;
220                 }
221                 if ((ifp->if_flags & IFF_POINTOPOINT) &&
222                     (ifra->ifra_dstaddr.sns_family == AF_NS)) {
223                         if (hostIsNew == 0)
224                                 ns_ifscrub(ifp, (struct ns_ifaddr *)ia);
225                         ia->ia_dstaddr = ifra->ifra_dstaddr;
226                         dstIsNew  = 1;
227                 }
228                 if (ifra->ifra_addr.sns_family == AF_NS &&
229                                             (hostIsNew || dstIsNew))
230                         error = ns_ifinit(ifp, (struct ns_ifaddr *)ia,
231                                                 &ifra->ifra_addr, 0);
232                 return (error);
233
234         default:
235                 if (ifp->if_ioctl == 0)
236                         return (EOPNOTSUPP);
237                 ifnet_serialize_all(ifp);
238                 error = ifp->if_ioctl(ifp, cmd, data, NULL);
239                 ifnet_deserialize_all(ifp);
240                 return (error);
241         }
242 }
243
244 /*
245 * Delete any previous route for an old address.
246 */
247 void
248 ns_ifscrub(struct ifnet *ifp, struct ns_ifaddr *ia)
249 {
250         if (ia->ia_flags & IFA_ROUTE) {
251                 if (ifp->if_flags & IFF_POINTOPOINT) {
252                         rtinit(&(ia->ia_ifa), (int)RTM_DELETE, RTF_HOST);
253                 } else
254                         rtinit(&(ia->ia_ifa), (int)RTM_DELETE, 0);
255                 ia->ia_flags &= ~IFA_ROUTE;
256         }
257 }
258 /*
259  * Initialize an interface's internet address
260  * and routing table entry.
261  */
262 int
263 ns_ifinit(struct ifnet *ifp, struct ns_ifaddr *ia, struct sockaddr_ns *sns, int scrub)
264 {
265         struct sockaddr_ns oldaddr;
266         union ns_host *h = &ia->ia_addr.sns_addr.x_host;
267         int error;
268
269         crit_enter();
270
271         /*
272          * Set up new addresses.
273          */
274         oldaddr = ia->ia_addr;
275         ia->ia_addr = *sns;
276         /*
277          * The convention we shall adopt for naming is that
278          * a supplied address of zero means that "we don't care".
279          * if there is a single interface, use the address of that
280          * interface as our 6 byte host address.
281          * if there are multiple interfaces, use any address already
282          * used.
283          *
284          * Give the interface a chance to initialize
285          * if this is its first address,
286          * and to validate the address if necessary.
287          */
288         if (ns_hosteqnh(ns_thishost, ns_zerohost)) {
289                 ifnet_serialize_all(ifp);
290                 if (ifp->if_ioctl &&
291                      (error = ifp->if_ioctl(ifp, SIOCSIFADDR, 
292                                                 (caddr_t)ia,
293                                                 NULL))) {
294                         ia->ia_addr = oldaddr;
295                         ifnet_deserialize_all(ifp);
296                         crit_exit();
297                         return (error);
298                 }
299                 ifnet_deserialize_all(ifp);
300                 ns_thishost = *h;
301         } else if (ns_hosteqnh(sns->sns_addr.x_host, ns_zerohost)
302             || ns_hosteqnh(sns->sns_addr.x_host, ns_thishost)) {
303                 *h = ns_thishost;
304                 ifnet_serialize_all(ifp);
305                 if (ifp->if_ioctl &&
306                      (error = ifp->if_ioctl(ifp, SIOCSIFADDR, 
307                                                 (caddr_t)ia,
308                                                 NULL))) {
309                         ia->ia_addr = oldaddr;
310                         ifnet_deserialize_all(ifp);
311                         crit_exit();
312                         return (error);
313                 }
314                 ifnet_deserialize_all(ifp);
315                 if (!ns_hosteqnh(ns_thishost,*h)) {
316                         ia->ia_addr = oldaddr;
317                         crit_exit();
318                         return (EINVAL);
319                 }
320         } else {
321                 ia->ia_addr = oldaddr;
322                 crit_exit();
323                 return (EINVAL);
324         }
325         ia->ia_ifa.ifa_metric = ifp->if_metric;
326         /*
327          * Add route for the network.
328          */
329         if (scrub) {
330                 ia->ia_ifa.ifa_addr = (struct sockaddr *)&oldaddr;
331                 ns_ifscrub(ifp, ia);
332                 ia->ia_ifa.ifa_addr = (struct sockaddr *)&ia->ia_addr;
333         }
334         if (ifp->if_flags & IFF_POINTOPOINT)
335                 rtinit(&(ia->ia_ifa), (int)RTM_ADD, RTF_HOST|RTF_UP);
336         else {
337                 ia->ia_broadaddr.sns_addr.x_net = ia->ia_addr.sns_addr.x_net;
338                 rtinit(&(ia->ia_ifa), (int)RTM_ADD, RTF_UP);
339         }
340         ia->ia_flags |= IFA_ROUTE;
341         return (0);
342 }
343
344 /*
345  * Return address info for specified internet network.
346  */
347 struct ns_ifaddr *
348 ns_iaonnetof(struct ns_addr *dst)
349 {
350         struct ns_ifaddr *ia;
351         struct ns_addr *compare;
352         struct ifnet *ifp;
353         struct ns_ifaddr *ia_maybe = 0;
354         union ns_net net = dst->x_net;
355
356         for (ia = ns_ifaddr; ia; ia = ia->ia_next) {
357                 if ((ifp = ia->ia_ifp) != NULL) {
358                         if (ifp->if_flags & IFF_POINTOPOINT) {
359                                 compare = &satons_addr(ia->ia_dstaddr);
360                                 if (ns_hosteq(*dst, *compare))
361                                         return (ia);
362                                 if (ns_neteqnn(net, ia->ia_addr.sns_addr.x_net))
363                                         ia_maybe = ia;
364                         } else {
365                                 if (ns_neteqnn(net, ia->ia_addr.sns_addr.x_net))
366                                         return (ia);
367                         }
368                 }
369         }
370         return (ia_maybe);
371 }
372 #endif