in_mcast.c revision 252510
1170613Sbms/*-
2189592Sbms * Copyright (c) 2007-2009 Bruce Simpson.
3170613Sbms * Copyright (c) 2005 Robert N. M. Watson.
4170613Sbms * All rights reserved.
5170613Sbms *
6170613Sbms * Redistribution and use in source and binary forms, with or without
7170613Sbms * modification, are permitted provided that the following conditions
8170613Sbms * are met:
9170613Sbms * 1. Redistributions of source code must retain the above copyright
10170613Sbms *    notice, this list of conditions and the following disclaimer.
11170613Sbms * 2. Redistributions in binary form must reproduce the above copyright
12170613Sbms *    notice, this list of conditions and the following disclaimer in the
13170613Sbms *    documentation and/or other materials provided with the distribution.
14170613Sbms * 3. The name of the author may not be used to endorse or promote
15170613Sbms *    products derived from this software without specific prior written
16170613Sbms *    permission.
17170613Sbms *
18170613Sbms * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19170613Sbms * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20170613Sbms * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21170613Sbms * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22170613Sbms * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23170613Sbms * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24170613Sbms * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25170613Sbms * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26170613Sbms * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27170613Sbms * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28170613Sbms * SUCH DAMAGE.
29170613Sbms */
30170613Sbms
31170613Sbms/*
32170613Sbms * IPv4 multicast socket, group, and socket option processing module.
33170613Sbms */
34170613Sbms
35170613Sbms#include <sys/cdefs.h>
36170613Sbms__FBSDID("$FreeBSD: head/sys/netinet/in_mcast.c 252510 2013-07-02 16:39:12Z hrs $");
37170613Sbms
38170613Sbms#include <sys/param.h>
39170613Sbms#include <sys/systm.h>
40170613Sbms#include <sys/kernel.h>
41170613Sbms#include <sys/malloc.h>
42170613Sbms#include <sys/mbuf.h>
43171746Scsjp#include <sys/protosw.h>
44170613Sbms#include <sys/socket.h>
45170613Sbms#include <sys/socketvar.h>
46189592Sbms#include <sys/protosw.h>
47170613Sbms#include <sys/sysctl.h>
48189592Sbms#include <sys/ktr.h>
49228969Sjhb#include <sys/taskqueue.h>
50189592Sbms#include <sys/tree.h>
51170613Sbms
52170613Sbms#include <net/if.h>
53170613Sbms#include <net/if_dl.h>
54170613Sbms#include <net/route.h>
55185571Sbz#include <net/vnet.h>
56170613Sbms
57170613Sbms#include <netinet/in.h>
58170613Sbms#include <netinet/in_systm.h>
59170613Sbms#include <netinet/in_pcb.h>
60170613Sbms#include <netinet/in_var.h>
61170613Sbms#include <netinet/ip_var.h>
62170613Sbms#include <netinet/igmp_var.h>
63170613Sbms
64189592Sbms#ifndef KTR_IGMPV3
65191659Sbms#define KTR_IGMPV3 KTR_INET
66189592Sbms#endif
67189592Sbms
68170613Sbms#ifndef __SOCKUNION_DECLARED
69170613Sbmsunion sockunion {
70170613Sbms	struct sockaddr_storage	ss;
71170613Sbms	struct sockaddr		sa;
72170613Sbms	struct sockaddr_dl	sdl;
73170613Sbms	struct sockaddr_in	sin;
74170613Sbms};
75170613Sbmstypedef union sockunion sockunion_t;
76170613Sbms#define __SOCKUNION_DECLARED
77170613Sbms#endif /* __SOCKUNION_DECLARED */
78170613Sbms
79189592Sbmsstatic MALLOC_DEFINE(M_INMFILTER, "in_mfilter",
80189592Sbms    "IPv4 multicast PCB-layer source filter");
81170613Sbmsstatic MALLOC_DEFINE(M_IPMADDR, "in_multi", "IPv4 multicast group");
82170613Sbmsstatic MALLOC_DEFINE(M_IPMOPTS, "ip_moptions", "IPv4 multicast options");
83189592Sbmsstatic MALLOC_DEFINE(M_IPMSOURCE, "ip_msource",
84189592Sbms    "IPv4 multicast IGMP-layer source filter");
85170613Sbms
86170613Sbms/*
87189592Sbms * Locking:
88189592Sbms * - Lock order is: Giant, INP_WLOCK, IN_MULTI_LOCK, IGMP_LOCK, IF_ADDR_LOCK.
89189592Sbms * - The IF_ADDR_LOCK is implicitly taken by inm_lookup() earlier, however
90189592Sbms *   it can be taken by code in net/if.c also.
91189592Sbms * - ip_moptions and in_mfilter are covered by the INP_WLOCK.
92189592Sbms *
93189592Sbms * struct in_multi is covered by IN_MULTI_LOCK. There isn't strictly
94189592Sbms * any need for in_multi itself to be virtualized -- it is bound to an ifp
95189592Sbms * anyway no matter what happens.
96170613Sbms */
97170613Sbmsstruct mtx in_multi_mtx;
98189592SbmsMTX_SYSINIT(in_multi_mtx, &in_multi_mtx, "in_multi_mtx", MTX_DEF);
99170613Sbms
100170613Sbms/*
101170613Sbms * Functions with non-static linkage defined in this file should be
102170613Sbms * declared in in_var.h:
103189592Sbms *  imo_multi_filter()
104170613Sbms *  in_addmulti()
105170613Sbms *  in_delmulti()
106189592Sbms *  in_joingroup()
107189592Sbms *  in_joingroup_locked()
108189592Sbms *  in_leavegroup()
109189592Sbms *  in_leavegroup_locked()
110170613Sbms * and ip_var.h:
111170613Sbms *  inp_freemoptions()
112170613Sbms *  inp_getmoptions()
113170613Sbms *  inp_setmoptions()
114189592Sbms *
115189592Sbms * XXX: Both carp and pf need to use the legacy (*,G) KPIs in_addmulti()
116189592Sbms * and in_delmulti().
117170613Sbms */
118189592Sbmsstatic void	imf_commit(struct in_mfilter *);
119189592Sbmsstatic int	imf_get_source(struct in_mfilter *imf,
120189592Sbms		    const struct sockaddr_in *psin,
121189592Sbms		    struct in_msource **);
122189592Sbmsstatic struct in_msource *
123189592Sbms		imf_graft(struct in_mfilter *, const uint8_t,
124189592Sbms		    const struct sockaddr_in *);
125189592Sbmsstatic void	imf_leave(struct in_mfilter *);
126189592Sbmsstatic int	imf_prune(struct in_mfilter *, const struct sockaddr_in *);
127189592Sbmsstatic void	imf_purge(struct in_mfilter *);
128189592Sbmsstatic void	imf_rollback(struct in_mfilter *);
129189592Sbmsstatic void	imf_reap(struct in_mfilter *);
130170613Sbmsstatic int	imo_grow(struct ip_moptions *);
131189592Sbmsstatic size_t	imo_match_group(const struct ip_moptions *,
132189592Sbms		    const struct ifnet *, const struct sockaddr *);
133189592Sbmsstatic struct in_msource *
134189592Sbms		imo_match_source(const struct ip_moptions *, const size_t,
135189592Sbms		    const struct sockaddr *);
136189592Sbmsstatic void	ims_merge(struct ip_msource *ims,
137189592Sbms		    const struct in_msource *lims, const int rollback);
138189592Sbmsstatic int	in_getmulti(struct ifnet *, const struct in_addr *,
139189592Sbms		    struct in_multi **);
140189592Sbmsstatic int	inm_get_source(struct in_multi *inm, const in_addr_t haddr,
141189592Sbms		    const int noalloc, struct ip_msource **pims);
142189592Sbmsstatic int	inm_is_ifp_detached(const struct in_multi *);
143189592Sbmsstatic int	inm_merge(struct in_multi *, /*const*/ struct in_mfilter *);
144189592Sbmsstatic void	inm_purge(struct in_multi *);
145189592Sbmsstatic void	inm_reap(struct in_multi *);
146170613Sbmsstatic struct ip_moptions *
147170613Sbms		inp_findmoptions(struct inpcb *);
148228969Sjhbstatic void	inp_freemoptions_internal(struct ip_moptions *);
149228969Sjhbstatic void	inp_gcmoptions(void *, int);
150170613Sbmsstatic int	inp_get_source_filters(struct inpcb *, struct sockopt *);
151170613Sbmsstatic int	inp_join_group(struct inpcb *, struct sockopt *);
152170613Sbmsstatic int	inp_leave_group(struct inpcb *, struct sockopt *);
153189592Sbmsstatic struct ifnet *
154189592Sbms		inp_lookup_mcast_ifp(const struct inpcb *,
155189592Sbms		    const struct sockaddr_in *, const struct in_addr);
156189592Sbmsstatic int	inp_block_unblock_source(struct inpcb *, struct sockopt *);
157170613Sbmsstatic int	inp_set_multicast_if(struct inpcb *, struct sockopt *);
158170613Sbmsstatic int	inp_set_source_filters(struct inpcb *, struct sockopt *);
159189592Sbmsstatic int	sysctl_ip_mcast_filters(SYSCTL_HANDLER_ARGS);
160170613Sbms
161227309Sedstatic SYSCTL_NODE(_net_inet_ip, OID_AUTO, mcast, CTLFLAG_RW, 0,
162227309Sed    "IPv4 multicast");
163189357Sbms
164189592Sbmsstatic u_long in_mcast_maxgrpsrc = IP_MAX_GROUP_SRC_FILTER;
165189592SbmsSYSCTL_ULONG(_net_inet_ip_mcast, OID_AUTO, maxgrpsrc,
166189592Sbms    CTLFLAG_RW | CTLFLAG_TUN, &in_mcast_maxgrpsrc, 0,
167189592Sbms    "Max source filters per group");
168189592SbmsTUNABLE_ULONG("net.inet.ip.mcast.maxgrpsrc", &in_mcast_maxgrpsrc);
169189592Sbms
170189592Sbmsstatic u_long in_mcast_maxsocksrc = IP_MAX_SOCK_SRC_FILTER;
171189592SbmsSYSCTL_ULONG(_net_inet_ip_mcast, OID_AUTO, maxsocksrc,
172189592Sbms    CTLFLAG_RW | CTLFLAG_TUN, &in_mcast_maxsocksrc, 0,
173189592Sbms    "Max source filters per socket");
174189592SbmsTUNABLE_ULONG("net.inet.ip.mcast.maxsocksrc", &in_mcast_maxsocksrc);
175189592Sbms
176189357Sbmsint in_mcast_loop = IP_DEFAULT_MULTICAST_LOOP;
177189357SbmsSYSCTL_INT(_net_inet_ip_mcast, OID_AUTO, loop, CTLFLAG_RW | CTLFLAG_TUN,
178189357Sbms    &in_mcast_loop, 0, "Loopback multicast datagrams by default");
179189357SbmsTUNABLE_INT("net.inet.ip.mcast.loop", &in_mcast_loop);
180189357Sbms
181227309Sedstatic SYSCTL_NODE(_net_inet_ip_mcast, OID_AUTO, filters,
182189592Sbms    CTLFLAG_RD | CTLFLAG_MPSAFE, sysctl_ip_mcast_filters,
183189592Sbms    "Per-interface stack-wide source filters");
184189592Sbms
185228969Sjhbstatic STAILQ_HEAD(, ip_moptions) imo_gc_list =
186228969Sjhb    STAILQ_HEAD_INITIALIZER(imo_gc_list);
187228969Sjhbstatic struct task imo_gc_task = TASK_INITIALIZER(0, inp_gcmoptions, NULL);
188228969Sjhb
189170613Sbms/*
190189592Sbms * Inline function which wraps assertions for a valid ifp.
191189592Sbms * The ifnet layer will set the ifma's ifp pointer to NULL if the ifp
192189592Sbms * is detached.
193189592Sbms */
194189592Sbmsstatic int __inline
195189592Sbmsinm_is_ifp_detached(const struct in_multi *inm)
196189592Sbms{
197189592Sbms	struct ifnet *ifp;
198189592Sbms
199189592Sbms	KASSERT(inm->inm_ifma != NULL, ("%s: no ifma", __func__));
200189592Sbms	ifp = inm->inm_ifma->ifma_ifp;
201189592Sbms	if (ifp != NULL) {
202189592Sbms		/*
203189592Sbms		 * Sanity check that netinet's notion of ifp is the
204189592Sbms		 * same as net's.
205189592Sbms		 */
206189592Sbms		KASSERT(inm->inm_ifp == ifp, ("%s: bad ifp", __func__));
207189592Sbms	}
208189592Sbms
209189592Sbms	return (ifp == NULL);
210189592Sbms}
211189592Sbms
212189592Sbms/*
213189592Sbms * Initialize an in_mfilter structure to a known state at t0, t1
214189592Sbms * with an empty source filter list.
215189592Sbms */
216189592Sbmsstatic __inline void
217189592Sbmsimf_init(struct in_mfilter *imf, const int st0, const int st1)
218189592Sbms{
219189592Sbms	memset(imf, 0, sizeof(struct in_mfilter));
220189592Sbms	RB_INIT(&imf->imf_sources);
221189592Sbms	imf->imf_st[0] = st0;
222189592Sbms	imf->imf_st[1] = st1;
223189592Sbms}
224189592Sbms
225189592Sbms/*
226170613Sbms * Resize the ip_moptions vector to the next power-of-two minus 1.
227170613Sbms * May be called with locks held; do not sleep.
228170613Sbms */
229170613Sbmsstatic int
230170613Sbmsimo_grow(struct ip_moptions *imo)
231170613Sbms{
232170613Sbms	struct in_multi		**nmships;
233170613Sbms	struct in_multi		**omships;
234170613Sbms	struct in_mfilter	 *nmfilters;
235170613Sbms	struct in_mfilter	 *omfilters;
236170613Sbms	size_t			  idx;
237170613Sbms	size_t			  newmax;
238170613Sbms	size_t			  oldmax;
239170613Sbms
240170613Sbms	nmships = NULL;
241170613Sbms	nmfilters = NULL;
242170613Sbms	omships = imo->imo_membership;
243170613Sbms	omfilters = imo->imo_mfilters;
244170613Sbms	oldmax = imo->imo_max_memberships;
245170613Sbms	newmax = ((oldmax + 1) * 2) - 1;
246170613Sbms
247170613Sbms	if (newmax <= IP_MAX_MEMBERSHIPS) {
248170613Sbms		nmships = (struct in_multi **)realloc(omships,
249170613Sbms		    sizeof(struct in_multi *) * newmax, M_IPMOPTS, M_NOWAIT);
250170613Sbms		nmfilters = (struct in_mfilter *)realloc(omfilters,
251189592Sbms		    sizeof(struct in_mfilter) * newmax, M_INMFILTER, M_NOWAIT);
252170613Sbms		if (nmships != NULL && nmfilters != NULL) {
253170613Sbms			/* Initialize newly allocated source filter heads. */
254170613Sbms			for (idx = oldmax; idx < newmax; idx++) {
255189592Sbms				imf_init(&nmfilters[idx], MCAST_UNDEFINED,
256189592Sbms				    MCAST_EXCLUDE);
257170613Sbms			}
258170613Sbms			imo->imo_max_memberships = newmax;
259170613Sbms			imo->imo_membership = nmships;
260170613Sbms			imo->imo_mfilters = nmfilters;
261170613Sbms		}
262170613Sbms	}
263170613Sbms
264170613Sbms	if (nmships == NULL || nmfilters == NULL) {
265170613Sbms		if (nmships != NULL)
266170613Sbms			free(nmships, M_IPMOPTS);
267170613Sbms		if (nmfilters != NULL)
268189592Sbms			free(nmfilters, M_INMFILTER);
269170613Sbms		return (ETOOMANYREFS);
270170613Sbms	}
271170613Sbms
272170613Sbms	return (0);
273170613Sbms}
274170613Sbms
275170613Sbms/*
276170613Sbms * Find an IPv4 multicast group entry for this ip_moptions instance
277170613Sbms * which matches the specified group, and optionally an interface.
278170613Sbms * Return its index into the array, or -1 if not found.
279170613Sbms */
280189592Sbmsstatic size_t
281189592Sbmsimo_match_group(const struct ip_moptions *imo, const struct ifnet *ifp,
282189592Sbms    const struct sockaddr *group)
283170613Sbms{
284189592Sbms	const struct sockaddr_in *gsin;
285170613Sbms	struct in_multi	**pinm;
286170613Sbms	int		  idx;
287170613Sbms	int		  nmships;
288170613Sbms
289189592Sbms	gsin = (const struct sockaddr_in *)group;
290170613Sbms
291170613Sbms	/* The imo_membership array may be lazy allocated. */
292170613Sbms	if (imo->imo_membership == NULL || imo->imo_num_memberships == 0)
293170613Sbms		return (-1);
294170613Sbms
295170613Sbms	nmships = imo->imo_num_memberships;
296170613Sbms	pinm = &imo->imo_membership[0];
297170613Sbms	for (idx = 0; idx < nmships; idx++, pinm++) {
298170613Sbms		if (*pinm == NULL)
299170613Sbms			continue;
300170613Sbms		if ((ifp == NULL || ((*pinm)->inm_ifp == ifp)) &&
301189592Sbms		    in_hosteq((*pinm)->inm_addr, gsin->sin_addr)) {
302170613Sbms			break;
303170613Sbms		}
304170613Sbms	}
305170613Sbms	if (idx >= nmships)
306170613Sbms		idx = -1;
307170613Sbms
308170613Sbms	return (idx);
309170613Sbms}
310170613Sbms
311170613Sbms/*
312189592Sbms * Find an IPv4 multicast source entry for this imo which matches
313170613Sbms * the given group index for this socket, and source address.
314189592Sbms *
315189592Sbms * NOTE: This does not check if the entry is in-mode, merely if
316189592Sbms * it exists, which may not be the desired behaviour.
317170613Sbms */
318189592Sbmsstatic struct in_msource *
319189592Sbmsimo_match_source(const struct ip_moptions *imo, const size_t gidx,
320189592Sbms    const struct sockaddr *src)
321170613Sbms{
322189592Sbms	struct ip_msource	 find;
323170613Sbms	struct in_mfilter	*imf;
324189592Sbms	struct ip_msource	*ims;
325189592Sbms	const sockunion_t	*psa;
326170613Sbms
327170613Sbms	KASSERT(src->sa_family == AF_INET, ("%s: !AF_INET", __func__));
328170613Sbms	KASSERT(gidx != -1 && gidx < imo->imo_num_memberships,
329170613Sbms	    ("%s: invalid index %d\n", __func__, (int)gidx));
330170613Sbms
331170613Sbms	/* The imo_mfilters array may be lazy allocated. */
332170613Sbms	if (imo->imo_mfilters == NULL)
333170613Sbms		return (NULL);
334170613Sbms	imf = &imo->imo_mfilters[gidx];
335170613Sbms
336189592Sbms	/* Source trees are keyed in host byte order. */
337189592Sbms	psa = (const sockunion_t *)src;
338189592Sbms	find.ims_haddr = ntohl(psa->sin.sin_addr.s_addr);
339189592Sbms	ims = RB_FIND(ip_msource_tree, &imf->imf_sources, &find);
340189592Sbms
341189592Sbms	return ((struct in_msource *)ims);
342170613Sbms}
343170613Sbms
344170613Sbms/*
345189592Sbms * Perform filtering for multicast datagrams on a socket by group and source.
346189592Sbms *
347189592Sbms * Returns 0 if a datagram should be allowed through, or various error codes
348189592Sbms * if the socket was not a member of the group, or the source was muted, etc.
349170613Sbms */
350189592Sbmsint
351189592Sbmsimo_multi_filter(const struct ip_moptions *imo, const struct ifnet *ifp,
352189592Sbms    const struct sockaddr *group, const struct sockaddr *src)
353170613Sbms{
354189592Sbms	size_t gidx;
355189592Sbms	struct in_msource *ims;
356189592Sbms	int mode;
357189592Sbms
358189592Sbms	KASSERT(ifp != NULL, ("%s: null ifp", __func__));
359189592Sbms
360189592Sbms	gidx = imo_match_group(imo, ifp, group);
361189592Sbms	if (gidx == -1)
362189592Sbms		return (MCAST_NOTGMEMBER);
363189592Sbms
364189592Sbms	/*
365189592Sbms	 * Check if the source was included in an (S,G) join.
366189592Sbms	 * Allow reception on exclusive memberships by default,
367189592Sbms	 * reject reception on inclusive memberships by default.
368189592Sbms	 * Exclude source only if an in-mode exclude filter exists.
369189592Sbms	 * Include source only if an in-mode include filter exists.
370189592Sbms	 * NOTE: We are comparing group state here at IGMP t1 (now)
371189592Sbms	 * with socket-layer t0 (since last downcall).
372189592Sbms	 */
373189592Sbms	mode = imo->imo_mfilters[gidx].imf_st[1];
374189592Sbms	ims = imo_match_source(imo, gidx, src);
375189592Sbms
376189592Sbms	if ((ims == NULL && mode == MCAST_INCLUDE) ||
377189592Sbms	    (ims != NULL && ims->imsl_st[0] != mode))
378189592Sbms		return (MCAST_NOTSMEMBER);
379189592Sbms
380189592Sbms	return (MCAST_PASS);
381189592Sbms}
382189592Sbms
383189592Sbms/*
384189592Sbms * Find and return a reference to an in_multi record for (ifp, group),
385189592Sbms * and bump its reference count.
386189592Sbms * If one does not exist, try to allocate it, and update link-layer multicast
387189592Sbms * filters on ifp to listen for group.
388189592Sbms * Assumes the IN_MULTI lock is held across the call.
389189592Sbms * Return 0 if successful, otherwise return an appropriate error code.
390189592Sbms */
391189592Sbmsstatic int
392189592Sbmsin_getmulti(struct ifnet *ifp, const struct in_addr *group,
393189592Sbms    struct in_multi **pinm)
394189592Sbms{
395189592Sbms	struct sockaddr_in	 gsin;
396189592Sbms	struct ifmultiaddr	*ifma;
397189592Sbms	struct in_ifinfo	*ii;
398189592Sbms	struct in_multi		*inm;
399189592Sbms	int error;
400170613Sbms
401189592Sbms	IN_MULTI_LOCK_ASSERT();
402170613Sbms
403189592Sbms	ii = (struct in_ifinfo *)ifp->if_afdata[AF_INET];
404170613Sbms
405189592Sbms	inm = inm_lookup(ifp, *group);
406170613Sbms	if (inm != NULL) {
407170613Sbms		/*
408170613Sbms		 * If we already joined this group, just bump the
409170613Sbms		 * refcount and return it.
410170613Sbms		 */
411170613Sbms		KASSERT(inm->inm_refcount >= 1,
412170613Sbms		    ("%s: bad refcount %d", __func__, inm->inm_refcount));
413170613Sbms		++inm->inm_refcount;
414189592Sbms		*pinm = inm;
415189592Sbms		return (0);
416189592Sbms	}
417170613Sbms
418189592Sbms	memset(&gsin, 0, sizeof(gsin));
419189592Sbms	gsin.sin_family = AF_INET;
420189592Sbms	gsin.sin_len = sizeof(struct sockaddr_in);
421189592Sbms	gsin.sin_addr = *group;
422170613Sbms
423189592Sbms	/*
424189592Sbms	 * Check if a link-layer group is already associated
425189592Sbms	 * with this network-layer group on the given ifnet.
426189592Sbms	 */
427189592Sbms	error = if_addmulti(ifp, (struct sockaddr *)&gsin, &ifma);
428189592Sbms	if (error != 0)
429189592Sbms		return (error);
430189592Sbms
431189931Sbms	/* XXX ifma_protospec must be covered by IF_ADDR_LOCK */
432229621Sjhb	IF_ADDR_WLOCK(ifp);
433189931Sbms
434189592Sbms	/*
435189592Sbms	 * If something other than netinet is occupying the link-layer
436189592Sbms	 * group, print a meaningful error message and back out of
437189592Sbms	 * the allocation.
438189592Sbms	 * Otherwise, bump the refcount on the existing network-layer
439189592Sbms	 * group association and return it.
440189592Sbms	 */
441189592Sbms	if (ifma->ifma_protospec != NULL) {
442189592Sbms		inm = (struct in_multi *)ifma->ifma_protospec;
443170613Sbms#ifdef INVARIANTS
444189592Sbms		KASSERT(ifma->ifma_addr != NULL, ("%s: no ifma_addr",
445189592Sbms		    __func__));
446189592Sbms		KASSERT(ifma->ifma_addr->sa_family == AF_INET,
447189592Sbms		    ("%s: ifma not AF_INET", __func__));
448189592Sbms		KASSERT(inm != NULL, ("%s: no ifma_protospec", __func__));
449189592Sbms		if (inm->inm_ifma != ifma || inm->inm_ifp != ifp ||
450189592Sbms		    !in_hosteq(inm->inm_addr, *group))
451189592Sbms			panic("%s: ifma %p is inconsistent with %p (%s)",
452189592Sbms			    __func__, ifma, inm, inet_ntoa(*group));
453170613Sbms#endif
454189592Sbms		++inm->inm_refcount;
455189592Sbms		*pinm = inm;
456229621Sjhb		IF_ADDR_WUNLOCK(ifp);
457189592Sbms		return (0);
458189592Sbms	}
459189592Sbms
460229621Sjhb	IF_ADDR_WLOCK_ASSERT(ifp);
461189931Sbms
462189592Sbms	/*
463189592Sbms	 * A new in_multi record is needed; allocate and initialize it.
464189592Sbms	 * We DO NOT perform an IGMP join as the in_ layer may need to
465189592Sbms	 * push an initial source list down to IGMP to support SSM.
466189592Sbms	 *
467189592Sbms	 * The initial source filter state is INCLUDE, {} as per the RFC.
468189592Sbms	 */
469189592Sbms	inm = malloc(sizeof(*inm), M_IPMADDR, M_NOWAIT | M_ZERO);
470189592Sbms	if (inm == NULL) {
471189592Sbms		if_delmulti_ifma(ifma);
472229621Sjhb		IF_ADDR_WUNLOCK(ifp);
473189592Sbms		return (ENOMEM);
474189592Sbms	}
475189592Sbms	inm->inm_addr = *group;
476189592Sbms	inm->inm_ifp = ifp;
477189592Sbms	inm->inm_igi = ii->ii_igmp;
478189592Sbms	inm->inm_ifma = ifma;
479189592Sbms	inm->inm_refcount = 1;
480189592Sbms	inm->inm_state = IGMP_NOT_MEMBER;
481189592Sbms
482189592Sbms	/*
483189592Sbms	 * Pending state-changes per group are subject to a bounds check.
484189592Sbms	 */
485189592Sbms	IFQ_SET_MAXLEN(&inm->inm_scq, IGMP_MAX_STATE_CHANGES);
486189592Sbms
487189592Sbms	inm->inm_st[0].iss_fmode = MCAST_UNDEFINED;
488189592Sbms	inm->inm_st[1].iss_fmode = MCAST_UNDEFINED;
489189592Sbms	RB_INIT(&inm->inm_srcs);
490189592Sbms
491189592Sbms	ifma->ifma_protospec = inm;
492189592Sbms
493189592Sbms	*pinm = inm;
494189592Sbms
495229621Sjhb	IF_ADDR_WUNLOCK(ifp);
496189592Sbms	return (0);
497189592Sbms}
498189592Sbms
499189592Sbms/*
500189592Sbms * Drop a reference to an in_multi record.
501189592Sbms *
502189592Sbms * If the refcount drops to 0, free the in_multi record and
503189592Sbms * delete the underlying link-layer membership.
504189592Sbms */
505189592Sbmsvoid
506189592Sbmsinm_release_locked(struct in_multi *inm)
507189592Sbms{
508189592Sbms	struct ifmultiaddr *ifma;
509189592Sbms
510189592Sbms	IN_MULTI_LOCK_ASSERT();
511189592Sbms
512189592Sbms	CTR2(KTR_IGMPV3, "%s: refcount is %d", __func__, inm->inm_refcount);
513189592Sbms
514189592Sbms	if (--inm->inm_refcount > 0) {
515189592Sbms		CTR2(KTR_IGMPV3, "%s: refcount is now %d", __func__,
516189592Sbms		    inm->inm_refcount);
517189592Sbms		return;
518189592Sbms	}
519189592Sbms
520189592Sbms	CTR2(KTR_IGMPV3, "%s: freeing inm %p", __func__, inm);
521189592Sbms
522189592Sbms	ifma = inm->inm_ifma;
523189592Sbms
524189931Sbms	/* XXX this access is not covered by IF_ADDR_LOCK */
525189592Sbms	CTR2(KTR_IGMPV3, "%s: purging ifma %p", __func__, ifma);
526189592Sbms	KASSERT(ifma->ifma_protospec == inm,
527189592Sbms	    ("%s: ifma_protospec != inm", __func__));
528189592Sbms	ifma->ifma_protospec = NULL;
529189592Sbms
530189592Sbms	inm_purge(inm);
531189592Sbms
532189592Sbms	free(inm, M_IPMADDR);
533189592Sbms
534189592Sbms	if_delmulti_ifma(ifma);
535189592Sbms}
536189592Sbms
537189592Sbms/*
538189592Sbms * Clear recorded source entries for a group.
539189592Sbms * Used by the IGMP code. Caller must hold the IN_MULTI lock.
540189592Sbms * FIXME: Should reap.
541189592Sbms */
542189592Sbmsvoid
543189592Sbmsinm_clear_recorded(struct in_multi *inm)
544189592Sbms{
545189592Sbms	struct ip_msource	*ims;
546189592Sbms
547189592Sbms	IN_MULTI_LOCK_ASSERT();
548189592Sbms
549189592Sbms	RB_FOREACH(ims, ip_msource_tree, &inm->inm_srcs) {
550189592Sbms		if (ims->ims_stp) {
551189592Sbms			ims->ims_stp = 0;
552189592Sbms			--inm->inm_st[1].iss_rec;
553170613Sbms		}
554189592Sbms	}
555189592Sbms	KASSERT(inm->inm_st[1].iss_rec == 0,
556189592Sbms	    ("%s: iss_rec %d not 0", __func__, inm->inm_st[1].iss_rec));
557189592Sbms}
558170613Sbms
559189592Sbms/*
560189592Sbms * Record a source as pending for a Source-Group IGMPv3 query.
561189592Sbms * This lives here as it modifies the shared tree.
562189592Sbms *
563189592Sbms * inm is the group descriptor.
564189592Sbms * naddr is the address of the source to record in network-byte order.
565189592Sbms *
566189592Sbms * If the net.inet.igmp.sgalloc sysctl is non-zero, we will
567189592Sbms * lazy-allocate a source node in response to an SG query.
568189592Sbms * Otherwise, no allocation is performed. This saves some memory
569189592Sbms * with the trade-off that the source will not be reported to the
570189592Sbms * router if joined in the window between the query response and
571189592Sbms * the group actually being joined on the local host.
572189592Sbms *
573189592Sbms * VIMAGE: XXX: Currently the igmp_sgalloc feature has been removed.
574189592Sbms * This turns off the allocation of a recorded source entry if
575189592Sbms * the group has not been joined.
576189592Sbms *
577189592Sbms * Return 0 if the source didn't exist or was already marked as recorded.
578189592Sbms * Return 1 if the source was marked as recorded by this function.
579189592Sbms * Return <0 if any error occured (negated errno code).
580189592Sbms */
581189592Sbmsint
582189592Sbmsinm_record_source(struct in_multi *inm, const in_addr_t naddr)
583189592Sbms{
584189592Sbms	struct ip_msource	 find;
585189592Sbms	struct ip_msource	*ims, *nims;
586189592Sbms
587189592Sbms	IN_MULTI_LOCK_ASSERT();
588189592Sbms
589189592Sbms	find.ims_haddr = ntohl(naddr);
590189592Sbms	ims = RB_FIND(ip_msource_tree, &inm->inm_srcs, &find);
591189592Sbms	if (ims && ims->ims_stp)
592189592Sbms		return (0);
593189592Sbms	if (ims == NULL) {
594189592Sbms		if (inm->inm_nsrc == in_mcast_maxgrpsrc)
595189592Sbms			return (-ENOSPC);
596189592Sbms		nims = malloc(sizeof(struct ip_msource), M_IPMSOURCE,
597189592Sbms		    M_NOWAIT | M_ZERO);
598189592Sbms		if (nims == NULL)
599189592Sbms			return (-ENOMEM);
600189592Sbms		nims->ims_haddr = find.ims_haddr;
601189592Sbms		RB_INSERT(ip_msource_tree, &inm->inm_srcs, nims);
602189592Sbms		++inm->inm_nsrc;
603189592Sbms		ims = nims;
604189592Sbms	}
605189592Sbms
606189592Sbms	/*
607189592Sbms	 * Mark the source as recorded and update the recorded
608189592Sbms	 * source count.
609189592Sbms	 */
610189592Sbms	++ims->ims_stp;
611189592Sbms	++inm->inm_st[1].iss_rec;
612189592Sbms
613189592Sbms	return (1);
614189592Sbms}
615189592Sbms
616189592Sbms/*
617189592Sbms * Return a pointer to an in_msource owned by an in_mfilter,
618189592Sbms * given its source address.
619189592Sbms * Lazy-allocate if needed. If this is a new entry its filter state is
620189592Sbms * undefined at t0.
621189592Sbms *
622189592Sbms * imf is the filter set being modified.
623189592Sbms * haddr is the source address in *host* byte-order.
624189592Sbms *
625189592Sbms * SMPng: May be called with locks held; malloc must not block.
626189592Sbms */
627189592Sbmsstatic int
628189592Sbmsimf_get_source(struct in_mfilter *imf, const struct sockaddr_in *psin,
629189592Sbms    struct in_msource **plims)
630189592Sbms{
631189592Sbms	struct ip_msource	 find;
632189592Sbms	struct ip_msource	*ims, *nims;
633189592Sbms	struct in_msource	*lims;
634189592Sbms	int			 error;
635189592Sbms
636189592Sbms	error = 0;
637189592Sbms	ims = NULL;
638189592Sbms	lims = NULL;
639189592Sbms
640189592Sbms	/* key is host byte order */
641189592Sbms	find.ims_haddr = ntohl(psin->sin_addr.s_addr);
642189592Sbms	ims = RB_FIND(ip_msource_tree, &imf->imf_sources, &find);
643189592Sbms	lims = (struct in_msource *)ims;
644189592Sbms	if (lims == NULL) {
645189592Sbms		if (imf->imf_nsrc == in_mcast_maxsocksrc)
646189592Sbms			return (ENOSPC);
647189592Sbms		nims = malloc(sizeof(struct in_msource), M_INMFILTER,
648189592Sbms		    M_NOWAIT | M_ZERO);
649189592Sbms		if (nims == NULL)
650189592Sbms			return (ENOMEM);
651189592Sbms		lims = (struct in_msource *)nims;
652189592Sbms		lims->ims_haddr = find.ims_haddr;
653189592Sbms		lims->imsl_st[0] = MCAST_UNDEFINED;
654189592Sbms		RB_INSERT(ip_msource_tree, &imf->imf_sources, nims);
655189592Sbms		++imf->imf_nsrc;
656189592Sbms	}
657189592Sbms
658189592Sbms	*plims = lims;
659189592Sbms
660189592Sbms	return (error);
661189592Sbms}
662189592Sbms
663189592Sbms/*
664189592Sbms * Graft a source entry into an existing socket-layer filter set,
665189592Sbms * maintaining any required invariants and checking allocations.
666189592Sbms *
667189592Sbms * The source is marked as being in the new filter mode at t1.
668189592Sbms *
669189592Sbms * Return the pointer to the new node, otherwise return NULL.
670189592Sbms */
671189592Sbmsstatic struct in_msource *
672189592Sbmsimf_graft(struct in_mfilter *imf, const uint8_t st1,
673189592Sbms    const struct sockaddr_in *psin)
674189592Sbms{
675189592Sbms	struct ip_msource	*nims;
676189592Sbms	struct in_msource	*lims;
677189592Sbms
678189592Sbms	nims = malloc(sizeof(struct in_msource), M_INMFILTER,
679189592Sbms	    M_NOWAIT | M_ZERO);
680189592Sbms	if (nims == NULL)
681189592Sbms		return (NULL);
682189592Sbms	lims = (struct in_msource *)nims;
683189592Sbms	lims->ims_haddr = ntohl(psin->sin_addr.s_addr);
684189592Sbms	lims->imsl_st[0] = MCAST_UNDEFINED;
685189592Sbms	lims->imsl_st[1] = st1;
686189592Sbms	RB_INSERT(ip_msource_tree, &imf->imf_sources, nims);
687189592Sbms	++imf->imf_nsrc;
688189592Sbms
689189592Sbms	return (lims);
690189592Sbms}
691189592Sbms
692189592Sbms/*
693189592Sbms * Prune a source entry from an existing socket-layer filter set,
694189592Sbms * maintaining any required invariants and checking allocations.
695189592Sbms *
696189592Sbms * The source is marked as being left at t1, it is not freed.
697189592Sbms *
698189592Sbms * Return 0 if no error occurred, otherwise return an errno value.
699189592Sbms */
700189592Sbmsstatic int
701189592Sbmsimf_prune(struct in_mfilter *imf, const struct sockaddr_in *psin)
702189592Sbms{
703189592Sbms	struct ip_msource	 find;
704189592Sbms	struct ip_msource	*ims;
705189592Sbms	struct in_msource	*lims;
706189592Sbms
707189592Sbms	/* key is host byte order */
708189592Sbms	find.ims_haddr = ntohl(psin->sin_addr.s_addr);
709189592Sbms	ims = RB_FIND(ip_msource_tree, &imf->imf_sources, &find);
710189592Sbms	if (ims == NULL)
711189592Sbms		return (ENOENT);
712189592Sbms	lims = (struct in_msource *)ims;
713189592Sbms	lims->imsl_st[1] = MCAST_UNDEFINED;
714189592Sbms	return (0);
715189592Sbms}
716189592Sbms
717189592Sbms/*
718189592Sbms * Revert socket-layer filter set deltas at t1 to t0 state.
719189592Sbms */
720189592Sbmsstatic void
721189592Sbmsimf_rollback(struct in_mfilter *imf)
722189592Sbms{
723189592Sbms	struct ip_msource	*ims, *tims;
724189592Sbms	struct in_msource	*lims;
725189592Sbms
726189592Sbms	RB_FOREACH_SAFE(ims, ip_msource_tree, &imf->imf_sources, tims) {
727189592Sbms		lims = (struct in_msource *)ims;
728189592Sbms		if (lims->imsl_st[0] == lims->imsl_st[1]) {
729189592Sbms			/* no change at t1 */
730189592Sbms			continue;
731189592Sbms		} else if (lims->imsl_st[0] != MCAST_UNDEFINED) {
732189592Sbms			/* revert change to existing source at t1 */
733189592Sbms			lims->imsl_st[1] = lims->imsl_st[0];
734189592Sbms		} else {
735189592Sbms			/* revert source added t1 */
736189592Sbms			CTR2(KTR_IGMPV3, "%s: free ims %p", __func__, ims);
737189592Sbms			RB_REMOVE(ip_msource_tree, &imf->imf_sources, ims);
738189592Sbms			free(ims, M_INMFILTER);
739189592Sbms			imf->imf_nsrc--;
740189592Sbms		}
741189592Sbms	}
742189592Sbms	imf->imf_st[1] = imf->imf_st[0];
743189592Sbms}
744189592Sbms
745189592Sbms/*
746189592Sbms * Mark socket-layer filter set as INCLUDE {} at t1.
747189592Sbms */
748189592Sbmsstatic void
749189592Sbmsimf_leave(struct in_mfilter *imf)
750189592Sbms{
751189592Sbms	struct ip_msource	*ims;
752189592Sbms	struct in_msource	*lims;
753189592Sbms
754189592Sbms	RB_FOREACH(ims, ip_msource_tree, &imf->imf_sources) {
755189592Sbms		lims = (struct in_msource *)ims;
756189592Sbms		lims->imsl_st[1] = MCAST_UNDEFINED;
757189592Sbms	}
758189592Sbms	imf->imf_st[1] = MCAST_INCLUDE;
759189592Sbms}
760189592Sbms
761189592Sbms/*
762189592Sbms * Mark socket-layer filter set deltas as committed.
763189592Sbms */
764189592Sbmsstatic void
765189592Sbmsimf_commit(struct in_mfilter *imf)
766189592Sbms{
767189592Sbms	struct ip_msource	*ims;
768189592Sbms	struct in_msource	*lims;
769189592Sbms
770189592Sbms	RB_FOREACH(ims, ip_msource_tree, &imf->imf_sources) {
771189592Sbms		lims = (struct in_msource *)ims;
772189592Sbms		lims->imsl_st[0] = lims->imsl_st[1];
773189592Sbms	}
774189592Sbms	imf->imf_st[0] = imf->imf_st[1];
775189592Sbms}
776189592Sbms
777189592Sbms/*
778189592Sbms * Reap unreferenced sources from socket-layer filter set.
779189592Sbms */
780189592Sbmsstatic void
781189592Sbmsimf_reap(struct in_mfilter *imf)
782189592Sbms{
783189592Sbms	struct ip_msource	*ims, *tims;
784189592Sbms	struct in_msource	*lims;
785189592Sbms
786189592Sbms	RB_FOREACH_SAFE(ims, ip_msource_tree, &imf->imf_sources, tims) {
787189592Sbms		lims = (struct in_msource *)ims;
788189592Sbms		if ((lims->imsl_st[0] == MCAST_UNDEFINED) &&
789189592Sbms		    (lims->imsl_st[1] == MCAST_UNDEFINED)) {
790189592Sbms			CTR2(KTR_IGMPV3, "%s: free lims %p", __func__, ims);
791189592Sbms			RB_REMOVE(ip_msource_tree, &imf->imf_sources, ims);
792189592Sbms			free(ims, M_INMFILTER);
793189592Sbms			imf->imf_nsrc--;
794189592Sbms		}
795189592Sbms	}
796189592Sbms}
797189592Sbms
798189592Sbms/*
799189592Sbms * Purge socket-layer filter set.
800189592Sbms */
801189592Sbmsstatic void
802189592Sbmsimf_purge(struct in_mfilter *imf)
803189592Sbms{
804189592Sbms	struct ip_msource	*ims, *tims;
805189592Sbms
806189592Sbms	RB_FOREACH_SAFE(ims, ip_msource_tree, &imf->imf_sources, tims) {
807189592Sbms		CTR2(KTR_IGMPV3, "%s: free ims %p", __func__, ims);
808189592Sbms		RB_REMOVE(ip_msource_tree, &imf->imf_sources, ims);
809189592Sbms		free(ims, M_INMFILTER);
810189592Sbms		imf->imf_nsrc--;
811189592Sbms	}
812189592Sbms	imf->imf_st[0] = imf->imf_st[1] = MCAST_UNDEFINED;
813189592Sbms	KASSERT(RB_EMPTY(&imf->imf_sources),
814189592Sbms	    ("%s: imf_sources not empty", __func__));
815189592Sbms}
816189592Sbms
817189592Sbms/*
818189592Sbms * Look up a source filter entry for a multicast group.
819189592Sbms *
820189592Sbms * inm is the group descriptor to work with.
821189592Sbms * haddr is the host-byte-order IPv4 address to look up.
822189592Sbms * noalloc may be non-zero to suppress allocation of sources.
823189592Sbms * *pims will be set to the address of the retrieved or allocated source.
824189592Sbms *
825189592Sbms * SMPng: NOTE: may be called with locks held.
826189592Sbms * Return 0 if successful, otherwise return a non-zero error code.
827189592Sbms */
828189592Sbmsstatic int
829189592Sbmsinm_get_source(struct in_multi *inm, const in_addr_t haddr,
830189592Sbms    const int noalloc, struct ip_msource **pims)
831189592Sbms{
832189592Sbms	struct ip_msource	 find;
833189592Sbms	struct ip_msource	*ims, *nims;
834189592Sbms#ifdef KTR
835189592Sbms	struct in_addr ia;
836189592Sbms#endif
837189592Sbms
838189592Sbms	find.ims_haddr = haddr;
839189592Sbms	ims = RB_FIND(ip_msource_tree, &inm->inm_srcs, &find);
840189592Sbms	if (ims == NULL && !noalloc) {
841189592Sbms		if (inm->inm_nsrc == in_mcast_maxgrpsrc)
842189592Sbms			return (ENOSPC);
843189592Sbms		nims = malloc(sizeof(struct ip_msource), M_IPMSOURCE,
844189592Sbms		    M_NOWAIT | M_ZERO);
845189592Sbms		if (nims == NULL)
846189592Sbms			return (ENOMEM);
847189592Sbms		nims->ims_haddr = haddr;
848189592Sbms		RB_INSERT(ip_msource_tree, &inm->inm_srcs, nims);
849189592Sbms		++inm->inm_nsrc;
850189592Sbms		ims = nims;
851189592Sbms#ifdef KTR
852189592Sbms		ia.s_addr = htonl(haddr);
853189592Sbms		CTR3(KTR_IGMPV3, "%s: allocated %s as %p", __func__,
854189592Sbms		    inet_ntoa(ia), ims);
855189592Sbms#endif
856189592Sbms	}
857189592Sbms
858189592Sbms	*pims = ims;
859189592Sbms	return (0);
860189592Sbms}
861189592Sbms
862189592Sbms/*
863189592Sbms * Merge socket-layer source into IGMP-layer source.
864189592Sbms * If rollback is non-zero, perform the inverse of the merge.
865189592Sbms */
866189592Sbmsstatic void
867189592Sbmsims_merge(struct ip_msource *ims, const struct in_msource *lims,
868189592Sbms    const int rollback)
869189592Sbms{
870189592Sbms	int n = rollback ? -1 : 1;
871189592Sbms#ifdef KTR
872189592Sbms	struct in_addr ia;
873189592Sbms
874189592Sbms	ia.s_addr = htonl(ims->ims_haddr);
875189592Sbms#endif
876189592Sbms
877189592Sbms	if (lims->imsl_st[0] == MCAST_EXCLUDE) {
878189592Sbms		CTR3(KTR_IGMPV3, "%s: t1 ex -= %d on %s",
879189592Sbms		    __func__, n, inet_ntoa(ia));
880189592Sbms		ims->ims_st[1].ex -= n;
881189592Sbms	} else if (lims->imsl_st[0] == MCAST_INCLUDE) {
882189592Sbms		CTR3(KTR_IGMPV3, "%s: t1 in -= %d on %s",
883189592Sbms		    __func__, n, inet_ntoa(ia));
884189592Sbms		ims->ims_st[1].in -= n;
885189592Sbms	}
886189592Sbms
887189592Sbms	if (lims->imsl_st[1] == MCAST_EXCLUDE) {
888189592Sbms		CTR3(KTR_IGMPV3, "%s: t1 ex += %d on %s",
889189592Sbms		    __func__, n, inet_ntoa(ia));
890189592Sbms		ims->ims_st[1].ex += n;
891189592Sbms	} else if (lims->imsl_st[1] == MCAST_INCLUDE) {
892189592Sbms		CTR3(KTR_IGMPV3, "%s: t1 in += %d on %s",
893189592Sbms		    __func__, n, inet_ntoa(ia));
894189592Sbms		ims->ims_st[1].in += n;
895189592Sbms	}
896189592Sbms}
897189592Sbms
898189592Sbms/*
899189592Sbms * Atomically update the global in_multi state, when a membership's
900189592Sbms * filter list is being updated in any way.
901189592Sbms *
902189592Sbms * imf is the per-inpcb-membership group filter pointer.
903189592Sbms * A fake imf may be passed for in-kernel consumers.
904189592Sbms *
905189592Sbms * XXX This is a candidate for a set-symmetric-difference style loop
906189592Sbms * which would eliminate the repeated lookup from root of ims nodes,
907189592Sbms * as they share the same key space.
908189592Sbms *
909189592Sbms * If any error occurred this function will back out of refcounts
910189592Sbms * and return a non-zero value.
911189592Sbms */
912189592Sbmsstatic int
913189592Sbmsinm_merge(struct in_multi *inm, /*const*/ struct in_mfilter *imf)
914189592Sbms{
915189592Sbms	struct ip_msource	*ims, *nims;
916189592Sbms	struct in_msource	*lims;
917189592Sbms	int			 schanged, error;
918189592Sbms	int			 nsrc0, nsrc1;
919189592Sbms
920189592Sbms	schanged = 0;
921189592Sbms	error = 0;
922189592Sbms	nsrc1 = nsrc0 = 0;
923189592Sbms
924189592Sbms	/*
925189592Sbms	 * Update the source filters first, as this may fail.
926189592Sbms	 * Maintain count of in-mode filters at t0, t1. These are
927189592Sbms	 * used to work out if we transition into ASM mode or not.
928189592Sbms	 * Maintain a count of source filters whose state was
929189592Sbms	 * actually modified by this operation.
930189592Sbms	 */
931189592Sbms	RB_FOREACH(ims, ip_msource_tree, &imf->imf_sources) {
932189592Sbms		lims = (struct in_msource *)ims;
933189592Sbms		if (lims->imsl_st[0] == imf->imf_st[0]) nsrc0++;
934189592Sbms		if (lims->imsl_st[1] == imf->imf_st[1]) nsrc1++;
935189592Sbms		if (lims->imsl_st[0] == lims->imsl_st[1]) continue;
936189592Sbms		error = inm_get_source(inm, lims->ims_haddr, 0, &nims);
937189592Sbms		++schanged;
938189592Sbms		if (error)
939170613Sbms			break;
940189592Sbms		ims_merge(nims, lims, 0);
941189592Sbms	}
942189592Sbms	if (error) {
943189592Sbms		struct ip_msource *bims;
944189592Sbms
945189592Sbms		RB_FOREACH_REVERSE_FROM(ims, ip_msource_tree, nims) {
946189592Sbms			lims = (struct in_msource *)ims;
947189592Sbms			if (lims->imsl_st[0] == lims->imsl_st[1])
948189592Sbms				continue;
949189592Sbms			(void)inm_get_source(inm, lims->ims_haddr, 1, &bims);
950189592Sbms			if (bims == NULL)
951189592Sbms				continue;
952189592Sbms			ims_merge(bims, lims, 1);
953170613Sbms		}
954189592Sbms		goto out_reap;
955189592Sbms	}
956170613Sbms
957189592Sbms	CTR3(KTR_IGMPV3, "%s: imf filters in-mode: %d at t0, %d at t1",
958189592Sbms	    __func__, nsrc0, nsrc1);
959170613Sbms
960189592Sbms	/* Handle transition between INCLUDE {n} and INCLUDE {} on socket. */
961189592Sbms	if (imf->imf_st[0] == imf->imf_st[1] &&
962189592Sbms	    imf->imf_st[1] == MCAST_INCLUDE) {
963189592Sbms		if (nsrc1 == 0) {
964189592Sbms			CTR1(KTR_IGMPV3, "%s: --in on inm at t1", __func__);
965189592Sbms			--inm->inm_st[1].iss_in;
966189592Sbms		}
967189592Sbms	}
968170613Sbms
969189592Sbms	/* Handle filter mode transition on socket. */
970189592Sbms	if (imf->imf_st[0] != imf->imf_st[1]) {
971189592Sbms		CTR3(KTR_IGMPV3, "%s: imf transition %d to %d",
972189592Sbms		    __func__, imf->imf_st[0], imf->imf_st[1]);
973189592Sbms
974189592Sbms		if (imf->imf_st[0] == MCAST_EXCLUDE) {
975189592Sbms			CTR1(KTR_IGMPV3, "%s: --ex on inm at t1", __func__);
976189592Sbms			--inm->inm_st[1].iss_ex;
977189592Sbms		} else if (imf->imf_st[0] == MCAST_INCLUDE) {
978189592Sbms			CTR1(KTR_IGMPV3, "%s: --in on inm at t1", __func__);
979189592Sbms			--inm->inm_st[1].iss_in;
980189592Sbms		}
981189592Sbms
982189592Sbms		if (imf->imf_st[1] == MCAST_EXCLUDE) {
983189592Sbms			CTR1(KTR_IGMPV3, "%s: ex++ on inm at t1", __func__);
984189592Sbms			inm->inm_st[1].iss_ex++;
985189592Sbms		} else if (imf->imf_st[1] == MCAST_INCLUDE && nsrc1 > 0) {
986189592Sbms			CTR1(KTR_IGMPV3, "%s: in++ on inm at t1", __func__);
987189592Sbms			inm->inm_st[1].iss_in++;
988189592Sbms		}
989189592Sbms	}
990189592Sbms
991189592Sbms	/*
992189592Sbms	 * Track inm filter state in terms of listener counts.
993189592Sbms	 * If there are any exclusive listeners, stack-wide
994189592Sbms	 * membership is exclusive.
995189592Sbms	 * Otherwise, if only inclusive listeners, stack-wide is inclusive.
996189592Sbms	 * If no listeners remain, state is undefined at t1,
997189592Sbms	 * and the IGMP lifecycle for this group should finish.
998189592Sbms	 */
999189592Sbms	if (inm->inm_st[1].iss_ex > 0) {
1000189592Sbms		CTR1(KTR_IGMPV3, "%s: transition to EX", __func__);
1001189592Sbms		inm->inm_st[1].iss_fmode = MCAST_EXCLUDE;
1002189592Sbms	} else if (inm->inm_st[1].iss_in > 0) {
1003189592Sbms		CTR1(KTR_IGMPV3, "%s: transition to IN", __func__);
1004189592Sbms		inm->inm_st[1].iss_fmode = MCAST_INCLUDE;
1005189592Sbms	} else {
1006189592Sbms		CTR1(KTR_IGMPV3, "%s: transition to UNDEF", __func__);
1007189592Sbms		inm->inm_st[1].iss_fmode = MCAST_UNDEFINED;
1008189592Sbms	}
1009189592Sbms
1010189592Sbms	/* Decrement ASM listener count on transition out of ASM mode. */
1011189592Sbms	if (imf->imf_st[0] == MCAST_EXCLUDE && nsrc0 == 0) {
1012189592Sbms		if ((imf->imf_st[1] != MCAST_EXCLUDE) ||
1013189592Sbms		    (imf->imf_st[1] == MCAST_EXCLUDE && nsrc1 > 0))
1014189592Sbms			CTR1(KTR_IGMPV3, "%s: --asm on inm at t1", __func__);
1015189592Sbms			--inm->inm_st[1].iss_asm;
1016189592Sbms	}
1017189592Sbms
1018189592Sbms	/* Increment ASM listener count on transition to ASM mode. */
1019189592Sbms	if (imf->imf_st[1] == MCAST_EXCLUDE && nsrc1 == 0) {
1020189592Sbms		CTR1(KTR_IGMPV3, "%s: asm++ on inm at t1", __func__);
1021189592Sbms		inm->inm_st[1].iss_asm++;
1022189592Sbms	}
1023189592Sbms
1024189592Sbms	CTR3(KTR_IGMPV3, "%s: merged imf %p to inm %p", __func__, imf, inm);
1025189592Sbms	inm_print(inm);
1026189592Sbms
1027189592Sbmsout_reap:
1028189592Sbms	if (schanged > 0) {
1029189592Sbms		CTR1(KTR_IGMPV3, "%s: sources changed; reaping", __func__);
1030189592Sbms		inm_reap(inm);
1031189592Sbms	}
1032189592Sbms	return (error);
1033189592Sbms}
1034189592Sbms
1035189592Sbms/*
1036189592Sbms * Mark an in_multi's filter set deltas as committed.
1037189592Sbms * Called by IGMP after a state change has been enqueued.
1038189592Sbms */
1039189592Sbmsvoid
1040189592Sbmsinm_commit(struct in_multi *inm)
1041189592Sbms{
1042189592Sbms	struct ip_msource	*ims;
1043189592Sbms
1044189592Sbms	CTR2(KTR_IGMPV3, "%s: commit inm %p", __func__, inm);
1045189592Sbms	CTR1(KTR_IGMPV3, "%s: pre commit:", __func__);
1046189592Sbms	inm_print(inm);
1047189592Sbms
1048189592Sbms	RB_FOREACH(ims, ip_msource_tree, &inm->inm_srcs) {
1049189592Sbms		ims->ims_st[0] = ims->ims_st[1];
1050189592Sbms	}
1051189592Sbms	inm->inm_st[0] = inm->inm_st[1];
1052189592Sbms}
1053189592Sbms
1054189592Sbms/*
1055189592Sbms * Reap unreferenced nodes from an in_multi's filter set.
1056189592Sbms */
1057189592Sbmsstatic void
1058189592Sbmsinm_reap(struct in_multi *inm)
1059189592Sbms{
1060189592Sbms	struct ip_msource	*ims, *tims;
1061189592Sbms
1062189592Sbms	RB_FOREACH_SAFE(ims, ip_msource_tree, &inm->inm_srcs, tims) {
1063189592Sbms		if (ims->ims_st[0].ex > 0 || ims->ims_st[0].in > 0 ||
1064189592Sbms		    ims->ims_st[1].ex > 0 || ims->ims_st[1].in > 0 ||
1065189592Sbms		    ims->ims_stp != 0)
1066189592Sbms			continue;
1067189592Sbms		CTR2(KTR_IGMPV3, "%s: free ims %p", __func__, ims);
1068189592Sbms		RB_REMOVE(ip_msource_tree, &inm->inm_srcs, ims);
1069189592Sbms		free(ims, M_IPMSOURCE);
1070189592Sbms		inm->inm_nsrc--;
1071189592Sbms	}
1072189592Sbms}
1073189592Sbms
1074189592Sbms/*
1075189592Sbms * Purge all source nodes from an in_multi's filter set.
1076189592Sbms */
1077189592Sbmsstatic void
1078189592Sbmsinm_purge(struct in_multi *inm)
1079189592Sbms{
1080189592Sbms	struct ip_msource	*ims, *tims;
1081189592Sbms
1082189592Sbms	RB_FOREACH_SAFE(ims, ip_msource_tree, &inm->inm_srcs, tims) {
1083189592Sbms		CTR2(KTR_IGMPV3, "%s: free ims %p", __func__, ims);
1084189592Sbms		RB_REMOVE(ip_msource_tree, &inm->inm_srcs, ims);
1085189592Sbms		free(ims, M_IPMSOURCE);
1086189592Sbms		inm->inm_nsrc--;
1087189592Sbms	}
1088189592Sbms}
1089189592Sbms
1090189592Sbms/*
1091189592Sbms * Join a multicast group; unlocked entry point.
1092189592Sbms *
1093189592Sbms * SMPng: XXX: in_joingroup() is called from in_control() when Giant
1094189592Sbms * is not held. Fortunately, ifp is unlikely to have been detached
1095189592Sbms * at this point, so we assume it's OK to recurse.
1096189592Sbms */
1097189592Sbmsint
1098189592Sbmsin_joingroup(struct ifnet *ifp, const struct in_addr *gina,
1099189592Sbms    /*const*/ struct in_mfilter *imf, struct in_multi **pinm)
1100189592Sbms{
1101189592Sbms	int error;
1102189592Sbms
1103189592Sbms	IN_MULTI_LOCK();
1104189592Sbms	error = in_joingroup_locked(ifp, gina, imf, pinm);
1105170613Sbms	IN_MULTI_UNLOCK();
1106170613Sbms
1107189592Sbms	return (error);
1108170613Sbms}
1109170613Sbms
1110170613Sbms/*
1111189592Sbms * Join a multicast group; real entry point.
1112170613Sbms *
1113189592Sbms * Only preserves atomicity at inm level.
1114189592Sbms * NOTE: imf argument cannot be const due to sys/tree.h limitations.
1115170613Sbms *
1116189592Sbms * If the IGMP downcall fails, the group is not joined, and an error
1117189592Sbms * code is returned.
1118170613Sbms */
1119189592Sbmsint
1120189592Sbmsin_joingroup_locked(struct ifnet *ifp, const struct in_addr *gina,
1121189592Sbms    /*const*/ struct in_mfilter *imf, struct in_multi **pinm)
1122170613Sbms{
1123189592Sbms	struct in_mfilter	 timf;
1124189592Sbms	struct in_multi		*inm;
1125189592Sbms	int			 error;
1126170613Sbms
1127189592Sbms	IN_MULTI_LOCK_ASSERT();
1128170613Sbms
1129189592Sbms	CTR4(KTR_IGMPV3, "%s: join %s on %p(%s))", __func__,
1130189592Sbms	    inet_ntoa(*gina), ifp, ifp->if_xname);
1131189592Sbms
1132189592Sbms	error = 0;
1133189592Sbms	inm = NULL;
1134189592Sbms
1135189592Sbms	/*
1136189592Sbms	 * If no imf was specified (i.e. kernel consumer),
1137189592Sbms	 * fake one up and assume it is an ASM join.
1138189592Sbms	 */
1139189592Sbms	if (imf == NULL) {
1140189592Sbms		imf_init(&timf, MCAST_UNDEFINED, MCAST_EXCLUDE);
1141189592Sbms		imf = &timf;
1142170613Sbms	}
1143170613Sbms
1144189592Sbms	error = in_getmulti(ifp, gina, &inm);
1145189592Sbms	if (error) {
1146189592Sbms		CTR1(KTR_IGMPV3, "%s: in_getmulti() failure", __func__);
1147189592Sbms		return (error);
1148189592Sbms	}
1149189592Sbms
1150189592Sbms	CTR1(KTR_IGMPV3, "%s: merge inm state", __func__);
1151189592Sbms	error = inm_merge(inm, imf);
1152189592Sbms	if (error) {
1153189592Sbms		CTR1(KTR_IGMPV3, "%s: failed to merge inm state", __func__);
1154189592Sbms		goto out_inm_release;
1155189592Sbms	}
1156189592Sbms
1157189592Sbms	CTR1(KTR_IGMPV3, "%s: doing igmp downcall", __func__);
1158189592Sbms	error = igmp_change_state(inm);
1159189592Sbms	if (error) {
1160189592Sbms		CTR1(KTR_IGMPV3, "%s: failed to update source", __func__);
1161189592Sbms		goto out_inm_release;
1162189592Sbms	}
1163189592Sbms
1164189592Sbmsout_inm_release:
1165189592Sbms	if (error) {
1166189592Sbms		CTR2(KTR_IGMPV3, "%s: dropping ref on %p", __func__, inm);
1167189592Sbms		inm_release_locked(inm);
1168189592Sbms	} else {
1169189592Sbms		*pinm = inm;
1170189592Sbms	}
1171189592Sbms
1172189592Sbms	return (error);
1173189592Sbms}
1174189592Sbms
1175189592Sbms/*
1176189592Sbms * Leave a multicast group; unlocked entry point.
1177189592Sbms */
1178189592Sbmsint
1179189592Sbmsin_leavegroup(struct in_multi *inm, /*const*/ struct in_mfilter *imf)
1180189592Sbms{
1181189851Srwatson	int error;
1182189592Sbms
1183170613Sbms	IN_MULTI_LOCK();
1184189592Sbms	error = in_leavegroup_locked(inm, imf);
1185170613Sbms	IN_MULTI_UNLOCK();
1186170613Sbms
1187189592Sbms	return (error);
1188170613Sbms}
1189170613Sbms
1190170613Sbms/*
1191189592Sbms * Leave a multicast group; real entry point.
1192189592Sbms * All source filters will be expunged.
1193170613Sbms *
1194189592Sbms * Only preserves atomicity at inm level.
1195189592Sbms *
1196189592Sbms * Holding the write lock for the INP which contains imf
1197189592Sbms * is highly advisable. We can't assert for it as imf does not
1198189592Sbms * contain a back-pointer to the owning inp.
1199189592Sbms *
1200189592Sbms * Note: This is not the same as inm_release(*) as this function also
1201189592Sbms * makes a state change downcall into IGMP.
1202170613Sbms */
1203189592Sbmsint
1204189592Sbmsin_leavegroup_locked(struct in_multi *inm, /*const*/ struct in_mfilter *imf)
1205170613Sbms{
1206189592Sbms	struct in_mfilter	 timf;
1207189592Sbms	int			 error;
1208170613Sbms
1209189592Sbms	error = 0;
1210189592Sbms
1211170613Sbms	IN_MULTI_LOCK_ASSERT();
1212170613Sbms
1213189592Sbms	CTR5(KTR_IGMPV3, "%s: leave inm %p, %s/%s, imf %p", __func__,
1214189592Sbms	    inm, inet_ntoa(inm->inm_addr),
1215189592Sbms	    (inm_is_ifp_detached(inm) ? "null" : inm->inm_ifp->if_xname),
1216189592Sbms	    imf);
1217170613Sbms
1218189592Sbms	/*
1219189592Sbms	 * If no imf was specified (i.e. kernel consumer),
1220189592Sbms	 * fake one up and assume it is an ASM join.
1221189592Sbms	 */
1222189592Sbms	if (imf == NULL) {
1223189592Sbms		imf_init(&timf, MCAST_EXCLUDE, MCAST_UNDEFINED);
1224189592Sbms		imf = &timf;
1225189592Sbms	}
1226170613Sbms
1227189592Sbms	/*
1228189592Sbms	 * Begin state merge transaction at IGMP layer.
1229189592Sbms	 *
1230189592Sbms	 * As this particular invocation should not cause any memory
1231189592Sbms	 * to be allocated, and there is no opportunity to roll back
1232189592Sbms	 * the transaction, it MUST NOT fail.
1233189592Sbms	 */
1234189592Sbms	CTR1(KTR_IGMPV3, "%s: merge inm state", __func__);
1235189592Sbms	error = inm_merge(inm, imf);
1236189592Sbms	KASSERT(error == 0, ("%s: failed to merge inm state", __func__));
1237170613Sbms
1238189592Sbms	CTR1(KTR_IGMPV3, "%s: doing igmp downcall", __func__);
1239252510Shrs	CURVNET_SET(inm->inm_ifp->if_vnet);
1240189592Sbms	error = igmp_change_state(inm);
1241252510Shrs	CURVNET_RESTORE();
1242189592Sbms	if (error)
1243189592Sbms		CTR1(KTR_IGMPV3, "%s: failed igmp downcall", __func__);
1244189592Sbms
1245189592Sbms	CTR2(KTR_IGMPV3, "%s: dropping ref on %p", __func__, inm);
1246189592Sbms	inm_release_locked(inm);
1247189592Sbms
1248189592Sbms	return (error);
1249170613Sbms}
1250170613Sbms
1251189592Sbms/*#ifndef BURN_BRIDGES*/
1252170613Sbms/*
1253189592Sbms * Join an IPv4 multicast group in (*,G) exclusive mode.
1254189592Sbms * The group must be a 224.0.0.0/24 link-scope group.
1255189592Sbms * This KPI is for legacy kernel consumers only.
1256170613Sbms */
1257189592Sbmsstruct in_multi *
1258189592Sbmsin_addmulti(struct in_addr *ap, struct ifnet *ifp)
1259189592Sbms{
1260189592Sbms	struct in_multi *pinm;
1261189592Sbms	int error;
1262189592Sbms
1263189592Sbms	KASSERT(IN_LOCAL_GROUP(ntohl(ap->s_addr)),
1264189592Sbms	    ("%s: %s not in 224.0.0.0/24", __func__, inet_ntoa(*ap)));
1265189592Sbms
1266189592Sbms	error = in_joingroup(ifp, ap, NULL, &pinm);
1267189592Sbms	if (error != 0)
1268189592Sbms		pinm = NULL;
1269189592Sbms
1270189592Sbms	return (pinm);
1271189592Sbms}
1272189592Sbms
1273189592Sbms/*
1274189592Sbms * Leave an IPv4 multicast group, assumed to be in exclusive (*,G) mode.
1275189592Sbms * This KPI is for legacy kernel consumers only.
1276189592Sbms */
1277189592Sbmsvoid
1278189592Sbmsin_delmulti(struct in_multi *inm)
1279189592Sbms{
1280189592Sbms
1281189592Sbms	(void)in_leavegroup(inm, NULL);
1282189592Sbms}
1283189592Sbms/*#endif*/
1284189592Sbms
1285189592Sbms/*
1286189592Sbms * Block or unblock an ASM multicast source on an inpcb.
1287189592Sbms * This implements the delta-based API described in RFC 3678.
1288189592Sbms *
1289189592Sbms * The delta-based API applies only to exclusive-mode memberships.
1290189592Sbms * An IGMP downcall will be performed.
1291189592Sbms *
1292189592Sbms * SMPng: NOTE: Must take Giant as a join may create a new ifma.
1293189592Sbms *
1294189592Sbms * Return 0 if successful, otherwise return an appropriate error code.
1295189592Sbms */
1296170613Sbmsstatic int
1297189592Sbmsinp_block_unblock_source(struct inpcb *inp, struct sockopt *sopt)
1298170613Sbms{
1299170613Sbms	struct group_source_req		 gsr;
1300170613Sbms	sockunion_t			*gsa, *ssa;
1301170613Sbms	struct ifnet			*ifp;
1302170613Sbms	struct in_mfilter		*imf;
1303170613Sbms	struct ip_moptions		*imo;
1304170613Sbms	struct in_msource		*ims;
1305189592Sbms	struct in_multi			*inm;
1306170613Sbms	size_t				 idx;
1307189592Sbms	uint16_t			 fmode;
1308189592Sbms	int				 error, doblock;
1309170613Sbms
1310170613Sbms	ifp = NULL;
1311170613Sbms	error = 0;
1312189592Sbms	doblock = 0;
1313170613Sbms
1314170613Sbms	memset(&gsr, 0, sizeof(struct group_source_req));
1315170613Sbms	gsa = (sockunion_t *)&gsr.gsr_group;
1316170613Sbms	ssa = (sockunion_t *)&gsr.gsr_source;
1317170613Sbms
1318170613Sbms	switch (sopt->sopt_name) {
1319170613Sbms	case IP_BLOCK_SOURCE:
1320170613Sbms	case IP_UNBLOCK_SOURCE: {
1321170613Sbms		struct ip_mreq_source	 mreqs;
1322170613Sbms
1323170613Sbms		error = sooptcopyin(sopt, &mreqs,
1324170613Sbms		    sizeof(struct ip_mreq_source),
1325170613Sbms		    sizeof(struct ip_mreq_source));
1326170613Sbms		if (error)
1327170613Sbms			return (error);
1328170613Sbms
1329170613Sbms		gsa->sin.sin_family = AF_INET;
1330170613Sbms		gsa->sin.sin_len = sizeof(struct sockaddr_in);
1331170613Sbms		gsa->sin.sin_addr = mreqs.imr_multiaddr;
1332170613Sbms
1333170613Sbms		ssa->sin.sin_family = AF_INET;
1334170613Sbms		ssa->sin.sin_len = sizeof(struct sockaddr_in);
1335170613Sbms		ssa->sin.sin_addr = mreqs.imr_sourceaddr;
1336170613Sbms
1337189592Sbms		if (!in_nullhost(mreqs.imr_interface))
1338170613Sbms			INADDR_TO_IFP(mreqs.imr_interface, ifp);
1339170613Sbms
1340170613Sbms		if (sopt->sopt_name == IP_BLOCK_SOURCE)
1341189592Sbms			doblock = 1;
1342170613Sbms
1343189592Sbms		CTR3(KTR_IGMPV3, "%s: imr_interface = %s, ifp = %p",
1344189592Sbms		    __func__, inet_ntoa(mreqs.imr_interface), ifp);
1345170613Sbms		break;
1346170613Sbms	    }
1347170613Sbms
1348170613Sbms	case MCAST_BLOCK_SOURCE:
1349170613Sbms	case MCAST_UNBLOCK_SOURCE:
1350170613Sbms		error = sooptcopyin(sopt, &gsr,
1351170613Sbms		    sizeof(struct group_source_req),
1352170613Sbms		    sizeof(struct group_source_req));
1353170613Sbms		if (error)
1354170613Sbms			return (error);
1355170613Sbms
1356170613Sbms		if (gsa->sin.sin_family != AF_INET ||
1357170613Sbms		    gsa->sin.sin_len != sizeof(struct sockaddr_in))
1358170613Sbms			return (EINVAL);
1359170613Sbms
1360170613Sbms		if (ssa->sin.sin_family != AF_INET ||
1361170613Sbms		    ssa->sin.sin_len != sizeof(struct sockaddr_in))
1362170613Sbms			return (EINVAL);
1363170613Sbms
1364181803Sbz		if (gsr.gsr_interface == 0 || V_if_index < gsr.gsr_interface)
1365170613Sbms			return (EADDRNOTAVAIL);
1366170613Sbms
1367170613Sbms		ifp = ifnet_byindex(gsr.gsr_interface);
1368170613Sbms
1369170613Sbms		if (sopt->sopt_name == MCAST_BLOCK_SOURCE)
1370189592Sbms			doblock = 1;
1371170613Sbms		break;
1372170613Sbms
1373170613Sbms	default:
1374189592Sbms		CTR2(KTR_IGMPV3, "%s: unknown sopt_name %d",
1375189592Sbms		    __func__, sopt->sopt_name);
1376170613Sbms		return (EOPNOTSUPP);
1377170613Sbms		break;
1378170613Sbms	}
1379170613Sbms
1380170613Sbms	if (!IN_MULTICAST(ntohl(gsa->sin.sin_addr.s_addr)))
1381170613Sbms		return (EINVAL);
1382170613Sbms
1383170613Sbms	/*
1384170613Sbms	 * Check if we are actually a member of this group.
1385170613Sbms	 */
1386170613Sbms	imo = inp_findmoptions(inp);
1387170613Sbms	idx = imo_match_group(imo, ifp, &gsa->sa);
1388170613Sbms	if (idx == -1 || imo->imo_mfilters == NULL) {
1389170613Sbms		error = EADDRNOTAVAIL;
1390189592Sbms		goto out_inp_locked;
1391170613Sbms	}
1392170613Sbms
1393170613Sbms	KASSERT(imo->imo_mfilters != NULL,
1394170613Sbms	    ("%s: imo_mfilters not allocated", __func__));
1395170613Sbms	imf = &imo->imo_mfilters[idx];
1396189592Sbms	inm = imo->imo_membership[idx];
1397170613Sbms
1398170613Sbms	/*
1399189592Sbms	 * Attempting to use the delta-based API on an
1400189592Sbms	 * non exclusive-mode membership is an error.
1401170613Sbms	 */
1402189592Sbms	fmode = imf->imf_st[0];
1403189592Sbms	if (fmode != MCAST_EXCLUDE) {
1404189592Sbms		error = EINVAL;
1405189592Sbms		goto out_inp_locked;
1406170613Sbms	}
1407189592Sbms
1408189592Sbms	/*
1409189592Sbms	 * Deal with error cases up-front:
1410189592Sbms	 *  Asked to block, but already blocked; or
1411189592Sbms	 *  Asked to unblock, but nothing to unblock.
1412189592Sbms	 * If adding a new block entry, allocate it.
1413189592Sbms	 */
1414170613Sbms	ims = imo_match_source(imo, idx, &ssa->sa);
1415189592Sbms	if ((ims != NULL && doblock) || (ims == NULL && !doblock)) {
1416189592Sbms		CTR3(KTR_IGMPV3, "%s: source %s %spresent", __func__,
1417189592Sbms		    inet_ntoa(ssa->sin.sin_addr), doblock ? "" : "not ");
1418189592Sbms		error = EADDRNOTAVAIL;
1419189592Sbms		goto out_inp_locked;
1420189592Sbms	}
1421189592Sbms
1422189592Sbms	INP_WLOCK_ASSERT(inp);
1423189592Sbms
1424189592Sbms	/*
1425189592Sbms	 * Begin state merge transaction at socket layer.
1426189592Sbms	 */
1427189592Sbms	if (doblock) {
1428189592Sbms		CTR2(KTR_IGMPV3, "%s: %s source", __func__, "block");
1429189592Sbms		ims = imf_graft(imf, fmode, &ssa->sin);
1430189592Sbms		if (ims == NULL)
1431189592Sbms			error = ENOMEM;
1432170613Sbms	} else {
1433189592Sbms		CTR2(KTR_IGMPV3, "%s: %s source", __func__, "allow");
1434189592Sbms		error = imf_prune(imf, &ssa->sin);
1435170613Sbms	}
1436170613Sbms
1437189592Sbms	if (error) {
1438189592Sbms		CTR1(KTR_IGMPV3, "%s: merge imf state failed", __func__);
1439189592Sbms		goto out_imf_rollback;
1440189592Sbms	}
1441189592Sbms
1442189592Sbms	/*
1443189592Sbms	 * Begin state merge transaction at IGMP layer.
1444189592Sbms	 */
1445189592Sbms	IN_MULTI_LOCK();
1446189592Sbms
1447189592Sbms	CTR1(KTR_IGMPV3, "%s: merge inm state", __func__);
1448189592Sbms	error = inm_merge(inm, imf);
1449189592Sbms	if (error) {
1450189592Sbms		CTR1(KTR_IGMPV3, "%s: failed to merge inm state", __func__);
1451189592Sbms		goto out_imf_rollback;
1452189592Sbms	}
1453189592Sbms
1454189592Sbms	CTR1(KTR_IGMPV3, "%s: doing igmp downcall", __func__);
1455189592Sbms	error = igmp_change_state(inm);
1456189592Sbms	if (error)
1457189592Sbms		CTR1(KTR_IGMPV3, "%s: failed igmp downcall", __func__);
1458189592Sbms
1459189592Sbms	IN_MULTI_UNLOCK();
1460189592Sbms
1461189592Sbmsout_imf_rollback:
1462189592Sbms	if (error)
1463189592Sbms		imf_rollback(imf);
1464189592Sbms	else
1465189592Sbms		imf_commit(imf);
1466189592Sbms
1467189592Sbms	imf_reap(imf);
1468189592Sbms
1469189592Sbmsout_inp_locked:
1470178285Srwatson	INP_WUNLOCK(inp);
1471170613Sbms	return (error);
1472170613Sbms}
1473170613Sbms
1474170613Sbms/*
1475170613Sbms * Given an inpcb, return its multicast options structure pointer.  Accepts
1476170613Sbms * an unlocked inpcb pointer, but will return it locked.  May sleep.
1477189592Sbms *
1478189592Sbms * SMPng: NOTE: Potentially calls malloc(M_WAITOK) with Giant held.
1479189592Sbms * SMPng: NOTE: Returns with the INP write lock held.
1480170613Sbms */
1481170613Sbmsstatic struct ip_moptions *
1482170613Sbmsinp_findmoptions(struct inpcb *inp)
1483170613Sbms{
1484170613Sbms	struct ip_moptions	 *imo;
1485170613Sbms	struct in_multi		**immp;
1486170613Sbms	struct in_mfilter	 *imfp;
1487170613Sbms	size_t			  idx;
1488170613Sbms
1489178285Srwatson	INP_WLOCK(inp);
1490170613Sbms	if (inp->inp_moptions != NULL)
1491170613Sbms		return (inp->inp_moptions);
1492170613Sbms
1493178285Srwatson	INP_WUNLOCK(inp);
1494170613Sbms
1495189592Sbms	imo = malloc(sizeof(*imo), M_IPMOPTS, M_WAITOK);
1496189592Sbms	immp = malloc(sizeof(*immp) * IP_MIN_MEMBERSHIPS, M_IPMOPTS,
1497189592Sbms	    M_WAITOK | M_ZERO);
1498189592Sbms	imfp = malloc(sizeof(struct in_mfilter) * IP_MIN_MEMBERSHIPS,
1499189592Sbms	    M_INMFILTER, M_WAITOK);
1500170613Sbms
1501170613Sbms	imo->imo_multicast_ifp = NULL;
1502170613Sbms	imo->imo_multicast_addr.s_addr = INADDR_ANY;
1503170613Sbms	imo->imo_multicast_vif = -1;
1504170613Sbms	imo->imo_multicast_ttl = IP_DEFAULT_MULTICAST_TTL;
1505189357Sbms	imo->imo_multicast_loop = in_mcast_loop;
1506170613Sbms	imo->imo_num_memberships = 0;
1507170613Sbms	imo->imo_max_memberships = IP_MIN_MEMBERSHIPS;
1508170613Sbms	imo->imo_membership = immp;
1509170613Sbms
1510170613Sbms	/* Initialize per-group source filters. */
1511189592Sbms	for (idx = 0; idx < IP_MIN_MEMBERSHIPS; idx++)
1512189592Sbms		imf_init(&imfp[idx], MCAST_UNDEFINED, MCAST_EXCLUDE);
1513170613Sbms	imo->imo_mfilters = imfp;
1514170613Sbms
1515178285Srwatson	INP_WLOCK(inp);
1516170613Sbms	if (inp->inp_moptions != NULL) {
1517189592Sbms		free(imfp, M_INMFILTER);
1518170613Sbms		free(immp, M_IPMOPTS);
1519170613Sbms		free(imo, M_IPMOPTS);
1520170613Sbms		return (inp->inp_moptions);
1521170613Sbms	}
1522170613Sbms	inp->inp_moptions = imo;
1523170613Sbms	return (imo);
1524170613Sbms}
1525170613Sbms
1526170613Sbms/*
1527228969Sjhb * Discard the IP multicast options (and source filters).  To minimize
1528228969Sjhb * the amount of work done while holding locks such as the INP's
1529228969Sjhb * pcbinfo lock (which is used in the receive path), the free
1530228969Sjhb * operation is performed asynchronously in a separate task.
1531189592Sbms *
1532189592Sbms * SMPng: NOTE: assumes INP write lock is held.
1533170613Sbms */
1534170613Sbmsvoid
1535170613Sbmsinp_freemoptions(struct ip_moptions *imo)
1536170613Sbms{
1537228969Sjhb
1538228969Sjhb	KASSERT(imo != NULL, ("%s: ip_moptions is NULL", __func__));
1539228969Sjhb	IN_MULTI_LOCK();
1540228969Sjhb	STAILQ_INSERT_TAIL(&imo_gc_list, imo, imo_link);
1541228969Sjhb	IN_MULTI_UNLOCK();
1542228969Sjhb	taskqueue_enqueue(taskqueue_thread, &imo_gc_task);
1543228969Sjhb}
1544228969Sjhb
1545228969Sjhbstatic void
1546228969Sjhbinp_freemoptions_internal(struct ip_moptions *imo)
1547228969Sjhb{
1548170613Sbms	struct in_mfilter	*imf;
1549170613Sbms	size_t			 idx, nmships;
1550170613Sbms
1551170613Sbms	nmships = imo->imo_num_memberships;
1552170613Sbms	for (idx = 0; idx < nmships; ++idx) {
1553189592Sbms		imf = imo->imo_mfilters ? &imo->imo_mfilters[idx] : NULL;
1554189592Sbms		if (imf)
1555189592Sbms			imf_leave(imf);
1556189592Sbms		(void)in_leavegroup(imo->imo_membership[idx], imf);
1557189592Sbms		if (imf)
1558189592Sbms			imf_purge(imf);
1559170613Sbms	}
1560170613Sbms
1561189592Sbms	if (imo->imo_mfilters)
1562189592Sbms		free(imo->imo_mfilters, M_INMFILTER);
1563170613Sbms	free(imo->imo_membership, M_IPMOPTS);
1564170613Sbms	free(imo, M_IPMOPTS);
1565170613Sbms}
1566170613Sbms
1567228969Sjhbstatic void
1568228969Sjhbinp_gcmoptions(void *context, int pending)
1569228969Sjhb{
1570228969Sjhb	struct ip_moptions *imo;
1571228969Sjhb
1572228969Sjhb	IN_MULTI_LOCK();
1573228969Sjhb	while (!STAILQ_EMPTY(&imo_gc_list)) {
1574228969Sjhb		imo = STAILQ_FIRST(&imo_gc_list);
1575228969Sjhb		STAILQ_REMOVE_HEAD(&imo_gc_list, imo_link);
1576228969Sjhb		IN_MULTI_UNLOCK();
1577228969Sjhb		inp_freemoptions_internal(imo);
1578228969Sjhb		IN_MULTI_LOCK();
1579228969Sjhb	}
1580228969Sjhb	IN_MULTI_UNLOCK();
1581228969Sjhb}
1582228969Sjhb
1583170613Sbms/*
1584170613Sbms * Atomically get source filters on a socket for an IPv4 multicast group.
1585170613Sbms * Called with INP lock held; returns with lock released.
1586170613Sbms */
1587170613Sbmsstatic int
1588170613Sbmsinp_get_source_filters(struct inpcb *inp, struct sockopt *sopt)
1589170613Sbms{
1590170613Sbms	struct __msfilterreq	 msfr;
1591170613Sbms	sockunion_t		*gsa;
1592170613Sbms	struct ifnet		*ifp;
1593170613Sbms	struct ip_moptions	*imo;
1594170613Sbms	struct in_mfilter	*imf;
1595189592Sbms	struct ip_msource	*ims;
1596189592Sbms	struct in_msource	*lims;
1597189592Sbms	struct sockaddr_in	*psin;
1598170613Sbms	struct sockaddr_storage	*ptss;
1599170613Sbms	struct sockaddr_storage	*tss;
1600170613Sbms	int			 error;
1601189592Sbms	size_t			 idx, nsrcs, ncsrcs;
1602170613Sbms
1603178285Srwatson	INP_WLOCK_ASSERT(inp);
1604170613Sbms
1605170613Sbms	imo = inp->inp_moptions;
1606170613Sbms	KASSERT(imo != NULL, ("%s: null ip_moptions", __func__));
1607170613Sbms
1608178285Srwatson	INP_WUNLOCK(inp);
1609170613Sbms
1610170613Sbms	error = sooptcopyin(sopt, &msfr, sizeof(struct __msfilterreq),
1611170613Sbms	    sizeof(struct __msfilterreq));
1612170613Sbms	if (error)
1613170613Sbms		return (error);
1614170613Sbms
1615181803Sbz	if (msfr.msfr_ifindex == 0 || V_if_index < msfr.msfr_ifindex)
1616170613Sbms		return (EINVAL);
1617170613Sbms
1618170613Sbms	ifp = ifnet_byindex(msfr.msfr_ifindex);
1619170613Sbms	if (ifp == NULL)
1620170613Sbms		return (EINVAL);
1621170613Sbms
1622178285Srwatson	INP_WLOCK(inp);
1623170613Sbms
1624170613Sbms	/*
1625170613Sbms	 * Lookup group on the socket.
1626170613Sbms	 */
1627170613Sbms	gsa = (sockunion_t *)&msfr.msfr_group;
1628170613Sbms	idx = imo_match_group(imo, ifp, &gsa->sa);
1629170613Sbms	if (idx == -1 || imo->imo_mfilters == NULL) {
1630178285Srwatson		INP_WUNLOCK(inp);
1631170613Sbms		return (EADDRNOTAVAIL);
1632170613Sbms	}
1633170613Sbms	imf = &imo->imo_mfilters[idx];
1634170613Sbms
1635170613Sbms	/*
1636189592Sbms	 * Ignore memberships which are in limbo.
1637189592Sbms	 */
1638189592Sbms	if (imf->imf_st[1] == MCAST_UNDEFINED) {
1639189592Sbms		INP_WUNLOCK(inp);
1640189592Sbms		return (EAGAIN);
1641189592Sbms	}
1642189592Sbms	msfr.msfr_fmode = imf->imf_st[1];
1643189592Sbms
1644189592Sbms	/*
1645170613Sbms	 * If the user specified a buffer, copy out the source filter
1646170613Sbms	 * entries to userland gracefully.
1647189592Sbms	 * We only copy out the number of entries which userland
1648189592Sbms	 * has asked for, but we always tell userland how big the
1649189592Sbms	 * buffer really needs to be.
1650170613Sbms	 */
1651170613Sbms	tss = NULL;
1652170613Sbms	if (msfr.msfr_srcs != NULL && msfr.msfr_nsrcs > 0) {
1653184214Sdes		tss = malloc(sizeof(struct sockaddr_storage) * msfr.msfr_nsrcs,
1654189592Sbms		    M_TEMP, M_NOWAIT | M_ZERO);
1655170613Sbms		if (tss == NULL) {
1656189592Sbms			INP_WUNLOCK(inp);
1657189592Sbms			return (ENOBUFS);
1658170613Sbms		}
1659170613Sbms	}
1660170613Sbms
1661189592Sbms	/*
1662189592Sbms	 * Count number of sources in-mode at t0.
1663189592Sbms	 * If buffer space exists and remains, copy out source entries.
1664189592Sbms	 */
1665189592Sbms	nsrcs = msfr.msfr_nsrcs;
1666189592Sbms	ncsrcs = 0;
1667189592Sbms	ptss = tss;
1668189592Sbms	RB_FOREACH(ims, ip_msource_tree, &imf->imf_sources) {
1669189592Sbms		lims = (struct in_msource *)ims;
1670189592Sbms		if (lims->imsl_st[0] == MCAST_UNDEFINED ||
1671189592Sbms		    lims->imsl_st[0] != imf->imf_st[0])
1672189592Sbms			continue;
1673189592Sbms		++ncsrcs;
1674191659Sbms		if (tss != NULL && nsrcs > 0) {
1675191659Sbms			psin = (struct sockaddr_in *)ptss;
1676189592Sbms			psin->sin_family = AF_INET;
1677189592Sbms			psin->sin_len = sizeof(struct sockaddr_in);
1678189592Sbms			psin->sin_addr.s_addr = htonl(lims->ims_haddr);
1679191659Sbms			psin->sin_port = 0;
1680191659Sbms			++ptss;
1681191659Sbms			--nsrcs;
1682189592Sbms		}
1683189592Sbms	}
1684189592Sbms
1685178285Srwatson	INP_WUNLOCK(inp);
1686170613Sbms
1687170613Sbms	if (tss != NULL) {
1688170613Sbms		error = copyout(tss, msfr.msfr_srcs,
1689170613Sbms		    sizeof(struct sockaddr_storage) * msfr.msfr_nsrcs);
1690184205Sdes		free(tss, M_TEMP);
1691189592Sbms		if (error)
1692189592Sbms			return (error);
1693170613Sbms	}
1694170613Sbms
1695189592Sbms	msfr.msfr_nsrcs = ncsrcs;
1696170613Sbms	error = sooptcopyout(sopt, &msfr, sizeof(struct __msfilterreq));
1697170613Sbms
1698170613Sbms	return (error);
1699170613Sbms}
1700170613Sbms
1701170613Sbms/*
1702170613Sbms * Return the IP multicast options in response to user getsockopt().
1703170613Sbms */
1704170613Sbmsint
1705170613Sbmsinp_getmoptions(struct inpcb *inp, struct sockopt *sopt)
1706170613Sbms{
1707170613Sbms	struct ip_mreqn		 mreqn;
1708170613Sbms	struct ip_moptions	*imo;
1709170613Sbms	struct ifnet		*ifp;
1710170613Sbms	struct in_ifaddr	*ia;
1711170613Sbms	int			 error, optval;
1712170613Sbms	u_char			 coptval;
1713170613Sbms
1714178285Srwatson	INP_WLOCK(inp);
1715170613Sbms	imo = inp->inp_moptions;
1716171746Scsjp	/*
1717171746Scsjp	 * If socket is neither of type SOCK_RAW or SOCK_DGRAM,
1718171746Scsjp	 * or is a divert socket, reject it.
1719171746Scsjp	 */
1720171746Scsjp	if (inp->inp_socket->so_proto->pr_protocol == IPPROTO_DIVERT ||
1721171746Scsjp	    (inp->inp_socket->so_proto->pr_type != SOCK_RAW &&
1722171746Scsjp	    inp->inp_socket->so_proto->pr_type != SOCK_DGRAM)) {
1723178285Srwatson		INP_WUNLOCK(inp);
1724171746Scsjp		return (EOPNOTSUPP);
1725171746Scsjp	}
1726170613Sbms
1727170613Sbms	error = 0;
1728170613Sbms	switch (sopt->sopt_name) {
1729170613Sbms	case IP_MULTICAST_VIF:
1730170613Sbms		if (imo != NULL)
1731170613Sbms			optval = imo->imo_multicast_vif;
1732170613Sbms		else
1733170613Sbms			optval = -1;
1734178285Srwatson		INP_WUNLOCK(inp);
1735170613Sbms		error = sooptcopyout(sopt, &optval, sizeof(int));
1736170613Sbms		break;
1737170613Sbms
1738170613Sbms	case IP_MULTICAST_IF:
1739170613Sbms		memset(&mreqn, 0, sizeof(struct ip_mreqn));
1740170613Sbms		if (imo != NULL) {
1741170613Sbms			ifp = imo->imo_multicast_ifp;
1742189592Sbms			if (!in_nullhost(imo->imo_multicast_addr)) {
1743170613Sbms				mreqn.imr_address = imo->imo_multicast_addr;
1744170613Sbms			} else if (ifp != NULL) {
1745170613Sbms				mreqn.imr_ifindex = ifp->if_index;
1746170613Sbms				IFP_TO_IA(ifp, ia);
1747170613Sbms				if (ia != NULL) {
1748170613Sbms					mreqn.imr_address =
1749170613Sbms					    IA_SIN(ia)->sin_addr;
1750194760Srwatson					ifa_free(&ia->ia_ifa);
1751170613Sbms				}
1752170613Sbms			}
1753170613Sbms		}
1754178285Srwatson		INP_WUNLOCK(inp);
1755170613Sbms		if (sopt->sopt_valsize == sizeof(struct ip_mreqn)) {
1756170613Sbms			error = sooptcopyout(sopt, &mreqn,
1757170613Sbms			    sizeof(struct ip_mreqn));
1758170613Sbms		} else {
1759170613Sbms			error = sooptcopyout(sopt, &mreqn.imr_address,
1760170613Sbms			    sizeof(struct in_addr));
1761170613Sbms		}
1762170613Sbms		break;
1763170613Sbms
1764170613Sbms	case IP_MULTICAST_TTL:
1765170613Sbms		if (imo == 0)
1766170613Sbms			optval = coptval = IP_DEFAULT_MULTICAST_TTL;
1767170613Sbms		else
1768170613Sbms			optval = coptval = imo->imo_multicast_ttl;
1769178285Srwatson		INP_WUNLOCK(inp);
1770170613Sbms		if (sopt->sopt_valsize == sizeof(u_char))
1771170613Sbms			error = sooptcopyout(sopt, &coptval, sizeof(u_char));
1772170613Sbms		else
1773170613Sbms			error = sooptcopyout(sopt, &optval, sizeof(int));
1774170613Sbms		break;
1775170613Sbms
1776170613Sbms	case IP_MULTICAST_LOOP:
1777170613Sbms		if (imo == 0)
1778170613Sbms			optval = coptval = IP_DEFAULT_MULTICAST_LOOP;
1779170613Sbms		else
1780170613Sbms			optval = coptval = imo->imo_multicast_loop;
1781178285Srwatson		INP_WUNLOCK(inp);
1782170613Sbms		if (sopt->sopt_valsize == sizeof(u_char))
1783170613Sbms			error = sooptcopyout(sopt, &coptval, sizeof(u_char));
1784170613Sbms		else
1785170613Sbms			error = sooptcopyout(sopt, &optval, sizeof(int));
1786170613Sbms		break;
1787170613Sbms
1788170613Sbms	case IP_MSFILTER:
1789170613Sbms		if (imo == NULL) {
1790170613Sbms			error = EADDRNOTAVAIL;
1791178285Srwatson			INP_WUNLOCK(inp);
1792170613Sbms		} else {
1793170613Sbms			error = inp_get_source_filters(inp, sopt);
1794170613Sbms		}
1795170613Sbms		break;
1796170613Sbms
1797170613Sbms	default:
1798178285Srwatson		INP_WUNLOCK(inp);
1799170613Sbms		error = ENOPROTOOPT;
1800170613Sbms		break;
1801170613Sbms	}
1802170613Sbms
1803170613Sbms	INP_UNLOCK_ASSERT(inp);
1804170613Sbms
1805170613Sbms	return (error);
1806170613Sbms}
1807170613Sbms
1808170613Sbms/*
1809189592Sbms * Look up the ifnet to use for a multicast group membership,
1810189592Sbms * given the IPv4 address of an interface, and the IPv4 group address.
1811189592Sbms *
1812189592Sbms * This routine exists to support legacy multicast applications
1813189592Sbms * which do not understand that multicast memberships are scoped to
1814189592Sbms * specific physical links in the networking stack, or which need
1815189592Sbms * to join link-scope groups before IPv4 addresses are configured.
1816189592Sbms *
1817189592Sbms * If inp is non-NULL, use this socket's current FIB number for any
1818189592Sbms * required FIB lookup.
1819189592Sbms * If ina is INADDR_ANY, look up the group address in the unicast FIB,
1820189592Sbms * and use its ifp; usually, this points to the default next-hop.
1821189592Sbms *
1822189592Sbms * If the FIB lookup fails, attempt to use the first non-loopback
1823189592Sbms * interface with multicast capability in the system as a
1824189592Sbms * last resort. The legacy IPv4 ASM API requires that we do
1825189592Sbms * this in order to allow groups to be joined when the routing
1826189592Sbms * table has not yet been populated during boot.
1827189592Sbms *
1828189592Sbms * Returns NULL if no ifp could be found.
1829189592Sbms *
1830189592Sbms * SMPng: TODO: Acquire the appropriate locks for INADDR_TO_IFP.
1831189592Sbms * FUTURE: Implement IPv4 source-address selection.
1832189592Sbms */
1833189592Sbmsstatic struct ifnet *
1834189592Sbmsinp_lookup_mcast_ifp(const struct inpcb *inp,
1835189592Sbms    const struct sockaddr_in *gsin, const struct in_addr ina)
1836189592Sbms{
1837189592Sbms	struct ifnet *ifp;
1838189592Sbms
1839189592Sbms	KASSERT(gsin->sin_family == AF_INET, ("%s: not AF_INET", __func__));
1840189592Sbms	KASSERT(IN_MULTICAST(ntohl(gsin->sin_addr.s_addr)),
1841189592Sbms	    ("%s: not multicast", __func__));
1842189592Sbms
1843189592Sbms	ifp = NULL;
1844189592Sbms	if (!in_nullhost(ina)) {
1845189592Sbms		INADDR_TO_IFP(ina, ifp);
1846189592Sbms	} else {
1847189592Sbms		struct route ro;
1848189592Sbms
1849189592Sbms		ro.ro_rt = NULL;
1850189592Sbms		memcpy(&ro.ro_dst, gsin, sizeof(struct sockaddr_in));
1851189592Sbms		in_rtalloc_ign(&ro, 0, inp ? inp->inp_inc.inc_fibnum : 0);
1852189592Sbms		if (ro.ro_rt != NULL) {
1853189592Sbms			ifp = ro.ro_rt->rt_ifp;
1854189592Sbms			KASSERT(ifp != NULL, ("%s: null ifp", __func__));
1855189592Sbms			RTFREE(ro.ro_rt);
1856189592Sbms		} else {
1857189592Sbms			struct in_ifaddr *ia;
1858189592Sbms			struct ifnet *mifp;
1859189592Sbms
1860189592Sbms			mifp = NULL;
1861194951Srwatson			IN_IFADDR_RLOCK();
1862189592Sbms			TAILQ_FOREACH(ia, &V_in_ifaddrhead, ia_link) {
1863189592Sbms				mifp = ia->ia_ifp;
1864189592Sbms				if (!(mifp->if_flags & IFF_LOOPBACK) &&
1865189592Sbms				     (mifp->if_flags & IFF_MULTICAST)) {
1866189592Sbms					ifp = mifp;
1867189592Sbms					break;
1868189592Sbms				}
1869189592Sbms			}
1870194951Srwatson			IN_IFADDR_RUNLOCK();
1871189592Sbms		}
1872189592Sbms	}
1873189592Sbms
1874189592Sbms	return (ifp);
1875189592Sbms}
1876189592Sbms
1877189592Sbms/*
1878170613Sbms * Join an IPv4 multicast group, possibly with a source.
1879170613Sbms */
1880170613Sbmsstatic int
1881170613Sbmsinp_join_group(struct inpcb *inp, struct sockopt *sopt)
1882170613Sbms{
1883170613Sbms	struct group_source_req		 gsr;
1884170613Sbms	sockunion_t			*gsa, *ssa;
1885170613Sbms	struct ifnet			*ifp;
1886170613Sbms	struct in_mfilter		*imf;
1887170613Sbms	struct ip_moptions		*imo;
1888170613Sbms	struct in_multi			*inm;
1889189592Sbms	struct in_msource		*lims;
1890170613Sbms	size_t				 idx;
1891189592Sbms	int				 error, is_new;
1892170613Sbms
1893170613Sbms	ifp = NULL;
1894189592Sbms	imf = NULL;
1895197136Sbms	lims = NULL;
1896170613Sbms	error = 0;
1897189592Sbms	is_new = 0;
1898170613Sbms
1899170613Sbms	memset(&gsr, 0, sizeof(struct group_source_req));
1900170613Sbms	gsa = (sockunion_t *)&gsr.gsr_group;
1901170613Sbms	gsa->ss.ss_family = AF_UNSPEC;
1902170613Sbms	ssa = (sockunion_t *)&gsr.gsr_source;
1903170613Sbms	ssa->ss.ss_family = AF_UNSPEC;
1904170613Sbms
1905170613Sbms	switch (sopt->sopt_name) {
1906170613Sbms	case IP_ADD_MEMBERSHIP:
1907170613Sbms	case IP_ADD_SOURCE_MEMBERSHIP: {
1908170613Sbms		struct ip_mreq_source	 mreqs;
1909170613Sbms
1910170613Sbms		if (sopt->sopt_name == IP_ADD_MEMBERSHIP) {
1911170613Sbms			error = sooptcopyin(sopt, &mreqs,
1912170613Sbms			    sizeof(struct ip_mreq),
1913170613Sbms			    sizeof(struct ip_mreq));
1914170613Sbms			/*
1915170613Sbms			 * Do argument switcharoo from ip_mreq into
1916170613Sbms			 * ip_mreq_source to avoid using two instances.
1917170613Sbms			 */
1918170613Sbms			mreqs.imr_interface = mreqs.imr_sourceaddr;
1919170613Sbms			mreqs.imr_sourceaddr.s_addr = INADDR_ANY;
1920170613Sbms		} else if (sopt->sopt_name == IP_ADD_SOURCE_MEMBERSHIP) {
1921170613Sbms			error = sooptcopyin(sopt, &mreqs,
1922170613Sbms			    sizeof(struct ip_mreq_source),
1923170613Sbms			    sizeof(struct ip_mreq_source));
1924170613Sbms		}
1925170613Sbms		if (error)
1926170613Sbms			return (error);
1927170613Sbms
1928170613Sbms		gsa->sin.sin_family = AF_INET;
1929170613Sbms		gsa->sin.sin_len = sizeof(struct sockaddr_in);
1930170613Sbms		gsa->sin.sin_addr = mreqs.imr_multiaddr;
1931170613Sbms
1932170613Sbms		if (sopt->sopt_name == IP_ADD_SOURCE_MEMBERSHIP) {
1933170613Sbms			ssa->sin.sin_family = AF_INET;
1934170613Sbms			ssa->sin.sin_len = sizeof(struct sockaddr_in);
1935170613Sbms			ssa->sin.sin_addr = mreqs.imr_sourceaddr;
1936170613Sbms		}
1937170613Sbms
1938196932Ssyrinx		if (!IN_MULTICAST(ntohl(gsa->sin.sin_addr.s_addr)))
1939196932Ssyrinx			return (EINVAL);
1940196932Ssyrinx
1941189592Sbms		ifp = inp_lookup_mcast_ifp(inp, &gsa->sin,
1942189592Sbms		    mreqs.imr_interface);
1943189592Sbms		CTR3(KTR_IGMPV3, "%s: imr_interface = %s, ifp = %p",
1944189592Sbms		    __func__, inet_ntoa(mreqs.imr_interface), ifp);
1945170613Sbms		break;
1946170613Sbms	}
1947170613Sbms
1948170613Sbms	case MCAST_JOIN_GROUP:
1949170613Sbms	case MCAST_JOIN_SOURCE_GROUP:
1950170613Sbms		if (sopt->sopt_name == MCAST_JOIN_GROUP) {
1951170613Sbms			error = sooptcopyin(sopt, &gsr,
1952170613Sbms			    sizeof(struct group_req),
1953170613Sbms			    sizeof(struct group_req));
1954170613Sbms		} else if (sopt->sopt_name == MCAST_JOIN_SOURCE_GROUP) {
1955170613Sbms			error = sooptcopyin(sopt, &gsr,
1956170613Sbms			    sizeof(struct group_source_req),
1957170613Sbms			    sizeof(struct group_source_req));
1958170613Sbms		}
1959170613Sbms		if (error)
1960170613Sbms			return (error);
1961170613Sbms
1962170613Sbms		if (gsa->sin.sin_family != AF_INET ||
1963170613Sbms		    gsa->sin.sin_len != sizeof(struct sockaddr_in))
1964170613Sbms			return (EINVAL);
1965170613Sbms
1966170613Sbms		/*
1967170613Sbms		 * Overwrite the port field if present, as the sockaddr
1968170613Sbms		 * being copied in may be matched with a binary comparison.
1969170613Sbms		 */
1970170613Sbms		gsa->sin.sin_port = 0;
1971170613Sbms		if (sopt->sopt_name == MCAST_JOIN_SOURCE_GROUP) {
1972170613Sbms			if (ssa->sin.sin_family != AF_INET ||
1973170613Sbms			    ssa->sin.sin_len != sizeof(struct sockaddr_in))
1974170613Sbms				return (EINVAL);
1975170613Sbms			ssa->sin.sin_port = 0;
1976170613Sbms		}
1977170613Sbms
1978196932Ssyrinx		if (!IN_MULTICAST(ntohl(gsa->sin.sin_addr.s_addr)))
1979196932Ssyrinx			return (EINVAL);
1980196932Ssyrinx
1981181803Sbz		if (gsr.gsr_interface == 0 || V_if_index < gsr.gsr_interface)
1982170613Sbms			return (EADDRNOTAVAIL);
1983170613Sbms		ifp = ifnet_byindex(gsr.gsr_interface);
1984170613Sbms		break;
1985170613Sbms
1986170613Sbms	default:
1987189592Sbms		CTR2(KTR_IGMPV3, "%s: unknown sopt_name %d",
1988189592Sbms		    __func__, sopt->sopt_name);
1989170613Sbms		return (EOPNOTSUPP);
1990170613Sbms		break;
1991170613Sbms	}
1992170613Sbms
1993170613Sbms	if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0)
1994170613Sbms		return (EADDRNOTAVAIL);
1995170613Sbms
1996170613Sbms	imo = inp_findmoptions(inp);
1997170613Sbms	idx = imo_match_group(imo, ifp, &gsa->sa);
1998189592Sbms	if (idx == -1) {
1999189592Sbms		is_new = 1;
2000189592Sbms	} else {
2001189592Sbms		inm = imo->imo_membership[idx];
2002189592Sbms		imf = &imo->imo_mfilters[idx];
2003197132Sbms		if (ssa->ss.ss_family != AF_UNSPEC) {
2004197132Sbms			/*
2005199525Sbms			 * MCAST_JOIN_SOURCE_GROUP on an exclusive membership
2006197132Sbms			 * is an error. On an existing inclusive membership,
2007197132Sbms			 * it just adds the source to the filter list.
2008197132Sbms			 */
2009197132Sbms			if (imf->imf_st[1] != MCAST_INCLUDE) {
2010197132Sbms				error = EINVAL;
2011197132Sbms				goto out_inp_locked;
2012197132Sbms			}
2013197136Sbms			/*
2014197136Sbms			 * Throw out duplicates.
2015197136Sbms			 *
2016197136Sbms			 * XXX FIXME: This makes a naive assumption that
2017197136Sbms			 * even if entries exist for *ssa in this imf,
2018197136Sbms			 * they will be rejected as dupes, even if they
2019197136Sbms			 * are not valid in the current mode (in-mode).
2020197136Sbms			 *
2021197136Sbms			 * in_msource is transactioned just as for anything
2022197136Sbms			 * else in SSM -- but note naive use of inm_graft()
2023197136Sbms			 * below for allocating new filter entries.
2024197136Sbms			 *
2025197136Sbms			 * This is only an issue if someone mixes the
2026197136Sbms			 * full-state SSM API with the delta-based API,
2027197136Sbms			 * which is discouraged in the relevant RFCs.
2028197136Sbms			 */
2029197132Sbms			lims = imo_match_source(imo, idx, &ssa->sa);
2030197136Sbms			if (lims != NULL /*&&
2031197136Sbms			    lims->imsl_st[1] == MCAST_INCLUDE*/) {
2032197132Sbms				error = EADDRNOTAVAIL;
2033197132Sbms				goto out_inp_locked;
2034197132Sbms			}
2035197132Sbms		} else {
2036197132Sbms			/*
2037206452Sbms			 * MCAST_JOIN_GROUP on an existing exclusive
2038206452Sbms			 * membership is an error; return EADDRINUSE
2039206452Sbms			 * to preserve 4.4BSD API idempotence, and
2040206452Sbms			 * avoid tedious detour to code below.
2041206452Sbms			 * NOTE: This is bending RFC 3678 a bit.
2042206452Sbms			 *
2043197135Sbms			 * On an existing inclusive membership, this is also
2044197135Sbms			 * an error; if you want to change filter mode,
2045197135Sbms			 * you must use the userland API setsourcefilter().
2046197135Sbms			 * XXX We don't reject this for imf in UNDEFINED
2047197135Sbms			 * state at t1, because allocation of a filter
2048197135Sbms			 * is atomic with allocation of a membership.
2049197132Sbms			 */
2050197135Sbms			error = EINVAL;
2051206452Sbms			if (imf->imf_st[1] == MCAST_EXCLUDE)
2052206452Sbms				error = EADDRINUSE;
2053197135Sbms			goto out_inp_locked;
2054189592Sbms		}
2055170613Sbms	}
2056170613Sbms
2057170613Sbms	/*
2058189592Sbms	 * Begin state merge transaction at socket layer.
2059170613Sbms	 */
2060189592Sbms	INP_WLOCK_ASSERT(inp);
2061189592Sbms
2062189592Sbms	if (is_new) {
2063189592Sbms		if (imo->imo_num_memberships == imo->imo_max_memberships) {
2064189592Sbms			error = imo_grow(imo);
2065189592Sbms			if (error)
2066189592Sbms				goto out_inp_locked;
2067189592Sbms		}
2068189592Sbms		/*
2069189592Sbms		 * Allocate the new slot upfront so we can deal with
2070189592Sbms		 * grafting the new source filter in same code path
2071189592Sbms		 * as for join-source on existing membership.
2072189592Sbms		 */
2073189592Sbms		idx = imo->imo_num_memberships;
2074189592Sbms		imo->imo_membership[idx] = NULL;
2075189592Sbms		imo->imo_num_memberships++;
2076189592Sbms		KASSERT(imo->imo_mfilters != NULL,
2077189592Sbms		    ("%s: imf_mfilters vector was not allocated", __func__));
2078189592Sbms		imf = &imo->imo_mfilters[idx];
2079189592Sbms		KASSERT(RB_EMPTY(&imf->imf_sources),
2080189592Sbms		    ("%s: imf_sources not empty", __func__));
2081170613Sbms	}
2082170613Sbms
2083170613Sbms	/*
2084189592Sbms	 * Graft new source into filter list for this inpcb's
2085189592Sbms	 * membership of the group. The in_multi may not have
2086197132Sbms	 * been allocated yet if this is a new membership, however,
2087197132Sbms	 * the in_mfilter slot will be allocated and must be initialized.
2088197135Sbms	 *
2089197135Sbms	 * Note: Grafting of exclusive mode filters doesn't happen
2090197135Sbms	 * in this path.
2091197136Sbms	 * XXX: Should check for non-NULL lims (node exists but may
2092197136Sbms	 * not be in-mode) for interop with full-state API.
2093170613Sbms	 */
2094189592Sbms	if (ssa->ss.ss_family != AF_UNSPEC) {
2095189592Sbms		/* Membership starts in IN mode */
2096189592Sbms		if (is_new) {
2097189592Sbms			CTR1(KTR_IGMPV3, "%s: new join w/source", __func__);
2098189592Sbms			imf_init(imf, MCAST_UNDEFINED, MCAST_INCLUDE);
2099189592Sbms		} else {
2100189592Sbms			CTR2(KTR_IGMPV3, "%s: %s source", __func__, "allow");
2101189592Sbms		}
2102189592Sbms		lims = imf_graft(imf, MCAST_INCLUDE, &ssa->sin);
2103189592Sbms		if (lims == NULL) {
2104189592Sbms			CTR1(KTR_IGMPV3, "%s: merge imf state failed",
2105189592Sbms			    __func__);
2106189592Sbms			error = ENOMEM;
2107189592Sbms			goto out_imo_free;
2108189592Sbms		}
2109197132Sbms	} else {
2110197132Sbms		/* No address specified; Membership starts in EX mode */
2111197132Sbms		if (is_new) {
2112197132Sbms			CTR1(KTR_IGMPV3, "%s: new join w/o source", __func__);
2113197132Sbms			imf_init(imf, MCAST_UNDEFINED, MCAST_EXCLUDE);
2114197132Sbms		}
2115170613Sbms	}
2116170613Sbms
2117170613Sbms	/*
2118189592Sbms	 * Begin state merge transaction at IGMP layer.
2119170613Sbms	 */
2120189592Sbms	IN_MULTI_LOCK();
2121170613Sbms
2122189592Sbms	if (is_new) {
2123189592Sbms		error = in_joingroup_locked(ifp, &gsa->sin.sin_addr, imf,
2124189592Sbms		    &inm);
2125189592Sbms		if (error)
2126189592Sbms			goto out_imo_free;
2127189592Sbms		imo->imo_membership[idx] = inm;
2128189592Sbms	} else {
2129189592Sbms		CTR1(KTR_IGMPV3, "%s: merge inm state", __func__);
2130189592Sbms		error = inm_merge(inm, imf);
2131170613Sbms		if (error) {
2132189592Sbms			CTR1(KTR_IGMPV3, "%s: failed to merge inm state",
2133189592Sbms			    __func__);
2134189592Sbms			goto out_imf_rollback;
2135170613Sbms		}
2136189592Sbms		CTR1(KTR_IGMPV3, "%s: doing igmp downcall", __func__);
2137189592Sbms		error = igmp_change_state(inm);
2138189592Sbms		if (error) {
2139189592Sbms			CTR1(KTR_IGMPV3, "%s: failed igmp downcall",
2140189592Sbms			    __func__);
2141189592Sbms			goto out_imf_rollback;
2142189592Sbms		}
2143170613Sbms	}
2144170613Sbms
2145189592Sbms	IN_MULTI_UNLOCK();
2146189592Sbms
2147189592Sbmsout_imf_rollback:
2148189592Sbms	INP_WLOCK_ASSERT(inp);
2149189592Sbms	if (error) {
2150189592Sbms		imf_rollback(imf);
2151189592Sbms		if (is_new)
2152189592Sbms			imf_purge(imf);
2153189592Sbms		else
2154189592Sbms			imf_reap(imf);
2155189592Sbms	} else {
2156189592Sbms		imf_commit(imf);
2157189592Sbms	}
2158189592Sbms
2159189592Sbmsout_imo_free:
2160189592Sbms	if (error && is_new) {
2161189592Sbms		imo->imo_membership[idx] = NULL;
2162189592Sbms		--imo->imo_num_memberships;
2163189592Sbms	}
2164189592Sbms
2165189592Sbmsout_inp_locked:
2166178285Srwatson	INP_WUNLOCK(inp);
2167170613Sbms	return (error);
2168170613Sbms}
2169170613Sbms
2170170613Sbms/*
2171170613Sbms * Leave an IPv4 multicast group on an inpcb, possibly with a source.
2172170613Sbms */
2173170613Sbmsstatic int
2174170613Sbmsinp_leave_group(struct inpcb *inp, struct sockopt *sopt)
2175170613Sbms{
2176170613Sbms	struct group_source_req		 gsr;
2177170613Sbms	struct ip_mreq_source		 mreqs;
2178170613Sbms	sockunion_t			*gsa, *ssa;
2179170613Sbms	struct ifnet			*ifp;
2180170613Sbms	struct in_mfilter		*imf;
2181170613Sbms	struct ip_moptions		*imo;
2182189592Sbms	struct in_msource		*ims;
2183170613Sbms	struct in_multi			*inm;
2184170613Sbms	size_t				 idx;
2185189592Sbms	int				 error, is_final;
2186170613Sbms
2187170613Sbms	ifp = NULL;
2188170613Sbms	error = 0;
2189189592Sbms	is_final = 1;
2190170613Sbms
2191170613Sbms	memset(&gsr, 0, sizeof(struct group_source_req));
2192170613Sbms	gsa = (sockunion_t *)&gsr.gsr_group;
2193170613Sbms	gsa->ss.ss_family = AF_UNSPEC;
2194170613Sbms	ssa = (sockunion_t *)&gsr.gsr_source;
2195170613Sbms	ssa->ss.ss_family = AF_UNSPEC;
2196170613Sbms
2197170613Sbms	switch (sopt->sopt_name) {
2198170613Sbms	case IP_DROP_MEMBERSHIP:
2199170613Sbms	case IP_DROP_SOURCE_MEMBERSHIP:
2200170613Sbms		if (sopt->sopt_name == IP_DROP_MEMBERSHIP) {
2201170613Sbms			error = sooptcopyin(sopt, &mreqs,
2202170613Sbms			    sizeof(struct ip_mreq),
2203170613Sbms			    sizeof(struct ip_mreq));
2204170613Sbms			/*
2205170613Sbms			 * Swap interface and sourceaddr arguments,
2206170613Sbms			 * as ip_mreq and ip_mreq_source are laid
2207170613Sbms			 * out differently.
2208170613Sbms			 */
2209170613Sbms			mreqs.imr_interface = mreqs.imr_sourceaddr;
2210170613Sbms			mreqs.imr_sourceaddr.s_addr = INADDR_ANY;
2211170613Sbms		} else if (sopt->sopt_name == IP_DROP_SOURCE_MEMBERSHIP) {
2212170613Sbms			error = sooptcopyin(sopt, &mreqs,
2213170613Sbms			    sizeof(struct ip_mreq_source),
2214170613Sbms			    sizeof(struct ip_mreq_source));
2215170613Sbms		}
2216170613Sbms		if (error)
2217170613Sbms			return (error);
2218170613Sbms
2219170613Sbms		gsa->sin.sin_family = AF_INET;
2220170613Sbms		gsa->sin.sin_len = sizeof(struct sockaddr_in);
2221170613Sbms		gsa->sin.sin_addr = mreqs.imr_multiaddr;
2222170613Sbms
2223170613Sbms		if (sopt->sopt_name == IP_DROP_SOURCE_MEMBERSHIP) {
2224170613Sbms			ssa->sin.sin_family = AF_INET;
2225170613Sbms			ssa->sin.sin_len = sizeof(struct sockaddr_in);
2226170613Sbms			ssa->sin.sin_addr = mreqs.imr_sourceaddr;
2227170613Sbms		}
2228170613Sbms
2229206452Sbms		/*
2230206452Sbms		 * Attempt to look up hinted ifp from interface address.
2231206452Sbms		 * Fallthrough with null ifp iff lookup fails, to
2232206452Sbms		 * preserve 4.4BSD mcast API idempotence.
2233206452Sbms		 * XXX NOTE WELL: The RFC 3678 API is preferred because
2234206452Sbms		 * using an IPv4 address as a key is racy.
2235206452Sbms		 */
2236206452Sbms		if (!in_nullhost(mreqs.imr_interface))
2237170613Sbms			INADDR_TO_IFP(mreqs.imr_interface, ifp);
2238170613Sbms
2239189592Sbms		CTR3(KTR_IGMPV3, "%s: imr_interface = %s, ifp = %p",
2240189592Sbms		    __func__, inet_ntoa(mreqs.imr_interface), ifp);
2241189592Sbms
2242170613Sbms		break;
2243170613Sbms
2244170613Sbms	case MCAST_LEAVE_GROUP:
2245170613Sbms	case MCAST_LEAVE_SOURCE_GROUP:
2246170613Sbms		if (sopt->sopt_name == MCAST_LEAVE_GROUP) {
2247170613Sbms			error = sooptcopyin(sopt, &gsr,
2248170613Sbms			    sizeof(struct group_req),
2249170613Sbms			    sizeof(struct group_req));
2250170613Sbms		} else if (sopt->sopt_name == MCAST_LEAVE_SOURCE_GROUP) {
2251170613Sbms			error = sooptcopyin(sopt, &gsr,
2252170613Sbms			    sizeof(struct group_source_req),
2253170613Sbms			    sizeof(struct group_source_req));
2254170613Sbms		}
2255170613Sbms		if (error)
2256170613Sbms			return (error);
2257170613Sbms
2258170613Sbms		if (gsa->sin.sin_family != AF_INET ||
2259170613Sbms		    gsa->sin.sin_len != sizeof(struct sockaddr_in))
2260170613Sbms			return (EINVAL);
2261170613Sbms
2262170613Sbms		if (sopt->sopt_name == MCAST_LEAVE_SOURCE_GROUP) {
2263170613Sbms			if (ssa->sin.sin_family != AF_INET ||
2264170613Sbms			    ssa->sin.sin_len != sizeof(struct sockaddr_in))
2265170613Sbms				return (EINVAL);
2266170613Sbms		}
2267170613Sbms
2268181803Sbz		if (gsr.gsr_interface == 0 || V_if_index < gsr.gsr_interface)
2269170613Sbms			return (EADDRNOTAVAIL);
2270170613Sbms
2271170613Sbms		ifp = ifnet_byindex(gsr.gsr_interface);
2272206452Sbms
2273206452Sbms		if (ifp == NULL)
2274206452Sbms			return (EADDRNOTAVAIL);
2275170613Sbms		break;
2276170613Sbms
2277170613Sbms	default:
2278189592Sbms		CTR2(KTR_IGMPV3, "%s: unknown sopt_name %d",
2279189592Sbms		    __func__, sopt->sopt_name);
2280170613Sbms		return (EOPNOTSUPP);
2281170613Sbms		break;
2282170613Sbms	}
2283170613Sbms
2284170613Sbms	if (!IN_MULTICAST(ntohl(gsa->sin.sin_addr.s_addr)))
2285170613Sbms		return (EINVAL);
2286170613Sbms
2287170613Sbms	/*
2288170613Sbms	 * Find the membership in the membership array.
2289170613Sbms	 */
2290170613Sbms	imo = inp_findmoptions(inp);
2291170613Sbms	idx = imo_match_group(imo, ifp, &gsa->sa);
2292170613Sbms	if (idx == -1) {
2293170613Sbms		error = EADDRNOTAVAIL;
2294189592Sbms		goto out_inp_locked;
2295170613Sbms	}
2296189592Sbms	inm = imo->imo_membership[idx];
2297170613Sbms	imf = &imo->imo_mfilters[idx];
2298170613Sbms
2299189592Sbms	if (ssa->ss.ss_family != AF_UNSPEC)
2300189592Sbms		is_final = 0;
2301189592Sbms
2302170613Sbms	/*
2303189592Sbms	 * Begin state merge transaction at socket layer.
2304189592Sbms	 */
2305189592Sbms	INP_WLOCK_ASSERT(inp);
2306189592Sbms
2307189592Sbms	/*
2308170613Sbms	 * If we were instructed only to leave a given source, do so.
2309189592Sbms	 * MCAST_LEAVE_SOURCE_GROUP is only valid for inclusive memberships.
2310170613Sbms	 */
2311189592Sbms	if (is_final) {
2312189592Sbms		imf_leave(imf);
2313189592Sbms	} else {
2314189592Sbms		if (imf->imf_st[0] == MCAST_EXCLUDE) {
2315189592Sbms			error = EADDRNOTAVAIL;
2316189592Sbms			goto out_inp_locked;
2317170613Sbms		}
2318189592Sbms		ims = imo_match_source(imo, idx, &ssa->sa);
2319189592Sbms		if (ims == NULL) {
2320189592Sbms			CTR3(KTR_IGMPV3, "%s: source %s %spresent", __func__,
2321189592Sbms			    inet_ntoa(ssa->sin.sin_addr), "not ");
2322189592Sbms			error = EADDRNOTAVAIL;
2323189592Sbms			goto out_inp_locked;
2324189592Sbms		}
2325189592Sbms		CTR2(KTR_IGMPV3, "%s: %s source", __func__, "block");
2326189592Sbms		error = imf_prune(imf, &ssa->sin);
2327189592Sbms		if (error) {
2328189592Sbms			CTR1(KTR_IGMPV3, "%s: merge imf state failed",
2329189592Sbms			    __func__);
2330189592Sbms			goto out_inp_locked;
2331189592Sbms		}
2332170613Sbms	}
2333170613Sbms
2334170613Sbms	/*
2335189592Sbms	 * Begin state merge transaction at IGMP layer.
2336170613Sbms	 */
2337189592Sbms	IN_MULTI_LOCK();
2338170613Sbms
2339189592Sbms	if (is_final) {
2340189592Sbms		/*
2341189592Sbms		 * Give up the multicast address record to which
2342189592Sbms		 * the membership points.
2343189592Sbms		 */
2344189592Sbms		(void)in_leavegroup_locked(inm, imf);
2345189592Sbms	} else {
2346189592Sbms		CTR1(KTR_IGMPV3, "%s: merge inm state", __func__);
2347189592Sbms		error = inm_merge(inm, imf);
2348189592Sbms		if (error) {
2349189592Sbms			CTR1(KTR_IGMPV3, "%s: failed to merge inm state",
2350189592Sbms			    __func__);
2351189592Sbms			goto out_imf_rollback;
2352170613Sbms		}
2353189592Sbms
2354189592Sbms		CTR1(KTR_IGMPV3, "%s: doing igmp downcall", __func__);
2355189592Sbms		error = igmp_change_state(inm);
2356189592Sbms		if (error) {
2357189592Sbms			CTR1(KTR_IGMPV3, "%s: failed igmp downcall",
2358189592Sbms			    __func__);
2359189592Sbms		}
2360170613Sbms	}
2361170613Sbms
2362189592Sbms	IN_MULTI_UNLOCK();
2363170613Sbms
2364189592Sbmsout_imf_rollback:
2365189592Sbms	if (error)
2366189592Sbms		imf_rollback(imf);
2367189592Sbms	else
2368189592Sbms		imf_commit(imf);
2369189592Sbms
2370189592Sbms	imf_reap(imf);
2371189592Sbms
2372189592Sbms	if (is_final) {
2373197130Sbms		/* Remove the gap in the membership and filter array. */
2374197130Sbms		for (++idx; idx < imo->imo_num_memberships; ++idx) {
2375189592Sbms			imo->imo_membership[idx-1] = imo->imo_membership[idx];
2376197130Sbms			imo->imo_mfilters[idx-1] = imo->imo_mfilters[idx];
2377197130Sbms		}
2378189592Sbms		imo->imo_num_memberships--;
2379189592Sbms	}
2380189592Sbms
2381189592Sbmsout_inp_locked:
2382178285Srwatson	INP_WUNLOCK(inp);
2383170613Sbms	return (error);
2384170613Sbms}
2385170613Sbms
2386170613Sbms/*
2387170613Sbms * Select the interface for transmitting IPv4 multicast datagrams.
2388170613Sbms *
2389170613Sbms * Either an instance of struct in_addr or an instance of struct ip_mreqn
2390170613Sbms * may be passed to this socket option. An address of INADDR_ANY or an
2391170613Sbms * interface index of 0 is used to remove a previous selection.
2392170613Sbms * When no interface is selected, one is chosen for every send.
2393170613Sbms */
2394170613Sbmsstatic int
2395170613Sbmsinp_set_multicast_if(struct inpcb *inp, struct sockopt *sopt)
2396170613Sbms{
2397170613Sbms	struct in_addr		 addr;
2398170613Sbms	struct ip_mreqn		 mreqn;
2399170613Sbms	struct ifnet		*ifp;
2400170613Sbms	struct ip_moptions	*imo;
2401170613Sbms	int			 error;
2402170613Sbms
2403170613Sbms	if (sopt->sopt_valsize == sizeof(struct ip_mreqn)) {
2404170613Sbms		/*
2405170613Sbms		 * An interface index was specified using the
2406170613Sbms		 * Linux-derived ip_mreqn structure.
2407170613Sbms		 */
2408170613Sbms		error = sooptcopyin(sopt, &mreqn, sizeof(struct ip_mreqn),
2409170613Sbms		    sizeof(struct ip_mreqn));
2410170613Sbms		if (error)
2411170613Sbms			return (error);
2412170613Sbms
2413181803Sbz		if (mreqn.imr_ifindex < 0 || V_if_index < mreqn.imr_ifindex)
2414170613Sbms			return (EINVAL);
2415170613Sbms
2416170613Sbms		if (mreqn.imr_ifindex == 0) {
2417170613Sbms			ifp = NULL;
2418170613Sbms		} else {
2419170613Sbms			ifp = ifnet_byindex(mreqn.imr_ifindex);
2420170613Sbms			if (ifp == NULL)
2421170613Sbms				return (EADDRNOTAVAIL);
2422170613Sbms		}
2423170613Sbms	} else {
2424170613Sbms		/*
2425170613Sbms		 * An interface was specified by IPv4 address.
2426170613Sbms		 * This is the traditional BSD usage.
2427170613Sbms		 */
2428170613Sbms		error = sooptcopyin(sopt, &addr, sizeof(struct in_addr),
2429170613Sbms		    sizeof(struct in_addr));
2430170613Sbms		if (error)
2431170613Sbms			return (error);
2432189592Sbms		if (in_nullhost(addr)) {
2433170613Sbms			ifp = NULL;
2434170613Sbms		} else {
2435170613Sbms			INADDR_TO_IFP(addr, ifp);
2436170613Sbms			if (ifp == NULL)
2437170613Sbms				return (EADDRNOTAVAIL);
2438170613Sbms		}
2439189592Sbms		CTR3(KTR_IGMPV3, "%s: ifp = %p, addr = %s", __func__, ifp,
2440189592Sbms		    inet_ntoa(addr));
2441170613Sbms	}
2442170613Sbms
2443170613Sbms	/* Reject interfaces which do not support multicast. */
2444170613Sbms	if (ifp != NULL && (ifp->if_flags & IFF_MULTICAST) == 0)
2445170613Sbms		return (EOPNOTSUPP);
2446170613Sbms
2447170613Sbms	imo = inp_findmoptions(inp);
2448170613Sbms	imo->imo_multicast_ifp = ifp;
2449170613Sbms	imo->imo_multicast_addr.s_addr = INADDR_ANY;
2450178285Srwatson	INP_WUNLOCK(inp);
2451170613Sbms
2452170613Sbms	return (0);
2453170613Sbms}
2454170613Sbms
2455170613Sbms/*
2456170613Sbms * Atomically set source filters on a socket for an IPv4 multicast group.
2457189592Sbms *
2458189592Sbms * SMPng: NOTE: Potentially calls malloc(M_WAITOK) with Giant held.
2459170613Sbms */
2460170613Sbmsstatic int
2461170613Sbmsinp_set_source_filters(struct inpcb *inp, struct sockopt *sopt)
2462170613Sbms{
2463170613Sbms	struct __msfilterreq	 msfr;
2464170613Sbms	sockunion_t		*gsa;
2465170613Sbms	struct ifnet		*ifp;
2466170613Sbms	struct in_mfilter	*imf;
2467170613Sbms	struct ip_moptions	*imo;
2468189592Sbms	struct in_multi		*inm;
2469170613Sbms	size_t			 idx;
2470170613Sbms	int			 error;
2471170613Sbms
2472170613Sbms	error = sooptcopyin(sopt, &msfr, sizeof(struct __msfilterreq),
2473170613Sbms	    sizeof(struct __msfilterreq));
2474170613Sbms	if (error)
2475170613Sbms		return (error);
2476170613Sbms
2477197314Sbms	if (msfr.msfr_nsrcs > in_mcast_maxsocksrc)
2478197314Sbms		return (ENOBUFS);
2479197314Sbms
2480197314Sbms	if ((msfr.msfr_fmode != MCAST_EXCLUDE &&
2481170613Sbms	     msfr.msfr_fmode != MCAST_INCLUDE))
2482170613Sbms		return (EINVAL);
2483170613Sbms
2484170613Sbms	if (msfr.msfr_group.ss_family != AF_INET ||
2485170613Sbms	    msfr.msfr_group.ss_len != sizeof(struct sockaddr_in))
2486170613Sbms		return (EINVAL);
2487170613Sbms
2488170613Sbms	gsa = (sockunion_t *)&msfr.msfr_group;
2489170613Sbms	if (!IN_MULTICAST(ntohl(gsa->sin.sin_addr.s_addr)))
2490170613Sbms		return (EINVAL);
2491170613Sbms
2492170613Sbms	gsa->sin.sin_port = 0;	/* ignore port */
2493170613Sbms
2494181803Sbz	if (msfr.msfr_ifindex == 0 || V_if_index < msfr.msfr_ifindex)
2495170613Sbms		return (EADDRNOTAVAIL);
2496170613Sbms
2497170613Sbms	ifp = ifnet_byindex(msfr.msfr_ifindex);
2498170613Sbms	if (ifp == NULL)
2499170613Sbms		return (EADDRNOTAVAIL);
2500170613Sbms
2501170613Sbms	/*
2502189592Sbms	 * Take the INP write lock.
2503170613Sbms	 * Check if this socket is a member of this group.
2504170613Sbms	 */
2505170613Sbms	imo = inp_findmoptions(inp);
2506170613Sbms	idx = imo_match_group(imo, ifp, &gsa->sa);
2507170613Sbms	if (idx == -1 || imo->imo_mfilters == NULL) {
2508170613Sbms		error = EADDRNOTAVAIL;
2509189592Sbms		goto out_inp_locked;
2510170613Sbms	}
2511189592Sbms	inm = imo->imo_membership[idx];
2512170613Sbms	imf = &imo->imo_mfilters[idx];
2513170613Sbms
2514170613Sbms	/*
2515189592Sbms	 * Begin state merge transaction at socket layer.
2516170613Sbms	 */
2517189592Sbms	INP_WLOCK_ASSERT(inp);
2518170613Sbms
2519189592Sbms	imf->imf_st[1] = msfr.msfr_fmode;
2520189592Sbms
2521170613Sbms	/*
2522170613Sbms	 * Apply any new source filters, if present.
2523189592Sbms	 * Make a copy of the user-space source vector so
2524189592Sbms	 * that we may copy them with a single copyin. This
2525189592Sbms	 * allows us to deal with page faults up-front.
2526170613Sbms	 */
2527170613Sbms	if (msfr.msfr_nsrcs > 0) {
2528189592Sbms		struct in_msource	*lims;
2529189592Sbms		struct sockaddr_in	*psin;
2530189592Sbms		struct sockaddr_storage	*kss, *pkss;
2531189592Sbms		int			 i;
2532170613Sbms
2533178285Srwatson		INP_WUNLOCK(inp);
2534189592Sbms
2535189592Sbms		CTR2(KTR_IGMPV3, "%s: loading %lu source list entries",
2536189592Sbms		    __func__, (unsigned long)msfr.msfr_nsrcs);
2537184214Sdes		kss = malloc(sizeof(struct sockaddr_storage) * msfr.msfr_nsrcs,
2538170613Sbms		    M_TEMP, M_WAITOK);
2539170613Sbms		error = copyin(msfr.msfr_srcs, kss,
2540170613Sbms		    sizeof(struct sockaddr_storage) * msfr.msfr_nsrcs);
2541170613Sbms		if (error) {
2542184205Sdes			free(kss, M_TEMP);
2543170613Sbms			return (error);
2544170613Sbms		}
2545170613Sbms
2546189592Sbms		INP_WLOCK(inp);
2547189592Sbms
2548170613Sbms		/*
2549189592Sbms		 * Mark all source filters as UNDEFINED at t1.
2550189592Sbms		 * Restore new group filter mode, as imf_leave()
2551189592Sbms		 * will set it to INCLUDE.
2552170613Sbms		 */
2553189592Sbms		imf_leave(imf);
2554189592Sbms		imf->imf_st[1] = msfr.msfr_fmode;
2555189592Sbms
2556189592Sbms		/*
2557189592Sbms		 * Update socket layer filters at t1, lazy-allocating
2558189592Sbms		 * new entries. This saves a bunch of memory at the
2559189592Sbms		 * cost of one RB_FIND() per source entry; duplicate
2560189592Sbms		 * entries in the msfr_nsrcs vector are ignored.
2561189592Sbms		 * If we encounter an error, rollback transaction.
2562189592Sbms		 *
2563189592Sbms		 * XXX This too could be replaced with a set-symmetric
2564189592Sbms		 * difference like loop to avoid walking from root
2565189592Sbms		 * every time, as the key space is common.
2566189592Sbms		 */
2567189592Sbms		for (i = 0, pkss = kss; i < msfr.msfr_nsrcs; i++, pkss++) {
2568189592Sbms			psin = (struct sockaddr_in *)pkss;
2569189592Sbms			if (psin->sin_family != AF_INET) {
2570170613Sbms				error = EAFNOSUPPORT;
2571170613Sbms				break;
2572170613Sbms			}
2573189592Sbms			if (psin->sin_len != sizeof(struct sockaddr_in)) {
2574189592Sbms				error = EINVAL;
2575189592Sbms				break;
2576189592Sbms			}
2577189592Sbms			error = imf_get_source(imf, psin, &lims);
2578170613Sbms			if (error)
2579170613Sbms				break;
2580189592Sbms			lims->imsl_st[1] = imf->imf_st[1];
2581170613Sbms		}
2582189592Sbms		free(kss, M_TEMP);
2583189592Sbms	}
2584170613Sbms
2585189592Sbms	if (error)
2586189592Sbms		goto out_imf_rollback;
2587170613Sbms
2588189592Sbms	INP_WLOCK_ASSERT(inp);
2589189592Sbms	IN_MULTI_LOCK();
2590170613Sbms
2591170613Sbms	/*
2592189592Sbms	 * Begin state merge transaction at IGMP layer.
2593170613Sbms	 */
2594189592Sbms	CTR1(KTR_IGMPV3, "%s: merge inm state", __func__);
2595189592Sbms	error = inm_merge(inm, imf);
2596189592Sbms	if (error) {
2597189592Sbms		CTR1(KTR_IGMPV3, "%s: failed to merge inm state", __func__);
2598189592Sbms		goto out_imf_rollback;
2599189592Sbms	}
2600170613Sbms
2601189592Sbms	CTR1(KTR_IGMPV3, "%s: doing igmp downcall", __func__);
2602189592Sbms	error = igmp_change_state(inm);
2603189592Sbms	if (error)
2604189592Sbms		CTR1(KTR_IGMPV3, "%s: failed igmp downcall", __func__);
2605189592Sbms
2606189592Sbms	IN_MULTI_UNLOCK();
2607189592Sbms
2608189592Sbmsout_imf_rollback:
2609189592Sbms	if (error)
2610189592Sbms		imf_rollback(imf);
2611189592Sbms	else
2612189592Sbms		imf_commit(imf);
2613189592Sbms
2614189592Sbms	imf_reap(imf);
2615189592Sbms
2616189592Sbmsout_inp_locked:
2617178285Srwatson	INP_WUNLOCK(inp);
2618170613Sbms	return (error);
2619170613Sbms}
2620170613Sbms
2621170613Sbms/*
2622170613Sbms * Set the IP multicast options in response to user setsockopt().
2623170613Sbms *
2624170613Sbms * Many of the socket options handled in this function duplicate the
2625170613Sbms * functionality of socket options in the regular unicast API. However,
2626170613Sbms * it is not possible to merge the duplicate code, because the idempotence
2627170613Sbms * of the IPv4 multicast part of the BSD Sockets API must be preserved;
2628170613Sbms * the effects of these options must be treated as separate and distinct.
2629189592Sbms *
2630189592Sbms * SMPng: XXX: Unlocked read of inp_socket believed OK.
2631189592Sbms * FUTURE: The IP_MULTICAST_VIF option may be eliminated if MROUTING
2632189592Sbms * is refactored to no longer use vifs.
2633170613Sbms */
2634170613Sbmsint
2635170613Sbmsinp_setmoptions(struct inpcb *inp, struct sockopt *sopt)
2636170613Sbms{
2637170613Sbms	struct ip_moptions	*imo;
2638170613Sbms	int			 error;
2639170613Sbms
2640170613Sbms	error = 0;
2641170613Sbms
2642171746Scsjp	/*
2643171746Scsjp	 * If socket is neither of type SOCK_RAW or SOCK_DGRAM,
2644171746Scsjp	 * or is a divert socket, reject it.
2645171746Scsjp	 */
2646171746Scsjp	if (inp->inp_socket->so_proto->pr_protocol == IPPROTO_DIVERT ||
2647171746Scsjp	    (inp->inp_socket->so_proto->pr_type != SOCK_RAW &&
2648189592Sbms	     inp->inp_socket->so_proto->pr_type != SOCK_DGRAM))
2649171746Scsjp		return (EOPNOTSUPP);
2650171746Scsjp
2651170613Sbms	switch (sopt->sopt_name) {
2652170613Sbms	case IP_MULTICAST_VIF: {
2653170613Sbms		int vifi;
2654170613Sbms		/*
2655170613Sbms		 * Select a multicast VIF for transmission.
2656170613Sbms		 * Only useful if multicast forwarding is active.
2657170613Sbms		 */
2658170613Sbms		if (legal_vif_num == NULL) {
2659170613Sbms			error = EOPNOTSUPP;
2660170613Sbms			break;
2661170613Sbms		}
2662170613Sbms		error = sooptcopyin(sopt, &vifi, sizeof(int), sizeof(int));
2663170613Sbms		if (error)
2664170613Sbms			break;
2665170613Sbms		if (!legal_vif_num(vifi) && (vifi != -1)) {
2666170613Sbms			error = EINVAL;
2667170613Sbms			break;
2668170613Sbms		}
2669170613Sbms		imo = inp_findmoptions(inp);
2670170613Sbms		imo->imo_multicast_vif = vifi;
2671178285Srwatson		INP_WUNLOCK(inp);
2672170613Sbms		break;
2673170613Sbms	}
2674170613Sbms
2675170613Sbms	case IP_MULTICAST_IF:
2676170613Sbms		error = inp_set_multicast_if(inp, sopt);
2677170613Sbms		break;
2678170613Sbms
2679170613Sbms	case IP_MULTICAST_TTL: {
2680170613Sbms		u_char ttl;
2681170613Sbms
2682170613Sbms		/*
2683170613Sbms		 * Set the IP time-to-live for outgoing multicast packets.
2684170613Sbms		 * The original multicast API required a char argument,
2685170613Sbms		 * which is inconsistent with the rest of the socket API.
2686170613Sbms		 * We allow either a char or an int.
2687170613Sbms		 */
2688170613Sbms		if (sopt->sopt_valsize == sizeof(u_char)) {
2689170613Sbms			error = sooptcopyin(sopt, &ttl, sizeof(u_char),
2690170613Sbms			    sizeof(u_char));
2691170613Sbms			if (error)
2692170613Sbms				break;
2693170613Sbms		} else {
2694170613Sbms			u_int ittl;
2695170613Sbms
2696170613Sbms			error = sooptcopyin(sopt, &ittl, sizeof(u_int),
2697170613Sbms			    sizeof(u_int));
2698170613Sbms			if (error)
2699170613Sbms				break;
2700170613Sbms			if (ittl > 255) {
2701170613Sbms				error = EINVAL;
2702170613Sbms				break;
2703170613Sbms			}
2704170613Sbms			ttl = (u_char)ittl;
2705170613Sbms		}
2706170613Sbms		imo = inp_findmoptions(inp);
2707170613Sbms		imo->imo_multicast_ttl = ttl;
2708178285Srwatson		INP_WUNLOCK(inp);
2709170613Sbms		break;
2710170613Sbms	}
2711170613Sbms
2712170613Sbms	case IP_MULTICAST_LOOP: {
2713170613Sbms		u_char loop;
2714170613Sbms
2715170613Sbms		/*
2716170613Sbms		 * Set the loopback flag for outgoing multicast packets.
2717170613Sbms		 * Must be zero or one.  The original multicast API required a
2718170613Sbms		 * char argument, which is inconsistent with the rest
2719170613Sbms		 * of the socket API.  We allow either a char or an int.
2720170613Sbms		 */
2721170613Sbms		if (sopt->sopt_valsize == sizeof(u_char)) {
2722170613Sbms			error = sooptcopyin(sopt, &loop, sizeof(u_char),
2723170613Sbms			    sizeof(u_char));
2724170613Sbms			if (error)
2725170613Sbms				break;
2726170613Sbms		} else {
2727170613Sbms			u_int iloop;
2728170613Sbms
2729170613Sbms			error = sooptcopyin(sopt, &iloop, sizeof(u_int),
2730170613Sbms					    sizeof(u_int));
2731170613Sbms			if (error)
2732170613Sbms				break;
2733170613Sbms			loop = (u_char)iloop;
2734170613Sbms		}
2735170613Sbms		imo = inp_findmoptions(inp);
2736170613Sbms		imo->imo_multicast_loop = !!loop;
2737178285Srwatson		INP_WUNLOCK(inp);
2738170613Sbms		break;
2739170613Sbms	}
2740170613Sbms
2741170613Sbms	case IP_ADD_MEMBERSHIP:
2742170613Sbms	case IP_ADD_SOURCE_MEMBERSHIP:
2743170613Sbms	case MCAST_JOIN_GROUP:
2744170613Sbms	case MCAST_JOIN_SOURCE_GROUP:
2745170613Sbms		error = inp_join_group(inp, sopt);
2746170613Sbms		break;
2747170613Sbms
2748170613Sbms	case IP_DROP_MEMBERSHIP:
2749170613Sbms	case IP_DROP_SOURCE_MEMBERSHIP:
2750170613Sbms	case MCAST_LEAVE_GROUP:
2751170613Sbms	case MCAST_LEAVE_SOURCE_GROUP:
2752170613Sbms		error = inp_leave_group(inp, sopt);
2753170613Sbms		break;
2754170613Sbms
2755170613Sbms	case IP_BLOCK_SOURCE:
2756170613Sbms	case IP_UNBLOCK_SOURCE:
2757170613Sbms	case MCAST_BLOCK_SOURCE:
2758170613Sbms	case MCAST_UNBLOCK_SOURCE:
2759189592Sbms		error = inp_block_unblock_source(inp, sopt);
2760170613Sbms		break;
2761170613Sbms
2762170613Sbms	case IP_MSFILTER:
2763170613Sbms		error = inp_set_source_filters(inp, sopt);
2764170613Sbms		break;
2765170613Sbms
2766170613Sbms	default:
2767170613Sbms		error = EOPNOTSUPP;
2768170613Sbms		break;
2769170613Sbms	}
2770170613Sbms
2771170613Sbms	INP_UNLOCK_ASSERT(inp);
2772170613Sbms
2773170613Sbms	return (error);
2774170613Sbms}
2775189592Sbms
2776189592Sbms/*
2777189592Sbms * Expose IGMP's multicast filter mode and source list(s) to userland,
2778189592Sbms * keyed by (ifindex, group).
2779189592Sbms * The filter mode is written out as a uint32_t, followed by
2780189592Sbms * 0..n of struct in_addr.
2781189592Sbms * For use by ifmcstat(8).
2782189592Sbms * SMPng: NOTE: unlocked read of ifindex space.
2783189592Sbms */
2784189592Sbmsstatic int
2785189592Sbmssysctl_ip_mcast_filters(SYSCTL_HANDLER_ARGS)
2786189592Sbms{
2787189592Sbms	struct in_addr			 src, group;
2788189592Sbms	struct ifnet			*ifp;
2789189592Sbms	struct ifmultiaddr		*ifma;
2790189592Sbms	struct in_multi			*inm;
2791189592Sbms	struct ip_msource		*ims;
2792189592Sbms	int				*name;
2793189592Sbms	int				 retval;
2794189592Sbms	u_int				 namelen;
2795189592Sbms	uint32_t			 fmode, ifindex;
2796189592Sbms
2797189592Sbms	name = (int *)arg1;
2798189592Sbms	namelen = arg2;
2799189592Sbms
2800189592Sbms	if (req->newptr != NULL)
2801189592Sbms		return (EPERM);
2802189592Sbms
2803189592Sbms	if (namelen != 2)
2804189592Sbms		return (EINVAL);
2805189592Sbms
2806189592Sbms	ifindex = name[0];
2807189592Sbms	if (ifindex <= 0 || ifindex > V_if_index) {
2808189592Sbms		CTR2(KTR_IGMPV3, "%s: ifindex %u out of range",
2809189592Sbms		    __func__, ifindex);
2810189592Sbms		return (ENOENT);
2811189592Sbms	}
2812189592Sbms
2813189592Sbms	group.s_addr = name[1];
2814189592Sbms	if (!IN_MULTICAST(ntohl(group.s_addr))) {
2815189592Sbms		CTR2(KTR_IGMPV3, "%s: group %s is not multicast",
2816189592Sbms		    __func__, inet_ntoa(group));
2817189592Sbms		return (EINVAL);
2818189592Sbms	}
2819189592Sbms
2820189592Sbms	ifp = ifnet_byindex(ifindex);
2821189592Sbms	if (ifp == NULL) {
2822189592Sbms		CTR2(KTR_IGMPV3, "%s: no ifp for ifindex %u",
2823189592Sbms		    __func__, ifindex);
2824189592Sbms		return (ENOENT);
2825189592Sbms	}
2826189592Sbms
2827189592Sbms	retval = sysctl_wire_old_buffer(req,
2828189592Sbms	    sizeof(uint32_t) + (in_mcast_maxgrpsrc * sizeof(struct in_addr)));
2829189592Sbms	if (retval)
2830189592Sbms		return (retval);
2831189592Sbms
2832189592Sbms	IN_MULTI_LOCK();
2833189592Sbms
2834229621Sjhb	IF_ADDR_RLOCK(ifp);
2835189592Sbms	TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
2836189592Sbms		if (ifma->ifma_addr->sa_family != AF_INET ||
2837189592Sbms		    ifma->ifma_protospec == NULL)
2838189592Sbms			continue;
2839189592Sbms		inm = (struct in_multi *)ifma->ifma_protospec;
2840189592Sbms		if (!in_hosteq(inm->inm_addr, group))
2841189592Sbms			continue;
2842189592Sbms		fmode = inm->inm_st[1].iss_fmode;
2843189592Sbms		retval = SYSCTL_OUT(req, &fmode, sizeof(uint32_t));
2844189592Sbms		if (retval != 0)
2845189592Sbms			break;
2846189592Sbms		RB_FOREACH(ims, ip_msource_tree, &inm->inm_srcs) {
2847189592Sbms#ifdef KTR
2848189592Sbms			struct in_addr ina;
2849189592Sbms			ina.s_addr = htonl(ims->ims_haddr);
2850189592Sbms			CTR2(KTR_IGMPV3, "%s: visit node %s", __func__,
2851189592Sbms			    inet_ntoa(ina));
2852189592Sbms#endif
2853189592Sbms			/*
2854189592Sbms			 * Only copy-out sources which are in-mode.
2855189592Sbms			 */
2856189592Sbms			if (fmode != ims_get_mode(inm, ims, 1)) {
2857189592Sbms				CTR1(KTR_IGMPV3, "%s: skip non-in-mode",
2858189592Sbms				    __func__);
2859189592Sbms				continue;
2860189592Sbms			}
2861189592Sbms			src.s_addr = htonl(ims->ims_haddr);
2862189592Sbms			retval = SYSCTL_OUT(req, &src, sizeof(struct in_addr));
2863189592Sbms			if (retval != 0)
2864189592Sbms				break;
2865189592Sbms		}
2866189592Sbms	}
2867229621Sjhb	IF_ADDR_RUNLOCK(ifp);
2868189592Sbms
2869189592Sbms	IN_MULTI_UNLOCK();
2870189592Sbms
2871189592Sbms	return (retval);
2872189592Sbms}
2873189592Sbms
2874189592Sbms#ifdef KTR
2875189592Sbms
2876189592Sbmsstatic const char *inm_modestrs[] = { "un", "in", "ex" };
2877189592Sbms
2878189592Sbmsstatic const char *
2879189592Sbmsinm_mode_str(const int mode)
2880189592Sbms{
2881189592Sbms
2882189592Sbms	if (mode >= MCAST_UNDEFINED && mode <= MCAST_EXCLUDE)
2883189592Sbms		return (inm_modestrs[mode]);
2884189592Sbms	return ("??");
2885189592Sbms}
2886189592Sbms
2887189592Sbmsstatic const char *inm_statestrs[] = {
2888189592Sbms	"not-member",
2889189592Sbms	"silent",
2890189592Sbms	"idle",
2891189592Sbms	"lazy",
2892189592Sbms	"sleeping",
2893189592Sbms	"awakening",
2894189592Sbms	"query-pending",
2895189592Sbms	"sg-query-pending",
2896189592Sbms	"leaving"
2897189592Sbms};
2898189592Sbms
2899189592Sbmsstatic const char *
2900189592Sbmsinm_state_str(const int state)
2901189592Sbms{
2902189592Sbms
2903189592Sbms	if (state >= IGMP_NOT_MEMBER && state <= IGMP_LEAVING_MEMBER)
2904189592Sbms		return (inm_statestrs[state]);
2905189592Sbms	return ("??");
2906189592Sbms}
2907189592Sbms
2908189592Sbms/*
2909189592Sbms * Dump an in_multi structure to the console.
2910189592Sbms */
2911189592Sbmsvoid
2912189592Sbmsinm_print(const struct in_multi *inm)
2913189592Sbms{
2914189592Sbms	int t;
2915189592Sbms
2916190753Skan	if ((ktr_mask & KTR_IGMPV3) == 0)
2917189635Sbms		return;
2918189635Sbms
2919189592Sbms	printf("%s: --- begin inm %p ---\n", __func__, inm);
2920189592Sbms	printf("addr %s ifp %p(%s) ifma %p\n",
2921189592Sbms	    inet_ntoa(inm->inm_addr),
2922189592Sbms	    inm->inm_ifp,
2923189592Sbms	    inm->inm_ifp->if_xname,
2924189592Sbms	    inm->inm_ifma);
2925189592Sbms	printf("timer %u state %s refcount %u scq.len %u\n",
2926189592Sbms	    inm->inm_timer,
2927189592Sbms	    inm_state_str(inm->inm_state),
2928189592Sbms	    inm->inm_refcount,
2929189592Sbms	    inm->inm_scq.ifq_len);
2930189592Sbms	printf("igi %p nsrc %lu sctimer %u scrv %u\n",
2931189592Sbms	    inm->inm_igi,
2932189592Sbms	    inm->inm_nsrc,
2933189592Sbms	    inm->inm_sctimer,
2934189592Sbms	    inm->inm_scrv);
2935189592Sbms	for (t = 0; t < 2; t++) {
2936189592Sbms		printf("t%d: fmode %s asm %u ex %u in %u rec %u\n", t,
2937189592Sbms		    inm_mode_str(inm->inm_st[t].iss_fmode),
2938189592Sbms		    inm->inm_st[t].iss_asm,
2939189592Sbms		    inm->inm_st[t].iss_ex,
2940189592Sbms		    inm->inm_st[t].iss_in,
2941189592Sbms		    inm->inm_st[t].iss_rec);
2942189592Sbms	}
2943189592Sbms	printf("%s: --- end inm %p ---\n", __func__, inm);
2944189592Sbms}
2945189592Sbms
2946189592Sbms#else /* !KTR */
2947189592Sbms
2948189592Sbmsvoid
2949189592Sbmsinm_print(const struct in_multi *inm)
2950189592Sbms{
2951189592Sbms
2952189592Sbms}
2953189592Sbms
2954189592Sbms#endif /* KTR */
2955189592Sbms
2956189592SbmsRB_GENERATE(ip_msource_tree, ip_msource, ims_link, ip_msource_cmp);
2957