ip6_mroute.c revision 1.29 1 1.29 itojun /* $NetBSD: ip6_mroute.c,v 1.29 2002/05/29 07:53:41 itojun Exp $ */
2 1.22 itojun /* $KAME: ip6_mroute.c,v 1.49 2001/07/25 09:21:18 jinmei Exp $ */
3 1.3 thorpej
4 1.2 itojun /*
5 1.2 itojun * Copyright (C) 1998 WIDE Project.
6 1.2 itojun * All rights reserved.
7 1.12 itojun *
8 1.2 itojun * Redistribution and use in source and binary forms, with or without
9 1.2 itojun * modification, are permitted provided that the following conditions
10 1.2 itojun * are met:
11 1.2 itojun * 1. Redistributions of source code must retain the above copyright
12 1.2 itojun * notice, this list of conditions and the following disclaimer.
13 1.2 itojun * 2. Redistributions in binary form must reproduce the above copyright
14 1.2 itojun * notice, this list of conditions and the following disclaimer in the
15 1.2 itojun * documentation and/or other materials provided with the distribution.
16 1.2 itojun * 3. Neither the name of the project nor the names of its contributors
17 1.2 itojun * may be used to endorse or promote products derived from this software
18 1.2 itojun * without specific prior written permission.
19 1.12 itojun *
20 1.2 itojun * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
21 1.2 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 1.2 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 1.2 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
24 1.2 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 1.2 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 1.2 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 1.2 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 1.2 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 1.2 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30 1.2 itojun * SUCH DAMAGE.
31 1.2 itojun */
32 1.2 itojun
33 1.2 itojun /* BSDI ip_mroute.c,v 2.10 1996/11/14 00:29:52 jch Exp */
34 1.2 itojun
35 1.2 itojun /*
36 1.2 itojun * IP multicast forwarding procedures
37 1.2 itojun *
38 1.2 itojun * Written by David Waitzman, BBN Labs, August 1988.
39 1.2 itojun * Modified by Steve Deering, Stanford, February 1989.
40 1.2 itojun * Modified by Mark J. Steiglitz, Stanford, May, 1991
41 1.2 itojun * Modified by Van Jacobson, LBL, January 1993
42 1.2 itojun * Modified by Ajit Thyagarajan, PARC, August 1993
43 1.2 itojun * Modified by Bill Fenenr, PARC, April 1994
44 1.2 itojun *
45 1.2 itojun * MROUTING Revision: 3.5.1.2 + PIM-SMv2 (pimd) Support
46 1.2 itojun */
47 1.24 lukem
48 1.24 lukem #include <sys/cdefs.h>
49 1.29 itojun __KERNEL_RCSID(0, "$NetBSD: ip6_mroute.c,v 1.29 2002/05/29 07:53:41 itojun Exp $");
50 1.2 itojun
51 1.2 itojun #include "opt_inet.h"
52 1.2 itojun
53 1.8 itojun #ifndef _KERNEL
54 1.8 itojun # ifdef KERNEL
55 1.8 itojun # define _KERNEL
56 1.8 itojun # endif
57 1.8 itojun #endif
58 1.8 itojun
59 1.2 itojun #include <sys/param.h>
60 1.2 itojun #include <sys/systm.h>
61 1.11 thorpej #include <sys/callout.h>
62 1.2 itojun #include <sys/mbuf.h>
63 1.2 itojun #include <sys/socket.h>
64 1.2 itojun #include <sys/socketvar.h>
65 1.2 itojun #include <sys/sockio.h>
66 1.2 itojun #include <sys/protosw.h>
67 1.2 itojun #include <sys/errno.h>
68 1.2 itojun #include <sys/time.h>
69 1.2 itojun #include <sys/kernel.h>
70 1.2 itojun #include <sys/ioctl.h>
71 1.2 itojun #include <sys/syslog.h>
72 1.2 itojun
73 1.2 itojun #include <net/if.h>
74 1.2 itojun #include <net/route.h>
75 1.2 itojun #include <net/raw_cb.h>
76 1.2 itojun
77 1.2 itojun #include <netinet/in.h>
78 1.2 itojun #include <netinet/in_var.h>
79 1.2 itojun
80 1.10 itojun #include <netinet/ip6.h>
81 1.2 itojun #include <netinet6/ip6_var.h>
82 1.2 itojun #include <netinet6/ip6_mroute.h>
83 1.2 itojun #include <netinet6/pim6.h>
84 1.2 itojun #include <netinet6/pim6_var.h>
85 1.29 itojun #include <netinet6/nd6.h>
86 1.2 itojun
87 1.13 itojun #include <net/net_osdep.h>
88 1.13 itojun
89 1.2 itojun #define M_HASCL(m) ((m)->m_flags & M_EXT)
90 1.2 itojun
91 1.2 itojun static int ip6_mdq __P((struct mbuf *, struct ifnet *, struct mf6c *));
92 1.2 itojun static void phyint_send __P((struct ip6_hdr *, struct mif6 *, struct mbuf *));
93 1.2 itojun
94 1.2 itojun static int set_pim6 __P((int *));
95 1.2 itojun static int get_pim6 __P((struct mbuf *));
96 1.2 itojun static int socket_send __P((struct socket *, struct mbuf *,
97 1.2 itojun struct sockaddr_in6 *));
98 1.2 itojun static int register_send __P((struct ip6_hdr *, struct mif6 *,
99 1.2 itojun struct mbuf *));
100 1.2 itojun
101 1.2 itojun /*
102 1.2 itojun * Globals. All but ip6_mrouter, ip6_mrtproto and mrt6stat could be static,
103 1.2 itojun * except for netstat or debugging purposes.
104 1.2 itojun */
105 1.2 itojun struct socket *ip6_mrouter = NULL;
106 1.12 itojun int ip6_mrouter_ver = 0;
107 1.2 itojun int ip6_mrtproto = IPPROTO_PIM; /* for netstat only */
108 1.2 itojun struct mrt6stat mrt6stat;
109 1.2 itojun
110 1.2 itojun #define NO_RTE_FOUND 0x1
111 1.2 itojun #define RTE_FOUND 0x2
112 1.2 itojun
113 1.2 itojun struct mf6c *mf6ctable[MF6CTBLSIZ];
114 1.28 matt u_char nexpire6[MF6CTBLSIZ];
115 1.2 itojun static struct mif6 mif6table[MAXMIFS];
116 1.2 itojun #ifdef MRT6DEBUG
117 1.2 itojun u_int mrt6debug = 0; /* debug level */
118 1.2 itojun #define DEBUG_MFC 0x02
119 1.2 itojun #define DEBUG_FORWARD 0x04
120 1.2 itojun #define DEBUG_EXPIRE 0x08
121 1.2 itojun #define DEBUG_XMIT 0x10
122 1.2 itojun #define DEBUG_REG 0x20
123 1.2 itojun #define DEBUG_PIM 0x40
124 1.2 itojun #endif
125 1.2 itojun
126 1.2 itojun static void expire_upcalls __P((void *));
127 1.2 itojun #define EXPIRE_TIMEOUT (hz / 4) /* 4x / second */
128 1.2 itojun #define UPCALL_EXPIRE 6 /* number of timeouts */
129 1.2 itojun
130 1.2 itojun #ifdef INET
131 1.2 itojun #ifdef MROUTING
132 1.2 itojun extern struct socket *ip_mrouter;
133 1.2 itojun #endif
134 1.12 itojun #endif
135 1.2 itojun
136 1.2 itojun /*
137 1.2 itojun * 'Interfaces' associated with decapsulator (so we can tell
138 1.2 itojun * packets that went through it from ones that get reflected
139 1.2 itojun * by a broken gateway). These interfaces are never linked into
140 1.2 itojun * the system ifnet list & no routes point to them. I.e., packets
141 1.2 itojun * can't be sent this way. They only exist as a placeholder for
142 1.2 itojun * multicast source verification.
143 1.2 itojun */
144 1.2 itojun struct ifnet multicast_register_if;
145 1.2 itojun
146 1.2 itojun #define ENCAP_HOPS 64
147 1.2 itojun
148 1.2 itojun /*
149 1.2 itojun * Private variables.
150 1.2 itojun */
151 1.2 itojun static mifi_t nummifs = 0;
152 1.2 itojun static mifi_t reg_mif_num = (mifi_t)-1;
153 1.2 itojun
154 1.2 itojun static struct pim6stat pim6stat;
155 1.2 itojun static int pim6;
156 1.2 itojun
157 1.2 itojun /*
158 1.2 itojun * Hash function for a source, group entry
159 1.2 itojun */
160 1.2 itojun #define MF6CHASH(a, g) MF6CHASHMOD((a).s6_addr32[0] ^ (a).s6_addr32[1] ^ \
161 1.2 itojun (a).s6_addr32[2] ^ (a).s6_addr32[3] ^ \
162 1.2 itojun (g).s6_addr32[0] ^ (g).s6_addr32[1] ^ \
163 1.2 itojun (g).s6_addr32[2] ^ (g).s6_addr32[3])
164 1.2 itojun
165 1.2 itojun /*
166 1.2 itojun * Find a route for a given origin IPv6 address and Multicast group address.
167 1.2 itojun * Quality of service parameter to be added in the future!!!
168 1.2 itojun */
169 1.2 itojun
170 1.12 itojun #define MF6CFIND(o, g, rt) do { \
171 1.15 itojun struct mf6c *_rt = mf6ctable[MF6CHASH(o,g)]; \
172 1.2 itojun rt = NULL; \
173 1.2 itojun mrt6stat.mrt6s_mfc_lookups++; \
174 1.2 itojun while (_rt) { \
175 1.2 itojun if (IN6_ARE_ADDR_EQUAL(&_rt->mf6c_origin.sin6_addr, &(o)) && \
176 1.2 itojun IN6_ARE_ADDR_EQUAL(&_rt->mf6c_mcastgrp.sin6_addr, &(g)) && \
177 1.2 itojun (_rt->mf6c_stall == NULL)) { \
178 1.2 itojun rt = _rt; \
179 1.2 itojun break; \
180 1.2 itojun } \
181 1.2 itojun _rt = _rt->mf6c_next; \
182 1.2 itojun } \
183 1.2 itojun if (rt == NULL) { \
184 1.2 itojun mrt6stat.mrt6s_mfc_misses++; \
185 1.2 itojun } \
186 1.12 itojun } while (0)
187 1.2 itojun
188 1.2 itojun /*
189 1.2 itojun * Macros to compute elapsed time efficiently
190 1.2 itojun * Borrowed from Van Jacobson's scheduling code
191 1.2 itojun */
192 1.12 itojun #define TV_DELTA(a, b, delta) do { \
193 1.15 itojun int xxs; \
194 1.2 itojun \
195 1.2 itojun delta = (a).tv_usec - (b).tv_usec; \
196 1.2 itojun if ((xxs = (a).tv_sec - (b).tv_sec)) { \
197 1.2 itojun switch (xxs) { \
198 1.2 itojun case 2: \
199 1.2 itojun delta += 1000000; \
200 1.2 itojun /* fall through */ \
201 1.2 itojun case 1: \
202 1.2 itojun delta += 1000000; \
203 1.2 itojun break; \
204 1.2 itojun default: \
205 1.2 itojun delta += (1000000 * xxs); \
206 1.2 itojun } \
207 1.2 itojun } \
208 1.12 itojun } while (0)
209 1.2 itojun
210 1.2 itojun #define TV_LT(a, b) (((a).tv_usec < (b).tv_usec && \
211 1.2 itojun (a).tv_sec <= (b).tv_sec) || (a).tv_sec < (b).tv_sec)
212 1.2 itojun
213 1.2 itojun #ifdef UPCALL_TIMING
214 1.7 itojun #define UPCALL_MAX 50
215 1.7 itojun u_long upcall_data[UPCALL_MAX + 1];
216 1.2 itojun static void collate();
217 1.2 itojun #endif /* UPCALL_TIMING */
218 1.2 itojun
219 1.2 itojun static int get_sg_cnt __P((struct sioc_sg_req6 *));
220 1.2 itojun static int get_mif6_cnt __P((struct sioc_mif_req6 *));
221 1.12 itojun static int ip6_mrouter_init __P((struct socket *, struct mbuf *, int));
222 1.2 itojun static int add_m6if __P((struct mif6ctl *));
223 1.2 itojun static int del_m6if __P((mifi_t *));
224 1.2 itojun static int add_m6fc __P((struct mf6cctl *));
225 1.2 itojun static int del_m6fc __P((struct mf6cctl *));
226 1.2 itojun
227 1.11 thorpej static struct callout expire_upcalls_ch = CALLOUT_INITIALIZER;
228 1.11 thorpej
229 1.2 itojun /*
230 1.2 itojun * Handle MRT setsockopt commands to modify the multicast routing tables.
231 1.2 itojun */
232 1.2 itojun int
233 1.2 itojun ip6_mrouter_set(cmd, so, m)
234 1.2 itojun int cmd;
235 1.2 itojun struct socket *so;
236 1.2 itojun struct mbuf *m;
237 1.2 itojun {
238 1.2 itojun if (cmd != MRT6_INIT && so != ip6_mrouter)
239 1.2 itojun return EACCES;
240 1.2 itojun
241 1.2 itojun switch (cmd) {
242 1.23 itojun case MRT6_OINIT: return ip6_mrouter_init(so, m, cmd);
243 1.23 itojun case MRT6_INIT: return ip6_mrouter_init(so, m, cmd);
244 1.23 itojun case MRT6_DONE: return ip6_mrouter_done();
245 1.23 itojun case MRT6_ADD_MIF: return add_m6if(mtod(m, struct mif6ctl *));
246 1.23 itojun case MRT6_DEL_MIF: return del_m6if(mtod(m, mifi_t *));
247 1.23 itojun case MRT6_ADD_MFC: return add_m6fc(mtod(m, struct mf6cctl *));
248 1.23 itojun case MRT6_DEL_MFC: return del_m6fc(mtod(m, struct mf6cctl *));
249 1.23 itojun case MRT6_PIM: return set_pim6(mtod(m, int *));
250 1.23 itojun default: return EOPNOTSUPP;
251 1.2 itojun }
252 1.2 itojun }
253 1.2 itojun
254 1.2 itojun /*
255 1.2 itojun * Handle MRT getsockopt commands
256 1.2 itojun */
257 1.2 itojun int
258 1.2 itojun ip6_mrouter_get(cmd, so, m)
259 1.2 itojun int cmd;
260 1.2 itojun struct socket *so;
261 1.2 itojun struct mbuf **m;
262 1.2 itojun {
263 1.2 itojun struct mbuf *mb;
264 1.2 itojun
265 1.2 itojun if (so != ip6_mrouter) return EACCES;
266 1.2 itojun
267 1.2 itojun *m = mb = m_get(M_WAIT, MT_SOOPTS);
268 1.2 itojun
269 1.2 itojun switch (cmd) {
270 1.23 itojun case MRT6_PIM:
271 1.23 itojun return get_pim6(mb);
272 1.23 itojun default:
273 1.23 itojun m_free(mb);
274 1.23 itojun return EOPNOTSUPP;
275 1.2 itojun }
276 1.2 itojun }
277 1.2 itojun
278 1.2 itojun /*
279 1.2 itojun * Handle ioctl commands to obtain information from the cache
280 1.2 itojun */
281 1.2 itojun int
282 1.2 itojun mrt6_ioctl(cmd, data)
283 1.2 itojun int cmd;
284 1.2 itojun caddr_t data;
285 1.2 itojun {
286 1.23 itojun int error = 0;
287 1.2 itojun
288 1.23 itojun switch (cmd) {
289 1.23 itojun case SIOCGETSGCNT_IN6:
290 1.23 itojun return(get_sg_cnt((struct sioc_sg_req6 *)data));
291 1.23 itojun break; /* for safety */
292 1.23 itojun case SIOCGETMIFCNT_IN6:
293 1.23 itojun return(get_mif6_cnt((struct sioc_mif_req6 *)data));
294 1.23 itojun break; /* for safety */
295 1.23 itojun default:
296 1.23 itojun return (EINVAL);
297 1.23 itojun break;
298 1.23 itojun }
299 1.23 itojun return error;
300 1.2 itojun }
301 1.2 itojun
302 1.2 itojun /*
303 1.2 itojun * returns the packet, byte, rpf-failure count for the source group provided
304 1.2 itojun */
305 1.2 itojun static int
306 1.2 itojun get_sg_cnt(req)
307 1.15 itojun struct sioc_sg_req6 *req;
308 1.2 itojun {
309 1.15 itojun struct mf6c *rt;
310 1.2 itojun int s;
311 1.2 itojun
312 1.4 itojun s = splsoftnet();
313 1.2 itojun MF6CFIND(req->src.sin6_addr, req->grp.sin6_addr, rt);
314 1.2 itojun splx(s);
315 1.2 itojun if (rt != NULL) {
316 1.2 itojun req->pktcnt = rt->mf6c_pkt_cnt;
317 1.2 itojun req->bytecnt = rt->mf6c_byte_cnt;
318 1.2 itojun req->wrong_if = rt->mf6c_wrong_if;
319 1.2 itojun } else
320 1.2 itojun return(ESRCH);
321 1.2 itojun #if 0
322 1.2 itojun req->pktcnt = req->bytecnt = req->wrong_if = 0xffffffff;
323 1.12 itojun #endif
324 1.2 itojun
325 1.2 itojun return 0;
326 1.2 itojun }
327 1.2 itojun
328 1.2 itojun /*
329 1.2 itojun * returns the input and output packet and byte counts on the mif provided
330 1.2 itojun */
331 1.2 itojun static int
332 1.2 itojun get_mif6_cnt(req)
333 1.15 itojun struct sioc_mif_req6 *req;
334 1.2 itojun {
335 1.15 itojun mifi_t mifi = req->mifi;
336 1.2 itojun
337 1.2 itojun if (mifi >= nummifs)
338 1.2 itojun return EINVAL;
339 1.2 itojun
340 1.2 itojun req->icount = mif6table[mifi].m6_pkt_in;
341 1.2 itojun req->ocount = mif6table[mifi].m6_pkt_out;
342 1.2 itojun req->ibytes = mif6table[mifi].m6_bytes_in;
343 1.2 itojun req->obytes = mif6table[mifi].m6_bytes_out;
344 1.2 itojun
345 1.2 itojun return 0;
346 1.2 itojun }
347 1.2 itojun
348 1.2 itojun /*
349 1.2 itojun * Get PIM processiong global
350 1.2 itojun */
351 1.2 itojun static int
352 1.2 itojun get_pim6(m)
353 1.2 itojun struct mbuf *m;
354 1.2 itojun {
355 1.2 itojun int *i;
356 1.2 itojun
357 1.2 itojun i = mtod(m, int *);
358 1.2 itojun
359 1.2 itojun *i = pim6;
360 1.2 itojun
361 1.2 itojun return 0;
362 1.2 itojun }
363 1.2 itojun
364 1.2 itojun static int
365 1.2 itojun set_pim6(i)
366 1.2 itojun int *i;
367 1.2 itojun {
368 1.2 itojun if ((*i != 1) && (*i != 0))
369 1.2 itojun return EINVAL;
370 1.2 itojun
371 1.2 itojun pim6 = *i;
372 1.2 itojun
373 1.2 itojun return 0;
374 1.2 itojun }
375 1.2 itojun
376 1.2 itojun /*
377 1.2 itojun * Enable multicast routing
378 1.2 itojun */
379 1.2 itojun static int
380 1.12 itojun ip6_mrouter_init(so, m, cmd)
381 1.2 itojun struct socket *so;
382 1.2 itojun struct mbuf *m;
383 1.12 itojun int cmd;
384 1.2 itojun {
385 1.2 itojun int *v;
386 1.2 itojun
387 1.2 itojun #ifdef MRT6DEBUG
388 1.2 itojun if (mrt6debug)
389 1.2 itojun log(LOG_DEBUG,
390 1.2 itojun "ip6_mrouter_init: so_type = %d, pr_protocol = %d\n",
391 1.2 itojun so->so_type, so->so_proto->pr_protocol);
392 1.2 itojun #endif
393 1.2 itojun
394 1.2 itojun if (so->so_type != SOCK_RAW ||
395 1.2 itojun so->so_proto->pr_protocol != IPPROTO_ICMPV6)
396 1.2 itojun return EOPNOTSUPP;
397 1.2 itojun
398 1.2 itojun if (!m || (m->m_len != sizeof(int *)))
399 1.2 itojun return ENOPROTOOPT;
400 1.2 itojun
401 1.2 itojun v = mtod(m, int *);
402 1.2 itojun if (*v != 1)
403 1.2 itojun return ENOPROTOOPT;
404 1.2 itojun
405 1.2 itojun if (ip6_mrouter != NULL) return EADDRINUSE;
406 1.2 itojun
407 1.2 itojun ip6_mrouter = so;
408 1.12 itojun ip6_mrouter_ver = cmd;
409 1.2 itojun
410 1.2 itojun bzero((caddr_t)mf6ctable, sizeof(mf6ctable));
411 1.28 matt bzero((caddr_t)nexpire6, sizeof(nexpire6));
412 1.2 itojun
413 1.2 itojun pim6 = 0;/* used for stubbing out/in pim stuff */
414 1.2 itojun
415 1.11 thorpej callout_reset(&expire_upcalls_ch, EXPIRE_TIMEOUT,
416 1.11 thorpej expire_upcalls, NULL);
417 1.2 itojun
418 1.2 itojun #ifdef MRT6DEBUG
419 1.2 itojun if (mrt6debug)
420 1.2 itojun log(LOG_DEBUG, "ip6_mrouter_init\n");
421 1.2 itojun #endif
422 1.2 itojun
423 1.2 itojun return 0;
424 1.2 itojun }
425 1.2 itojun
426 1.2 itojun /*
427 1.2 itojun * Disable multicast routing
428 1.2 itojun */
429 1.2 itojun int
430 1.2 itojun ip6_mrouter_done()
431 1.2 itojun {
432 1.2 itojun mifi_t mifi;
433 1.2 itojun int i;
434 1.2 itojun struct ifnet *ifp;
435 1.2 itojun struct in6_ifreq ifr;
436 1.2 itojun struct mf6c *rt;
437 1.2 itojun struct rtdetq *rte;
438 1.2 itojun int s;
439 1.2 itojun
440 1.4 itojun s = splsoftnet();
441 1.2 itojun
442 1.2 itojun /*
443 1.2 itojun * For each phyint in use, disable promiscuous reception of all IPv6
444 1.2 itojun * multicasts.
445 1.2 itojun */
446 1.2 itojun #ifdef INET
447 1.2 itojun #ifdef MROUTING
448 1.2 itojun /*
449 1.2 itojun * If there is still IPv4 multicast routing daemon,
450 1.2 itojun * we remain interfaces to receive all muliticasted packets.
451 1.2 itojun * XXX: there may be an interface in which the IPv4 multicast
452 1.2 itojun * daemon is not interested...
453 1.2 itojun */
454 1.2 itojun if (!ip_mrouter)
455 1.2 itojun #endif
456 1.12 itojun #endif
457 1.2 itojun {
458 1.2 itojun for (mifi = 0; mifi < nummifs; mifi++) {
459 1.2 itojun if (mif6table[mifi].m6_ifp &&
460 1.2 itojun !(mif6table[mifi].m6_flags & MIFF_REGISTER)) {
461 1.2 itojun ifr.ifr_addr.sin6_family = AF_INET6;
462 1.2 itojun ifr.ifr_addr.sin6_addr= in6addr_any;
463 1.2 itojun ifp = mif6table[mifi].m6_ifp;
464 1.2 itojun (*ifp->if_ioctl)(ifp, SIOCDELMULTI,
465 1.2 itojun (caddr_t)&ifr);
466 1.2 itojun }
467 1.2 itojun }
468 1.2 itojun }
469 1.2 itojun #ifdef notyet
470 1.2 itojun bzero((caddr_t)qtable, sizeof(qtable));
471 1.2 itojun bzero((caddr_t)tbftable, sizeof(tbftable));
472 1.12 itojun #endif
473 1.2 itojun bzero((caddr_t)mif6table, sizeof(mif6table));
474 1.2 itojun nummifs = 0;
475 1.2 itojun
476 1.2 itojun pim6 = 0; /* used to stub out/in pim specific code */
477 1.2 itojun
478 1.11 thorpej callout_stop(&expire_upcalls_ch);
479 1.2 itojun
480 1.2 itojun /*
481 1.2 itojun * Free all multicast forwarding cache entries.
482 1.2 itojun */
483 1.2 itojun for (i = 0; i < MF6CTBLSIZ; i++) {
484 1.2 itojun rt = mf6ctable[i];
485 1.2 itojun while (rt) {
486 1.2 itojun struct mf6c *frt;
487 1.2 itojun
488 1.2 itojun for (rte = rt->mf6c_stall; rte != NULL; ) {
489 1.2 itojun struct rtdetq *n = rte->next;
490 1.2 itojun
491 1.2 itojun m_free(rte->m);
492 1.2 itojun free(rte, M_MRTABLE);
493 1.2 itojun rte = n;
494 1.2 itojun }
495 1.2 itojun frt = rt;
496 1.2 itojun rt = rt->mf6c_next;
497 1.2 itojun free(frt, M_MRTABLE);
498 1.2 itojun }
499 1.2 itojun }
500 1.2 itojun
501 1.2 itojun bzero((caddr_t)mf6ctable, sizeof(mf6ctable));
502 1.2 itojun
503 1.2 itojun /*
504 1.2 itojun * Reset de-encapsulation cache
505 1.2 itojun */
506 1.2 itojun reg_mif_num = -1;
507 1.12 itojun
508 1.2 itojun ip6_mrouter = NULL;
509 1.12 itojun ip6_mrouter_ver = 0;
510 1.2 itojun
511 1.2 itojun splx(s);
512 1.2 itojun
513 1.2 itojun #ifdef MRT6DEBUG
514 1.2 itojun if (mrt6debug)
515 1.2 itojun log(LOG_DEBUG, "ip6_mrouter_done\n");
516 1.2 itojun #endif
517 1.2 itojun
518 1.2 itojun return 0;
519 1.2 itojun }
520 1.2 itojun
521 1.2 itojun static struct sockaddr_in6 sin6 = { sizeof(sin6), AF_INET6 };
522 1.2 itojun
523 1.2 itojun /*
524 1.2 itojun * Add a mif to the mif table
525 1.2 itojun */
526 1.2 itojun static int
527 1.2 itojun add_m6if(mifcp)
528 1.15 itojun struct mif6ctl *mifcp;
529 1.2 itojun {
530 1.15 itojun struct mif6 *mifp;
531 1.2 itojun struct ifnet *ifp;
532 1.2 itojun struct in6_ifreq ifr;
533 1.2 itojun int error, s;
534 1.2 itojun #ifdef notyet
535 1.2 itojun struct tbf *m_tbf = tbftable + mifcp->mif6c_mifi;
536 1.12 itojun #endif
537 1.2 itojun
538 1.2 itojun if (mifcp->mif6c_mifi >= MAXMIFS)
539 1.2 itojun return EINVAL;
540 1.2 itojun mifp = mif6table + mifcp->mif6c_mifi;
541 1.2 itojun if (mifp->m6_ifp)
542 1.2 itojun return EADDRINUSE; /* XXX: is it appropriate? */
543 1.2 itojun if (mifcp->mif6c_pifi == 0 || mifcp->mif6c_pifi > if_index)
544 1.2 itojun return ENXIO;
545 1.22 itojun /*
546 1.22 itojun * XXX: some OSes can remove ifp and clear ifindex2ifnet[id]
547 1.22 itojun * even for id between 0 and if_index.
548 1.22 itojun */
549 1.22 itojun if ((ifp = ifindex2ifnet[mifcp->mif6c_pifi]) == NULL)
550 1.22 itojun return ENXIO;
551 1.2 itojun
552 1.2 itojun if (mifcp->mif6c_flags & MIFF_REGISTER) {
553 1.2 itojun if (reg_mif_num == (mifi_t)-1) {
554 1.2 itojun strcpy(multicast_register_if.if_xname,
555 1.2 itojun "register_mif"); /* XXX */
556 1.2 itojun multicast_register_if.if_flags |= IFF_LOOPBACK;
557 1.2 itojun multicast_register_if.if_index = mifcp->mif6c_mifi;
558 1.2 itojun reg_mif_num = mifcp->mif6c_mifi;
559 1.2 itojun }
560 1.2 itojun
561 1.2 itojun ifp = &multicast_register_if;
562 1.2 itojun
563 1.2 itojun } /* if REGISTER */
564 1.2 itojun else {
565 1.2 itojun /* Make sure the interface supports multicast */
566 1.2 itojun if ((ifp->if_flags & IFF_MULTICAST) == 0)
567 1.2 itojun return EOPNOTSUPP;
568 1.2 itojun
569 1.8 itojun s = splsoftnet();
570 1.2 itojun /*
571 1.2 itojun * Enable promiscuous reception of all IPv6 multicasts
572 1.8 itojun * from the interface.
573 1.2 itojun */
574 1.2 itojun ifr.ifr_addr.sin6_family = AF_INET6;
575 1.2 itojun ifr.ifr_addr.sin6_addr = in6addr_any;
576 1.2 itojun error = (*ifp->if_ioctl)(ifp, SIOCADDMULTI, (caddr_t)&ifr);
577 1.2 itojun splx(s);
578 1.2 itojun if (error)
579 1.2 itojun return error;
580 1.2 itojun }
581 1.2 itojun
582 1.4 itojun s = splsoftnet();
583 1.2 itojun mifp->m6_flags = mifcp->mif6c_flags;
584 1.2 itojun mifp->m6_ifp = ifp;
585 1.2 itojun #ifdef notyet
586 1.2 itojun /* scaling up here allows division by 1024 in critical code */
587 1.2 itojun mifp->m6_rate_limit = mifcp->mif6c_rate_limit * 1024 / 1000;
588 1.12 itojun #endif
589 1.2 itojun /* initialize per mif pkt counters */
590 1.2 itojun mifp->m6_pkt_in = 0;
591 1.2 itojun mifp->m6_pkt_out = 0;
592 1.2 itojun mifp->m6_bytes_in = 0;
593 1.2 itojun mifp->m6_bytes_out = 0;
594 1.2 itojun splx(s);
595 1.2 itojun
596 1.2 itojun /* Adjust nummifs up if the mifi is higher than nummifs */
597 1.2 itojun if (nummifs <= mifcp->mif6c_mifi)
598 1.2 itojun nummifs = mifcp->mif6c_mifi + 1;
599 1.2 itojun
600 1.2 itojun #ifdef MRT6DEBUG
601 1.2 itojun if (mrt6debug)
602 1.2 itojun log(LOG_DEBUG,
603 1.2 itojun "add_mif #%d, phyint %s%d\n",
604 1.2 itojun mifcp->mif6c_mifi,
605 1.2 itojun ifp->if_name, ifp->if_unit);
606 1.2 itojun #endif
607 1.2 itojun
608 1.2 itojun return 0;
609 1.2 itojun }
610 1.2 itojun
611 1.2 itojun /*
612 1.2 itojun * Delete a mif from the mif table
613 1.2 itojun */
614 1.2 itojun static int
615 1.2 itojun del_m6if(mifip)
616 1.2 itojun mifi_t *mifip;
617 1.2 itojun {
618 1.15 itojun struct mif6 *mifp = mif6table + *mifip;
619 1.15 itojun mifi_t mifi;
620 1.2 itojun struct ifnet *ifp;
621 1.2 itojun struct in6_ifreq ifr;
622 1.2 itojun int s;
623 1.2 itojun
624 1.2 itojun if (*mifip >= nummifs)
625 1.2 itojun return EINVAL;
626 1.2 itojun if (mifp->m6_ifp == NULL)
627 1.2 itojun return EINVAL;
628 1.2 itojun
629 1.4 itojun s = splsoftnet();
630 1.2 itojun
631 1.2 itojun if (!(mifp->m6_flags & MIFF_REGISTER)) {
632 1.2 itojun /*
633 1.2 itojun * XXX: what if there is yet IPv4 multicast daemon
634 1.2 itojun * using the interface?
635 1.2 itojun */
636 1.8 itojun ifp = mifp->m6_ifp;
637 1.8 itojun
638 1.2 itojun ifr.ifr_addr.sin6_family = AF_INET6;
639 1.2 itojun ifr.ifr_addr.sin6_addr = in6addr_any;
640 1.2 itojun (*ifp->if_ioctl)(ifp, SIOCDELMULTI, (caddr_t)&ifr);
641 1.2 itojun }
642 1.2 itojun
643 1.2 itojun #ifdef notyet
644 1.2 itojun bzero((caddr_t)qtable[*mifip], sizeof(qtable[*mifip]));
645 1.2 itojun bzero((caddr_t)mifp->m6_tbf, sizeof(*(mifp->m6_tbf)));
646 1.12 itojun #endif
647 1.2 itojun bzero((caddr_t)mifp, sizeof (*mifp));
648 1.2 itojun
649 1.2 itojun /* Adjust nummifs down */
650 1.2 itojun for (mifi = nummifs; mifi > 0; mifi--)
651 1.2 itojun if (mif6table[mifi - 1].m6_ifp)
652 1.2 itojun break;
653 1.2 itojun nummifs = mifi;
654 1.2 itojun
655 1.2 itojun splx(s);
656 1.2 itojun
657 1.2 itojun #ifdef MRT6DEBUG
658 1.2 itojun if (mrt6debug)
659 1.2 itojun log(LOG_DEBUG, "del_m6if %d, nummifs %d\n", *mifip, nummifs);
660 1.2 itojun #endif
661 1.2 itojun
662 1.2 itojun return 0;
663 1.2 itojun }
664 1.2 itojun
665 1.2 itojun /*
666 1.2 itojun * Add an mfc entry
667 1.2 itojun */
668 1.2 itojun static int
669 1.2 itojun add_m6fc(mfccp)
670 1.2 itojun struct mf6cctl *mfccp;
671 1.2 itojun {
672 1.2 itojun struct mf6c *rt;
673 1.2 itojun u_long hash;
674 1.2 itojun struct rtdetq *rte;
675 1.15 itojun u_short nstl;
676 1.2 itojun int s;
677 1.2 itojun
678 1.2 itojun MF6CFIND(mfccp->mf6cc_origin.sin6_addr,
679 1.2 itojun mfccp->mf6cc_mcastgrp.sin6_addr, rt);
680 1.2 itojun
681 1.2 itojun /* If an entry already exists, just update the fields */
682 1.2 itojun if (rt) {
683 1.2 itojun #ifdef MRT6DEBUG
684 1.2 itojun if (mrt6debug & DEBUG_MFC)
685 1.2 itojun log(LOG_DEBUG,"add_m6fc update o %s g %s p %x\n",
686 1.2 itojun ip6_sprintf(&mfccp->mf6cc_origin.sin6_addr),
687 1.2 itojun ip6_sprintf(&mfccp->mf6cc_mcastgrp.sin6_addr),
688 1.2 itojun mfccp->mf6cc_parent);
689 1.2 itojun #endif
690 1.2 itojun
691 1.4 itojun s = splsoftnet();
692 1.2 itojun rt->mf6c_parent = mfccp->mf6cc_parent;
693 1.2 itojun rt->mf6c_ifset = mfccp->mf6cc_ifset;
694 1.2 itojun splx(s);
695 1.2 itojun return 0;
696 1.2 itojun }
697 1.2 itojun
698 1.12 itojun /*
699 1.2 itojun * Find the entry for which the upcall was made and update
700 1.2 itojun */
701 1.4 itojun s = splsoftnet();
702 1.2 itojun hash = MF6CHASH(mfccp->mf6cc_origin.sin6_addr,
703 1.2 itojun mfccp->mf6cc_mcastgrp.sin6_addr);
704 1.2 itojun for (rt = mf6ctable[hash], nstl = 0; rt; rt = rt->mf6c_next) {
705 1.2 itojun if (IN6_ARE_ADDR_EQUAL(&rt->mf6c_origin.sin6_addr,
706 1.2 itojun &mfccp->mf6cc_origin.sin6_addr) &&
707 1.2 itojun IN6_ARE_ADDR_EQUAL(&rt->mf6c_mcastgrp.sin6_addr,
708 1.2 itojun &mfccp->mf6cc_mcastgrp.sin6_addr) &&
709 1.2 itojun (rt->mf6c_stall != NULL)) {
710 1.2 itojun
711 1.2 itojun if (nstl++)
712 1.2 itojun log(LOG_ERR,
713 1.5 itojun "add_m6fc: %s o %s g %s p %x dbx %p\n",
714 1.2 itojun "multiple kernel entries",
715 1.2 itojun ip6_sprintf(&mfccp->mf6cc_origin.sin6_addr),
716 1.2 itojun ip6_sprintf(&mfccp->mf6cc_mcastgrp.sin6_addr),
717 1.5 itojun mfccp->mf6cc_parent, rt->mf6c_stall);
718 1.2 itojun
719 1.2 itojun #ifdef MRT6DEBUG
720 1.2 itojun if (mrt6debug & DEBUG_MFC)
721 1.2 itojun log(LOG_DEBUG,
722 1.2 itojun "add_m6fc o %s g %s p %x dbg %x\n",
723 1.2 itojun ip6_sprintf(&mfccp->mf6cc_origin.sin6_addr),
724 1.2 itojun ip6_sprintf(&mfccp->mf6cc_mcastgrp.sin6_addr),
725 1.2 itojun mfccp->mf6cc_parent, rt->mf6c_stall);
726 1.2 itojun #endif
727 1.2 itojun
728 1.2 itojun rt->mf6c_origin = mfccp->mf6cc_origin;
729 1.2 itojun rt->mf6c_mcastgrp = mfccp->mf6cc_mcastgrp;
730 1.2 itojun rt->mf6c_parent = mfccp->mf6cc_parent;
731 1.2 itojun rt->mf6c_ifset = mfccp->mf6cc_ifset;
732 1.2 itojun /* initialize pkt counters per src-grp */
733 1.2 itojun rt->mf6c_pkt_cnt = 0;
734 1.2 itojun rt->mf6c_byte_cnt = 0;
735 1.2 itojun rt->mf6c_wrong_if = 0;
736 1.2 itojun
737 1.2 itojun rt->mf6c_expire = 0; /* Don't clean this guy up */
738 1.28 matt nexpire6[hash]--;
739 1.2 itojun
740 1.2 itojun /* free packets Qed at the end of this entry */
741 1.2 itojun for (rte = rt->mf6c_stall; rte != NULL; ) {
742 1.2 itojun struct rtdetq *n = rte->next;
743 1.2 itojun ip6_mdq(rte->m, rte->ifp, rt);
744 1.2 itojun m_freem(rte->m);
745 1.2 itojun #ifdef UPCALL_TIMING
746 1.2 itojun collate(&(rte->t));
747 1.2 itojun #endif /* UPCALL_TIMING */
748 1.2 itojun free(rte, M_MRTABLE);
749 1.2 itojun rte = n;
750 1.2 itojun }
751 1.2 itojun rt->mf6c_stall = NULL;
752 1.2 itojun }
753 1.2 itojun }
754 1.2 itojun
755 1.2 itojun /*
756 1.2 itojun * It is possible that an entry is being inserted without an upcall
757 1.2 itojun */
758 1.2 itojun if (nstl == 0) {
759 1.2 itojun #ifdef MRT6DEBUG
760 1.2 itojun if (mrt6debug & DEBUG_MFC)
761 1.2 itojun log(LOG_DEBUG,"add_mfc no upcall h %d o %s g %s p %x\n",
762 1.2 itojun hash,
763 1.2 itojun ip6_sprintf(&mfccp->mf6cc_origin.sin6_addr),
764 1.2 itojun ip6_sprintf(&mfccp->mf6cc_mcastgrp.sin6_addr),
765 1.2 itojun mfccp->mf6cc_parent);
766 1.2 itojun #endif
767 1.2 itojun
768 1.2 itojun for (rt = mf6ctable[hash]; rt; rt = rt->mf6c_next) {
769 1.26 sommerfe
770 1.2 itojun if (IN6_ARE_ADDR_EQUAL(&rt->mf6c_origin.sin6_addr,
771 1.2 itojun &mfccp->mf6cc_origin.sin6_addr)&&
772 1.2 itojun IN6_ARE_ADDR_EQUAL(&rt->mf6c_mcastgrp.sin6_addr,
773 1.2 itojun &mfccp->mf6cc_mcastgrp.sin6_addr)) {
774 1.2 itojun
775 1.2 itojun rt->mf6c_origin = mfccp->mf6cc_origin;
776 1.2 itojun rt->mf6c_mcastgrp = mfccp->mf6cc_mcastgrp;
777 1.2 itojun rt->mf6c_parent = mfccp->mf6cc_parent;
778 1.14 itojun rt->mf6c_ifset = mfccp->mf6cc_ifset;
779 1.2 itojun /* initialize pkt counters per src-grp */
780 1.2 itojun rt->mf6c_pkt_cnt = 0;
781 1.2 itojun rt->mf6c_byte_cnt = 0;
782 1.2 itojun rt->mf6c_wrong_if = 0;
783 1.2 itojun
784 1.2 itojun if (rt->mf6c_expire)
785 1.28 matt nexpire6[hash]--;
786 1.2 itojun rt->mf6c_expire = 0;
787 1.2 itojun }
788 1.2 itojun }
789 1.2 itojun if (rt == NULL) {
790 1.2 itojun /* no upcall, so make a new entry */
791 1.2 itojun rt = (struct mf6c *)malloc(sizeof(*rt), M_MRTABLE,
792 1.2 itojun M_NOWAIT);
793 1.2 itojun if (rt == NULL) {
794 1.2 itojun splx(s);
795 1.2 itojun return ENOBUFS;
796 1.2 itojun }
797 1.26 sommerfe
798 1.2 itojun /* insert new entry at head of hash chain */
799 1.2 itojun rt->mf6c_origin = mfccp->mf6cc_origin;
800 1.2 itojun rt->mf6c_mcastgrp = mfccp->mf6cc_mcastgrp;
801 1.2 itojun rt->mf6c_parent = mfccp->mf6cc_parent;
802 1.14 itojun rt->mf6c_ifset = mfccp->mf6cc_ifset;
803 1.2 itojun /* initialize pkt counters per src-grp */
804 1.2 itojun rt->mf6c_pkt_cnt = 0;
805 1.2 itojun rt->mf6c_byte_cnt = 0;
806 1.2 itojun rt->mf6c_wrong_if = 0;
807 1.2 itojun rt->mf6c_expire = 0;
808 1.2 itojun rt->mf6c_stall = NULL;
809 1.26 sommerfe
810 1.2 itojun /* link into table */
811 1.2 itojun rt->mf6c_next = mf6ctable[hash];
812 1.2 itojun mf6ctable[hash] = rt;
813 1.2 itojun }
814 1.2 itojun }
815 1.2 itojun splx(s);
816 1.2 itojun return 0;
817 1.2 itojun }
818 1.2 itojun
819 1.2 itojun #ifdef UPCALL_TIMING
820 1.2 itojun /*
821 1.12 itojun * collect delay statistics on the upcalls
822 1.2 itojun */
823 1.2 itojun static void
824 1.2 itojun collate(t)
825 1.15 itojun struct timeval *t;
826 1.2 itojun {
827 1.15 itojun u_long d;
828 1.15 itojun struct timeval tp;
829 1.15 itojun u_long delta;
830 1.12 itojun
831 1.2 itojun GET_TIME(tp);
832 1.12 itojun
833 1.2 itojun if (TV_LT(*t, tp))
834 1.2 itojun {
835 1.2 itojun TV_DELTA(tp, *t, delta);
836 1.26 sommerfe
837 1.2 itojun d = delta >> 10;
838 1.7 itojun if (d > UPCALL_MAX)
839 1.7 itojun d = UPCALL_MAX;
840 1.26 sommerfe
841 1.2 itojun ++upcall_data[d];
842 1.2 itojun }
843 1.2 itojun }
844 1.2 itojun #endif /* UPCALL_TIMING */
845 1.2 itojun
846 1.2 itojun /*
847 1.2 itojun * Delete an mfc entry
848 1.2 itojun */
849 1.2 itojun static int
850 1.2 itojun del_m6fc(mfccp)
851 1.2 itojun struct mf6cctl *mfccp;
852 1.2 itojun {
853 1.2 itojun struct sockaddr_in6 origin;
854 1.2 itojun struct sockaddr_in6 mcastgrp;
855 1.2 itojun struct mf6c *rt;
856 1.2 itojun struct mf6c **nptr;
857 1.2 itojun u_long hash;
858 1.2 itojun int s;
859 1.2 itojun
860 1.2 itojun origin = mfccp->mf6cc_origin;
861 1.2 itojun mcastgrp = mfccp->mf6cc_mcastgrp;
862 1.2 itojun hash = MF6CHASH(origin.sin6_addr, mcastgrp.sin6_addr);
863 1.2 itojun
864 1.2 itojun #ifdef MRT6DEBUG
865 1.2 itojun if (mrt6debug & DEBUG_MFC)
866 1.2 itojun log(LOG_DEBUG,"del_m6fc orig %s mcastgrp %s\n",
867 1.2 itojun ip6_sprintf(&origin.sin6_addr),
868 1.2 itojun ip6_sprintf(&mcastgrp.sin6_addr));
869 1.2 itojun #endif
870 1.2 itojun
871 1.4 itojun s = splsoftnet();
872 1.2 itojun
873 1.2 itojun nptr = &mf6ctable[hash];
874 1.2 itojun while ((rt = *nptr) != NULL) {
875 1.2 itojun if (IN6_ARE_ADDR_EQUAL(&origin.sin6_addr,
876 1.2 itojun &rt->mf6c_origin.sin6_addr) &&
877 1.2 itojun IN6_ARE_ADDR_EQUAL(&mcastgrp.sin6_addr,
878 1.2 itojun &rt->mf6c_mcastgrp.sin6_addr) &&
879 1.2 itojun rt->mf6c_stall == NULL)
880 1.2 itojun break;
881 1.2 itojun
882 1.2 itojun nptr = &rt->mf6c_next;
883 1.2 itojun }
884 1.2 itojun if (rt == NULL) {
885 1.2 itojun splx(s);
886 1.2 itojun return EADDRNOTAVAIL;
887 1.2 itojun }
888 1.2 itojun
889 1.2 itojun *nptr = rt->mf6c_next;
890 1.2 itojun free(rt, M_MRTABLE);
891 1.2 itojun
892 1.2 itojun splx(s);
893 1.2 itojun
894 1.2 itojun return 0;
895 1.2 itojun }
896 1.2 itojun
897 1.2 itojun static int
898 1.2 itojun socket_send(s, mm, src)
899 1.2 itojun struct socket *s;
900 1.2 itojun struct mbuf *mm;
901 1.2 itojun struct sockaddr_in6 *src;
902 1.2 itojun {
903 1.2 itojun if (s) {
904 1.2 itojun if (sbappendaddr(&s->so_rcv,
905 1.2 itojun (struct sockaddr *)src,
906 1.2 itojun mm, (struct mbuf *)0) != 0) {
907 1.2 itojun sorwakeup(s);
908 1.2 itojun return 0;
909 1.2 itojun }
910 1.2 itojun }
911 1.2 itojun m_freem(mm);
912 1.2 itojun return -1;
913 1.2 itojun }
914 1.2 itojun
915 1.2 itojun /*
916 1.2 itojun * IPv6 multicast forwarding function. This function assumes that the packet
917 1.2 itojun * pointed to by "ip6" has arrived on (or is about to be sent to) the interface
918 1.2 itojun * pointed to by "ifp", and the packet is to be relayed to other networks
919 1.2 itojun * that have members of the packet's destination IPv6 multicast group.
920 1.2 itojun *
921 1.2 itojun * The packet is returned unscathed to the caller, unless it is
922 1.2 itojun * erroneous, in which case a non-zero return value tells the caller to
923 1.2 itojun * discard it.
924 1.2 itojun */
925 1.2 itojun
926 1.2 itojun int
927 1.2 itojun ip6_mforward(ip6, ifp, m)
928 1.15 itojun struct ip6_hdr *ip6;
929 1.2 itojun struct ifnet *ifp;
930 1.2 itojun struct mbuf *m;
931 1.2 itojun {
932 1.15 itojun struct mf6c *rt;
933 1.15 itojun struct mif6 *mifp;
934 1.15 itojun struct mbuf *mm;
935 1.2 itojun int s;
936 1.2 itojun mifi_t mifi;
937 1.13 itojun long time_second = time.tv_sec;
938 1.2 itojun
939 1.2 itojun #ifdef MRT6DEBUG
940 1.2 itojun if (mrt6debug & DEBUG_FORWARD)
941 1.2 itojun log(LOG_DEBUG, "ip6_mforward: src %s, dst %s, ifindex %d\n",
942 1.2 itojun ip6_sprintf(&ip6->ip6_src), ip6_sprintf(&ip6->ip6_dst),
943 1.2 itojun ifp->if_index);
944 1.2 itojun #endif
945 1.2 itojun
946 1.2 itojun /*
947 1.2 itojun * Don't forward a packet with Hop limit of zero or one,
948 1.2 itojun * or a packet destined to a local-only group.
949 1.2 itojun */
950 1.2 itojun if (ip6->ip6_hlim <= 1 || IN6_IS_ADDR_MC_NODELOCAL(&ip6->ip6_dst) ||
951 1.2 itojun IN6_IS_ADDR_MC_LINKLOCAL(&ip6->ip6_dst))
952 1.2 itojun return 0;
953 1.2 itojun ip6->ip6_hlim--;
954 1.13 itojun
955 1.13 itojun /*
956 1.13 itojun * Source address check: do not forward packets with unspecified
957 1.13 itojun * source. It was discussed in July 2000, on ipngwg mailing list.
958 1.13 itojun * This is rather more serious than unicast cases, because some
959 1.13 itojun * MLD packets can be sent with the unspecified source address
960 1.13 itojun * (although such packets must normally set 1 to the hop limit field).
961 1.13 itojun */
962 1.13 itojun if (IN6_IS_ADDR_UNSPECIFIED(&ip6->ip6_src)) {
963 1.13 itojun ip6stat.ip6s_cantforward++;
964 1.13 itojun if (ip6_log_time + ip6_log_interval < time_second) {
965 1.13 itojun ip6_log_time = time_second;
966 1.13 itojun log(LOG_DEBUG,
967 1.13 itojun "cannot forward "
968 1.13 itojun "from %s to %s nxt %d received on %s\n",
969 1.13 itojun ip6_sprintf(&ip6->ip6_src),
970 1.13 itojun ip6_sprintf(&ip6->ip6_dst),
971 1.13 itojun ip6->ip6_nxt,
972 1.25 itojun m->m_pkthdr.rcvif ?
973 1.25 itojun if_name(m->m_pkthdr.rcvif) : "?");
974 1.13 itojun }
975 1.13 itojun return 0;
976 1.13 itojun }
977 1.2 itojun
978 1.2 itojun /*
979 1.2 itojun * Determine forwarding mifs from the forwarding cache table
980 1.2 itojun */
981 1.4 itojun s = splsoftnet();
982 1.2 itojun MF6CFIND(ip6->ip6_src, ip6->ip6_dst, rt);
983 1.2 itojun
984 1.2 itojun /* Entry exists, so forward if necessary */
985 1.2 itojun if (rt) {
986 1.2 itojun splx(s);
987 1.2 itojun return (ip6_mdq(m, ifp, rt));
988 1.2 itojun } else {
989 1.2 itojun /*
990 1.2 itojun * If we don't have a route for packet's origin,
991 1.2 itojun * Make a copy of the packet &
992 1.2 itojun * send message to routing daemon
993 1.2 itojun */
994 1.2 itojun
995 1.15 itojun struct mbuf *mb0;
996 1.15 itojun struct rtdetq *rte;
997 1.15 itojun u_long hash;
998 1.15 itojun /* int i, npkts;*/
999 1.2 itojun #ifdef UPCALL_TIMING
1000 1.2 itojun struct timeval tp;
1001 1.2 itojun
1002 1.2 itojun GET_TIME(tp);
1003 1.2 itojun #endif /* UPCALL_TIMING */
1004 1.2 itojun
1005 1.2 itojun mrt6stat.mrt6s_no_route++;
1006 1.2 itojun #ifdef MRT6DEBUG
1007 1.2 itojun if (mrt6debug & (DEBUG_FORWARD | DEBUG_MFC))
1008 1.2 itojun log(LOG_DEBUG, "ip6_mforward: no rte s %s g %s\n",
1009 1.2 itojun ip6_sprintf(&ip6->ip6_src),
1010 1.2 itojun ip6_sprintf(&ip6->ip6_dst));
1011 1.2 itojun #endif
1012 1.2 itojun
1013 1.2 itojun /*
1014 1.2 itojun * Allocate mbufs early so that we don't do extra work if we
1015 1.2 itojun * are just going to fail anyway.
1016 1.2 itojun */
1017 1.2 itojun rte = (struct rtdetq *)malloc(sizeof(*rte), M_MRTABLE,
1018 1.2 itojun M_NOWAIT);
1019 1.2 itojun if (rte == NULL) {
1020 1.2 itojun splx(s);
1021 1.2 itojun return ENOBUFS;
1022 1.2 itojun }
1023 1.2 itojun mb0 = m_copy(m, 0, M_COPYALL);
1024 1.2 itojun /*
1025 1.2 itojun * Pullup packet header if needed before storing it,
1026 1.2 itojun * as other references may modify it in the meantime.
1027 1.2 itojun */
1028 1.2 itojun if (mb0 &&
1029 1.2 itojun (M_HASCL(mb0) || mb0->m_len < sizeof(struct ip6_hdr)))
1030 1.2 itojun mb0 = m_pullup(mb0, sizeof(struct ip6_hdr));
1031 1.2 itojun if (mb0 == NULL) {
1032 1.2 itojun free(rte, M_MRTABLE);
1033 1.2 itojun splx(s);
1034 1.2 itojun return ENOBUFS;
1035 1.2 itojun }
1036 1.26 sommerfe
1037 1.2 itojun /* is there an upcall waiting for this packet? */
1038 1.2 itojun hash = MF6CHASH(ip6->ip6_src, ip6->ip6_dst);
1039 1.2 itojun for (rt = mf6ctable[hash]; rt; rt = rt->mf6c_next) {
1040 1.2 itojun if (IN6_ARE_ADDR_EQUAL(&ip6->ip6_src,
1041 1.2 itojun &rt->mf6c_origin.sin6_addr) &&
1042 1.2 itojun IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst,
1043 1.2 itojun &rt->mf6c_mcastgrp.sin6_addr) &&
1044 1.2 itojun (rt->mf6c_stall != NULL))
1045 1.2 itojun break;
1046 1.2 itojun }
1047 1.2 itojun
1048 1.2 itojun if (rt == NULL) {
1049 1.2 itojun struct mrt6msg *im;
1050 1.12 itojun struct omrt6msg *oim;
1051 1.2 itojun
1052 1.2 itojun /* no upcall, so make a new entry */
1053 1.2 itojun rt = (struct mf6c *)malloc(sizeof(*rt), M_MRTABLE,
1054 1.2 itojun M_NOWAIT);
1055 1.2 itojun if (rt == NULL) {
1056 1.2 itojun free(rte, M_MRTABLE);
1057 1.2 itojun m_freem(mb0);
1058 1.2 itojun splx(s);
1059 1.2 itojun return ENOBUFS;
1060 1.2 itojun }
1061 1.2 itojun /*
1062 1.2 itojun * Make a copy of the header to send to the user
1063 1.2 itojun * level process
1064 1.2 itojun */
1065 1.2 itojun mm = m_copy(mb0, 0, sizeof(struct ip6_hdr));
1066 1.2 itojun
1067 1.2 itojun if (mm == NULL) {
1068 1.2 itojun free(rte, M_MRTABLE);
1069 1.2 itojun m_freem(mb0);
1070 1.2 itojun free(rt, M_MRTABLE);
1071 1.2 itojun splx(s);
1072 1.2 itojun return ENOBUFS;
1073 1.2 itojun }
1074 1.2 itojun
1075 1.12 itojun /*
1076 1.2 itojun * Send message to routing daemon
1077 1.2 itojun */
1078 1.2 itojun sin6.sin6_addr = ip6->ip6_src;
1079 1.26 sommerfe
1080 1.12 itojun im = NULL;
1081 1.12 itojun oim = NULL;
1082 1.12 itojun switch (ip6_mrouter_ver) {
1083 1.12 itojun case MRT6_OINIT:
1084 1.12 itojun oim = mtod(mm, struct omrt6msg *);
1085 1.12 itojun oim->im6_msgtype = MRT6MSG_NOCACHE;
1086 1.12 itojun oim->im6_mbz = 0;
1087 1.12 itojun break;
1088 1.12 itojun case MRT6_INIT:
1089 1.12 itojun im = mtod(mm, struct mrt6msg *);
1090 1.12 itojun im->im6_msgtype = MRT6MSG_NOCACHE;
1091 1.12 itojun im->im6_mbz = 0;
1092 1.12 itojun break;
1093 1.12 itojun default:
1094 1.12 itojun free(rte, M_MRTABLE);
1095 1.12 itojun m_freem(mb0);
1096 1.12 itojun free(rt, M_MRTABLE);
1097 1.12 itojun splx(s);
1098 1.12 itojun return EINVAL;
1099 1.12 itojun }
1100 1.2 itojun
1101 1.2 itojun #ifdef MRT6DEBUG
1102 1.2 itojun if (mrt6debug & DEBUG_FORWARD)
1103 1.2 itojun log(LOG_DEBUG,
1104 1.2 itojun "getting the iif info in the kernel\n");
1105 1.2 itojun #endif
1106 1.2 itojun
1107 1.2 itojun for (mifp = mif6table, mifi = 0;
1108 1.2 itojun mifi < nummifs && mifp->m6_ifp != ifp;
1109 1.2 itojun mifp++, mifi++)
1110 1.2 itojun ;
1111 1.2 itojun
1112 1.12 itojun switch (ip6_mrouter_ver) {
1113 1.12 itojun case MRT6_OINIT:
1114 1.12 itojun oim->im6_mif = mifi;
1115 1.12 itojun break;
1116 1.12 itojun case MRT6_INIT:
1117 1.12 itojun im->im6_mif = mifi;
1118 1.12 itojun break;
1119 1.12 itojun }
1120 1.2 itojun
1121 1.2 itojun if (socket_send(ip6_mrouter, mm, &sin6) < 0) {
1122 1.2 itojun log(LOG_WARNING, "ip6_mforward: ip6_mrouter "
1123 1.2 itojun "socket queue full\n");
1124 1.2 itojun mrt6stat.mrt6s_upq_sockfull++;
1125 1.2 itojun free(rte, M_MRTABLE);
1126 1.2 itojun m_freem(mb0);
1127 1.2 itojun free(rt, M_MRTABLE);
1128 1.2 itojun splx(s);
1129 1.2 itojun return ENOBUFS;
1130 1.2 itojun }
1131 1.2 itojun
1132 1.2 itojun mrt6stat.mrt6s_upcalls++;
1133 1.2 itojun
1134 1.2 itojun /* insert new entry at head of hash chain */
1135 1.2 itojun bzero(rt, sizeof(*rt));
1136 1.8 itojun rt->mf6c_origin.sin6_family = AF_INET6;
1137 1.8 itojun rt->mf6c_origin.sin6_len = sizeof(struct sockaddr_in6);
1138 1.2 itojun rt->mf6c_origin.sin6_addr = ip6->ip6_src;
1139 1.8 itojun rt->mf6c_mcastgrp.sin6_family = AF_INET6;
1140 1.8 itojun rt->mf6c_mcastgrp.sin6_len = sizeof(struct sockaddr_in6);
1141 1.2 itojun rt->mf6c_mcastgrp.sin6_addr = ip6->ip6_dst;
1142 1.2 itojun rt->mf6c_expire = UPCALL_EXPIRE;
1143 1.28 matt nexpire6[hash]++;
1144 1.2 itojun rt->mf6c_parent = MF6C_INCOMPLETE_PARENT;
1145 1.2 itojun
1146 1.2 itojun /* link into table */
1147 1.2 itojun rt->mf6c_next = mf6ctable[hash];
1148 1.2 itojun mf6ctable[hash] = rt;
1149 1.2 itojun /* Add this entry to the end of the queue */
1150 1.2 itojun rt->mf6c_stall = rte;
1151 1.2 itojun } else {
1152 1.2 itojun /* determine if q has overflowed */
1153 1.2 itojun struct rtdetq **p;
1154 1.15 itojun int npkts = 0;
1155 1.2 itojun
1156 1.2 itojun for (p = &rt->mf6c_stall; *p != NULL; p = &(*p)->next)
1157 1.2 itojun if (++npkts > MAX_UPQ6) {
1158 1.2 itojun mrt6stat.mrt6s_upq_ovflw++;
1159 1.2 itojun free(rte, M_MRTABLE);
1160 1.2 itojun m_freem(mb0);
1161 1.2 itojun splx(s);
1162 1.2 itojun return 0;
1163 1.2 itojun }
1164 1.2 itojun
1165 1.2 itojun /* Add this entry to the end of the queue */
1166 1.2 itojun *p = rte;
1167 1.2 itojun }
1168 1.2 itojun
1169 1.2 itojun rte->next = NULL;
1170 1.2 itojun rte->m = mb0;
1171 1.2 itojun rte->ifp = ifp;
1172 1.2 itojun #ifdef UPCALL_TIMING
1173 1.2 itojun rte->t = tp;
1174 1.2 itojun #endif /* UPCALL_TIMING */
1175 1.2 itojun
1176 1.2 itojun splx(s);
1177 1.2 itojun
1178 1.2 itojun return 0;
1179 1.2 itojun }
1180 1.2 itojun }
1181 1.2 itojun
1182 1.2 itojun /*
1183 1.2 itojun * Clean up cache entries if upcalls are not serviced
1184 1.2 itojun * Call from the Slow Timeout mechanism, every half second.
1185 1.2 itojun */
1186 1.2 itojun static void
1187 1.2 itojun expire_upcalls(unused)
1188 1.2 itojun void *unused;
1189 1.2 itojun {
1190 1.2 itojun struct rtdetq *rte;
1191 1.2 itojun struct mf6c *mfc, **nptr;
1192 1.2 itojun int i;
1193 1.2 itojun int s;
1194 1.2 itojun
1195 1.4 itojun s = splsoftnet();
1196 1.2 itojun for (i = 0; i < MF6CTBLSIZ; i++) {
1197 1.28 matt if (nexpire6[i] == 0)
1198 1.2 itojun continue;
1199 1.2 itojun nptr = &mf6ctable[i];
1200 1.2 itojun while ((mfc = *nptr) != NULL) {
1201 1.2 itojun rte = mfc->mf6c_stall;
1202 1.2 itojun /*
1203 1.2 itojun * Skip real cache entries
1204 1.2 itojun * Make sure it wasn't marked to not expire (shouldn't happen)
1205 1.2 itojun * If it expires now
1206 1.2 itojun */
1207 1.2 itojun if (rte != NULL &&
1208 1.2 itojun mfc->mf6c_expire != 0 &&
1209 1.2 itojun --mfc->mf6c_expire == 0) {
1210 1.2 itojun #ifdef MRT6DEBUG
1211 1.2 itojun if (mrt6debug & DEBUG_EXPIRE)
1212 1.2 itojun log(LOG_DEBUG, "expire_upcalls: expiring (%s %s)\n",
1213 1.2 itojun ip6_sprintf(&mfc->mf6c_origin.sin6_addr),
1214 1.2 itojun ip6_sprintf(&mfc->mf6c_mcastgrp.sin6_addr));
1215 1.2 itojun #endif
1216 1.2 itojun /*
1217 1.2 itojun * drop all the packets
1218 1.2 itojun * free the mbuf with the pkt, if, timing info
1219 1.2 itojun */
1220 1.2 itojun do {
1221 1.2 itojun struct rtdetq *n = rte->next;
1222 1.2 itojun m_freem(rte->m);
1223 1.2 itojun free(rte, M_MRTABLE);
1224 1.2 itojun rte = n;
1225 1.2 itojun } while (rte != NULL);
1226 1.2 itojun mrt6stat.mrt6s_cache_cleanups++;
1227 1.28 matt nexpire6[i]--;
1228 1.2 itojun
1229 1.2 itojun *nptr = mfc->mf6c_next;
1230 1.2 itojun free(mfc, M_MRTABLE);
1231 1.2 itojun } else {
1232 1.2 itojun nptr = &mfc->mf6c_next;
1233 1.2 itojun }
1234 1.2 itojun }
1235 1.2 itojun }
1236 1.2 itojun splx(s);
1237 1.11 thorpej callout_reset(&expire_upcalls_ch, EXPIRE_TIMEOUT,
1238 1.11 thorpej expire_upcalls, NULL);
1239 1.2 itojun }
1240 1.2 itojun
1241 1.2 itojun /*
1242 1.2 itojun * Packet forwarding routine once entry in the cache is made
1243 1.2 itojun */
1244 1.2 itojun static int
1245 1.2 itojun ip6_mdq(m, ifp, rt)
1246 1.15 itojun struct mbuf *m;
1247 1.15 itojun struct ifnet *ifp;
1248 1.15 itojun struct mf6c *rt;
1249 1.15 itojun {
1250 1.15 itojun struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
1251 1.15 itojun mifi_t mifi, iif;
1252 1.15 itojun struct mif6 *mifp;
1253 1.15 itojun int plen = m->m_pkthdr.len;
1254 1.2 itojun
1255 1.2 itojun /*
1256 1.2 itojun * Macro to send packet on mif. Since RSVP packets don't get counted on
1257 1.2 itojun * input, they shouldn't get counted on output, so statistics keeping is
1258 1.21 wiz * separate.
1259 1.2 itojun */
1260 1.2 itojun
1261 1.12 itojun #define MC6_SEND(ip6, mifp, m) do { \
1262 1.12 itojun if ((mifp)->m6_flags & MIFF_REGISTER) \
1263 1.12 itojun register_send((ip6), (mifp), (m)); \
1264 1.12 itojun else \
1265 1.12 itojun phyint_send((ip6), (mifp), (m)); \
1266 1.12 itojun } while (0)
1267 1.2 itojun
1268 1.2 itojun /*
1269 1.2 itojun * Don't forward if it didn't arrive from the parent mif
1270 1.2 itojun * for its origin.
1271 1.2 itojun */
1272 1.2 itojun mifi = rt->mf6c_parent;
1273 1.2 itojun if ((mifi >= nummifs) || (mif6table[mifi].m6_ifp != ifp)) {
1274 1.2 itojun /* came in the wrong interface */
1275 1.2 itojun #ifdef MRT6DEBUG
1276 1.2 itojun if (mrt6debug & DEBUG_FORWARD)
1277 1.2 itojun log(LOG_DEBUG,
1278 1.2 itojun "wrong if: ifid %d mifi %d mififid %x\n",
1279 1.2 itojun ifp->if_index, mifi,
1280 1.12 itojun mif6table[mifi].m6_ifp->if_index);
1281 1.2 itojun #endif
1282 1.2 itojun mrt6stat.mrt6s_wrong_if++;
1283 1.2 itojun rt->mf6c_wrong_if++;
1284 1.2 itojun /*
1285 1.2 itojun * If we are doing PIM processing, and we are forwarding
1286 1.2 itojun * packets on this interface, send a message to the
1287 1.2 itojun * routing daemon.
1288 1.2 itojun */
1289 1.12 itojun /* have to make sure this is a valid mif */
1290 1.12 itojun if (mifi < nummifs && mif6table[mifi].m6_ifp)
1291 1.12 itojun if (pim6 && (m->m_flags & M_LOOP) == 0) {
1292 1.12 itojun /*
1293 1.12 itojun * Check the M_LOOP flag to avoid an
1294 1.12 itojun * unnecessary PIM assert.
1295 1.12 itojun * XXX: M_LOOP is an ad-hoc hack...
1296 1.12 itojun */
1297 1.12 itojun static struct sockaddr_in6 sin6 =
1298 1.12 itojun { sizeof(sin6), AF_INET6 };
1299 1.2 itojun
1300 1.15 itojun struct mbuf *mm;
1301 1.12 itojun struct mrt6msg *im;
1302 1.12 itojun struct omrt6msg *oim;
1303 1.12 itojun
1304 1.12 itojun mm = m_copy(m, 0, sizeof(struct ip6_hdr));
1305 1.12 itojun if (mm &&
1306 1.12 itojun (M_HASCL(mm) ||
1307 1.12 itojun mm->m_len < sizeof(struct ip6_hdr)))
1308 1.12 itojun mm = m_pullup(mm, sizeof(struct ip6_hdr));
1309 1.12 itojun if (mm == NULL)
1310 1.12 itojun return ENOBUFS;
1311 1.26 sommerfe
1312 1.12 itojun oim = NULL;
1313 1.12 itojun im = NULL;
1314 1.12 itojun switch (ip6_mrouter_ver) {
1315 1.12 itojun case MRT6_OINIT:
1316 1.12 itojun oim = mtod(mm, struct omrt6msg *);
1317 1.12 itojun oim->im6_msgtype = MRT6MSG_WRONGMIF;
1318 1.12 itojun oim->im6_mbz = 0;
1319 1.12 itojun break;
1320 1.12 itojun case MRT6_INIT:
1321 1.2 itojun im = mtod(mm, struct mrt6msg *);
1322 1.12 itojun im->im6_msgtype = MRT6MSG_WRONGMIF;
1323 1.16 itojun im->im6_mbz = 0;
1324 1.12 itojun break;
1325 1.12 itojun default:
1326 1.12 itojun m_freem(mm);
1327 1.12 itojun return EINVAL;
1328 1.12 itojun }
1329 1.2 itojun
1330 1.12 itojun for (mifp = mif6table, iif = 0;
1331 1.12 itojun iif < nummifs && mifp &&
1332 1.12 itojun mifp->m6_ifp != ifp;
1333 1.12 itojun mifp++, iif++)
1334 1.12 itojun ;
1335 1.12 itojun
1336 1.12 itojun switch (ip6_mrouter_ver) {
1337 1.12 itojun case MRT6_OINIT:
1338 1.12 itojun oim->im6_mif = iif;
1339 1.12 itojun sin6.sin6_addr = oim->im6_src;
1340 1.12 itojun break;
1341 1.12 itojun case MRT6_INIT:
1342 1.12 itojun im->im6_mif = iif;
1343 1.2 itojun sin6.sin6_addr = im->im6_src;
1344 1.12 itojun break;
1345 1.12 itojun }
1346 1.2 itojun
1347 1.12 itojun mrt6stat.mrt6s_upcalls++;
1348 1.2 itojun
1349 1.12 itojun if (socket_send(ip6_mrouter, mm, &sin6) < 0) {
1350 1.2 itojun #ifdef MRT6DEBUG
1351 1.12 itojun if (mrt6debug)
1352 1.12 itojun log(LOG_WARNING, "mdq, ip6_mrouter socket queue full\n");
1353 1.2 itojun #endif
1354 1.12 itojun ++mrt6stat.mrt6s_upq_sockfull;
1355 1.12 itojun return ENOBUFS;
1356 1.12 itojun } /* if socket Q full */
1357 1.12 itojun } /* if PIM */
1358 1.2 itojun return 0;
1359 1.2 itojun } /* if wrong iif */
1360 1.2 itojun
1361 1.2 itojun /* If I sourced this packet, it counts as output, else it was input. */
1362 1.2 itojun if (m->m_pkthdr.rcvif == NULL) {
1363 1.2 itojun /* XXX: is rcvif really NULL when output?? */
1364 1.2 itojun mif6table[mifi].m6_pkt_out++;
1365 1.2 itojun mif6table[mifi].m6_bytes_out += plen;
1366 1.2 itojun } else {
1367 1.2 itojun mif6table[mifi].m6_pkt_in++;
1368 1.2 itojun mif6table[mifi].m6_bytes_in += plen;
1369 1.2 itojun }
1370 1.2 itojun rt->mf6c_pkt_cnt++;
1371 1.2 itojun rt->mf6c_byte_cnt += plen;
1372 1.2 itojun
1373 1.2 itojun /*
1374 1.2 itojun * For each mif, forward a copy of the packet if there are group
1375 1.2 itojun * members downstream on the interface.
1376 1.2 itojun */
1377 1.2 itojun for (mifp = mif6table, mifi = 0; mifi < nummifs; mifp++, mifi++)
1378 1.2 itojun if (IF_ISSET(mifi, &rt->mf6c_ifset)) {
1379 1.12 itojun #ifdef notyet
1380 1.12 itojun /*
1381 1.12 itojun * check if the outgoing packet is going to break
1382 1.12 itojun * a scope boundary.
1383 1.12 itojun * XXX For packets through PIM register tunnel
1384 1.12 itojun * interface, we believe a routing daemon.
1385 1.12 itojun */
1386 1.12 itojun if ((mif6table[rt->mf6c_parent].m6_flags &
1387 1.12 itojun MIFF_REGISTER) == 0 &&
1388 1.12 itojun (mif6table[mifi].m6_flags & MIFF_REGISTER) == 0 &&
1389 1.12 itojun (in6_addr2scopeid(ifp, &ip6->ip6_dst) !=
1390 1.12 itojun in6_addr2scopeid(mif6table[mifi].m6_ifp,
1391 1.12 itojun &ip6->ip6_dst) ||
1392 1.12 itojun in6_addr2scopeid(ifp, &ip6->ip6_src) !=
1393 1.12 itojun in6_addr2scopeid(mif6table[mifi].m6_ifp,
1394 1.12 itojun &ip6->ip6_src))) {
1395 1.12 itojun ip6stat.ip6s_badscope++;
1396 1.12 itojun continue;
1397 1.12 itojun }
1398 1.12 itojun #endif
1399 1.12 itojun
1400 1.2 itojun mifp->m6_pkt_out++;
1401 1.2 itojun mifp->m6_bytes_out += plen;
1402 1.2 itojun MC6_SEND(ip6, mifp, m);
1403 1.2 itojun }
1404 1.2 itojun return 0;
1405 1.2 itojun }
1406 1.2 itojun
1407 1.2 itojun static void
1408 1.2 itojun phyint_send(ip6, mifp, m)
1409 1.2 itojun struct ip6_hdr *ip6;
1410 1.2 itojun struct mif6 *mifp;
1411 1.2 itojun struct mbuf *m;
1412 1.2 itojun {
1413 1.15 itojun struct mbuf *mb_copy;
1414 1.2 itojun struct ifnet *ifp = mifp->m6_ifp;
1415 1.2 itojun int error = 0;
1416 1.4 itojun int s = splsoftnet();
1417 1.15 itojun static struct route_in6 ro;
1418 1.2 itojun struct in6_multi *in6m;
1419 1.15 itojun struct sockaddr_in6 *dst6;
1420 1.29 itojun u_long linkmtu;
1421 1.2 itojun
1422 1.2 itojun /*
1423 1.2 itojun * Make a new reference to the packet; make sure that
1424 1.2 itojun * the IPv6 header is actually copied, not just referenced,
1425 1.2 itojun * so that ip6_output() only scribbles on the copy.
1426 1.2 itojun */
1427 1.2 itojun mb_copy = m_copy(m, 0, M_COPYALL);
1428 1.2 itojun if (mb_copy &&
1429 1.2 itojun (M_HASCL(mb_copy) || mb_copy->m_len < sizeof(struct ip6_hdr)))
1430 1.2 itojun mb_copy = m_pullup(mb_copy, sizeof(struct ip6_hdr));
1431 1.18 itojun if (mb_copy == NULL) {
1432 1.18 itojun splx(s);
1433 1.2 itojun return;
1434 1.18 itojun }
1435 1.2 itojun /* set MCAST flag to the outgoing packet */
1436 1.2 itojun mb_copy->m_flags |= M_MCAST;
1437 1.2 itojun
1438 1.2 itojun /*
1439 1.2 itojun * If we sourced the packet, call ip6_output since we may devide
1440 1.2 itojun * the packet into fragments when the packet is too big for the
1441 1.2 itojun * outgoing interface.
1442 1.2 itojun * Otherwise, we can simply send the packet to the interface
1443 1.2 itojun * sending queue.
1444 1.2 itojun */
1445 1.2 itojun if (m->m_pkthdr.rcvif == NULL) {
1446 1.2 itojun struct ip6_moptions im6o;
1447 1.2 itojun
1448 1.2 itojun im6o.im6o_multicast_ifp = ifp;
1449 1.2 itojun /* XXX: ip6_output will override ip6->ip6_hlim */
1450 1.2 itojun im6o.im6o_multicast_hlim = ip6->ip6_hlim;
1451 1.2 itojun im6o.im6o_multicast_loop = 1;
1452 1.15 itojun error = ip6_output(mb_copy, NULL, &ro,
1453 1.8 itojun IPV6_FORWARDING, &im6o, NULL);
1454 1.2 itojun
1455 1.2 itojun #ifdef MRT6DEBUG
1456 1.2 itojun if (mrt6debug & DEBUG_XMIT)
1457 1.2 itojun log(LOG_DEBUG, "phyint_send on mif %d err %d\n",
1458 1.2 itojun mifp - mif6table, error);
1459 1.2 itojun #endif
1460 1.2 itojun splx(s);
1461 1.2 itojun return;
1462 1.2 itojun }
1463 1.2 itojun
1464 1.2 itojun /*
1465 1.2 itojun * If we belong to the destination multicast group
1466 1.2 itojun * on the outgoing interface, loop back a copy.
1467 1.2 itojun */
1468 1.15 itojun dst6 = (struct sockaddr_in6 *)&ro.ro_dst;
1469 1.2 itojun IN6_LOOKUP_MULTI(ip6->ip6_dst, ifp, in6m);
1470 1.2 itojun if (in6m != NULL) {
1471 1.15 itojun dst6->sin6_len = sizeof(struct sockaddr_in6);
1472 1.15 itojun dst6->sin6_family = AF_INET6;
1473 1.15 itojun dst6->sin6_addr = ip6->ip6_dst;
1474 1.15 itojun ip6_mloopback(ifp, m, (struct sockaddr_in6 *)&ro.ro_dst);
1475 1.2 itojun }
1476 1.2 itojun /*
1477 1.12 itojun * Put the packet into the sending queue of the outgoing interface
1478 1.2 itojun * if it would fit in the MTU of the interface.
1479 1.2 itojun */
1480 1.29 itojun linkmtu = IN6_LINKMTU(ifp);
1481 1.29 itojun if (mb_copy->m_pkthdr.len < linkmtu || linkmtu < IPV6_MMTU) {
1482 1.15 itojun dst6->sin6_len = sizeof(struct sockaddr_in6);
1483 1.15 itojun dst6->sin6_family = AF_INET6;
1484 1.15 itojun dst6->sin6_addr = ip6->ip6_dst;
1485 1.8 itojun /*
1486 1.8 itojun * We just call if_output instead of nd6_output here, since
1487 1.8 itojun * we need no ND for a multicast forwarded packet...right?
1488 1.8 itojun */
1489 1.2 itojun error = (*ifp->if_output)(ifp, mb_copy,
1490 1.15 itojun (struct sockaddr *)&ro.ro_dst, NULL);
1491 1.2 itojun #ifdef MRT6DEBUG
1492 1.2 itojun if (mrt6debug & DEBUG_XMIT)
1493 1.2 itojun log(LOG_DEBUG, "phyint_send on mif %d err %d\n",
1494 1.2 itojun mifp - mif6table, error);
1495 1.2 itojun #endif
1496 1.20 itojun } else {
1497 1.2 itojun #ifdef MULTICAST_PMTUD
1498 1.29 itojun icmp6_error(mb_copy, ICMP6_PACKET_TOO_BIG, 0, linkmtu);
1499 1.2 itojun #else
1500 1.2 itojun #ifdef MRT6DEBUG
1501 1.20 itojun if (mrt6debug & DEBUG_XMIT)
1502 1.2 itojun log(LOG_DEBUG,
1503 1.2 itojun "phyint_send: packet too big on %s o %s g %s"
1504 1.2 itojun " size %d(discarded)\n",
1505 1.20 itojun if_name(ifp),
1506 1.2 itojun ip6_sprintf(&ip6->ip6_src),
1507 1.2 itojun ip6_sprintf(&ip6->ip6_dst),
1508 1.2 itojun mb_copy->m_pkthdr.len);
1509 1.2 itojun #endif /* MRT6DEBUG */
1510 1.2 itojun m_freem(mb_copy); /* simply discard the packet */
1511 1.12 itojun #endif
1512 1.2 itojun }
1513 1.20 itojun
1514 1.20 itojun splx(s);
1515 1.2 itojun }
1516 1.2 itojun
1517 1.12 itojun static int
1518 1.2 itojun register_send(ip6, mif, m)
1519 1.15 itojun struct ip6_hdr *ip6;
1520 1.2 itojun struct mif6 *mif;
1521 1.15 itojun struct mbuf *m;
1522 1.2 itojun {
1523 1.15 itojun struct mbuf *mm;
1524 1.15 itojun int i, len = m->m_pkthdr.len;
1525 1.2 itojun static struct sockaddr_in6 sin6 = { sizeof(sin6), AF_INET6 };
1526 1.2 itojun struct mrt6msg *im6;
1527 1.2 itojun
1528 1.2 itojun #ifdef MRT6DEBUG
1529 1.2 itojun if (mrt6debug)
1530 1.2 itojun log(LOG_DEBUG, "** IPv6 register_send **\n src %s dst %s\n",
1531 1.2 itojun ip6_sprintf(&ip6->ip6_src), ip6_sprintf(&ip6->ip6_dst));
1532 1.2 itojun #endif
1533 1.2 itojun ++pim6stat.pim6s_snd_registers;
1534 1.2 itojun
1535 1.2 itojun /* Make a copy of the packet to send to the user level process */
1536 1.2 itojun MGETHDR(mm, M_DONTWAIT, MT_HEADER);
1537 1.2 itojun if (mm == NULL)
1538 1.2 itojun return ENOBUFS;
1539 1.2 itojun mm->m_data += max_linkhdr;
1540 1.2 itojun mm->m_len = sizeof(struct ip6_hdr);
1541 1.2 itojun
1542 1.2 itojun if ((mm->m_next = m_copy(m, 0, M_COPYALL)) == NULL) {
1543 1.2 itojun m_freem(mm);
1544 1.2 itojun return ENOBUFS;
1545 1.2 itojun }
1546 1.2 itojun i = MHLEN - M_LEADINGSPACE(mm);
1547 1.2 itojun if (i > len)
1548 1.2 itojun i = len;
1549 1.2 itojun mm = m_pullup(mm, i);
1550 1.27 itojun if (mm == NULL)
1551 1.2 itojun return ENOBUFS;
1552 1.2 itojun /* TODO: check it! */
1553 1.2 itojun mm->m_pkthdr.len = len + sizeof(struct ip6_hdr);
1554 1.2 itojun
1555 1.12 itojun /*
1556 1.2 itojun * Send message to routing daemon
1557 1.2 itojun */
1558 1.2 itojun sin6.sin6_addr = ip6->ip6_src;
1559 1.2 itojun
1560 1.2 itojun im6 = mtod(mm, struct mrt6msg *);
1561 1.2 itojun im6->im6_msgtype = MRT6MSG_WHOLEPKT;
1562 1.2 itojun im6->im6_mbz = 0;
1563 1.2 itojun
1564 1.2 itojun im6->im6_mif = mif - mif6table;
1565 1.2 itojun
1566 1.2 itojun /* iif info is not given for reg. encap.n */
1567 1.2 itojun mrt6stat.mrt6s_upcalls++;
1568 1.2 itojun
1569 1.2 itojun if (socket_send(ip6_mrouter, mm, &sin6) < 0) {
1570 1.2 itojun #ifdef MRT6DEBUG
1571 1.2 itojun if (mrt6debug)
1572 1.2 itojun log(LOG_WARNING,
1573 1.2 itojun "register_send: ip_mrouter socket queue full\n");
1574 1.2 itojun #endif
1575 1.15 itojun ++mrt6stat.mrt6s_upq_sockfull;
1576 1.15 itojun return ENOBUFS;
1577 1.2 itojun }
1578 1.2 itojun return 0;
1579 1.2 itojun }
1580 1.12 itojun
1581 1.2 itojun /*
1582 1.2 itojun * PIM sparse mode hook
1583 1.2 itojun * Receives the pim control messages, and passes them up to the listening
1584 1.2 itojun * socket, using rip6_input.
1585 1.2 itojun * The only message processed is the REGISTER pim message; the pim header
1586 1.2 itojun * is stripped off, and the inner packet is passed to register_mforward.
1587 1.2 itojun */
1588 1.2 itojun int
1589 1.2 itojun pim6_input(mp, offp, proto)
1590 1.2 itojun struct mbuf **mp;
1591 1.2 itojun int *offp, proto;
1592 1.2 itojun {
1593 1.15 itojun struct pim *pim; /* pointer to a pim struct */
1594 1.15 itojun struct ip6_hdr *ip6;
1595 1.15 itojun int pimlen;
1596 1.2 itojun struct mbuf *m = *mp;
1597 1.15 itojun int minlen;
1598 1.2 itojun int off = *offp;
1599 1.2 itojun
1600 1.2 itojun ++pim6stat.pim6s_rcv_total;
1601 1.2 itojun
1602 1.15 itojun ip6 = mtod(m, struct ip6_hdr *);
1603 1.15 itojun pimlen = m->m_pkthdr.len - *offp;
1604 1.2 itojun
1605 1.15 itojun /*
1606 1.15 itojun * Validate lengths
1607 1.15 itojun */
1608 1.2 itojun if (pimlen < PIM_MINLEN) {
1609 1.2 itojun ++pim6stat.pim6s_rcv_tooshort;
1610 1.2 itojun #ifdef MRT6DEBUG
1611 1.2 itojun if (mrt6debug & DEBUG_PIM)
1612 1.2 itojun log(LOG_DEBUG,"pim6_input: PIM packet too short\n");
1613 1.2 itojun #endif
1614 1.2 itojun m_freem(m);
1615 1.2 itojun return(IPPROTO_DONE);
1616 1.2 itojun }
1617 1.2 itojun
1618 1.2 itojun /*
1619 1.2 itojun * if the packet is at least as big as a REGISTER, go ahead
1620 1.2 itojun * and grab the PIM REGISTER header size, to avoid another
1621 1.2 itojun * possible m_pullup() later.
1622 1.12 itojun *
1623 1.2 itojun * PIM_MINLEN == pimhdr + u_int32 == 8
1624 1.2 itojun * PIM6_REG_MINLEN == pimhdr + reghdr + eip6hdr == 4 + 4 + 40
1625 1.2 itojun */
1626 1.2 itojun minlen = (pimlen >= PIM6_REG_MINLEN) ? PIM6_REG_MINLEN : PIM_MINLEN;
1627 1.12 itojun
1628 1.2 itojun /*
1629 1.2 itojun * Make sure that the IP6 and PIM headers in contiguous memory, and
1630 1.2 itojun * possibly the PIM REGISTER header
1631 1.2 itojun */
1632 1.8 itojun #ifndef PULLDOWN_TEST
1633 1.2 itojun IP6_EXTHDR_CHECK(m, off, minlen, IPPROTO_DONE);
1634 1.8 itojun /* adjust pointer */
1635 1.2 itojun ip6 = mtod(m, struct ip6_hdr *);
1636 1.12 itojun
1637 1.2 itojun /* adjust mbuf to point to the PIM header */
1638 1.2 itojun pim = (struct pim *)((caddr_t)ip6 + off);
1639 1.8 itojun #else
1640 1.8 itojun IP6_EXTHDR_GET(pim, struct pim *, m, off, minlen);
1641 1.8 itojun if (pim == NULL) {
1642 1.8 itojun pim6stat.pim6s_rcv_tooshort++;
1643 1.8 itojun return IPPROTO_DONE;
1644 1.8 itojun }
1645 1.8 itojun #endif
1646 1.2 itojun
1647 1.2 itojun #define PIM6_CHECKSUM
1648 1.2 itojun #ifdef PIM6_CHECKSUM
1649 1.2 itojun {
1650 1.2 itojun int cksumlen;
1651 1.2 itojun
1652 1.2 itojun /*
1653 1.2 itojun * Validate checksum.
1654 1.2 itojun * If PIM REGISTER, exclude the data packet
1655 1.2 itojun */
1656 1.2 itojun if (pim->pim_type == PIM_REGISTER)
1657 1.2 itojun cksumlen = PIM_MINLEN;
1658 1.2 itojun else
1659 1.2 itojun cksumlen = pimlen;
1660 1.2 itojun
1661 1.2 itojun if (in6_cksum(m, IPPROTO_PIM, off, cksumlen)) {
1662 1.2 itojun ++pim6stat.pim6s_rcv_badsum;
1663 1.2 itojun #ifdef MRT6DEBUG
1664 1.2 itojun if (mrt6debug & DEBUG_PIM)
1665 1.2 itojun log(LOG_DEBUG,
1666 1.2 itojun "pim6_input: invalid checksum\n");
1667 1.12 itojun #endif
1668 1.2 itojun m_freem(m);
1669 1.2 itojun return(IPPROTO_DONE);
1670 1.2 itojun }
1671 1.2 itojun }
1672 1.2 itojun #endif /* PIM_CHECKSUM */
1673 1.2 itojun
1674 1.2 itojun /* PIM version check */
1675 1.2 itojun if (pim->pim_ver != PIM_VERSION) {
1676 1.2 itojun ++pim6stat.pim6s_rcv_badversion;
1677 1.2 itojun #ifdef MRT6DEBUG
1678 1.2 itojun log(LOG_ERR,
1679 1.2 itojun "pim6_input: incorrect version %d, expecting %d\n",
1680 1.2 itojun pim->pim_ver, PIM_VERSION);
1681 1.12 itojun #endif
1682 1.2 itojun m_freem(m);
1683 1.2 itojun return(IPPROTO_DONE);
1684 1.2 itojun }
1685 1.2 itojun
1686 1.2 itojun if (pim->pim_type == PIM_REGISTER) {
1687 1.2 itojun /*
1688 1.2 itojun * since this is a REGISTER, we'll make a copy of the register
1689 1.7 itojun * headers ip6+pim+u_int32_t+encap_ip6, to be passed up to the
1690 1.2 itojun * routing daemon.
1691 1.2 itojun */
1692 1.2 itojun static struct sockaddr_in6 dst = { sizeof(dst), AF_INET6 };
1693 1.2 itojun
1694 1.2 itojun struct mbuf *mcp;
1695 1.2 itojun struct ip6_hdr *eip6;
1696 1.7 itojun u_int32_t *reghdr;
1697 1.2 itojun int rc;
1698 1.26 sommerfe
1699 1.2 itojun ++pim6stat.pim6s_rcv_registers;
1700 1.2 itojun
1701 1.2 itojun if ((reg_mif_num >= nummifs) || (reg_mif_num == (mifi_t) -1)) {
1702 1.2 itojun #ifdef MRT6DEBUG
1703 1.2 itojun if (mrt6debug & DEBUG_PIM)
1704 1.2 itojun log(LOG_DEBUG,
1705 1.2 itojun "pim6_input: register mif not set: %d\n",
1706 1.2 itojun reg_mif_num);
1707 1.2 itojun #endif
1708 1.2 itojun m_freem(m);
1709 1.2 itojun return(IPPROTO_DONE);
1710 1.2 itojun }
1711 1.26 sommerfe
1712 1.7 itojun reghdr = (u_int32_t *)(pim + 1);
1713 1.26 sommerfe
1714 1.2 itojun if ((ntohl(*reghdr) & PIM_NULL_REGISTER))
1715 1.2 itojun goto pim6_input_to_daemon;
1716 1.2 itojun
1717 1.2 itojun /*
1718 1.2 itojun * Validate length
1719 1.2 itojun */
1720 1.2 itojun if (pimlen < PIM6_REG_MINLEN) {
1721 1.2 itojun ++pim6stat.pim6s_rcv_tooshort;
1722 1.2 itojun ++pim6stat.pim6s_rcv_badregisters;
1723 1.2 itojun #ifdef MRT6DEBUG
1724 1.2 itojun log(LOG_ERR,
1725 1.2 itojun "pim6_input: register packet size too "
1726 1.2 itojun "small %d from %s\n",
1727 1.2 itojun pimlen, ip6_sprintf(&ip6->ip6_src));
1728 1.12 itojun #endif
1729 1.2 itojun m_freem(m);
1730 1.2 itojun return(IPPROTO_DONE);
1731 1.2 itojun }
1732 1.26 sommerfe
1733 1.2 itojun eip6 = (struct ip6_hdr *) (reghdr + 1);
1734 1.26 sommerfe #ifdef MRT6DEBUG
1735 1.2 itojun if (mrt6debug & DEBUG_PIM)
1736 1.2 itojun log(LOG_DEBUG,
1737 1.2 itojun "pim6_input[register], eip6: %s -> %s, "
1738 1.2 itojun "eip6 plen %d\n",
1739 1.2 itojun ip6_sprintf(&eip6->ip6_src),
1740 1.2 itojun ip6_sprintf(&eip6->ip6_dst),
1741 1.2 itojun ntohs(eip6->ip6_plen));
1742 1.12 itojun #endif
1743 1.14 itojun
1744 1.14 itojun /* verify the version number of the inner packet */
1745 1.14 itojun if ((eip6->ip6_vfc & IPV6_VERSION_MASK) != IPV6_VERSION) {
1746 1.14 itojun ++pim6stat.pim6s_rcv_badregisters;
1747 1.14 itojun #ifdef MRT6DEBUG
1748 1.14 itojun log(LOG_DEBUG, "pim6_input: invalid IP version (%d) "
1749 1.14 itojun "of the inner packet\n",
1750 1.14 itojun (eip6->ip6_vfc & IPV6_VERSION));
1751 1.14 itojun #endif
1752 1.14 itojun m_freem(m);
1753 1.14 itojun return(IPPROTO_NONE);
1754 1.14 itojun }
1755 1.26 sommerfe
1756 1.2 itojun /* verify the inner packet is destined to a mcast group */
1757 1.2 itojun if (!IN6_IS_ADDR_MULTICAST(&eip6->ip6_dst)) {
1758 1.2 itojun ++pim6stat.pim6s_rcv_badregisters;
1759 1.2 itojun #ifdef MRT6DEBUG
1760 1.2 itojun if (mrt6debug & DEBUG_PIM)
1761 1.2 itojun log(LOG_DEBUG,
1762 1.2 itojun "pim6_input: inner packet of register "
1763 1.2 itojun "is not multicast %s\n",
1764 1.2 itojun ip6_sprintf(&eip6->ip6_dst));
1765 1.12 itojun #endif
1766 1.2 itojun m_freem(m);
1767 1.2 itojun return(IPPROTO_DONE);
1768 1.2 itojun }
1769 1.26 sommerfe
1770 1.2 itojun /*
1771 1.2 itojun * make a copy of the whole header to pass to the daemon later.
1772 1.2 itojun */
1773 1.2 itojun mcp = m_copy(m, 0, off + PIM6_REG_MINLEN);
1774 1.2 itojun if (mcp == NULL) {
1775 1.2 itojun #ifdef MRT6DEBUG
1776 1.2 itojun log(LOG_ERR,
1777 1.2 itojun "pim6_input: pim register: "
1778 1.2 itojun "could not copy register head\n");
1779 1.12 itojun #endif
1780 1.2 itojun m_freem(m);
1781 1.2 itojun return(IPPROTO_DONE);
1782 1.2 itojun }
1783 1.26 sommerfe
1784 1.2 itojun /*
1785 1.2 itojun * forward the inner ip6 packet; point m_data at the inner ip6.
1786 1.2 itojun */
1787 1.2 itojun m_adj(m, off + PIM_MINLEN);
1788 1.2 itojun #ifdef MRT6DEBUG
1789 1.2 itojun if (mrt6debug & DEBUG_PIM) {
1790 1.2 itojun log(LOG_DEBUG,
1791 1.2 itojun "pim6_input: forwarding decapsulated register: "
1792 1.2 itojun "src %s, dst %s, mif %d\n",
1793 1.2 itojun ip6_sprintf(&eip6->ip6_src),
1794 1.2 itojun ip6_sprintf(&eip6->ip6_dst),
1795 1.2 itojun reg_mif_num);
1796 1.2 itojun }
1797 1.2 itojun #endif
1798 1.2 itojun
1799 1.2 itojun rc = looutput(mif6table[reg_mif_num].m6_ifp, m,
1800 1.2 itojun (struct sockaddr *) &dst,
1801 1.2 itojun (struct rtentry *) NULL);
1802 1.26 sommerfe
1803 1.2 itojun /* prepare the register head to send to the mrouting daemon */
1804 1.2 itojun m = mcp;
1805 1.2 itojun }
1806 1.12 itojun
1807 1.2 itojun /*
1808 1.2 itojun * Pass the PIM message up to the daemon; if it is a register message
1809 1.2 itojun * pass the 'head' only up to the daemon. This includes the
1810 1.2 itojun * encapsulator ip6 header, pim header, register header and the
1811 1.2 itojun * encapsulated ip6 header.
1812 1.2 itojun */
1813 1.2 itojun pim6_input_to_daemon:
1814 1.2 itojun rip6_input(&m, offp, proto);
1815 1.2 itojun return(IPPROTO_DONE);
1816 1.2 itojun }
1817