1 /* $NetBSD: if_atm.c,v 1.6 1996/10/13 02:03:01 christos Exp $ */
2
3 /*-
4 *
5 * Copyright (c) 1996 Charles D. Cranor and Washington University.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. All advertising materials mentioning features or use of this software
17 * must display the following acknowledgement:
18 * This product includes software developed by Charles D. Cranor and
19 * Washington University.
20 * 4. The name of the author may not be used to endorse or promote products
21 * derived from this software without specific prior written permission.
22 *
23 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
24 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
25 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
26 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
27 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
28 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
29 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
30 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
31 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
32 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 */
34 #include <sys/cdefs.h>
35 __FBSDID("$FreeBSD$");
36
37 /*
38 * IP <=> ATM address resolution.
39 */
40 #include "opt_inet.h"
41 #include "opt_inet6.h"
42 #include "opt_natm.h"
43
44 #if defined(INET) || defined(INET6)
45
46 #include <sys/param.h>
47 #include <sys/systm.h>
48 #include <sys/queue.h>
49 #include <sys/mbuf.h>
50 #include <sys/socket.h>
51 #include <sys/sockio.h>
52 #include <sys/syslog.h>
53
54 #include <net/if.h>
55 #include <net/if_var.h>
56 #include <net/if_dl.h>
57 #include <net/route.h>
58 #include <net/if_atm.h>
59
60 #include <netinet/in.h>
61 #include <netinet/if_atm.h>
62
63 #ifdef NATM
64 #include <netnatm/natm.h>
65 #endif
66
67 #define SDL(s) ((struct sockaddr_dl *)s)
68
69 #define GET3BYTE(V, A, L) do { \
70 (V) = ((A)[0] << 16) | ((A)[1] << 8) | (A)[2]; \
71 (A) += 3; \
72 (L) -= 3; \
73 } while (0)
74
75 #define GET2BYTE(V, A, L) do { \
76 (V) = ((A)[0] << 8) | (A)[1]; \
77 (A) += 2; \
78 (L) -= 2; \
79 } while (0)
80
81 #define GET1BYTE(V, A, L) do { \
82 (V) = *(A)++; \
83 (L)--; \
84 } while (0)
85
86
87 /*
88 * atm_rtrequest: handle ATM rt request (in support of generic code)
89 * inputs: "req" = request code
90 * "rt" = route entry
91 * "info" = rt_addrinfo
92 */
93 void
atm_rtrequest(int req,struct rtentry * rt,struct rt_addrinfo * info)94 atm_rtrequest(int req, struct rtentry *rt, struct rt_addrinfo *info)
95 {
96 struct sockaddr *gate = rt->rt_gateway;
97 struct atmio_openvcc op;
98 struct atmio_closevcc cl;
99 u_char *addr;
100 u_int alen;
101 #ifdef NATM
102 struct sockaddr_in *sin;
103 struct natmpcb *npcb = NULL;
104 #endif
105 static struct sockaddr_dl null_sdl = {sizeof(null_sdl), AF_LINK};
106
107 if (rt->rt_flags & RTF_GATEWAY) /* link level requests only */
108 return;
109
110 switch (req) {
111
112 case RTM_RESOLVE: /* resolve: only happens when cloning */
113 printf("atm_rtrequest: RTM_RESOLVE request detected?\n");
114 break;
115
116 case RTM_ADD:
117 /*
118 * route added by a command (e.g. ifconfig, route, arp...).
119 *
120 * first check to see if this is not a host route, in which
121 * case we are being called via "ifconfig" to set the address.
122 */
123 if ((rt->rt_flags & RTF_HOST) == 0) {
124 rt_setgate(rt,rt_key(rt),(struct sockaddr *)&null_sdl);
125 gate = rt->rt_gateway;
126 SDL(gate)->sdl_type = rt->rt_ifp->if_type;
127 SDL(gate)->sdl_index = rt->rt_ifp->if_index;
128 break;
129 }
130
131 if (gate->sa_family != AF_LINK ||
132 gate->sa_len < sizeof(null_sdl)) {
133 log(LOG_DEBUG, "atm_rtrequest: bad gateway value");
134 break;
135 }
136
137 KASSERT(rt->rt_ifp->if_ioctl != NULL,
138 ("atm_rtrequest: null ioctl"));
139
140 /*
141 * Parse and verify the link level address as
142 * an open request
143 */
144 #ifdef NATM
145 NATM_LOCK();
146 #endif
147 bzero(&op, sizeof(op));
148 addr = LLADDR(SDL(gate));
149 alen = SDL(gate)->sdl_alen;
150 if (alen < 4) {
151 printf("%s: bad link-level address\n", __func__);
152 goto failed;
153 }
154
155 if (alen == 4) {
156 /* old type address */
157 GET1BYTE(op.param.flags, addr, alen);
158 GET1BYTE(op.param.vpi, addr, alen);
159 GET2BYTE(op.param.vci, addr, alen);
160 op.param.traffic = ATMIO_TRAFFIC_UBR;
161 op.param.aal = (op.param.flags & ATM_PH_AAL5) ?
162 ATMIO_AAL_5 : ATMIO_AAL_0;
163 } else {
164 /* new address */
165 op.param.aal = ATMIO_AAL_5;
166
167 GET1BYTE(op.param.flags, addr, alen);
168 op.param.flags &= ATM_PH_LLCSNAP;
169
170 GET1BYTE(op.param.vpi, addr, alen);
171 GET2BYTE(op.param.vci, addr, alen);
172
173 GET1BYTE(op.param.traffic, addr, alen);
174
175 switch (op.param.traffic) {
176
177 case ATMIO_TRAFFIC_UBR:
178 if (alen >= 3)
179 GET3BYTE(op.param.tparam.pcr,
180 addr, alen);
181 break;
182
183 case ATMIO_TRAFFIC_CBR:
184 if (alen < 3)
185 goto bad_param;
186 GET3BYTE(op.param.tparam.pcr, addr, alen);
187 break;
188
189 case ATMIO_TRAFFIC_VBR:
190 if (alen < 3 * 3)
191 goto bad_param;
192 GET3BYTE(op.param.tparam.pcr, addr, alen);
193 GET3BYTE(op.param.tparam.scr, addr, alen);
194 GET3BYTE(op.param.tparam.mbs, addr, alen);
195 break;
196
197 case ATMIO_TRAFFIC_ABR:
198 if (alen < 4 * 3 + 2 + 1 * 2 + 3)
199 goto bad_param;
200 GET3BYTE(op.param.tparam.pcr, addr, alen);
201 GET3BYTE(op.param.tparam.mcr, addr, alen);
202 GET3BYTE(op.param.tparam.icr, addr, alen);
203 GET3BYTE(op.param.tparam.tbe, addr, alen);
204 GET1BYTE(op.param.tparam.nrm, addr, alen);
205 GET1BYTE(op.param.tparam.trm, addr, alen);
206 GET2BYTE(op.param.tparam.adtf, addr, alen);
207 GET1BYTE(op.param.tparam.rif, addr, alen);
208 GET1BYTE(op.param.tparam.rdf, addr, alen);
209 GET1BYTE(op.param.tparam.cdf, addr, alen);
210 break;
211
212 default:
213 bad_param:
214 printf("%s: bad traffic params\n", __func__);
215 goto failed;
216 }
217 }
218 op.param.rmtu = op.param.tmtu = rt->rt_ifp->if_mtu;
219 #ifdef NATM
220 /*
221 * let native ATM know we are using this VCI/VPI
222 * (i.e. reserve it)
223 */
224 sin = (struct sockaddr_in *) rt_key(rt);
225 if (sin->sin_family != AF_INET)
226 goto failed;
227 npcb = npcb_add(NULL, rt->rt_ifp, op.param.vci, op.param.vpi);
228 if (npcb == NULL)
229 goto failed;
230 npcb->npcb_flags |= NPCB_IP;
231 npcb->ipaddr.s_addr = sin->sin_addr.s_addr;
232 /* XXX: move npcb to llinfo when ATM ARP is ready */
233 #ifdef __notyet_restored__
234 rt->rt_llinfo = (caddr_t) npcb;
235 #endif
236 rt->rt_flags |= RTF_LLINFO;
237 #endif
238 /*
239 * let the lower level know this circuit is active
240 */
241 op.rxhand = NULL;
242 op.param.flags |= ATMIO_FLAG_ASYNC;
243 if (rt->rt_ifp->if_ioctl(rt->rt_ifp, SIOCATMOPENVCC,
244 (caddr_t)&op) != 0) {
245 printf("atm: couldn't add VC\n");
246 goto failed;
247 }
248
249 SDL(gate)->sdl_type = rt->rt_ifp->if_type;
250 SDL(gate)->sdl_index = rt->rt_ifp->if_index;
251
252 #ifdef NATM
253 NATM_UNLOCK();
254 #endif
255 break;
256
257 failed:
258 #ifdef NATM
259 if (npcb) {
260 npcb_free(npcb, NPCB_DESTROY);
261 #ifdef __notyet_restored__
262 rt->rt_llinfo = NULL;
263 #endif
264 rt->rt_flags &= ~RTF_LLINFO;
265 }
266 NATM_UNLOCK();
267 #endif
268 /* mark as invalid. We cannot RTM_DELETE the route from
269 * here, because the recursive call to rtrequest1 does
270 * not really work. */
271 rt->rt_flags |= RTF_REJECT;
272 break;
273
274 case RTM_DELETE:
275 #ifdef NATM
276 /*
277 * tell native ATM we are done with this VC
278 */
279 if (rt->rt_flags & RTF_LLINFO) {
280 NATM_LOCK();
281 #ifdef __notyet_restored__
282 npcb_free((struct natmpcb *)rt->rt_llinfo,
283 NPCB_DESTROY);
284 rt->rt_llinfo = NULL;
285 #endif
286 rt->rt_flags &= ~RTF_LLINFO;
287 NATM_UNLOCK();
288 }
289 #endif
290 /*
291 * tell the lower layer to disable this circuit
292 */
293 bzero(&op, sizeof(op));
294 addr = LLADDR(SDL(gate));
295 addr++;
296 cl.vpi = *addr++;
297 cl.vci = *addr++ << 8;
298 cl.vci |= *addr++;
299 (void)rt->rt_ifp->if_ioctl(rt->rt_ifp, SIOCATMCLOSEVCC,
300 (caddr_t)&cl);
301 break;
302 }
303 }
304
305 /*
306 * atmresolve:
307 * inputs:
308 * [1] "rt" = the link level route to use (or null if need to look one up)
309 * [2] "m" = mbuf containing the data to be sent
310 * [3] "dst" = sockaddr_in (IP) address of dest.
311 * output:
312 * [4] "desten" = ATM pseudo header which we will fill in VPI/VCI info
313 * return:
314 * 0 == resolve FAILED; note that "m" gets m_freem'd in this case
315 * 1 == resolve OK; desten contains result
316 *
317 * XXX: will need more work if we wish to support ATMARP in the kernel,
318 * but this is enough for PVCs entered via the "route" command.
319 */
320 int
atmresolve(struct rtentry * rt,struct mbuf * m,const struct sockaddr * dst,struct atm_pseudohdr * desten)321 atmresolve(struct rtentry *rt, struct mbuf *m, const struct sockaddr *dst,
322 struct atm_pseudohdr *desten)
323 {
324 struct sockaddr_dl *sdl;
325
326 if (m->m_flags & (M_BCAST | M_MCAST)) {
327 log(LOG_INFO,
328 "atmresolve: BCAST/MCAST packet detected/dumped\n");
329 goto bad;
330 }
331
332 if (rt == NULL) {
333 /* link level on table 0 XXX MRT */
334 rt = RTALLOC1(__DECONST(struct sockaddr *, dst), 0);
335 if (rt == NULL)
336 goto bad; /* failed */
337 RT_REMREF(rt); /* don't keep LL references */
338 if ((rt->rt_flags & RTF_GATEWAY) != 0 ||
339 rt->rt_gateway->sa_family != AF_LINK) {
340 RT_UNLOCK(rt);
341 goto bad;
342 }
343 RT_UNLOCK(rt);
344 }
345
346 /*
347 * note that rt_gateway is a sockaddr_dl which contains the
348 * atm_pseudohdr data structure for this route. we currently
349 * don't need any rt_llinfo info (but will if we want to support
350 * ATM ARP [c.f. if_ether.c]).
351 */
352 sdl = SDL(rt->rt_gateway);
353
354 /*
355 * Check the address family and length is valid, the address
356 * is resolved; otherwise, try to resolve.
357 */
358 if (sdl->sdl_family == AF_LINK && sdl->sdl_alen >= sizeof(*desten)) {
359 bcopy(LLADDR(sdl), desten, sizeof(*desten));
360 return (1); /* ok, go for it! */
361 }
362
363 /*
364 * we got an entry, but it doesn't have valid link address
365 * info in it (it is prob. the interface route, which has
366 * sdl_alen == 0). dump packet. (fall through to "bad").
367 */
368 bad:
369 m_freem(m);
370 return (0);
371 }
372 #endif /* INET */
373