Line data Source code
1 : /* $OpenBSD: if_enc.c,v 1.73 2018/07/08 16:41:12 jca Exp $ */
2 :
3 : /*
4 : * Copyright (c) 2010 Reyk Floeter <reyk@vantronix.net>
5 : *
6 : * Permission to use, copy, modify, and distribute this software for any
7 : * purpose with or without fee is hereby granted, provided that the above
8 : * copyright notice and this permission notice appear in all copies.
9 : *
10 : * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 : * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 : * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 : * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 : * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 : * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 : * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 : */
18 :
19 : #include "enc.h"
20 : #include "bpfilter.h"
21 :
22 : #include <sys/param.h>
23 : #include <sys/systm.h>
24 : #include <sys/malloc.h>
25 : #include <sys/socket.h>
26 : #include <sys/sockio.h>
27 : #include <sys/mbuf.h>
28 :
29 : #include <net/if.h>
30 : #include <net/if_dl.h>
31 : #include <net/if_var.h>
32 : #include <net/if_enc.h>
33 : #include <net/if_types.h>
34 : #if NBPFILTER > 0
35 : #include <net/bpf.h>
36 : #endif
37 :
38 : struct ifnet **enc_ifps; /* rdomain-mapped enc ifs */
39 : u_int enc_max_rdomain;
40 : struct ifnet **enc_allifps; /* unit-mapped enc ifs */
41 : u_int enc_max_unit;
42 : #define ENC_MAX_UNITS 4096 /* XXX n per rdomain */
43 :
44 : void encattach(int);
45 :
46 : int enc_clone_create(struct if_clone *, int);
47 : int enc_clone_destroy(struct ifnet *);
48 : void enc_start(struct ifnet *);
49 : int enc_output(struct ifnet *, struct mbuf *, struct sockaddr *,
50 : struct rtentry *);
51 : int enc_ioctl(struct ifnet *, u_long, caddr_t);
52 :
53 : int enc_setif(struct ifnet *, u_int);
54 : void enc_unsetif(struct ifnet *);
55 :
56 : struct if_clone enc_cloner =
57 : IF_CLONE_INITIALIZER("enc", enc_clone_create, enc_clone_destroy);
58 :
59 : void
60 0 : encattach(int count)
61 : {
62 : /* Create enc0 by default */
63 0 : (void)enc_clone_create(&enc_cloner, 0);
64 :
65 0 : if_clone_attach(&enc_cloner);
66 0 : }
67 :
68 : int
69 0 : enc_clone_create(struct if_clone *ifc, int unit)
70 : {
71 : struct enc_softc *sc;
72 : struct ifnet *ifp;
73 : struct ifnet **new;
74 : size_t newlen;
75 : int error;
76 :
77 0 : if (unit > ENC_MAX_UNITS)
78 0 : return (EINVAL);
79 :
80 0 : if ((sc = malloc(sizeof(struct enc_softc),
81 0 : M_DEVBUF, M_NOWAIT|M_ZERO)) == NULL)
82 0 : return (ENOBUFS);
83 :
84 0 : sc->sc_unit = unit;
85 :
86 0 : ifp = &sc->sc_if;
87 0 : ifp->if_softc = sc;
88 0 : ifp->if_type = IFT_ENC;
89 0 : ifp->if_xflags = IFXF_CLONED;
90 0 : ifp->if_start = enc_start;
91 0 : ifp->if_output = enc_output;
92 0 : ifp->if_ioctl = enc_ioctl;
93 0 : ifp->if_hdrlen = ENC_HDRLEN;
94 :
95 0 : snprintf(ifp->if_xname, sizeof(ifp->if_xname), "%s%d",
96 0 : ifc->ifc_name, unit);
97 :
98 0 : if_attach(ifp);
99 0 : if (unit == 0)
100 0 : if_addgroup(ifp, ifc->ifc_name);
101 : /*
102 : * enc(4) does not have a link-layer address but rtrequest()
103 : * wants an ifa for every route entry. So let's setup a fake
104 : * and empty ifa of type AF_LINK for this purpose.
105 : */
106 0 : if_alloc_sadl(ifp);
107 0 : sc->sc_ifa.ifa_ifp = ifp;
108 0 : sc->sc_ifa.ifa_addr = sdltosa(ifp->if_sadl);
109 0 : sc->sc_ifa.ifa_netmask = NULL;
110 :
111 : #if NBPFILTER > 0
112 0 : bpfattach(&ifp->if_bpf, ifp, DLT_ENC, ENC_HDRLEN);
113 : #endif
114 0 : NET_LOCK();
115 0 : error = enc_setif(ifp, 0);
116 0 : if (error != 0) {
117 0 : NET_UNLOCK();
118 0 : if_detach(ifp);
119 0 : free(sc, M_DEVBUF, 0);
120 0 : return (error);
121 : }
122 :
123 0 : if (enc_allifps == NULL || unit > enc_max_unit) {
124 0 : if ((new = mallocarray(unit + 1, sizeof(struct ifnet *),
125 0 : M_DEVBUF, M_NOWAIT|M_ZERO)) == NULL) {
126 0 : NET_UNLOCK();
127 0 : return (ENOBUFS);
128 : }
129 : newlen = sizeof(struct ifnet *) * (unit + 1);
130 :
131 0 : if (enc_allifps != NULL) {
132 0 : memcpy(new, enc_allifps,
133 : sizeof(struct ifnet *) * (enc_max_unit + 1));
134 0 : free(enc_allifps, M_DEVBUF, 0);
135 0 : }
136 0 : enc_allifps = new;
137 0 : enc_max_unit = unit;
138 0 : }
139 0 : enc_allifps[unit] = ifp;
140 0 : NET_UNLOCK();
141 :
142 0 : return (0);
143 0 : }
144 :
145 : int
146 0 : enc_clone_destroy(struct ifnet *ifp)
147 : {
148 0 : struct enc_softc *sc = ifp->if_softc;
149 :
150 : /* Protect users from removing enc0 */
151 0 : if (sc->sc_unit == 0)
152 0 : return (EPERM);
153 :
154 0 : NET_LOCK();
155 0 : enc_allifps[sc->sc_unit] = NULL;
156 0 : enc_unsetif(ifp);
157 0 : NET_UNLOCK();
158 :
159 0 : if_detach(ifp);
160 0 : free(sc, M_DEVBUF, 0);
161 :
162 0 : return (0);
163 0 : }
164 :
165 : void
166 0 : enc_start(struct ifnet *ifp)
167 : {
168 : struct mbuf *m;
169 :
170 0 : for (;;) {
171 0 : IFQ_DEQUEUE(&ifp->if_snd, m);
172 0 : if (m == NULL)
173 : break;
174 0 : m_freem(m);
175 : }
176 0 : }
177 :
178 : int
179 0 : enc_output(struct ifnet *ifp, struct mbuf *m, struct sockaddr *sa,
180 : struct rtentry *rt)
181 : {
182 0 : m_freem(m); /* drop packet */
183 0 : return (EAFNOSUPPORT);
184 : }
185 :
186 : int
187 0 : enc_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
188 : {
189 0 : struct ifreq *ifr = (struct ifreq *)data;
190 : int error;
191 :
192 0 : switch (cmd) {
193 : case SIOCSIFADDR:
194 : case SIOCSIFDSTADDR:
195 : case SIOCSIFFLAGS:
196 0 : if (ifp->if_flags & IFF_UP)
197 0 : ifp->if_flags |= IFF_RUNNING;
198 : else
199 0 : ifp->if_flags &= ~IFF_RUNNING;
200 : break;
201 : case SIOCSIFRDOMAIN:
202 0 : if ((error = enc_setif(ifp, ifr->ifr_rdomainid)) != 0)
203 0 : return (error);
204 : /* FALLTHROUGH */
205 : default:
206 0 : return (ENOTTY);
207 : }
208 :
209 0 : return (0);
210 0 : }
211 :
212 : struct ifnet *
213 0 : enc_getif(u_int rdomain, u_int unit)
214 : {
215 : struct ifnet *ifp;
216 :
217 0 : NET_ASSERT_LOCKED();
218 :
219 : /* Check if the caller wants to get a non-default enc interface */
220 0 : if (unit > 0) {
221 0 : if (unit > enc_max_unit)
222 0 : return (NULL);
223 0 : ifp = enc_allifps[unit];
224 0 : if (ifp == NULL || ifp->if_rdomain != rdomain)
225 0 : return (NULL);
226 0 : return (ifp);
227 : }
228 :
229 : /* Otherwise return the default enc interface for this rdomain */
230 0 : if (enc_ifps == NULL)
231 0 : return (NULL);
232 0 : else if (rdomain > RT_TABLEID_MAX)
233 0 : return (NULL);
234 0 : else if (rdomain > enc_max_rdomain)
235 0 : return (NULL);
236 0 : return (enc_ifps[rdomain]);
237 0 : }
238 :
239 : struct ifaddr *
240 0 : enc_getifa(u_int rdomain, u_int unit)
241 : {
242 : struct ifnet *ifp;
243 : struct enc_softc *sc;
244 :
245 0 : ifp = enc_getif(rdomain, unit);
246 0 : if (ifp == NULL)
247 0 : return (NULL);
248 :
249 0 : sc = ifp->if_softc;
250 0 : return (&sc->sc_ifa);
251 0 : }
252 : int
253 0 : enc_setif(struct ifnet *ifp, u_int rdomain)
254 : {
255 : struct ifnet **new;
256 : size_t newlen;
257 :
258 0 : NET_ASSERT_LOCKED();
259 :
260 0 : enc_unsetif(ifp);
261 :
262 : /*
263 : * There can only be one default encif per rdomain -
264 : * Don't overwrite the existing enc iface that is stored
265 : * for this rdomain, so only the first enc interface that
266 : * was added for this rdomain becomes the default.
267 : */
268 0 : if (enc_getif(rdomain, 0) != NULL)
269 0 : return (0);
270 :
271 0 : if (rdomain > RT_TABLEID_MAX)
272 0 : return (EINVAL);
273 :
274 0 : if (enc_ifps == NULL || rdomain > enc_max_rdomain) {
275 0 : if ((new = mallocarray(rdomain + 1, sizeof(struct ifnet *),
276 0 : M_DEVBUF, M_NOWAIT|M_ZERO)) == NULL)
277 0 : return (ENOBUFS);
278 : newlen = sizeof(struct ifnet *) * (rdomain + 1);
279 :
280 0 : if (enc_ifps != NULL) {
281 0 : memcpy(new, enc_ifps,
282 : sizeof(struct ifnet *) * (enc_max_rdomain + 1));
283 0 : free(enc_ifps, M_DEVBUF, 0);
284 0 : }
285 0 : enc_ifps = new;
286 0 : enc_max_rdomain = rdomain;
287 0 : }
288 :
289 0 : enc_ifps[rdomain] = ifp;
290 :
291 : /* Indicate that this interface is the rdomain default */
292 0 : ifp->if_link_state = LINK_STATE_UP;
293 :
294 0 : return (0);
295 0 : }
296 :
297 : void
298 0 : enc_unsetif(struct ifnet *ifp)
299 : {
300 0 : u_int rdomain = ifp->if_rdomain, i;
301 : struct ifnet *oifp, *nifp;
302 :
303 0 : if ((oifp = enc_getif(rdomain, 0)) == NULL || oifp != ifp)
304 0 : return;
305 :
306 : /* Clear slot for this rdomain */
307 0 : enc_ifps[rdomain] = NULL;
308 0 : ifp->if_link_state = LINK_STATE_UNKNOWN;
309 :
310 : /*
311 : * Now find the next available encif to be the default interface
312 : * for this rdomain.
313 : */
314 0 : for (i = 0; i < (enc_max_unit + 1); i++) {
315 0 : nifp = enc_allifps[i];
316 :
317 0 : if (nifp == NULL || nifp == ifp || nifp->if_rdomain != rdomain)
318 : continue;
319 :
320 0 : enc_ifps[rdomain] = nifp;
321 0 : nifp->if_link_state = LINK_STATE_UP;
322 0 : break;
323 : }
324 0 : }
|
