altq_afmap.c revision 1.4 1 1.4 lukem /* $NetBSD: altq_afmap.c,v 1.4 2001/11/12 23:14:21 lukem Exp $ */
2 1.1 thorpej /* $KAME: altq_afmap.c,v 1.7 2000/12/14 08:12:45 thorpej Exp $ */
3 1.1 thorpej
4 1.1 thorpej /*
5 1.1 thorpej * Copyright (C) 1997-2000
6 1.1 thorpej * Sony Computer Science Laboratories Inc. All rights reserved.
7 1.1 thorpej *
8 1.1 thorpej * Redistribution and use in source and binary forms, with or without
9 1.1 thorpej * modification, are permitted provided that the following conditions
10 1.1 thorpej * are met:
11 1.1 thorpej * 1. Redistributions of source code must retain the above copyright
12 1.1 thorpej * notice, this list of conditions and the following disclaimer.
13 1.1 thorpej * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 thorpej * notice, this list of conditions and the following disclaimer in the
15 1.1 thorpej * documentation and/or other materials provided with the distribution.
16 1.1 thorpej *
17 1.1 thorpej * THIS SOFTWARE IS PROVIDED BY SONY CSL AND CONTRIBUTORS ``AS IS'' AND
18 1.1 thorpej * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 1.1 thorpej * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 1.1 thorpej * ARE DISCLAIMED. IN NO EVENT SHALL SONY CSL OR CONTRIBUTORS BE LIABLE
21 1.1 thorpej * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 1.1 thorpej * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 1.1 thorpej * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 1.1 thorpej * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 1.1 thorpej * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 1.1 thorpej * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 1.1 thorpej * SUCH DAMAGE.
28 1.1 thorpej */
29 1.1 thorpej
30 1.1 thorpej /*
31 1.1 thorpej * experimental:
32 1.1 thorpej * mapping an ip flow to atm vpi/vci.
33 1.1 thorpej * this module is not related to queueing at all, but uses the altq
34 1.1 thorpej * flowinfo mechanism. it's just put in the altq framework since
35 1.1 thorpej * it is easy to add devices to altq.
36 1.1 thorpej */
37 1.4 lukem
38 1.4 lukem #include <sys/cdefs.h>
39 1.4 lukem __KERNEL_RCSID(0, "$NetBSD: altq_afmap.c,v 1.4 2001/11/12 23:14:21 lukem Exp $");
40 1.4 lukem
41 1.1 thorpej #if defined(__FreeBSD__) || defined(__NetBSD__)
42 1.1 thorpej #include "opt_altq.h"
43 1.1 thorpej #if (__FreeBSD__ != 2)
44 1.1 thorpej #include "opt_inet.h"
45 1.1 thorpej #ifdef __FreeBSD__
46 1.1 thorpej #include "opt_inet6.h"
47 1.1 thorpej #endif
48 1.1 thorpej #endif
49 1.1 thorpej #endif /* __FreeBSD__ || __NetBSD__ */
50 1.1 thorpej #ifdef ALTQ_AFMAP
51 1.1 thorpej
52 1.1 thorpej #include <sys/types.h>
53 1.1 thorpej #include <sys/param.h>
54 1.1 thorpej #include <sys/malloc.h>
55 1.1 thorpej #include <sys/mbuf.h>
56 1.1 thorpej #include <sys/uio.h>
57 1.1 thorpej #include <sys/socket.h>
58 1.1 thorpej #include <sys/systm.h>
59 1.1 thorpej #include <sys/proc.h>
60 1.1 thorpej #include <sys/errno.h>
61 1.1 thorpej #include <sys/time.h>
62 1.1 thorpej #include <sys/kernel.h>
63 1.1 thorpej
64 1.1 thorpej #include <net/if.h>
65 1.1 thorpej #include <net/if_types.h>
66 1.1 thorpej #include <netinet/in.h>
67 1.1 thorpej
68 1.1 thorpej #include <altq/altq.h>
69 1.1 thorpej #include <altq/altq_conf.h>
70 1.1 thorpej #include <altq/altq_afmap.h>
71 1.1 thorpej
72 1.1 thorpej LIST_HEAD(, afm_head) afhead_chain;
73 1.1 thorpej
74 1.1 thorpej static struct afm *afm_match4 __P((struct afm_head *, struct flowinfo_in *));
75 1.1 thorpej #ifdef INET6
76 1.1 thorpej static struct afm *afm_match6 __P((struct afm_head *, struct flowinfo_in6 *));
77 1.1 thorpej #endif
78 1.1 thorpej
79 1.1 thorpej /*
80 1.1 thorpej * rules to block interrupts: afm_match can be called from a net
81 1.1 thorpej * level interrupt so that other routines handling the lists should
82 1.1 thorpej * be called in splnet().
83 1.1 thorpej */
84 1.1 thorpej int
85 1.1 thorpej afm_alloc(ifp)
86 1.1 thorpej struct ifnet *ifp;
87 1.1 thorpej {
88 1.1 thorpej struct afm_head *head;
89 1.1 thorpej
90 1.1 thorpej MALLOC(head, struct afm_head *, sizeof(struct afm_head),
91 1.1 thorpej M_DEVBUF, M_WAITOK);
92 1.1 thorpej if (head == NULL)
93 1.1 thorpej panic("afm_alloc: malloc failed!");
94 1.1 thorpej bzero(head, sizeof(struct afm_head));
95 1.1 thorpej
96 1.1 thorpej /* initialize per interface afmap list */
97 1.1 thorpej LIST_INIT(&head->afh_head);
98 1.1 thorpej
99 1.1 thorpej head->afh_ifp = ifp;
100 1.1 thorpej
101 1.1 thorpej /* add this afm_head to the chain */
102 1.1 thorpej LIST_INSERT_HEAD(&afhead_chain, head, afh_chain);
103 1.1 thorpej
104 1.1 thorpej return (0);
105 1.1 thorpej }
106 1.1 thorpej
107 1.1 thorpej int
108 1.1 thorpej afm_dealloc(ifp)
109 1.1 thorpej struct ifnet *ifp;
110 1.1 thorpej {
111 1.1 thorpej struct afm_head *head;
112 1.1 thorpej
113 1.1 thorpej for (head = afhead_chain.lh_first; head != NULL;
114 1.1 thorpej head = head->afh_chain.le_next)
115 1.1 thorpej if (head->afh_ifp == ifp)
116 1.1 thorpej break;
117 1.1 thorpej if (head == NULL)
118 1.1 thorpej return (-1);
119 1.1 thorpej
120 1.1 thorpej afm_removeall(ifp);
121 1.1 thorpej
122 1.1 thorpej LIST_REMOVE(head, afh_chain);
123 1.1 thorpej
124 1.1 thorpej FREE(head, M_DEVBUF);
125 1.1 thorpej return 0;
126 1.1 thorpej }
127 1.1 thorpej
128 1.1 thorpej struct afm *
129 1.1 thorpej afm_top(ifp)
130 1.1 thorpej struct ifnet *ifp;
131 1.1 thorpej {
132 1.1 thorpej struct afm_head *head;
133 1.1 thorpej
134 1.1 thorpej for (head = afhead_chain.lh_first; head != NULL;
135 1.1 thorpej head = head->afh_chain.le_next)
136 1.1 thorpej if (head->afh_ifp == ifp)
137 1.1 thorpej break;
138 1.1 thorpej if (head == NULL)
139 1.1 thorpej return NULL;
140 1.1 thorpej
141 1.1 thorpej return (head->afh_head.lh_first);
142 1.1 thorpej }
143 1.1 thorpej
144 1.1 thorpej int afm_add(ifp, flowmap)
145 1.1 thorpej struct ifnet *ifp;
146 1.1 thorpej struct atm_flowmap *flowmap;
147 1.1 thorpej {
148 1.1 thorpej struct afm_head *head;
149 1.1 thorpej struct afm *afm;
150 1.1 thorpej
151 1.1 thorpej for (head = afhead_chain.lh_first; head != NULL;
152 1.1 thorpej head = head->afh_chain.le_next)
153 1.1 thorpej if (head->afh_ifp == ifp)
154 1.1 thorpej break;
155 1.1 thorpej if (head == NULL)
156 1.1 thorpej return (-1);
157 1.1 thorpej
158 1.1 thorpej if (flowmap->af_flowinfo.fi_family == AF_INET) {
159 1.1 thorpej if (flowmap->af_flowinfo.fi_len != sizeof(struct flowinfo_in))
160 1.1 thorpej return (EINVAL);
161 1.1 thorpej #ifdef INET6
162 1.1 thorpej } else if (flowmap->af_flowinfo.fi_family == AF_INET6) {
163 1.1 thorpej if (flowmap->af_flowinfo.fi_len != sizeof(struct flowinfo_in6))
164 1.1 thorpej return (EINVAL);
165 1.1 thorpej #endif
166 1.1 thorpej } else
167 1.1 thorpej return (EINVAL);
168 1.1 thorpej
169 1.1 thorpej MALLOC(afm, struct afm *, sizeof(struct afm),
170 1.1 thorpej M_DEVBUF, M_WAITOK);
171 1.1 thorpej if (afm == NULL)
172 1.1 thorpej return (ENOMEM);
173 1.1 thorpej bzero(afm, sizeof(struct afm));
174 1.1 thorpej
175 1.1 thorpej afm->afm_vci = flowmap->af_vci;
176 1.1 thorpej afm->afm_vpi = flowmap->af_vpi;
177 1.1 thorpej bcopy(&flowmap->af_flowinfo, &afm->afm_flowinfo,
178 1.1 thorpej flowmap->af_flowinfo.fi_len);
179 1.1 thorpej
180 1.1 thorpej LIST_INSERT_HEAD(&head->afh_head, afm, afm_list);
181 1.1 thorpej return 0;
182 1.1 thorpej }
183 1.1 thorpej
184 1.1 thorpej int
185 1.1 thorpej afm_remove(afm)
186 1.1 thorpej struct afm *afm;
187 1.1 thorpej {
188 1.1 thorpej LIST_REMOVE(afm, afm_list);
189 1.1 thorpej FREE(afm, M_DEVBUF);
190 1.1 thorpej return (0);
191 1.1 thorpej }
192 1.1 thorpej
193 1.1 thorpej int
194 1.1 thorpej afm_removeall(ifp)
195 1.1 thorpej struct ifnet *ifp;
196 1.1 thorpej {
197 1.1 thorpej struct afm_head *head;
198 1.1 thorpej struct afm *afm;
199 1.1 thorpej
200 1.1 thorpej for (head = afhead_chain.lh_first; head != NULL;
201 1.1 thorpej head = head->afh_chain.le_next)
202 1.1 thorpej if (head->afh_ifp == ifp)
203 1.1 thorpej break;
204 1.1 thorpej if (head == NULL)
205 1.1 thorpej return (-1);
206 1.1 thorpej
207 1.1 thorpej while ((afm = head->afh_head.lh_first) != NULL)
208 1.1 thorpej afm_remove(afm);
209 1.1 thorpej return (0);
210 1.1 thorpej }
211 1.1 thorpej
212 1.1 thorpej struct afm *
213 1.1 thorpej afm_lookup(ifp, vpi, vci)
214 1.1 thorpej struct ifnet *ifp;
215 1.1 thorpej int vpi, vci;
216 1.1 thorpej {
217 1.1 thorpej struct afm_head *head;
218 1.1 thorpej struct afm *afm;
219 1.1 thorpej
220 1.1 thorpej for (head = afhead_chain.lh_first; head != NULL;
221 1.1 thorpej head = head->afh_chain.le_next)
222 1.1 thorpej if (head->afh_ifp == ifp)
223 1.1 thorpej break;
224 1.1 thorpej if (head == NULL)
225 1.1 thorpej return NULL;
226 1.1 thorpej
227 1.1 thorpej for (afm = head->afh_head.lh_first; afm != NULL;
228 1.1 thorpej afm = afm->afm_list.le_next)
229 1.1 thorpej if (afm->afm_vpi == vpi && afm->afm_vci == vci)
230 1.1 thorpej break;
231 1.1 thorpej return afm;
232 1.1 thorpej }
233 1.1 thorpej
234 1.1 thorpej static struct afm *
235 1.1 thorpej afm_match4(head, fp)
236 1.1 thorpej struct afm_head *head;
237 1.1 thorpej struct flowinfo_in *fp;
238 1.1 thorpej {
239 1.1 thorpej struct afm *afm;
240 1.1 thorpej
241 1.1 thorpej for (afm = head->afh_head.lh_first; afm != NULL;
242 1.1 thorpej afm = afm->afm_list.le_next) {
243 1.1 thorpej if (afm->afm_flowinfo4.fi_dst.s_addr != 0 &&
244 1.1 thorpej afm->afm_flowinfo4.fi_dst.s_addr != fp->fi_dst.s_addr)
245 1.1 thorpej continue;
246 1.1 thorpej if (afm->afm_flowinfo4.fi_dport != 0 &&
247 1.1 thorpej afm->afm_flowinfo4.fi_dport != fp->fi_dport)
248 1.1 thorpej continue;
249 1.1 thorpej if (afm->afm_flowinfo4.fi_src.s_addr != 0 &&
250 1.1 thorpej afm->afm_flowinfo4.fi_src.s_addr != fp->fi_src.s_addr)
251 1.1 thorpej continue;
252 1.1 thorpej if (afm->afm_flowinfo4.fi_sport != 0 &&
253 1.1 thorpej afm->afm_flowinfo4.fi_sport != fp->fi_sport)
254 1.1 thorpej continue;
255 1.1 thorpej if (afm->afm_flowinfo4.fi_proto != 0 &&
256 1.1 thorpej afm->afm_flowinfo4.fi_proto != fp->fi_proto)
257 1.1 thorpej continue;
258 1.1 thorpej /* match found! */
259 1.1 thorpej return (afm);
260 1.1 thorpej }
261 1.1 thorpej return NULL;
262 1.1 thorpej }
263 1.1 thorpej
264 1.1 thorpej #ifdef INET6
265 1.1 thorpej static struct afm *
266 1.1 thorpej afm_match6(head, fp)
267 1.1 thorpej struct afm_head *head;
268 1.1 thorpej struct flowinfo_in6 *fp;
269 1.1 thorpej {
270 1.1 thorpej struct afm *afm;
271 1.1 thorpej
272 1.1 thorpej for (afm = head->afh_head.lh_first; afm != NULL;
273 1.1 thorpej afm = afm->afm_list.le_next) {
274 1.1 thorpej if (afm->afm_flowinfo6.fi6_flowlabel != 0 &&
275 1.1 thorpej afm->afm_flowinfo6.fi6_flowlabel != fp->fi6_flowlabel)
276 1.1 thorpej continue;
277 1.1 thorpej #ifdef notyet
278 1.1 thorpej if (!IN6_IS_ADDR_UNSPECIFIED(&afm->afm_flowinfo6.fi6_dst) &&
279 1.1 thorpej !IN6_ARE_ADDR_EQUAL(&afm->afm_flowinfo6.fi6_dst,
280 1.1 thorpej &fp->fi6_dst))
281 1.1 thorpej continue;
282 1.1 thorpej if (afm->afm_flowinfo6.fi6_dport != 0 &&
283 1.1 thorpej afm->afm_flowinfo6.fi6_dport != fp->fi6_dport)
284 1.1 thorpej continue;
285 1.1 thorpej #endif
286 1.1 thorpej if (!IN6_IS_ADDR_UNSPECIFIED(&afm->afm_flowinfo6.fi6_src) &&
287 1.1 thorpej !IN6_ARE_ADDR_EQUAL(&afm->afm_flowinfo6.fi6_src,
288 1.1 thorpej &fp->fi6_src))
289 1.1 thorpej continue;
290 1.1 thorpej #ifdef notyet
291 1.1 thorpej if (afm->afm_flowinfo6.fi6_sport != 0 &&
292 1.1 thorpej afm->afm_flowinfo6.fi6_sport != fp->fi6_sport)
293 1.1 thorpej continue;
294 1.1 thorpej #endif
295 1.1 thorpej if (afm->afm_flowinfo6.fi6_proto != 0 &&
296 1.1 thorpej afm->afm_flowinfo6.fi6_proto != fp->fi6_proto)
297 1.1 thorpej continue;
298 1.1 thorpej /* match found! */
299 1.1 thorpej return (afm);
300 1.1 thorpej }
301 1.1 thorpej return NULL;
302 1.1 thorpej }
303 1.1 thorpej #endif
304 1.1 thorpej
305 1.3 thorpej /* should be called in splnet() */
306 1.1 thorpej struct afm *
307 1.1 thorpej afm_match(ifp, flow)
308 1.1 thorpej struct ifnet *ifp;
309 1.1 thorpej struct flowinfo *flow;
310 1.1 thorpej {
311 1.1 thorpej struct afm_head *head;
312 1.1 thorpej
313 1.1 thorpej for (head = afhead_chain.lh_first; head != NULL;
314 1.1 thorpej head = head->afh_chain.le_next)
315 1.1 thorpej if (head->afh_ifp == ifp)
316 1.1 thorpej break;
317 1.1 thorpej if (head == NULL)
318 1.1 thorpej return NULL;
319 1.1 thorpej
320 1.1 thorpej switch (flow->fi_family) {
321 1.1 thorpej case AF_INET:
322 1.1 thorpej return (afm_match4(head, (struct flowinfo_in *)flow));
323 1.1 thorpej
324 1.1 thorpej #ifdef INET6
325 1.1 thorpej case AF_INET6:
326 1.1 thorpej return (afm_match6(head, (struct flowinfo_in6 *)flow));
327 1.1 thorpej #endif
328 1.1 thorpej
329 1.1 thorpej default:
330 1.1 thorpej return NULL;
331 1.1 thorpej }
332 1.1 thorpej }
333 1.1 thorpej
334 1.1 thorpej /*
335 1.1 thorpej * afm device interface
336 1.1 thorpej */
337 1.1 thorpej altqdev_decl(afm);
338 1.1 thorpej
339 1.1 thorpej int
340 1.1 thorpej afmopen(dev, flag, fmt, p)
341 1.1 thorpej dev_t dev;
342 1.1 thorpej int flag, fmt;
343 1.1 thorpej struct proc *p;
344 1.1 thorpej {
345 1.1 thorpej return 0;
346 1.1 thorpej }
347 1.1 thorpej
348 1.1 thorpej int
349 1.1 thorpej afmclose(dev, flag, fmt, p)
350 1.1 thorpej dev_t dev;
351 1.1 thorpej int flag, fmt;
352 1.1 thorpej struct proc *p;
353 1.1 thorpej {
354 1.1 thorpej int err, error = 0;
355 1.1 thorpej struct atm_flowmap fmap;
356 1.1 thorpej struct afm_head *head;
357 1.1 thorpej
358 1.1 thorpej for (head = afhead_chain.lh_first; head != NULL;
359 1.1 thorpej head = head->afh_chain.le_next) {
360 1.1 thorpej
361 1.1 thorpej /* call interface to clean up maps */
362 1.1 thorpej #if defined(__NetBSD__) || defined(__OpenBSD__)
363 1.1 thorpej sprintf(fmap.af_ifname, "%s", head->afh_ifp->if_xname);
364 1.1 thorpej #else
365 1.1 thorpej sprintf(fmap.af_ifname, "%s%d",
366 1.1 thorpej head->afh_ifp->if_name, head->afh_ifp->if_unit);
367 1.1 thorpej #endif
368 1.1 thorpej err = afmioctl(dev, AFM_CLEANFMAP, (caddr_t)&fmap, flag, p);
369 1.1 thorpej if (err && error == 0)
370 1.1 thorpej error = err;
371 1.1 thorpej }
372 1.1 thorpej
373 1.1 thorpej return error;
374 1.1 thorpej }
375 1.1 thorpej
376 1.1 thorpej int
377 1.1 thorpej afmioctl(dev, cmd, addr, flag, p)
378 1.1 thorpej dev_t dev;
379 1.1 thorpej ioctlcmd_t cmd;
380 1.1 thorpej caddr_t addr;
381 1.1 thorpej int flag;
382 1.1 thorpej struct proc *p;
383 1.1 thorpej {
384 1.1 thorpej int error = 0;
385 1.1 thorpej struct atm_flowmap *flowmap;
386 1.1 thorpej struct ifnet *ifp;
387 1.1 thorpej
388 1.1 thorpej /* check cmd for superuser only */
389 1.1 thorpej switch (cmd) {
390 1.1 thorpej case AFM_GETFMAP:
391 1.1 thorpej break;
392 1.1 thorpej default:
393 1.1 thorpej #if (__FreeBSD_version > 400000)
394 1.1 thorpej error = suser(p);
395 1.1 thorpej #else
396 1.1 thorpej error = suser(p->p_ucred, &p->p_acflag);
397 1.1 thorpej #endif
398 1.1 thorpej if (error)
399 1.1 thorpej return (error);
400 1.1 thorpej break;
401 1.1 thorpej }
402 1.1 thorpej
403 1.1 thorpej /* lookup interface */
404 1.1 thorpej flowmap = (struct atm_flowmap *)addr;
405 1.1 thorpej flowmap->af_ifname[IFNAMSIZ-1] = '\0';
406 1.1 thorpej ifp = ifunit(flowmap->af_ifname);
407 1.1 thorpej if (ifp == NULL || ifp->if_ioctl == NULL ||
408 1.1 thorpej (ifp->if_flags & IFF_RUNNING) == 0)
409 1.1 thorpej error = ENXIO;
410 1.1 thorpej else
411 1.1 thorpej error = ifp->if_ioctl(ifp, cmd, addr);
412 1.1 thorpej
413 1.1 thorpej return error;
414 1.1 thorpej }
415 1.1 thorpej
416 1.1 thorpej #endif /* ALTQ_AFMAP */
417