Ignore machine-check MSRs
[freebsd-src/fkvm-freebsd.git] / sys / netinet / if_atm.c
blob065f0c4bcb416b712256bbf90f607478a5d59971
1 /* $NetBSD: if_atm.c,v 1.6 1996/10/13 02:03:01 christos Exp $ */
3 /*-
5 * Copyright (c) 1996 Charles D. Cranor and Washington University.
6 * All rights reserved.
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.
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.
34 #include <sys/cdefs.h>
35 __FBSDID("$FreeBSD$");
38 * IP <=> ATM address resolution.
40 #include "opt_inet.h"
41 #include "opt_inet6.h"
42 #include "opt_natm.h"
44 #if defined(INET) || defined(INET6)
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>
54 #include <net/if.h>
55 #include <net/if_dl.h>
56 #include <net/route.h>
57 #include <net/if_atm.h>
59 #include <netinet/in.h>
60 #include <netinet/if_atm.h>
62 #ifdef NATM
63 #include <netnatm/natm.h>
64 #endif
66 #define SDL(s) ((struct sockaddr_dl *)s)
68 #define GET3BYTE(V, A, L) do { \
69 (V) = ((A)[0] << 16) | ((A)[1] << 8) | (A)[2]; \
70 (A) += 3; \
71 (L) -= 3; \
72 } while (0)
74 #define GET2BYTE(V, A, L) do { \
75 (V) = ((A)[0] << 8) | (A)[1]; \
76 (A) += 2; \
77 (L) -= 2; \
78 } while (0)
80 #define GET1BYTE(V, A, L) do { \
81 (V) = *(A)++; \
82 (L)--; \
83 } while (0)
87 * atm_rtrequest: handle ATM rt request (in support of generic code)
88 * inputs: "req" = request code
89 * "rt" = route entry
90 * "info" = rt_addrinfo
92 void
93 atm_rtrequest(int req, struct rtentry *rt, struct rt_addrinfo *info)
95 struct sockaddr *gate = rt->rt_gateway;
96 struct atmio_openvcc op;
97 struct atmio_closevcc cl;
98 u_char *addr;
99 u_int alen;
100 #ifdef NATM
101 struct sockaddr_in *sin;
102 struct natmpcb *npcb = NULL;
103 #endif
104 static struct sockaddr_dl null_sdl = {sizeof(null_sdl), AF_LINK};
106 if (rt->rt_flags & RTF_GATEWAY) /* link level requests only */
107 return;
109 switch (req) {
111 case RTM_RESOLVE: /* resolve: only happens when cloning */
112 printf("atm_rtrequest: RTM_RESOLVE request detected?\n");
113 break;
115 case RTM_ADD:
117 * route added by a command (e.g. ifconfig, route, arp...).
119 * first check to see if this is not a host route, in which
120 * case we are being called via "ifconfig" to set the address.
122 if ((rt->rt_flags & RTF_HOST) == 0) {
123 rt_setgate(rt,rt_key(rt),(struct sockaddr *)&null_sdl);
124 gate = rt->rt_gateway;
125 SDL(gate)->sdl_type = rt->rt_ifp->if_type;
126 SDL(gate)->sdl_index = rt->rt_ifp->if_index;
127 break;
130 if ((rt->rt_flags & RTF_CLONING) != 0) {
131 printf("atm_rtrequest: cloning route detected?\n");
132 break;
134 if (gate->sa_family != AF_LINK ||
135 gate->sa_len < sizeof(null_sdl)) {
136 log(LOG_DEBUG, "atm_rtrequest: bad gateway value");
137 break;
140 KASSERT(rt->rt_ifp->if_ioctl != NULL,
141 ("atm_rtrequest: null ioctl"));
144 * Parse and verify the link level address as
145 * an open request
147 #ifdef NATM
148 NATM_LOCK();
149 #endif
150 bzero(&op, sizeof(op));
151 addr = LLADDR(SDL(gate));
152 alen = SDL(gate)->sdl_alen;
153 if (alen < 4) {
154 printf("%s: bad link-level address\n", __func__);
155 goto failed;
158 if (alen == 4) {
159 /* old type address */
160 GET1BYTE(op.param.flags, addr, alen);
161 GET1BYTE(op.param.vpi, addr, alen);
162 GET2BYTE(op.param.vci, addr, alen);
163 op.param.traffic = ATMIO_TRAFFIC_UBR;
164 op.param.aal = (op.param.flags & ATM_PH_AAL5) ?
165 ATMIO_AAL_5 : ATMIO_AAL_0;
166 } else {
167 /* new address */
168 op.param.aal = ATMIO_AAL_5;
170 GET1BYTE(op.param.flags, addr, alen);
171 op.param.flags &= ATM_PH_LLCSNAP;
173 GET1BYTE(op.param.vpi, addr, alen);
174 GET2BYTE(op.param.vci, addr, alen);
176 GET1BYTE(op.param.traffic, addr, alen);
178 switch (op.param.traffic) {
180 case ATMIO_TRAFFIC_UBR:
181 if (alen >= 3)
182 GET3BYTE(op.param.tparam.pcr,
183 addr, alen);
184 break;
186 case ATMIO_TRAFFIC_CBR:
187 if (alen < 3)
188 goto bad_param;
189 GET3BYTE(op.param.tparam.pcr, addr, alen);
190 break;
192 case ATMIO_TRAFFIC_VBR:
193 if (alen < 3 * 3)
194 goto bad_param;
195 GET3BYTE(op.param.tparam.pcr, addr, alen);
196 GET3BYTE(op.param.tparam.scr, addr, alen);
197 GET3BYTE(op.param.tparam.mbs, addr, alen);
198 break;
200 case ATMIO_TRAFFIC_ABR:
201 if (alen < 4 * 3 + 2 + 1 * 2 + 3)
202 goto bad_param;
203 GET3BYTE(op.param.tparam.pcr, addr, alen);
204 GET3BYTE(op.param.tparam.mcr, addr, alen);
205 GET3BYTE(op.param.tparam.icr, addr, alen);
206 GET3BYTE(op.param.tparam.tbe, addr, alen);
207 GET1BYTE(op.param.tparam.nrm, addr, alen);
208 GET1BYTE(op.param.tparam.trm, addr, alen);
209 GET2BYTE(op.param.tparam.adtf, addr, alen);
210 GET1BYTE(op.param.tparam.rif, addr, alen);
211 GET1BYTE(op.param.tparam.rdf, addr, alen);
212 GET1BYTE(op.param.tparam.cdf, addr, alen);
213 break;
215 default:
216 bad_param:
217 printf("%s: bad traffic params\n", __func__);
218 goto failed;
221 op.param.rmtu = op.param.tmtu = rt->rt_ifp->if_mtu;
222 #ifdef NATM
224 * let native ATM know we are using this VCI/VPI
225 * (i.e. reserve it)
227 sin = (struct sockaddr_in *) rt_key(rt);
228 if (sin->sin_family != AF_INET)
229 goto failed;
230 npcb = npcb_add(NULL, rt->rt_ifp, op.param.vci, op.param.vpi);
231 if (npcb == NULL)
232 goto failed;
233 npcb->npcb_flags |= NPCB_IP;
234 npcb->ipaddr.s_addr = sin->sin_addr.s_addr;
235 /* XXX: move npcb to llinfo when ATM ARP is ready */
236 rt->rt_llinfo = (caddr_t) npcb;
237 rt->rt_flags |= RTF_LLINFO;
238 #endif
240 * let the lower level know this circuit is active
242 op.rxhand = NULL;
243 op.param.flags |= ATMIO_FLAG_ASYNC;
244 if (rt->rt_ifp->if_ioctl(rt->rt_ifp, SIOCATMOPENVCC,
245 (caddr_t)&op) != 0) {
246 printf("atm: couldn't add VC\n");
247 goto failed;
250 SDL(gate)->sdl_type = rt->rt_ifp->if_type;
251 SDL(gate)->sdl_index = rt->rt_ifp->if_index;
253 #ifdef NATM
254 NATM_UNLOCK();
255 #endif
256 break;
258 failed:
259 #ifdef NATM
260 if (npcb) {
261 npcb_free(npcb, NPCB_DESTROY);
262 rt->rt_llinfo = NULL;
263 rt->rt_flags &= ~RTF_LLINFO;
265 NATM_UNLOCK();
266 #endif
267 /* mark as invalid. We cannot RTM_DELETE the route from
268 * here, because the recursive call to rtrequest1 does
269 * not really work. */
270 rt->rt_flags |= RTF_REJECT;
271 break;
273 case RTM_DELETE:
274 #ifdef NATM
276 * tell native ATM we are done with this VC
278 if (rt->rt_flags & RTF_LLINFO) {
279 NATM_LOCK();
280 npcb_free((struct natmpcb *)rt->rt_llinfo,
281 NPCB_DESTROY);
282 rt->rt_llinfo = NULL;
283 rt->rt_flags &= ~RTF_LLINFO;
284 NATM_UNLOCK();
286 #endif
288 * tell the lower layer to disable this circuit
290 bzero(&op, sizeof(op));
291 addr = LLADDR(SDL(gate));
292 addr++;
293 cl.vpi = *addr++;
294 cl.vci = *addr++ << 8;
295 cl.vci |= *addr++;
296 (void)rt->rt_ifp->if_ioctl(rt->rt_ifp, SIOCATMCLOSEVCC,
297 (caddr_t)&cl);
298 break;
303 * atmresolve:
304 * inputs:
305 * [1] "rt" = the link level route to use (or null if need to look one up)
306 * [2] "m" = mbuf containing the data to be sent
307 * [3] "dst" = sockaddr_in (IP) address of dest.
308 * output:
309 * [4] "desten" = ATM pseudo header which we will fill in VPI/VCI info
310 * return:
311 * 0 == resolve FAILED; note that "m" gets m_freem'd in this case
312 * 1 == resolve OK; desten contains result
314 * XXX: will need more work if we wish to support ATMARP in the kernel,
315 * but this is enough for PVCs entered via the "route" command.
318 atmresolve(struct rtentry *rt, struct mbuf *m, struct sockaddr *dst,
319 struct atm_pseudohdr *desten)
321 struct sockaddr_dl *sdl;
323 if (m->m_flags & (M_BCAST | M_MCAST)) {
324 log(LOG_INFO,
325 "atmresolve: BCAST/MCAST packet detected/dumped\n");
326 goto bad;
329 if (rt == NULL) {
330 rt = RTALLOC1(dst, 0); /* link level on table 0 XXX MRT */
331 if (rt == NULL)
332 goto bad; /* failed */
333 RT_REMREF(rt); /* don't keep LL references */
334 if ((rt->rt_flags & RTF_GATEWAY) != 0 ||
335 (rt->rt_flags & RTF_LLINFO) == 0 ||
336 /* XXX: are we using LLINFO? */
337 rt->rt_gateway->sa_family != AF_LINK) {
338 RT_UNLOCK(rt);
339 goto bad;
341 RT_UNLOCK(rt);
345 * note that rt_gateway is a sockaddr_dl which contains the
346 * atm_pseudohdr data structure for this route. we currently
347 * don't need any rt_llinfo info (but will if we want to support
348 * ATM ARP [c.f. if_ether.c]).
350 sdl = SDL(rt->rt_gateway);
353 * Check the address family and length is valid, the address
354 * is resolved; otherwise, try to resolve.
356 if (sdl->sdl_family == AF_LINK && sdl->sdl_alen >= sizeof(*desten)) {
357 bcopy(LLADDR(sdl), desten, sizeof(*desten));
358 return (1); /* ok, go for it! */
362 * we got an entry, but it doesn't have valid link address
363 * info in it (it is prob. the interface route, which has
364 * sdl_alen == 0). dump packet. (fall through to "bad").
366 bad:
367 m_freem(m);
368 return (0);
370 #endif /* INET */