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