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