Home | History | Annotate | Line # | Download | only in netinet6
mld6.c revision 1.63
      1 /*	$NetBSD: mld6.c,v 1.63 2015/08/24 22:21:27 pooka Exp $	*/
      2 /*	$KAME: mld6.c,v 1.25 2001/01/16 14:14:18 itojun Exp $	*/
      3 
      4 /*
      5  * Copyright (C) 1998 WIDE Project.
      6  * All rights reserved.
      7  *
      8  * Redistribution and use in source and binary forms, with or without
      9  * modification, are permitted provided that the following conditions
     10  * are met:
     11  * 1. Redistributions of source code must retain the above copyright
     12  *    notice, this list of conditions and the following disclaimer.
     13  * 2. Redistributions in binary form must reproduce the above copyright
     14  *    notice, this list of conditions and the following disclaimer in the
     15  *    documentation and/or other materials provided with the distribution.
     16  * 3. Neither the name of the project nor the names of its contributors
     17  *    may be used to endorse or promote products derived from this software
     18  *    without specific prior written permission.
     19  *
     20  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     23  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     30  * SUCH DAMAGE.
     31  */
     32 
     33 /*
     34  * Copyright (c) 1992, 1993
     35  *	The Regents of the University of California.  All rights reserved.
     36  *
     37  * This code is derived from software contributed to Berkeley by
     38  * Stephen Deering of Stanford University.
     39  *
     40  * Redistribution and use in source and binary forms, with or without
     41  * modification, are permitted provided that the following conditions
     42  * are met:
     43  * 1. Redistributions of source code must retain the above copyright
     44  *    notice, this list of conditions and the following disclaimer.
     45  * 2. Redistributions in binary form must reproduce the above copyright
     46  *    notice, this list of conditions and the following disclaimer in the
     47  *    documentation and/or other materials provided with the distribution.
     48  * 3. Neither the name of the University nor the names of its contributors
     49  *    may be used to endorse or promote products derived from this software
     50  *    without specific prior written permission.
     51  *
     52  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     53  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     54  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     55  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     56  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     57  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     58  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     59  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     60  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     61  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     62  * SUCH DAMAGE.
     63  *
     64  *	@(#)igmp.c	8.1 (Berkeley) 7/19/93
     65  */
     66 
     67 /*
     68  * Copyright (c) 1988 Stephen Deering.
     69  *
     70  * This code is derived from software contributed to Berkeley by
     71  * Stephen Deering of Stanford University.
     72  *
     73  * Redistribution and use in source and binary forms, with or without
     74  * modification, are permitted provided that the following conditions
     75  * are met:
     76  * 1. Redistributions of source code must retain the above copyright
     77  *    notice, this list of conditions and the following disclaimer.
     78  * 2. Redistributions in binary form must reproduce the above copyright
     79  *    notice, this list of conditions and the following disclaimer in the
     80  *    documentation and/or other materials provided with the distribution.
     81  * 3. All advertising materials mentioning features or use of this software
     82  *    must display the following acknowledgement:
     83  *	This product includes software developed by the University of
     84  *	California, Berkeley and its contributors.
     85  * 4. Neither the name of the University nor the names of its contributors
     86  *    may be used to endorse or promote products derived from this software
     87  *    without specific prior written permission.
     88  *
     89  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     90  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     91  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     92  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     93  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     94  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     95  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     96  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     97  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     98  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     99  * SUCH DAMAGE.
    100  *
    101  *	@(#)igmp.c	8.1 (Berkeley) 7/19/93
    102  */
    103 
    104 #include <sys/cdefs.h>
    105 __KERNEL_RCSID(0, "$NetBSD: mld6.c,v 1.63 2015/08/24 22:21:27 pooka Exp $");
    106 
    107 #ifdef _KERNEL_OPT
    108 #include "opt_inet.h"
    109 #endif
    110 
    111 #include <sys/param.h>
    112 #include <sys/systm.h>
    113 #include <sys/mbuf.h>
    114 #include <sys/socket.h>
    115 #include <sys/socketvar.h>
    116 #include <sys/protosw.h>
    117 #include <sys/syslog.h>
    118 #include <sys/sysctl.h>
    119 #include <sys/kernel.h>
    120 #include <sys/callout.h>
    121 #include <sys/cprng.h>
    122 
    123 #include <net/if.h>
    124 
    125 #include <netinet/in.h>
    126 #include <netinet/in_var.h>
    127 #include <netinet6/in6_var.h>
    128 #include <netinet/ip6.h>
    129 #include <netinet6/ip6_var.h>
    130 #include <netinet6/scope6_var.h>
    131 #include <netinet/icmp6.h>
    132 #include <netinet6/icmp6_private.h>
    133 #include <netinet6/mld6_var.h>
    134 
    135 #include <net/net_osdep.h>
    136 
    137 
    138 /*
    139  * This structure is used to keep track of in6_multi chains which belong to
    140  * deleted interface addresses.
    141  */
    142 static LIST_HEAD(, multi6_kludge) in6_mk = LIST_HEAD_INITIALIZER(in6_mk);
    143 
    144 struct multi6_kludge {
    145 	LIST_ENTRY(multi6_kludge) mk_entry;
    146 	struct ifnet *mk_ifp;
    147 	struct in6_multihead mk_head;
    148 };
    149 
    150 
    151 /*
    152  * Protocol constants
    153  */
    154 
    155 /*
    156  * time between repetitions of a node's initial report of interest in a
    157  * multicast address(in seconds)
    158  */
    159 #define MLD_UNSOLICITED_REPORT_INTERVAL	10
    160 
    161 static struct ip6_pktopts ip6_opts;
    162 
    163 static void mld_start_listening(struct in6_multi *);
    164 static void mld_stop_listening(struct in6_multi *);
    165 
    166 static struct mld_hdr * mld_allocbuf(struct mbuf **, int, struct in6_multi *,
    167 	int);
    168 static void mld_sendpkt(struct in6_multi *, int, const struct in6_addr *);
    169 static void mld_starttimer(struct in6_multi *);
    170 static void mld_stoptimer(struct in6_multi *);
    171 static u_long mld_timerresid(struct in6_multi *);
    172 
    173 void
    174 mld_init(void)
    175 {
    176 	static u_int8_t hbh_buf[8];
    177 	struct ip6_hbh *hbh = (struct ip6_hbh *)hbh_buf;
    178 	u_int16_t rtalert_code = htons((u_int16_t)IP6OPT_RTALERT_MLD);
    179 
    180 	/* ip6h_nxt will be fill in later */
    181 	hbh->ip6h_len = 0;	/* (8 >> 3) - 1 */
    182 
    183 	/* XXX: grotty hard coding... */
    184 	hbh_buf[2] = IP6OPT_PADN;	/* 2 byte padding */
    185 	hbh_buf[3] = 0;
    186 	hbh_buf[4] = IP6OPT_RTALERT;
    187 	hbh_buf[5] = IP6OPT_RTALERT_LEN - 2;
    188 	memcpy(&hbh_buf[6], (void *)&rtalert_code, sizeof(u_int16_t));
    189 
    190 	ip6_opts.ip6po_hbh = hbh;
    191 	/* We will specify the hoplimit by a multicast option. */
    192 	ip6_opts.ip6po_hlim = -1;
    193 	ip6_opts.ip6po_prefer_tempaddr = IP6PO_TEMPADDR_NOTPREFER;
    194 }
    195 
    196 static void
    197 mld_starttimer(struct in6_multi *in6m)
    198 {
    199 	struct timeval now;
    200 
    201 	KASSERT(in6m->in6m_timer != IN6M_TIMER_UNDEF);
    202 
    203 	microtime(&now);
    204 	in6m->in6m_timer_expire.tv_sec = now.tv_sec + in6m->in6m_timer / hz;
    205 	in6m->in6m_timer_expire.tv_usec = now.tv_usec +
    206 	    (in6m->in6m_timer % hz) * (1000000 / hz);
    207 	if (in6m->in6m_timer_expire.tv_usec > 1000000) {
    208 		in6m->in6m_timer_expire.tv_sec++;
    209 		in6m->in6m_timer_expire.tv_usec -= 1000000;
    210 	}
    211 
    212 	/* start or restart the timer */
    213 	callout_schedule(&in6m->in6m_timer_ch, in6m->in6m_timer);
    214 }
    215 
    216 static void
    217 mld_stoptimer(struct in6_multi *in6m)
    218 {
    219 	if (in6m->in6m_timer == IN6M_TIMER_UNDEF)
    220 		return;
    221 
    222 	callout_stop(&in6m->in6m_timer_ch);
    223 
    224 	in6m->in6m_timer = IN6M_TIMER_UNDEF;
    225 }
    226 
    227 static void
    228 mld_timeo(void *arg)
    229 {
    230 	struct in6_multi *in6m = arg;
    231 
    232 	mutex_enter(softnet_lock);
    233 	KERNEL_LOCK(1, NULL);
    234 
    235 	if (in6m->in6m_timer == IN6M_TIMER_UNDEF)
    236 		goto out;
    237 
    238 	in6m->in6m_timer = IN6M_TIMER_UNDEF;
    239 
    240 	switch (in6m->in6m_state) {
    241 	case MLD_REPORTPENDING:
    242 		mld_start_listening(in6m);
    243 		break;
    244 	default:
    245 		mld_sendpkt(in6m, MLD_LISTENER_REPORT, NULL);
    246 		break;
    247 	}
    248 
    249 out:
    250 	KERNEL_UNLOCK_ONE(NULL);
    251 	mutex_exit(softnet_lock);
    252 }
    253 
    254 static u_long
    255 mld_timerresid(struct in6_multi *in6m)
    256 {
    257 	struct timeval now, diff;
    258 
    259 	microtime(&now);
    260 
    261 	if (now.tv_sec > in6m->in6m_timer_expire.tv_sec ||
    262 	    (now.tv_sec == in6m->in6m_timer_expire.tv_sec &&
    263 	    now.tv_usec > in6m->in6m_timer_expire.tv_usec)) {
    264 		return (0);
    265 	}
    266 	diff = in6m->in6m_timer_expire;
    267 	diff.tv_sec -= now.tv_sec;
    268 	diff.tv_usec -= now.tv_usec;
    269 	if (diff.tv_usec < 0) {
    270 		diff.tv_sec--;
    271 		diff.tv_usec += 1000000;
    272 	}
    273 
    274 	/* return the remaining time in milliseconds */
    275 	return diff.tv_sec * 1000 + diff.tv_usec / 1000;
    276 }
    277 
    278 static void
    279 mld_start_listening(struct in6_multi *in6m)
    280 {
    281 	struct in6_addr all_in6;
    282 
    283 	/*
    284 	 * RFC2710 page 10:
    285 	 * The node never sends a Report or Done for the link-scope all-nodes
    286 	 * address.
    287 	 * MLD messages are never sent for multicast addresses whose scope is 0
    288 	 * (reserved) or 1 (node-local).
    289 	 */
    290 	all_in6 = in6addr_linklocal_allnodes;
    291 	if (in6_setscope(&all_in6, in6m->in6m_ifp, NULL)) {
    292 		/* XXX: this should not happen! */
    293 		in6m->in6m_timer = 0;
    294 		in6m->in6m_state = MLD_OTHERLISTENER;
    295 	}
    296 	if (IN6_ARE_ADDR_EQUAL(&in6m->in6m_addr, &all_in6) ||
    297 	    IPV6_ADDR_MC_SCOPE(&in6m->in6m_addr) < IPV6_ADDR_SCOPE_LINKLOCAL) {
    298 		in6m->in6m_timer = IN6M_TIMER_UNDEF;
    299 		in6m->in6m_state = MLD_OTHERLISTENER;
    300 	} else {
    301 		mld_sendpkt(in6m, MLD_LISTENER_REPORT, NULL);
    302 		in6m->in6m_timer = cprng_fast32() %
    303 		    (MLD_UNSOLICITED_REPORT_INTERVAL * hz);
    304 		in6m->in6m_state = MLD_IREPORTEDLAST;
    305 
    306 		mld_starttimer(in6m);
    307 	}
    308 }
    309 
    310 static void
    311 mld_stop_listening(struct in6_multi *in6m)
    312 {
    313 	struct in6_addr allnode, allrouter;
    314 
    315 	allnode = in6addr_linklocal_allnodes;
    316 	if (in6_setscope(&allnode, in6m->in6m_ifp, NULL)) {
    317 		/* XXX: this should not happen! */
    318 		return;
    319 	}
    320 	allrouter = in6addr_linklocal_allrouters;
    321 	if (in6_setscope(&allrouter, in6m->in6m_ifp, NULL)) {
    322 		/* XXX impossible */
    323 		return;
    324 	}
    325 
    326 	if (in6m->in6m_state == MLD_IREPORTEDLAST &&
    327 	    (!IN6_ARE_ADDR_EQUAL(&in6m->in6m_addr, &allnode)) &&
    328 	    IPV6_ADDR_MC_SCOPE(&in6m->in6m_addr) >
    329 	    IPV6_ADDR_SCOPE_INTFACELOCAL) {
    330 		mld_sendpkt(in6m, MLD_LISTENER_DONE, &allrouter);
    331 	}
    332 }
    333 
    334 void
    335 mld_input(struct mbuf *m, int off)
    336 {
    337 	struct ip6_hdr *ip6;
    338 	struct mld_hdr *mldh;
    339 	struct ifnet *ifp = m->m_pkthdr.rcvif;
    340 	struct in6_multi *in6m = NULL;
    341 	struct in6_addr mld_addr, all_in6;
    342 	struct in6_ifaddr *ia;
    343 	u_long timer = 0;	/* timer value in the MLD query header */
    344 
    345 	IP6_EXTHDR_GET(mldh, struct mld_hdr *, m, off, sizeof(*mldh));
    346 	if (mldh == NULL) {
    347 		ICMP6_STATINC(ICMP6_STAT_TOOSHORT);
    348 		return;
    349 	}
    350 
    351 	/* source address validation */
    352 	ip6 = mtod(m, struct ip6_hdr *);/* in case mpullup */
    353 	if (!IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_src)) {
    354 		/*
    355 		 * RFC3590 allows the IPv6 unspecified address as the source
    356 		 * address of MLD report and done messages.  However, as this
    357 		 * same document says, this special rule is for snooping
    358 		 * switches and the RFC requires routers to discard MLD packets
    359 		 * with the unspecified source address.  The RFC only talks
    360 		 * about hosts receiving an MLD query or report in Security
    361 		 * Considerations, but this is probably the correct intention.
    362 		 * RFC3590 does not talk about other cases than link-local and
    363 		 * the unspecified source addresses, but we believe the same
    364 		 * rule should be applied.
    365 		 * As a result, we only allow link-local addresses as the
    366 		 * source address; otherwise, simply discard the packet.
    367 		 */
    368 #if 0
    369 		/*
    370 		 * XXX: do not log in an input path to avoid log flooding,
    371 		 * though RFC3590 says "SHOULD log" if the source of a query
    372 		 * is the unspecified address.
    373 		 */
    374 		log(LOG_INFO,
    375 		    "mld_input: src %s is not link-local (grp=%s)\n",
    376 		    ip6_sprintf(&ip6->ip6_src), ip6_sprintf(&mldh->mld_addr));
    377 #endif
    378 		m_freem(m);
    379 		return;
    380 	}
    381 
    382 	/*
    383 	 * make a copy for local work (in6_setscope() may modify the 1st arg)
    384 	 */
    385 	mld_addr = mldh->mld_addr;
    386 	if (in6_setscope(&mld_addr, ifp, NULL)) {
    387 		/* XXX: this should not happen! */
    388 		m_free(m);
    389 		return;
    390 	}
    391 
    392 	/*
    393 	 * In the MLD specification, there are 3 states and a flag.
    394 	 *
    395 	 * In Non-Listener state, we simply don't have a membership record.
    396 	 * In Delaying Listener state, our timer is running (in6m->in6m_timer)
    397 	 * In Idle Listener state, our timer is not running
    398 	 * (in6m->in6m_timer==IN6M_TIMER_UNDEF)
    399 	 *
    400 	 * The flag is in6m->in6m_state, it is set to MLD_OTHERLISTENER if
    401 	 * we have heard a report from another member, or MLD_IREPORTEDLAST
    402 	 * if we sent the last report.
    403 	 */
    404 	switch (mldh->mld_type) {
    405 	case MLD_LISTENER_QUERY:
    406 		if (ifp->if_flags & IFF_LOOPBACK)
    407 			break;
    408 
    409 		if (!IN6_IS_ADDR_UNSPECIFIED(&mld_addr) &&
    410 		    !IN6_IS_ADDR_MULTICAST(&mld_addr))
    411 			break;	/* print error or log stat? */
    412 
    413 		all_in6 = in6addr_linklocal_allnodes;
    414 		if (in6_setscope(&all_in6, ifp, NULL)) {
    415 			/* XXX: this should not happen! */
    416 			break;
    417 		}
    418 
    419 		/*
    420 		 * - Start the timers in all of our membership records
    421 		 *   that the query applies to for the interface on
    422 		 *   which the query arrived excl. those that belong
    423 		 *   to the "all-nodes" group (ff02::1).
    424 		 * - Restart any timer that is already running but has
    425 		 *   a value longer than the requested timeout.
    426 		 * - Use the value specified in the query message as
    427 		 *   the maximum timeout.
    428 		 */
    429 		timer = ntohs(mldh->mld_maxdelay);
    430 
    431 		IFP_TO_IA6(ifp, ia);
    432 		if (ia == NULL)
    433 			break;
    434 
    435 		LIST_FOREACH(in6m, &ia->ia6_multiaddrs, in6m_entry) {
    436 			if (IN6_ARE_ADDR_EQUAL(&in6m->in6m_addr, &all_in6) ||
    437 			    IPV6_ADDR_MC_SCOPE(&in6m->in6m_addr) <
    438 			    IPV6_ADDR_SCOPE_LINKLOCAL)
    439 				continue;
    440 
    441 			if (in6m->in6m_state == MLD_REPORTPENDING)
    442 				continue; /* we are not yet ready */
    443 
    444 			if (!IN6_IS_ADDR_UNSPECIFIED(&mld_addr) &&
    445 			    !IN6_ARE_ADDR_EQUAL(&mld_addr, &in6m->in6m_addr))
    446 				continue;
    447 
    448 			if (timer == 0) {
    449 				/* send a report immediately */
    450 				mld_stoptimer(in6m);
    451 				mld_sendpkt(in6m, MLD_LISTENER_REPORT, NULL);
    452 				in6m->in6m_state = MLD_IREPORTEDLAST;
    453 			} else if (in6m->in6m_timer == IN6M_TIMER_UNDEF ||
    454 			    mld_timerresid(in6m) > timer) {
    455 				in6m->in6m_timer =
    456 				   1 + (cprng_fast32() % timer) * hz / 1000;
    457 				mld_starttimer(in6m);
    458 			}
    459 		}
    460 		break;
    461 
    462 	case MLD_LISTENER_REPORT:
    463 		/*
    464 		 * For fast leave to work, we have to know that we are the
    465 		 * last person to send a report for this group.  Reports
    466 		 * can potentially get looped back if we are a multicast
    467 		 * router, so discard reports sourced by me.
    468 		 * Note that it is impossible to check IFF_LOOPBACK flag of
    469 		 * ifp for this purpose, since ip6_mloopback pass the physical
    470 		 * interface to looutput.
    471 		 */
    472 		if (m->m_flags & M_LOOP) /* XXX: grotty flag, but efficient */
    473 			break;
    474 
    475 		if (!IN6_IS_ADDR_MULTICAST(&mldh->mld_addr))
    476 			break;
    477 
    478 		/*
    479 		 * If we belong to the group being reported, stop
    480 		 * our timer for that group.
    481 		 */
    482 		IN6_LOOKUP_MULTI(mld_addr, ifp, in6m);
    483 		if (in6m) {
    484 			mld_stoptimer(in6m); /* transit to idle state */
    485 			in6m->in6m_state = MLD_OTHERLISTENER; /* clear flag */
    486 		}
    487 		break;
    488 	default:		/* this is impossible */
    489 #if 0
    490 		/*
    491 		 * this case should be impossible because of filtering in
    492 		 * icmp6_input().  But we explicitly disabled this part
    493 		 * just in case.
    494 		 */
    495 		log(LOG_ERR, "mld_input: illegal type(%d)", mldh->mld_type);
    496 #endif
    497 		break;
    498 	}
    499 
    500 	m_freem(m);
    501 }
    502 
    503 static void
    504 mld_sendpkt(struct in6_multi *in6m, int type,
    505 	const struct in6_addr *dst)
    506 {
    507 	struct mbuf *mh;
    508 	struct mld_hdr *mldh;
    509 	struct ip6_hdr *ip6 = NULL;
    510 	struct ip6_moptions im6o;
    511 	struct in6_ifaddr *ia = NULL;
    512 	struct ifnet *ifp = in6m->in6m_ifp;
    513 	int ignflags;
    514 
    515 	/*
    516 	 * At first, find a link local address on the outgoing interface
    517 	 * to use as the source address of the MLD packet.
    518 	 * We do not reject tentative addresses for MLD report to deal with
    519 	 * the case where we first join a link-local address.
    520 	 */
    521 	ignflags = (IN6_IFF_NOTREADY|IN6_IFF_ANYCAST) & ~IN6_IFF_TENTATIVE;
    522 	if ((ia = in6ifa_ifpforlinklocal(ifp, ignflags)) == NULL)
    523 		return;
    524 	if ((ia->ia6_flags & IN6_IFF_TENTATIVE))
    525 		ia = NULL;
    526 
    527 	/* Allocate two mbufs to store IPv6 header and MLD header */
    528 	mldh = mld_allocbuf(&mh, sizeof(struct mld_hdr), in6m, type);
    529 	if (mldh == NULL)
    530 		return;
    531 
    532 	/* fill src/dst here */
    533  	ip6 = mtod(mh, struct ip6_hdr *);
    534  	ip6->ip6_src = ia ? ia->ia_addr.sin6_addr : in6addr_any;
    535  	ip6->ip6_dst = dst ? *dst : in6m->in6m_addr;
    536 
    537 	mldh->mld_addr = in6m->in6m_addr;
    538 	in6_clearscope(&mldh->mld_addr); /* XXX */
    539 	mldh->mld_cksum = in6_cksum(mh, IPPROTO_ICMPV6, sizeof(struct ip6_hdr),
    540 	    sizeof(struct mld_hdr));
    541 
    542 	/* construct multicast option */
    543 	memset(&im6o, 0, sizeof(im6o));
    544 	im6o.im6o_multicast_ifp = ifp;
    545 	im6o.im6o_multicast_hlim = 1;
    546 
    547 	/*
    548 	 * Request loopback of the report if we are acting as a multicast
    549 	 * router, so that the process-level routing daemon can hear it.
    550 	 */
    551 	im6o.im6o_multicast_loop = (ip6_mrouter != NULL);
    552 
    553 	/* increment output statictics */
    554 	ICMP6_STATINC(ICMP6_STAT_OUTHIST + type);
    555 	icmp6_ifstat_inc(ifp, ifs6_out_msg);
    556 	switch (type) {
    557 	case MLD_LISTENER_QUERY:
    558 		icmp6_ifstat_inc(ifp, ifs6_out_mldquery);
    559 		break;
    560 	case MLD_LISTENER_REPORT:
    561 		icmp6_ifstat_inc(ifp, ifs6_out_mldreport);
    562 		break;
    563 	case MLD_LISTENER_DONE:
    564 		icmp6_ifstat_inc(ifp, ifs6_out_mlddone);
    565 		break;
    566 	}
    567 
    568 	ip6_output(mh, &ip6_opts, NULL, ia ? 0 : IPV6_UNSPECSRC,
    569 	    &im6o, NULL, NULL);
    570 }
    571 
    572 static struct mld_hdr *
    573 mld_allocbuf(struct mbuf **mh, int len, struct in6_multi *in6m,
    574     int type)
    575 {
    576 	struct mbuf *md;
    577 	struct mld_hdr *mldh;
    578 	struct ip6_hdr *ip6;
    579 
    580 	/*
    581 	 * Allocate mbufs to store ip6 header and MLD header.
    582 	 * We allocate 2 mbufs and make chain in advance because
    583 	 * it is more convenient when inserting the hop-by-hop option later.
    584 	 */
    585 	MGETHDR(*mh, M_DONTWAIT, MT_HEADER);
    586 	if (*mh == NULL)
    587 		return NULL;
    588 	MGET(md, M_DONTWAIT, MT_DATA);
    589 	if (md == NULL) {
    590 		m_free(*mh);
    591 		*mh = NULL;
    592 		return NULL;
    593 	}
    594 	(*mh)->m_next = md;
    595 	md->m_next = NULL;
    596 
    597 	(*mh)->m_pkthdr.rcvif = NULL;
    598 	(*mh)->m_pkthdr.len = sizeof(struct ip6_hdr) + len;
    599 	(*mh)->m_len = sizeof(struct ip6_hdr);
    600 	MH_ALIGN(*mh, sizeof(struct ip6_hdr));
    601 
    602 	/* fill in the ip6 header */
    603 	ip6 = mtod(*mh, struct ip6_hdr *);
    604 	memset(ip6, 0, sizeof(*ip6));
    605 	ip6->ip6_flow = 0;
    606 	ip6->ip6_vfc &= ~IPV6_VERSION_MASK;
    607 	ip6->ip6_vfc |= IPV6_VERSION;
    608 	/* ip6_plen will be set later */
    609 	ip6->ip6_nxt = IPPROTO_ICMPV6;
    610 	/* ip6_hlim will be set by im6o.im6o_multicast_hlim */
    611 	/* ip6_src/dst will be set by mld_sendpkt() or mld_sendbuf() */
    612 
    613 	/* fill in the MLD header as much as possible */
    614 	md->m_len = len;
    615 	mldh = mtod(md, struct mld_hdr *);
    616 	memset(mldh, 0, len);
    617 	mldh->mld_type = type;
    618 	return mldh;
    619 }
    620 
    621 /*
    622  * Add an address to the list of IP6 multicast addresses for a given interface.
    623  */
    624 struct	in6_multi *
    625 in6_addmulti(struct in6_addr *maddr6, struct ifnet *ifp,
    626 	int *errorp, int timer)
    627 {
    628 	struct	in6_ifaddr *ia;
    629 	struct	sockaddr_in6 sin6;
    630 	struct	in6_multi *in6m;
    631 	int	s = splsoftnet();
    632 
    633 	*errorp = 0;
    634 
    635 	/*
    636 	 * See if address already in list.
    637 	 */
    638 	IN6_LOOKUP_MULTI(*maddr6, ifp, in6m);
    639 	if (in6m != NULL) {
    640 		/*
    641 		 * Found it; just increment the refrence count.
    642 		 */
    643 		in6m->in6m_refcount++;
    644 	} else {
    645 		/*
    646 		 * New address; allocate a new multicast record
    647 		 * and link it into the interface's multicast list.
    648 		 */
    649 		in6m = (struct in6_multi *)
    650 			malloc(sizeof(*in6m), M_IPMADDR, M_NOWAIT|M_ZERO);
    651 		if (in6m == NULL) {
    652 			splx(s);
    653 			*errorp = ENOBUFS;
    654 			return (NULL);
    655 		}
    656 
    657 		in6m->in6m_addr = *maddr6;
    658 		in6m->in6m_ifp = ifp;
    659 		in6m->in6m_refcount = 1;
    660 		in6m->in6m_timer = IN6M_TIMER_UNDEF;
    661 		IFP_TO_IA6(ifp, ia);
    662 		if (ia == NULL) {
    663 			free(in6m, M_IPMADDR);
    664 			splx(s);
    665 			*errorp = EADDRNOTAVAIL; /* appropriate? */
    666 			return (NULL);
    667 		}
    668 		in6m->in6m_ia = ia;
    669 		ifaref(&ia->ia_ifa); /* gain a reference */
    670 		LIST_INSERT_HEAD(&ia->ia6_multiaddrs, in6m, in6m_entry);
    671 
    672 		/*
    673 		 * Ask the network driver to update its multicast reception
    674 		 * filter appropriately for the new address.
    675 		 */
    676 		sockaddr_in6_init(&sin6, maddr6, 0, 0, 0);
    677 		*errorp = if_mcast_op(ifp, SIOCADDMULTI, sin6tosa(&sin6));
    678 		if (*errorp) {
    679 			LIST_REMOVE(in6m, in6m_entry);
    680 			free(in6m, M_IPMADDR);
    681 			ifafree(&ia->ia_ifa);
    682 			splx(s);
    683 			return (NULL);
    684 		}
    685 
    686 		callout_init(&in6m->in6m_timer_ch, CALLOUT_MPSAFE);
    687 		callout_setfunc(&in6m->in6m_timer_ch, mld_timeo, in6m);
    688 		in6m->in6m_timer = timer;
    689 		if (in6m->in6m_timer > 0) {
    690 			in6m->in6m_state = MLD_REPORTPENDING;
    691 			mld_starttimer(in6m);
    692 
    693 			splx(s);
    694 			return (in6m);
    695 		}
    696 
    697 		/*
    698 		 * Let MLD6 know that we have joined a new IP6 multicast
    699 		 * group.
    700 		 */
    701 		mld_start_listening(in6m);
    702 	}
    703 	splx(s);
    704 	return (in6m);
    705 }
    706 
    707 /*
    708  * Delete a multicast address record.
    709  */
    710 void
    711 in6_delmulti(struct in6_multi *in6m)
    712 {
    713 	struct	sockaddr_in6 sin6;
    714 	struct	in6_ifaddr *ia;
    715 	int	s = splsoftnet();
    716 
    717 	mld_stoptimer(in6m);
    718 
    719 	if (--in6m->in6m_refcount == 0) {
    720 		/*
    721 		 * No remaining claims to this record; let MLD6 know
    722 		 * that we are leaving the multicast group.
    723 		 */
    724 		mld_stop_listening(in6m);
    725 
    726 		/*
    727 		 * Unlink from list.
    728 		 */
    729 		LIST_REMOVE(in6m, in6m_entry);
    730 		if (in6m->in6m_ia != NULL) {
    731 			ifafree(&in6m->in6m_ia->ia_ifa); /* release reference */
    732 			in6m->in6m_ia = NULL;
    733 		}
    734 
    735 		/*
    736 		 * Delete all references of this multicasting group from
    737 		 * the membership arrays
    738 		 */
    739 		for (ia = in6_ifaddr; ia; ia = ia->ia_next) {
    740 			struct in6_multi_mship *imm;
    741 			LIST_FOREACH(imm, &ia->ia6_memberships, i6mm_chain) {
    742 				if (imm->i6mm_maddr == in6m)
    743 					imm->i6mm_maddr = NULL;
    744 			}
    745 		}
    746 
    747 		/*
    748 		 * Notify the network driver to update its multicast
    749 		 * reception filter.
    750 		 */
    751 		sockaddr_in6_init(&sin6, &in6m->in6m_addr, 0, 0, 0);
    752 		if_mcast_op(in6m->in6m_ifp, SIOCDELMULTI, sin6tosa(&sin6));
    753 
    754 		/* Tell mld_timeo we're halting the timer */
    755 		in6m->in6m_timer = IN6M_TIMER_UNDEF;
    756 		callout_halt(&in6m->in6m_timer_ch, softnet_lock);
    757 		callout_destroy(&in6m->in6m_timer_ch);
    758 
    759 		free(in6m, M_IPMADDR);
    760 	}
    761 	splx(s);
    762 }
    763 
    764 
    765 struct in6_multi_mship *
    766 in6_joingroup(struct ifnet *ifp, struct in6_addr *addr,
    767 	int *errorp, int timer)
    768 {
    769 	struct in6_multi_mship *imm;
    770 
    771 	imm = malloc(sizeof(*imm), M_IPMADDR, M_NOWAIT|M_ZERO);
    772 	if (imm == NULL) {
    773 		*errorp = ENOBUFS;
    774 		return NULL;
    775 	}
    776 
    777 	imm->i6mm_maddr = in6_addmulti(addr, ifp, errorp, timer);
    778 	if (!imm->i6mm_maddr) {
    779 		/* *errorp is already set */
    780 		free(imm, M_IPMADDR);
    781 		return NULL;
    782 	}
    783 	return imm;
    784 }
    785 
    786 int
    787 in6_leavegroup(struct in6_multi_mship *imm)
    788 {
    789 
    790 	if (imm->i6mm_maddr) {
    791 		in6_delmulti(imm->i6mm_maddr);
    792 	}
    793 	free(imm, M_IPMADDR);
    794 	return 0;
    795 }
    796 
    797 
    798 /*
    799  * Multicast address kludge:
    800  * If there were any multicast addresses attached to this interface address,
    801  * either move them to another address on this interface, or save them until
    802  * such time as this interface is reconfigured for IPv6.
    803  */
    804 void
    805 in6_savemkludge(struct in6_ifaddr *oia)
    806 {
    807 	struct in6_ifaddr *ia;
    808 	struct in6_multi *in6m;
    809 
    810 	IFP_TO_IA6(oia->ia_ifp, ia);
    811 	if (ia) {	/* there is another address */
    812 		KASSERT(ia != oia);
    813 		while ((in6m = LIST_FIRST(&oia->ia6_multiaddrs)) != NULL) {
    814 			LIST_REMOVE(in6m, in6m_entry);
    815 			ifaref(&ia->ia_ifa);
    816 			ifafree(&in6m->in6m_ia->ia_ifa);
    817 			in6m->in6m_ia = ia;
    818 			LIST_INSERT_HEAD(&ia->ia6_multiaddrs, in6m, in6m_entry);
    819 		}
    820 	} else {	/* last address on this if deleted, save */
    821 		struct multi6_kludge *mk;
    822 
    823 		LIST_FOREACH(mk, &in6_mk, mk_entry) {
    824 			if (mk->mk_ifp == oia->ia_ifp)
    825 				break;
    826 		}
    827 		if (mk == NULL) /* this should not happen! */
    828 			panic("in6_savemkludge: no kludge space");
    829 
    830 		while ((in6m = LIST_FIRST(&oia->ia6_multiaddrs)) != NULL) {
    831 			LIST_REMOVE(in6m, in6m_entry);
    832 			ifafree(&in6m->in6m_ia->ia_ifa); /* release reference */
    833 			in6m->in6m_ia = NULL;
    834 			LIST_INSERT_HEAD(&mk->mk_head, in6m, in6m_entry);
    835 		}
    836 	}
    837 }
    838 
    839 /*
    840  * Continuation of multicast address hack:
    841  * If there was a multicast group list previously saved for this interface,
    842  * then we re-attach it to the first address configured on the i/f.
    843  */
    844 void
    845 in6_restoremkludge(struct in6_ifaddr *ia, struct ifnet *ifp)
    846 {
    847 	struct multi6_kludge *mk;
    848 	struct in6_multi *in6m;
    849 
    850 	LIST_FOREACH(mk, &in6_mk, mk_entry) {
    851 		if (mk->mk_ifp == ifp)
    852 			break;
    853 	}
    854 	if (mk == NULL)
    855 		return;
    856 	while ((in6m = LIST_FIRST(&mk->mk_head)) != NULL) {
    857 		LIST_REMOVE(in6m, in6m_entry);
    858 		in6m->in6m_ia = ia;
    859 		ifaref(&ia->ia_ifa);
    860 		LIST_INSERT_HEAD(&ia->ia6_multiaddrs, in6m, in6m_entry);
    861 	}
    862 }
    863 
    864 /*
    865  * Allocate space for the kludge at interface initialization time.
    866  * Formerly, we dynamically allocated the space in in6_savemkludge() with
    867  * malloc(M_WAITOK).  However, it was wrong since the function could be called
    868  * under an interrupt context (software timer on address lifetime expiration).
    869  * Also, we cannot just give up allocating the strucutre, since the group
    870  * membership structure is very complex and we need to keep it anyway.
    871  * Of course, this function MUST NOT be called under an interrupt context.
    872  * Specifically, it is expected to be called only from in6_ifattach(), though
    873  * it is a global function.
    874  */
    875 void
    876 in6_createmkludge(struct ifnet *ifp)
    877 {
    878 	struct multi6_kludge *mk;
    879 
    880 	LIST_FOREACH(mk, &in6_mk, mk_entry) {
    881 		/* If we've already had one, do not allocate. */
    882 		if (mk->mk_ifp == ifp)
    883 			return;
    884 	}
    885 
    886 	mk = malloc(sizeof(*mk), M_IPMADDR, M_ZERO|M_WAITOK);
    887 
    888 	LIST_INIT(&mk->mk_head);
    889 	mk->mk_ifp = ifp;
    890 	LIST_INSERT_HEAD(&in6_mk, mk, mk_entry);
    891 }
    892 
    893 void
    894 in6_purgemkludge(struct ifnet *ifp)
    895 {
    896 	struct multi6_kludge *mk;
    897 	struct in6_multi *in6m, *next;
    898 
    899 	LIST_FOREACH(mk, &in6_mk, mk_entry) {
    900 		if (mk->mk_ifp == ifp)
    901 			break;
    902 	}
    903 	if (mk == NULL)
    904 		return;
    905 
    906 	/* leave from all multicast groups joined */
    907 	for (in6m = LIST_FIRST(&mk->mk_head); in6m != NULL; in6m = next) {
    908 		next = LIST_NEXT(in6m, in6m_entry);
    909 		in6_delmulti(in6m);
    910 	}
    911 	LIST_REMOVE(mk, mk_entry);
    912 	free(mk, M_IPMADDR);
    913 }
    914 
    915 static int
    916 in6_mkludge_sysctl(SYSCTLFN_ARGS)
    917 {
    918 	struct multi6_kludge *mk;
    919 	struct in6_multi *in6m;
    920 	int error;
    921 	uint32_t tmp;
    922 	size_t written;
    923 
    924 	if (namelen != 1)
    925 		return EINVAL;
    926 
    927 	if (oldp == NULL) {
    928 		*oldlenp = 0;
    929 		LIST_FOREACH(mk, &in6_mk, mk_entry) {
    930 			if (mk->mk_ifp->if_index == name[0])
    931 				continue;
    932 			LIST_FOREACH(in6m, &mk->mk_head, in6m_entry) {
    933 				*oldlenp += sizeof(struct in6_addr) +
    934 				    sizeof(uint32_t);
    935 			}
    936 		}
    937 		return 0;
    938 	}
    939 
    940 	error = 0;
    941 	written = 0;
    942 	LIST_FOREACH(mk, &in6_mk, mk_entry) {
    943 		if (mk->mk_ifp->if_index == name[0])
    944 			continue;
    945 		LIST_FOREACH(in6m, &mk->mk_head, in6m_entry) {
    946 			if (written + sizeof(struct in6_addr) +
    947 			    sizeof(uint32_t) > *oldlenp)
    948 				goto done;
    949 			error = sysctl_copyout(l, &in6m->in6m_addr,
    950 			    oldp, sizeof(struct in6_addr));
    951 			if (error)
    952 				goto done;
    953 			oldp = (char *)oldp + sizeof(struct in6_addr);
    954 			written += sizeof(struct in6_addr);
    955 			tmp = in6m->in6m_refcount;
    956 			error = sysctl_copyout(l, &tmp, oldp, sizeof(tmp));
    957 			if (error)
    958 				goto done;
    959 			oldp = (char *)oldp + sizeof(tmp);
    960 			written += sizeof(tmp);
    961 		}
    962 	}
    963 
    964 done:
    965 	*oldlenp = written;
    966 	return error;
    967 }
    968 
    969 static int
    970 in6_multicast_sysctl(SYSCTLFN_ARGS)
    971 {
    972 	struct ifnet *ifp;
    973 	struct ifaddr *ifa;
    974 	struct in6_ifaddr *ifa6;
    975 	struct in6_multi *in6m;
    976 	uint32_t tmp;
    977 	int error;
    978 	size_t written;
    979 
    980 	if (namelen != 1)
    981 		return EINVAL;
    982 
    983 	ifp = if_byindex(name[0]);
    984 	if (ifp == NULL)
    985 		return ENODEV;
    986 
    987 	if (oldp == NULL) {
    988 		*oldlenp = 0;
    989 		IFADDR_FOREACH(ifa, ifp) {
    990 			if (ifa->ifa_addr == NULL)
    991 				continue;
    992 			if (ifa->ifa_addr->sa_family != AF_INET6)
    993 				continue;
    994 			ifa6 = (struct in6_ifaddr *)ifa;
    995 			LIST_FOREACH(in6m, &ifa6->ia6_multiaddrs, in6m_entry) {
    996 				*oldlenp += 2 * sizeof(struct in6_addr) +
    997 				    sizeof(uint32_t);
    998 			}
    999 		}
   1000 		return 0;
   1001 	}
   1002 
   1003 	error = 0;
   1004 	written = 0;
   1005 	IFADDR_FOREACH(ifa, ifp) {
   1006 		if (ifa->ifa_addr == NULL)
   1007 			continue;
   1008 		if (ifa->ifa_addr->sa_family != AF_INET6)
   1009 			continue;
   1010 		ifa6 = (struct in6_ifaddr *)ifa;
   1011 		LIST_FOREACH(in6m, &ifa6->ia6_multiaddrs, in6m_entry) {
   1012 			if (written + 2 * sizeof(struct in6_addr) +
   1013 			    sizeof(uint32_t) > *oldlenp)
   1014 				goto done;
   1015 			error = sysctl_copyout(l, &ifa6->ia_addr.sin6_addr,
   1016 			    oldp, sizeof(struct in6_addr));
   1017 			if (error)
   1018 				goto done;
   1019 			oldp = (char *)oldp + sizeof(struct in6_addr);
   1020 			written += sizeof(struct in6_addr);
   1021 			error = sysctl_copyout(l, &in6m->in6m_addr,
   1022 			    oldp, sizeof(struct in6_addr));
   1023 			if (error)
   1024 				goto done;
   1025 			oldp = (char *)oldp + sizeof(struct in6_addr);
   1026 			written += sizeof(struct in6_addr);
   1027 			tmp = in6m->in6m_refcount;
   1028 			error = sysctl_copyout(l, &tmp, oldp, sizeof(tmp));
   1029 			if (error)
   1030 				goto done;
   1031 			oldp = (char *)oldp + sizeof(tmp);
   1032 			written += sizeof(tmp);
   1033 		}
   1034 	}
   1035 done:
   1036 	*oldlenp = written;
   1037 	return error;
   1038 }
   1039 
   1040 SYSCTL_SETUP(sysctl_in6_mklude_setup, "sysctl net.inet6.multicast_kludge subtree setup")
   1041 {
   1042 
   1043 	sysctl_createv(clog, 0, NULL, NULL,
   1044 		       CTLFLAG_PERMANENT,
   1045 		       CTLTYPE_NODE, "inet6", NULL,
   1046 		       NULL, 0, NULL, 0,
   1047 		       CTL_NET, PF_INET6, CTL_EOL);
   1048 
   1049 	sysctl_createv(clog, 0, NULL, NULL,
   1050 		       CTLFLAG_PERMANENT,
   1051 		       CTLTYPE_NODE, "multicast",
   1052 		       SYSCTL_DESCR("Multicast information"),
   1053 		       in6_multicast_sysctl, 0, NULL, 0,
   1054 		       CTL_NET, PF_INET6, CTL_CREATE, CTL_EOL);
   1055 
   1056 	sysctl_createv(clog, 0, NULL, NULL,
   1057 		       CTLFLAG_PERMANENT,
   1058 		       CTLTYPE_NODE, "multicast_kludge",
   1059 		       SYSCTL_DESCR("multicast kludge information"),
   1060 		       in6_mkludge_sysctl, 0, NULL, 0,
   1061 		       CTL_NET, PF_INET6, CTL_CREATE, CTL_EOL);
   1062 }
   1063