igmp.c 63 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1
2
3
4
5
6
7
8
9
10
11
/*
 *	Linux NET3:	Internet Group Management Protocol  [IGMP]
 *
 *	This code implements the IGMP protocol as defined in RFC1112. There has
 *	been a further revision of this protocol since which is now supported.
 *
 *	If you have trouble with this module be careful what gcc you have used,
 *	the older version didn't come out right using gcc 2.5.8, the newer one
 *	seems to fall out with gcc 2.6.2.
 *
 *	Authors:
12
 *		Alan Cox <alan@lxorguk.ukuu.org.uk>
Linus Torvalds's avatar
Linus Torvalds committed
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
 *
 *	This program is free software; you can redistribute it and/or
 *	modify it under the terms of the GNU General Public License
 *	as published by the Free Software Foundation; either version
 *	2 of the License, or (at your option) any later version.
 *
 *	Fixes:
 *
 *		Alan Cox	:	Added lots of __inline__ to optimise
 *					the memory usage of all the tiny little
 *					functions.
 *		Alan Cox	:	Dumped the header building experiment.
 *		Alan Cox	:	Minor tweaks ready for multicast routing
 *					and extended IGMP protocol.
 *		Alan Cox	:	Removed a load of inline directives. Gcc 2.5.8
 *					writes utterly bogus code otherwise (sigh)
 *					fixed IGMP loopback to behave in the manner
 *					desired by mrouted, fixed the fact it has been
 *					broken since 1.3.6 and cleaned up a few minor
 *					points.
 *
 *		Chih-Jen Chang	:	Tried to revise IGMP to Version 2
 *		Tsu-Sheng Tsao		E-mail: chihjenc@scf.usc.edu and tsusheng@scf.usc.edu
36
 *					The enhancements are mainly based on Steve Deering's
Linus Torvalds's avatar
Linus Torvalds committed
37
38
39
40
41
42
43
44
45
46
47
48
49
 * 					ipmulti-3.5 source code.
 *		Chih-Jen Chang	:	Added the igmp_get_mrouter_info and
 *		Tsu-Sheng Tsao		igmp_set_mrouter_info to keep track of
 *					the mrouted version on that device.
 *		Chih-Jen Chang	:	Added the max_resp_time parameter to
 *		Tsu-Sheng Tsao		igmp_heard_query(). Using this parameter
 *					to identify the multicast router version
 *					and do what the IGMP version 2 specified.
 *		Chih-Jen Chang	:	Added a timer to revert to IGMP V2 router
 *		Tsu-Sheng Tsao		if the specified time expired.
 *		Alan Cox	:	Stop IGMP from 0.0.0.0 being accepted.
 *		Alan Cox	:	Use GFP_ATOMIC in the right places.
 *		Christian Daudt :	igmp timer wasn't set for local group
50
51
 *					memberships but was being deleted,
 *					which caused a "del_timer() called
Linus Torvalds's avatar
Linus Torvalds committed
52
53
 *					from %p with timer not initialized\n"
 *					message (960131).
54
 *		Christian Daudt :	removed del_timer from
Linus Torvalds's avatar
Linus Torvalds committed
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
 *					igmp_timer_expire function (960205).
 *             Christian Daudt :       igmp_heard_report now only calls
 *                                     igmp_timer_expire if tm->running is
 *                                     true (960216).
 *		Malcolm Beattie :	ttl comparison wrong in igmp_rcv made
 *					igmp_heard_query never trigger. Expiry
 *					miscalculation fixed in igmp_heard_query
 *					and random() made to return unsigned to
 *					prevent negative expiry times.
 *		Alexey Kuznetsov:	Wrong group leaving behaviour, backport
 *					fix from pending 2.1.x patches.
 *		Alan Cox:		Forget to enable FDDI support earlier.
 *		Alexey Kuznetsov:	Fixed leaving groups on device down.
 *		Alexey Kuznetsov:	Accordance to igmp-v2-06 draft.
 *		David L Stevens:	IGMPv3 support, with help from
 *					Vinay Kulkarni
 */

#include <linux/module.h>
74
#include <linux/slab.h>
Linus Torvalds's avatar
Linus Torvalds committed
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
#include <asm/uaccess.h>
#include <asm/system.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/jiffies.h>
#include <linux/string.h>
#include <linux/socket.h>
#include <linux/sockios.h>
#include <linux/in.h>
#include <linux/inet.h>
#include <linux/netdevice.h>
#include <linux/skbuff.h>
#include <linux/inetdevice.h>
#include <linux/igmp.h>
#include <linux/if_arp.h>
#include <linux/rtnetlink.h>
#include <linux/times.h>
92

93
#include <net/net_namespace.h>
94
#include <net/arp.h>
Linus Torvalds's avatar
Linus Torvalds committed
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
#include <net/ip.h>
#include <net/protocol.h>
#include <net/route.h>
#include <net/sock.h>
#include <net/checksum.h>
#include <linux/netfilter_ipv4.h>
#ifdef CONFIG_IP_MROUTE
#include <linux/mroute.h>
#endif
#ifdef CONFIG_PROC_FS
#include <linux/proc_fs.h>
#include <linux/seq_file.h>
#endif

#define IP_MAX_MEMBERSHIPS	20
#define IP_MAX_MSF		10

#ifdef CONFIG_IP_MULTICAST
/* Parameter names and values are taken from igmp-v2-06 draft */

#define IGMP_V1_Router_Present_Timeout		(400*HZ)
#define IGMP_V2_Router_Present_Timeout		(400*HZ)
#define IGMP_Unsolicited_Report_Interval	(10*HZ)
#define IGMP_Query_Response_Interval		(10*HZ)
#define IGMP_Unsolicited_Report_Count		2


#define IGMP_Initial_Report_Delay		(1)

/* IGMP_Initial_Report_Delay is not from IGMP specs!
 * IGMP specs require to report membership immediately after
 * joining a group, but we delay the first report by a
 * small interval. It seems more natural and still does not
 * contradict to specs provided this delay is small enough.
 */

131
#define IGMP_V1_SEEN(in_dev) \
132
	(IPV4_DEVCONF_ALL(dev_net(in_dev->dev), FORCE_IGMP_VERSION) == 1 || \
133
134
135
136
	 IN_DEV_CONF_GET((in_dev), FORCE_IGMP_VERSION) == 1 || \
	 ((in_dev)->mr_v1_seen && \
	  time_before(jiffies, (in_dev)->mr_v1_seen)))
#define IGMP_V2_SEEN(in_dev) \
137
	(IPV4_DEVCONF_ALL(dev_net(in_dev->dev), FORCE_IGMP_VERSION) == 2 || \
138
139
140
	 IN_DEV_CONF_GET((in_dev), FORCE_IGMP_VERSION) == 2 || \
	 ((in_dev)->mr_v2_seen && \
	  time_before(jiffies, (in_dev)->mr_v2_seen)))
Linus Torvalds's avatar
Linus Torvalds committed
141
142

static void igmpv3_add_delrec(struct in_device *in_dev, struct ip_mc_list *im);
Al Viro's avatar
Al Viro committed
143
static void igmpv3_del_delrec(struct in_device *in_dev, __be32 multiaddr);
Linus Torvalds's avatar
Linus Torvalds committed
144
145
146
147
148
static void igmpv3_clear_delrec(struct in_device *in_dev);
static int sf_setstate(struct ip_mc_list *pmc);
static void sf_markstate(struct ip_mc_list *pmc);
#endif
static void ip_mc_clear_src(struct ip_mc_list *pmc);
149
150
static int ip_mc_add_src(struct in_device *in_dev, __be32 *pmca, int sfmode,
			 int sfcount, __be32 *psfsrc, int delta);
Linus Torvalds's avatar
Linus Torvalds committed
151

152
153
154
155
156
157

static void ip_mc_list_reclaim(struct rcu_head *head)
{
	kfree(container_of(head, struct ip_mc_list, rcu));
}

Linus Torvalds's avatar
Linus Torvalds committed
158
159
160
161
static void ip_ma_put(struct ip_mc_list *im)
{
	if (atomic_dec_and_test(&im->refcnt)) {
		in_dev_put(im->interface);
162
		call_rcu(&im->rcu, ip_mc_list_reclaim);
Linus Torvalds's avatar
Linus Torvalds committed
163
164
165
	}
}

166
167
168
169
170
171
172
173
174
175
#define for_each_pmc_rcu(in_dev, pmc)				\
	for (pmc = rcu_dereference(in_dev->mc_list);		\
	     pmc != NULL;					\
	     pmc = rcu_dereference(pmc->next_rcu))

#define for_each_pmc_rtnl(in_dev, pmc)				\
	for (pmc = rtnl_dereference(in_dev->mc_list);		\
	     pmc != NULL;					\
	     pmc = rtnl_dereference(pmc->next_rcu))

Linus Torvalds's avatar
Linus Torvalds committed
176
177
178
179
180
181
#ifdef CONFIG_IP_MULTICAST

/*
 *	Timer management
 */

182
static void igmp_stop_timer(struct ip_mc_list *im)
Linus Torvalds's avatar
Linus Torvalds committed
183
184
185
186
{
	spin_lock_bh(&im->lock);
	if (del_timer(&im->timer))
		atomic_dec(&im->refcnt);
Jianjun Kong's avatar
Jianjun Kong committed
187
	im->tm_running = 0;
Linus Torvalds's avatar
Linus Torvalds committed
188
189
190
191
192
193
194
195
	im->reporter = 0;
	im->unsolicit_count = 0;
	spin_unlock_bh(&im->lock);
}

/* It must be called with locked im->lock */
static void igmp_start_timer(struct ip_mc_list *im, int max_delay)
{
Jianjun Kong's avatar
Jianjun Kong committed
196
	int tv = net_random() % max_delay;
Linus Torvalds's avatar
Linus Torvalds committed
197

Jianjun Kong's avatar
Jianjun Kong committed
198
	im->tm_running = 1;
Linus Torvalds's avatar
Linus Torvalds committed
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
	if (!mod_timer(&im->timer, jiffies+tv+2))
		atomic_inc(&im->refcnt);
}

static void igmp_gq_start_timer(struct in_device *in_dev)
{
	int tv = net_random() % in_dev->mr_maxdelay;

	in_dev->mr_gq_running = 1;
	if (!mod_timer(&in_dev->mr_gq_timer, jiffies+tv+2))
		in_dev_hold(in_dev);
}

static void igmp_ifc_start_timer(struct in_device *in_dev, int delay)
{
	int tv = net_random() % delay;

	if (!mod_timer(&in_dev->mr_ifc_timer, jiffies+tv+2))
		in_dev_hold(in_dev);
}

static void igmp_mod_timer(struct ip_mc_list *im, int max_delay)
{
	spin_lock_bh(&im->lock);
	im->unsolicit_count = 0;
	if (del_timer(&im->timer)) {
		if ((long)(im->timer.expires-jiffies) < max_delay) {
			add_timer(&im->timer);
Jianjun Kong's avatar
Jianjun Kong committed
227
			im->tm_running = 1;
Linus Torvalds's avatar
Linus Torvalds committed
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
			spin_unlock_bh(&im->lock);
			return;
		}
		atomic_dec(&im->refcnt);
	}
	igmp_start_timer(im, max_delay);
	spin_unlock_bh(&im->lock);
}


/*
 *	Send an IGMP report.
 */

#define IGMP_SIZE (sizeof(struct igmphdr)+sizeof(struct iphdr)+4)


static int is_in(struct ip_mc_list *pmc, struct ip_sf_list *psf, int type,
	int gdeleted, int sdeleted)
{
	switch (type) {
	case IGMPV3_MODE_IS_INCLUDE:
	case IGMPV3_MODE_IS_EXCLUDE:
		if (gdeleted || sdeleted)
			return 0;
253
254
255
256
257
258
259
260
261
262
263
264
		if (!(pmc->gsquery && !psf->sf_gsresp)) {
			if (pmc->sfmode == MCAST_INCLUDE)
				return 1;
			/* don't include if this source is excluded
			 * in all filters
			 */
			if (psf->sf_count[MCAST_INCLUDE])
				return type == IGMPV3_MODE_IS_INCLUDE;
			return pmc->sfcount[MCAST_EXCLUDE] ==
				psf->sf_count[MCAST_EXCLUDE];
		}
		return 0;
Linus Torvalds's avatar
Linus Torvalds committed
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
	case IGMPV3_CHANGE_TO_INCLUDE:
		if (gdeleted || sdeleted)
			return 0;
		return psf->sf_count[MCAST_INCLUDE] != 0;
	case IGMPV3_CHANGE_TO_EXCLUDE:
		if (gdeleted || sdeleted)
			return 0;
		if (pmc->sfcount[MCAST_EXCLUDE] == 0 ||
		    psf->sf_count[MCAST_INCLUDE])
			return 0;
		return pmc->sfcount[MCAST_EXCLUDE] ==
			psf->sf_count[MCAST_EXCLUDE];
	case IGMPV3_ALLOW_NEW_SOURCES:
		if (gdeleted || !psf->sf_crcount)
			return 0;
		return (pmc->sfmode == MCAST_INCLUDE) ^ sdeleted;
	case IGMPV3_BLOCK_OLD_SOURCES:
		if (pmc->sfmode == MCAST_INCLUDE)
			return gdeleted || (psf->sf_crcount && sdeleted);
		return psf->sf_crcount && !gdeleted && !sdeleted;
	}
	return 0;
}

static int
igmp_scount(struct ip_mc_list *pmc, int type, int gdeleted, int sdeleted)
{
	struct ip_sf_list *psf;
	int scount = 0;

	for (psf=pmc->sources; psf; psf=psf->sf_next) {
		if (!is_in(pmc, psf, type, gdeleted, sdeleted))
			continue;
		scount++;
	}
	return scount;
}

Eric Dumazet's avatar
Eric Dumazet committed
303
304
#define igmp_skb_size(skb) (*(unsigned int *)((skb)->cb))

Linus Torvalds's avatar
Linus Torvalds committed
305
306
307
308
309
310
static struct sk_buff *igmpv3_newpack(struct net_device *dev, int size)
{
	struct sk_buff *skb;
	struct rtable *rt;
	struct iphdr *pip;
	struct igmpv3_report *pig;
311
	struct net *net = dev_net(dev);
Linus Torvalds's avatar
Linus Torvalds committed
312

Eric Dumazet's avatar
Eric Dumazet committed
313
314
315
316
317
318
319
320
321
322
	while (1) {
		skb = alloc_skb(size + LL_ALLOCATED_SPACE(dev),
				GFP_ATOMIC | __GFP_NOWARN);
		if (skb)
			break;
		size >>= 1;
		if (size < 256)
			return NULL;
	}
	igmp_skb_size(skb) = size;
Linus Torvalds's avatar
Linus Torvalds committed
323

324
325
326
327
328
329
	rt = ip_route_output_ports(net, NULL, IGMPV3_ALL_MCR, 0,
				   0, 0,
				   IPPROTO_IGMP, 0, dev->ifindex);
	if (IS_ERR(rt)) {
		kfree_skb(skb);
		return NULL;
Linus Torvalds's avatar
Linus Torvalds committed
330
331
332
333
334
335
336
	}
	if (rt->rt_src == 0) {
		kfree_skb(skb);
		ip_rt_put(rt);
		return NULL;
	}

337
	skb_dst_set(skb, &rt->dst);
Linus Torvalds's avatar
Linus Torvalds committed
338
339
340
341
	skb->dev = dev;

	skb_reserve(skb, LL_RESERVED_SPACE(dev));

342
	skb_reset_network_header(skb);
343
	pip = ip_hdr(skb);
344
	skb_put(skb, sizeof(struct iphdr) + 4);
Linus Torvalds's avatar
Linus Torvalds committed
345
346
347
348
349
350
351
352
353
354

	pip->version  = 4;
	pip->ihl      = (sizeof(struct iphdr)+4)>>2;
	pip->tos      = 0xc0;
	pip->frag_off = htons(IP_DF);
	pip->ttl      = 1;
	pip->daddr    = rt->rt_dst;
	pip->saddr    = rt->rt_src;
	pip->protocol = IPPROTO_IGMP;
	pip->tot_len  = 0;	/* filled in later */
355
	ip_select_ident(pip, &rt->dst, NULL);
Linus Torvalds's avatar
Linus Torvalds committed
356
357
358
359
360
	((u8*)&pip[1])[0] = IPOPT_RA;
	((u8*)&pip[1])[1] = 4;
	((u8*)&pip[1])[2] = 0;
	((u8*)&pip[1])[3] = 0;

361
	skb->transport_header = skb->network_header + sizeof(struct iphdr) + 4;
362
	skb_put(skb, sizeof(*pig));
363
	pig = igmpv3_report_hdr(skb);
Linus Torvalds's avatar
Linus Torvalds committed
364
365
366
367
368
369
370
371
372
373
	pig->type = IGMPV3_HOST_MEMBERSHIP_REPORT;
	pig->resv1 = 0;
	pig->csum = 0;
	pig->resv2 = 0;
	pig->ngrec = 0;
	return skb;
}

static int igmpv3_sendpack(struct sk_buff *skb)
{
374
	struct igmphdr *pig = igmp_hdr(skb);
375
	const int igmplen = skb->tail - skb->transport_header;
Linus Torvalds's avatar
Linus Torvalds committed
376

377
	pig->csum = ip_compute_csum(igmp_hdr(skb), igmplen);
Linus Torvalds's avatar
Linus Torvalds committed
378

Herbert Xu's avatar
Herbert Xu committed
379
	return ip_local_out(skb);
Linus Torvalds's avatar
Linus Torvalds committed
380
381
382
383
}

static int grec_size(struct ip_mc_list *pmc, int type, int gdel, int sdel)
{
Jianjun Kong's avatar
Jianjun Kong committed
384
	return sizeof(struct igmpv3_grec) + 4*igmp_scount(pmc, type, gdel, sdel);
Linus Torvalds's avatar
Linus Torvalds committed
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
}

static struct sk_buff *add_grhead(struct sk_buff *skb, struct ip_mc_list *pmc,
	int type, struct igmpv3_grec **ppgr)
{
	struct net_device *dev = pmc->interface->dev;
	struct igmpv3_report *pih;
	struct igmpv3_grec *pgr;

	if (!skb)
		skb = igmpv3_newpack(dev, dev->mtu);
	if (!skb)
		return NULL;
	pgr = (struct igmpv3_grec *)skb_put(skb, sizeof(struct igmpv3_grec));
	pgr->grec_type = type;
	pgr->grec_auxwords = 0;
	pgr->grec_nsrcs = 0;
	pgr->grec_mca = pmc->multiaddr;
403
	pih = igmpv3_report_hdr(skb);
Linus Torvalds's avatar
Linus Torvalds committed
404
405
406
407
408
	pih->ngrec = htons(ntohs(pih->ngrec)+1);
	*ppgr = pgr;
	return skb;
}

Eric Dumazet's avatar
Eric Dumazet committed
409
#define AVAILABLE(skb) ((skb) ? ((skb)->dev ? igmp_skb_size(skb) - (skb)->len : \
Linus Torvalds's avatar
Linus Torvalds committed
410
411
412
413
414
415
416
417
418
	skb_tailroom(skb)) : 0)

static struct sk_buff *add_grec(struct sk_buff *skb, struct ip_mc_list *pmc,
	int type, int gdeleted, int sdeleted)
{
	struct net_device *dev = pmc->interface->dev;
	struct igmpv3_report *pih;
	struct igmpv3_grec *pgr = NULL;
	struct ip_sf_list *psf, *psf_next, *psf_prev, **psf_list;
419
	int scount, stotal, first, isquery, truncate;
Linus Torvalds's avatar
Linus Torvalds committed
420
421
422
423
424
425
426
427
428

	if (pmc->multiaddr == IGMP_ALL_HOSTS)
		return skb;

	isquery = type == IGMPV3_MODE_IS_INCLUDE ||
		  type == IGMPV3_MODE_IS_EXCLUDE;
	truncate = type == IGMPV3_MODE_IS_EXCLUDE ||
		    type == IGMPV3_CHANGE_TO_EXCLUDE;

429
430
	stotal = scount = 0;

Linus Torvalds's avatar
Linus Torvalds committed
431
432
	psf_list = sdeleted ? &pmc->tomb : &pmc->sources;

433
434
435
	if (!*psf_list)
		goto empty_source;

436
	pih = skb ? igmpv3_report_hdr(skb) : NULL;
Linus Torvalds's avatar
Linus Torvalds committed
437
438
439
440
441
442
443
444
445
446
447
448
449

	/* EX and TO_EX get a fresh packet, if needed */
	if (truncate) {
		if (pih && pih->ngrec &&
		    AVAILABLE(skb) < grec_size(pmc, type, gdeleted, sdeleted)) {
			if (skb)
				igmpv3_sendpack(skb);
			skb = igmpv3_newpack(dev, dev->mtu);
		}
	}
	first = 1;
	psf_prev = NULL;
	for (psf=*psf_list; psf; psf=psf_next) {
450
		__be32 *psrc;
Linus Torvalds's avatar
Linus Torvalds committed
451
452
453
454
455
456
457
458
459
460
461
462

		psf_next = psf->sf_next;

		if (!is_in(pmc, psf, type, gdeleted, sdeleted)) {
			psf_prev = psf;
			continue;
		}

		/* clear marks on query responses */
		if (isquery)
			psf->sf_gsresp = 0;

Al Viro's avatar
Al Viro committed
463
		if (AVAILABLE(skb) < sizeof(__be32) +
Linus Torvalds's avatar
Linus Torvalds committed
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
		    first*sizeof(struct igmpv3_grec)) {
			if (truncate && !first)
				break;	 /* truncate these */
			if (pgr)
				pgr->grec_nsrcs = htons(scount);
			if (skb)
				igmpv3_sendpack(skb);
			skb = igmpv3_newpack(dev, dev->mtu);
			first = 1;
			scount = 0;
		}
		if (first) {
			skb = add_grhead(skb, pmc, type, &pgr);
			first = 0;
		}
479
480
		if (!skb)
			return NULL;
Al Viro's avatar
Al Viro committed
481
		psrc = (__be32 *)skb_put(skb, sizeof(__be32));
Linus Torvalds's avatar
Linus Torvalds committed
482
		*psrc = psf->sf_inaddr;
483
		scount++; stotal++;
Linus Torvalds's avatar
Linus Torvalds committed
484
485
486
487
488
489
490
491
492
493
494
495
496
497
		if ((type == IGMPV3_ALLOW_NEW_SOURCES ||
		     type == IGMPV3_BLOCK_OLD_SOURCES) && psf->sf_crcount) {
			psf->sf_crcount--;
			if ((sdeleted || gdeleted) && psf->sf_crcount == 0) {
				if (psf_prev)
					psf_prev->sf_next = psf->sf_next;
				else
					*psf_list = psf->sf_next;
				kfree(psf);
				continue;
			}
		}
		psf_prev = psf;
	}
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512

empty_source:
	if (!stotal) {
		if (type == IGMPV3_ALLOW_NEW_SOURCES ||
		    type == IGMPV3_BLOCK_OLD_SOURCES)
			return skb;
		if (pmc->crcount || isquery) {
			/* make sure we have room for group header */
			if (skb && AVAILABLE(skb)<sizeof(struct igmpv3_grec)) {
				igmpv3_sendpack(skb);
				skb = NULL; /* add_grhead will get a new one */
			}
			skb = add_grhead(skb, pmc, type, &pgr);
		}
	}
Linus Torvalds's avatar
Linus Torvalds committed
513
514
515
516
517
518
519
520
521
522
523
524
525
526
	if (pgr)
		pgr->grec_nsrcs = htons(scount);

	if (isquery)
		pmc->gsquery = 0;	/* clear query state on report */
	return skb;
}

static int igmpv3_send_report(struct in_device *in_dev, struct ip_mc_list *pmc)
{
	struct sk_buff *skb = NULL;
	int type;

	if (!pmc) {
527
528
		rcu_read_lock();
		for_each_pmc_rcu(in_dev, pmc) {
Linus Torvalds's avatar
Linus Torvalds committed
529
530
531
532
533
534
535
536
537
538
			if (pmc->multiaddr == IGMP_ALL_HOSTS)
				continue;
			spin_lock_bh(&pmc->lock);
			if (pmc->sfcount[MCAST_EXCLUDE])
				type = IGMPV3_MODE_IS_EXCLUDE;
			else
				type = IGMPV3_MODE_IS_INCLUDE;
			skb = add_grec(skb, pmc, type, 0, 0);
			spin_unlock_bh(&pmc->lock);
		}
539
		rcu_read_unlock();
Linus Torvalds's avatar
Linus Torvalds committed
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
	} else {
		spin_lock_bh(&pmc->lock);
		if (pmc->sfcount[MCAST_EXCLUDE])
			type = IGMPV3_MODE_IS_EXCLUDE;
		else
			type = IGMPV3_MODE_IS_INCLUDE;
		skb = add_grec(skb, pmc, type, 0, 0);
		spin_unlock_bh(&pmc->lock);
	}
	if (!skb)
		return 0;
	return igmpv3_sendpack(skb);
}

/*
 * remove zero-count source records from a source filter list
 */
static void igmpv3_clear_zeros(struct ip_sf_list **ppsf)
{
	struct ip_sf_list *psf_prev, *psf_next, *psf;

	psf_prev = NULL;
	for (psf=*ppsf; psf; psf = psf_next) {
		psf_next = psf->sf_next;
		if (psf->sf_crcount == 0) {
			if (psf_prev)
				psf_prev->sf_next = psf->sf_next;
			else
				*ppsf = psf->sf_next;
			kfree(psf);
		} else
			psf_prev = psf;
	}
}

static void igmpv3_send_cr(struct in_device *in_dev)
{
	struct ip_mc_list *pmc, *pmc_prev, *pmc_next;
	struct sk_buff *skb = NULL;
	int type, dtype;

581
	rcu_read_lock();
Linus Torvalds's avatar
Linus Torvalds committed
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
	spin_lock_bh(&in_dev->mc_tomb_lock);

	/* deleted MCA's */
	pmc_prev = NULL;
	for (pmc=in_dev->mc_tomb; pmc; pmc=pmc_next) {
		pmc_next = pmc->next;
		if (pmc->sfmode == MCAST_INCLUDE) {
			type = IGMPV3_BLOCK_OLD_SOURCES;
			dtype = IGMPV3_BLOCK_OLD_SOURCES;
			skb = add_grec(skb, pmc, type, 1, 0);
			skb = add_grec(skb, pmc, dtype, 1, 1);
		}
		if (pmc->crcount) {
			if (pmc->sfmode == MCAST_EXCLUDE) {
				type = IGMPV3_CHANGE_TO_INCLUDE;
				skb = add_grec(skb, pmc, type, 1, 0);
			}
599
			pmc->crcount--;
Linus Torvalds's avatar
Linus Torvalds committed
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
			if (pmc->crcount == 0) {
				igmpv3_clear_zeros(&pmc->tomb);
				igmpv3_clear_zeros(&pmc->sources);
			}
		}
		if (pmc->crcount == 0 && !pmc->tomb && !pmc->sources) {
			if (pmc_prev)
				pmc_prev->next = pmc_next;
			else
				in_dev->mc_tomb = pmc_next;
			in_dev_put(pmc->interface);
			kfree(pmc);
		} else
			pmc_prev = pmc;
	}
	spin_unlock_bh(&in_dev->mc_tomb_lock);

	/* change recs */
618
	for_each_pmc_rcu(in_dev, pmc) {
Linus Torvalds's avatar
Linus Torvalds committed
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
		spin_lock_bh(&pmc->lock);
		if (pmc->sfcount[MCAST_EXCLUDE]) {
			type = IGMPV3_BLOCK_OLD_SOURCES;
			dtype = IGMPV3_ALLOW_NEW_SOURCES;
		} else {
			type = IGMPV3_ALLOW_NEW_SOURCES;
			dtype = IGMPV3_BLOCK_OLD_SOURCES;
		}
		skb = add_grec(skb, pmc, type, 0, 0);
		skb = add_grec(skb, pmc, dtype, 0, 1);	/* deleted sources */

		/* filter mode changes */
		if (pmc->crcount) {
			if (pmc->sfmode == MCAST_EXCLUDE)
				type = IGMPV3_CHANGE_TO_EXCLUDE;
			else
				type = IGMPV3_CHANGE_TO_INCLUDE;
			skb = add_grec(skb, pmc, type, 0, 0);
637
			pmc->crcount--;
Linus Torvalds's avatar
Linus Torvalds committed
638
639
640
		}
		spin_unlock_bh(&pmc->lock);
	}
641
	rcu_read_unlock();
Linus Torvalds's avatar
Linus Torvalds committed
642
643
644
645
646
647
648
649
650
651
652
653
654
655

	if (!skb)
		return;
	(void) igmpv3_sendpack(skb);
}

static int igmp_send_report(struct in_device *in_dev, struct ip_mc_list *pmc,
	int type)
{
	struct sk_buff *skb;
	struct iphdr *iph;
	struct igmphdr *ih;
	struct rtable *rt;
	struct net_device *dev = in_dev->dev;
656
	struct net *net = dev_net(dev);
Al Viro's avatar
Al Viro committed
657
658
	__be32	group = pmc ? pmc->multiaddr : 0;
	__be32	dst;
Linus Torvalds's avatar
Linus Torvalds committed
659
660
661
662
663
664
665
666

	if (type == IGMPV3_HOST_MEMBERSHIP_REPORT)
		return igmpv3_send_report(in_dev, pmc);
	else if (type == IGMP_HOST_LEAVE_MESSAGE)
		dst = IGMP_ALL_ROUTER;
	else
		dst = group;

667
668
669
670
671
672
	rt = ip_route_output_ports(net, NULL, dst, 0,
				   0, 0,
				   IPPROTO_IGMP, 0, dev->ifindex);
	if (IS_ERR(rt))
		return -1;

Linus Torvalds's avatar
Linus Torvalds committed
673
674
675
676
677
	if (rt->rt_src == 0) {
		ip_rt_put(rt);
		return -1;
	}

Jianjun Kong's avatar
Jianjun Kong committed
678
	skb = alloc_skb(IGMP_SIZE+LL_ALLOCATED_SPACE(dev), GFP_ATOMIC);
Linus Torvalds's avatar
Linus Torvalds committed
679
680
681
682
683
	if (skb == NULL) {
		ip_rt_put(rt);
		return -1;
	}

684
	skb_dst_set(skb, &rt->dst);
Linus Torvalds's avatar
Linus Torvalds committed
685
686
687

	skb_reserve(skb, LL_RESERVED_SPACE(dev));

688
	skb_reset_network_header(skb);
689
	iph = ip_hdr(skb);
690
	skb_put(skb, sizeof(struct iphdr) + 4);
Linus Torvalds's avatar
Linus Torvalds committed
691
692
693
694
695
696
697
698
699

	iph->version  = 4;
	iph->ihl      = (sizeof(struct iphdr)+4)>>2;
	iph->tos      = 0xc0;
	iph->frag_off = htons(IP_DF);
	iph->ttl      = 1;
	iph->daddr    = dst;
	iph->saddr    = rt->rt_src;
	iph->protocol = IPPROTO_IGMP;
700
	ip_select_ident(iph, &rt->dst, NULL);
Linus Torvalds's avatar
Linus Torvalds committed
701
702
703
704
705
706
	((u8*)&iph[1])[0] = IPOPT_RA;
	((u8*)&iph[1])[1] = 4;
	((u8*)&iph[1])[2] = 0;
	((u8*)&iph[1])[3] = 0;

	ih = (struct igmphdr *)skb_put(skb, sizeof(struct igmphdr));
Jianjun Kong's avatar
Jianjun Kong committed
707
708
709
710
711
	ih->type = type;
	ih->code = 0;
	ih->csum = 0;
	ih->group = group;
	ih->csum = ip_compute_csum((void *)ih, sizeof(struct igmphdr));
Linus Torvalds's avatar
Linus Torvalds committed
712

Herbert Xu's avatar
Herbert Xu committed
713
	return ip_local_out(skb);
Linus Torvalds's avatar
Linus Torvalds committed
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
}

static void igmp_gq_timer_expire(unsigned long data)
{
	struct in_device *in_dev = (struct in_device *)data;

	in_dev->mr_gq_running = 0;
	igmpv3_send_report(in_dev, NULL);
	__in_dev_put(in_dev);
}

static void igmp_ifc_timer_expire(unsigned long data)
{
	struct in_device *in_dev = (struct in_device *)data;

	igmpv3_send_cr(in_dev);
	if (in_dev->mr_ifc_count) {
		in_dev->mr_ifc_count--;
		igmp_ifc_start_timer(in_dev, IGMP_Unsolicited_Report_Interval);
	}
	__in_dev_put(in_dev);
}

static void igmp_ifc_event(struct in_device *in_dev)
{
	if (IGMP_V1_SEEN(in_dev) || IGMP_V2_SEEN(in_dev))
		return;
741
	in_dev->mr_ifc_count = in_dev->mr_qrv ? in_dev->mr_qrv :
Linus Torvalds's avatar
Linus Torvalds committed
742
743
744
745
746
747
748
749
750
751
752
		IGMP_Unsolicited_Report_Count;
	igmp_ifc_start_timer(in_dev, 1);
}


static void igmp_timer_expire(unsigned long data)
{
	struct ip_mc_list *im=(struct ip_mc_list *)data;
	struct in_device *in_dev = im->interface;

	spin_lock(&im->lock);
Jianjun Kong's avatar
Jianjun Kong committed
753
	im->tm_running = 0;
Linus Torvalds's avatar
Linus Torvalds committed
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771

	if (im->unsolicit_count) {
		im->unsolicit_count--;
		igmp_start_timer(im, IGMP_Unsolicited_Report_Interval);
	}
	im->reporter = 1;
	spin_unlock(&im->lock);

	if (IGMP_V1_SEEN(in_dev))
		igmp_send_report(in_dev, im, IGMP_HOST_MEMBERSHIP_REPORT);
	else if (IGMP_V2_SEEN(in_dev))
		igmp_send_report(in_dev, im, IGMPV2_HOST_MEMBERSHIP_REPORT);
	else
		igmp_send_report(in_dev, im, IGMPV3_HOST_MEMBERSHIP_REPORT);

	ip_ma_put(im);
}

772
/* mark EXCLUDE-mode sources */
773
static int igmp_xmarksources(struct ip_mc_list *pmc, int nsrcs, __be32 *srcs)
Linus Torvalds's avatar
Linus Torvalds committed
774
775
776
777
{
	struct ip_sf_list *psf;
	int i, scount;

778
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
797
798
799
	scount = 0;
	for (psf=pmc->sources; psf; psf=psf->sf_next) {
		if (scount == nsrcs)
			break;
		for (i=0; i<nsrcs; i++) {
			/* skip inactive filters */
			if (pmc->sfcount[MCAST_INCLUDE] ||
			    pmc->sfcount[MCAST_EXCLUDE] !=
			    psf->sf_count[MCAST_EXCLUDE])
				continue;
			if (srcs[i] == psf->sf_inaddr) {
				scount++;
				break;
			}
		}
	}
	pmc->gsquery = 0;
	if (scount == nsrcs)	/* all sources excluded */
		return 0;
	return 1;
}

800
static int igmp_marksources(struct ip_mc_list *pmc, int nsrcs, __be32 *srcs)
801
802
803
804
805
806
807
808
{
	struct ip_sf_list *psf;
	int i, scount;

	if (pmc->sfmode == MCAST_EXCLUDE)
		return igmp_xmarksources(pmc, nsrcs, srcs);

	/* mark INCLUDE-mode sources */
Linus Torvalds's avatar
Linus Torvalds committed
809
810
811
812
813
814
815
816
817
818
819
	scount = 0;
	for (psf=pmc->sources; psf; psf=psf->sf_next) {
		if (scount == nsrcs)
			break;
		for (i=0; i<nsrcs; i++)
			if (srcs[i] == psf->sf_inaddr) {
				psf->sf_gsresp = 1;
				scount++;
				break;
			}
	}
820
821
822
823
824
825
	if (!scount) {
		pmc->gsquery = 0;
		return 0;
	}
	pmc->gsquery = 1;
	return 1;
Linus Torvalds's avatar
Linus Torvalds committed
826
827
}

Al Viro's avatar
Al Viro committed
828
static void igmp_heard_report(struct in_device *in_dev, __be32 group)
Linus Torvalds's avatar
Linus Torvalds committed
829
830
831
832
833
834
835
836
{
	struct ip_mc_list *im;

	/* Timers are only set for non-local groups */

	if (group == IGMP_ALL_HOSTS)
		return;

837
838
	rcu_read_lock();
	for_each_pmc_rcu(in_dev, im) {
Linus Torvalds's avatar
Linus Torvalds committed
839
840
841
842
843
		if (im->multiaddr == group) {
			igmp_stop_timer(im);
			break;
		}
	}
844
	rcu_read_unlock();
Linus Torvalds's avatar
Linus Torvalds committed
845
846
847
848
849
}

static void igmp_heard_query(struct in_device *in_dev, struct sk_buff *skb,
	int len)
{
850
851
	struct igmphdr 		*ih = igmp_hdr(skb);
	struct igmpv3_query *ih3 = igmpv3_query_hdr(skb);
Linus Torvalds's avatar
Linus Torvalds committed
852
	struct ip_mc_list	*im;
Al Viro's avatar
Al Viro committed
853
	__be32			group = ih->group;
Linus Torvalds's avatar
Linus Torvalds committed
854
855
856
857
	int			max_delay;
	int			mark = 0;


858
	if (len == 8) {
Linus Torvalds's avatar
Linus Torvalds committed
859
860
		if (ih->code == 0) {
			/* Alas, old v1 router presents here. */
861

Linus Torvalds's avatar
Linus Torvalds committed
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
879
			max_delay = IGMP_Query_Response_Interval;
			in_dev->mr_v1_seen = jiffies +
				IGMP_V1_Router_Present_Timeout;
			group = 0;
		} else {
			/* v2 router present */
			max_delay = ih->code*(HZ/IGMP_TIMER_SCALE);
			in_dev->mr_v2_seen = jiffies +
				IGMP_V2_Router_Present_Timeout;
		}
		/* cancel the interface change timer */
		in_dev->mr_ifc_count = 0;
		if (del_timer(&in_dev->mr_ifc_timer))
			__in_dev_put(in_dev);
		/* clear deleted report items */
		igmpv3_clear_delrec(in_dev);
	} else if (len < 12) {
		return;	/* ignore bogus packet; freed by caller */
880
881
882
883
884
885
886
887
888
889
890
891
	} else if (IGMP_V1_SEEN(in_dev)) {
		/* This is a v3 query with v1 queriers present */
		max_delay = IGMP_Query_Response_Interval;
		group = 0;
	} else if (IGMP_V2_SEEN(in_dev)) {
		/* this is a v3 query with v2 queriers present;
		 * Interpretation of the max_delay code is problematic here.
		 * A real v2 host would use ih_code directly, while v3 has a
		 * different encoding. We use the v3 encoding as more likely
		 * to be intended in a v3 query.
		 */
		max_delay = IGMPV3_MRC(ih3->code)*(HZ/IGMP_TIMER_SCALE);
Linus Torvalds's avatar
Linus Torvalds committed
892
893
894
	} else { /* v3 */
		if (!pskb_may_pull(skb, sizeof(struct igmpv3_query)))
			return;
895

896
		ih3 = igmpv3_query_hdr(skb);
Linus Torvalds's avatar
Linus Torvalds committed
897
		if (ih3->nsrcs) {
898
			if (!pskb_may_pull(skb, sizeof(struct igmpv3_query)
Al Viro's avatar
Al Viro committed
899
					   + ntohs(ih3->nsrcs)*sizeof(__be32)))
Linus Torvalds's avatar
Linus Torvalds committed
900
				return;
901
			ih3 = igmpv3_query_hdr(skb);
Linus Torvalds's avatar
Linus Torvalds committed
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924
925
926
927
928
929
		}

		max_delay = IGMPV3_MRC(ih3->code)*(HZ/IGMP_TIMER_SCALE);
		if (!max_delay)
			max_delay = 1;	/* can't mod w/ 0 */
		in_dev->mr_maxdelay = max_delay;
		if (ih3->qrv)
			in_dev->mr_qrv = ih3->qrv;
		if (!group) { /* general query */
			if (ih3->nsrcs)
				return;	/* no sources allowed */
			igmp_gq_start_timer(in_dev);
			return;
		}
		/* mark sources to include, if group & source-specific */
		mark = ih3->nsrcs != 0;
	}

	/*
	 * - Start the timers in all of our membership records
	 *   that the query applies to for the interface on
	 *   which the query arrived excl. those that belong
	 *   to a "local" group (224.0.0.X)
	 * - For timers already running check if they need to
	 *   be reset.
	 * - Use the igmp->igmp_code field as the maximum
	 *   delay possible
	 */
930
931
	rcu_read_lock();
	for_each_pmc_rcu(in_dev, im) {
932
933
		int changed;

Linus Torvalds's avatar
Linus Torvalds committed
934
935
936
937
938
939
940
941
942
		if (group && group != im->multiaddr)
			continue;
		if (im->multiaddr == IGMP_ALL_HOSTS)
			continue;
		spin_lock_bh(&im->lock);
		if (im->tm_running)
			im->gsquery = im->gsquery && mark;
		else
			im->gsquery = mark;
943
		changed = !im->gsquery ||
944
			igmp_marksources(im, ntohs(ih3->nsrcs), ih3->srcs);
Linus Torvalds's avatar
Linus Torvalds committed
945
		spin_unlock_bh(&im->lock);
946
947
		if (changed)
			igmp_mod_timer(im, max_delay);
Linus Torvalds's avatar
Linus Torvalds committed
948
	}
949
	rcu_read_unlock();
Linus Torvalds's avatar
Linus Torvalds committed
950
951
}

952
/* called in rcu_read_lock() section */
Linus Torvalds's avatar
Linus Torvalds committed
953
954
955
956
int igmp_rcv(struct sk_buff *skb)
{
	/* This basically follows the spec line by line -- see RFC1112 */
	struct igmphdr *ih;
957
	struct in_device *in_dev = __in_dev_get_rcu(skb->dev);
Linus Torvalds's avatar
Linus Torvalds committed
958
959
	int len = skb->len;

960
961
	if (in_dev == NULL)
		goto drop;
Linus Torvalds's avatar
Linus Torvalds committed
962

963
	if (!pskb_may_pull(skb, sizeof(struct igmphdr)))
964
		goto drop;
965
966

	switch (skb->ip_summed) {
967
	case CHECKSUM_COMPLETE:
968
		if (!csum_fold(skb->csum))
969
970
971
972
973
			break;
		/* fall through */
	case CHECKSUM_NONE:
		skb->csum = 0;
		if (__skb_checksum_complete(skb))
974
			goto drop;
Linus Torvalds's avatar
Linus Torvalds committed
975
976
	}

977
	ih = igmp_hdr(skb);
Linus Torvalds's avatar
Linus Torvalds committed
978
979
980
981
982
983
984
	switch (ih->type) {
	case IGMP_HOST_MEMBERSHIP_QUERY:
		igmp_heard_query(in_dev, skb, len);
		break;
	case IGMP_HOST_MEMBERSHIP_REPORT:
	case IGMPV2_HOST_MEMBERSHIP_REPORT:
		/* Is it our report looped back? */
985
		if (rt_is_output_route(skb_rtable(skb)))
Linus Torvalds's avatar
Linus Torvalds committed
986
			break;
987
988
989
990
		/* don't rely on MC router hearing unicast reports */
		if (skb->pkt_type == PACKET_MULTICAST ||
		    skb->pkt_type == PACKET_BROADCAST)
			igmp_heard_report(in_dev, ih->group);
Linus Torvalds's avatar
Linus Torvalds committed
991
992
993
994
995
		break;
	case IGMP_PIM:
#ifdef CONFIG_IP_PIMSM_V1
		return pim_rcv_v1(skb);
#endif
996
	case IGMPV3_HOST_MEMBERSHIP_REPORT:
Linus Torvalds's avatar
Linus Torvalds committed
997
998
999
1000
1001
1002
1003
	case IGMP_DVMRP:
	case IGMP_TRACE:
	case IGMP_HOST_LEAVE_MESSAGE:
	case IGMP_MTRACE:
	case IGMP_MTRACE_RESP:
		break;
	default:
1004
		break;
Linus Torvalds's avatar
Linus Torvalds committed
1005
	}
1006

1007
drop:
Linus Torvalds's avatar
Linus Torvalds committed
1008
1009
1010
1011
1012
1013
1014
1015
1016
1017
1018
	kfree_skb(skb);
	return 0;
}

#endif


/*
 *	Add a filter to a device
 */

Al Viro's avatar
Al Viro committed
1019
static void ip_mc_filter_add(struct in_device *in_dev, __be32 addr)
Linus Torvalds's avatar
Linus Torvalds committed
1020
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030
1031
{
	char buf[MAX_ADDR_LEN];
	struct net_device *dev = in_dev->dev;

	/* Checking for IFF_MULTICAST here is WRONG-WRONG-WRONG.
	   We will get multicast token leakage, when IFF_MULTICAST
	   is changed. This check should be done in dev->set_multicast_list
	   routine. Something sort of:
	   if (dev->mc_list && dev->flags&IFF_MULTICAST) { do it; }
	   --ANK
	   */
	if (arp_mc_map(addr, buf, dev, 0) == 0)
1032
		dev_mc_add(dev, buf);
Linus Torvalds's avatar
Linus Torvalds committed
1033
1034
1035
1036
1037
1038
}

/*
 *	Remove a filter from a device
 */

Al Viro's avatar
Al Viro committed
1039
static void ip_mc_filter_del(struct in_device *in_dev, __be32 addr)
Linus Torvalds's avatar
Linus Torvalds committed
1040
1041
1042
1043
1044
{
	char buf[MAX_ADDR_LEN];
	struct net_device *dev = in_dev->dev;

	if (arp_mc_map(addr, buf, dev, 0) == 0)
1045
		dev_mc_del(dev, buf);
Linus Torvalds's avatar
Linus Torvalds committed
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
}

#ifdef CONFIG_IP_MULTICAST
/*
 * deleted ip_mc_list manipulation
 */
static void igmpv3_add_delrec(struct in_device *in_dev, struct ip_mc_list *im)
{
	struct ip_mc_list *pmc;

	/* this is an "ip_mc_list" for convenience; only the fields below
	 * are actually used. In particular, the refcnt and users are not
	 * used for management of the delete list. Using the same structure
	 * for deleted items allows change reports to use common code with
	 * non-deleted or query-response MCA's.
	 */
1062
	pmc = kzalloc(sizeof(*pmc), GFP_KERNEL);
Linus Torvalds's avatar
Linus Torvalds committed
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082
1083
1084
1085
1086
1087
1088
	if (!pmc)
		return;
	spin_lock_bh(&im->lock);
	pmc->interface = im->interface;
	in_dev_hold(in_dev);
	pmc->multiaddr = im->multiaddr;
	pmc->crcount = in_dev->mr_qrv ? in_dev->mr_qrv :
		IGMP_Unsolicited_Report_Count;
	pmc->sfmode = im->sfmode;
	if (pmc->sfmode == MCAST_INCLUDE) {
		struct ip_sf_list *psf;

		pmc->tomb = im->tomb;
		pmc->sources = im->sources;
		im->tomb = im->sources = NULL;
		for (psf=pmc->sources; psf; psf=psf->sf_next)
			psf->sf_crcount = pmc->crcount;
	}
	spin_unlock_bh(&im->lock);

	spin_lock_bh(&in_dev->mc_tomb_lock);
	pmc->next = in_dev->mc_tomb;
	in_dev->mc_tomb = pmc;
	spin_unlock_bh(&in_dev->mc_tomb_lock);
}

Al Viro's avatar
Al Viro committed
1089
static void igmpv3_del_delrec(struct in_device *in_dev, __be32 multiaddr)
Linus Torvalds's avatar
Linus Torvalds committed
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105
1106
1107
1108
1109
1110
1111
1112
1113
1114
1115
1116
1117
1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132
1133
{
	struct ip_mc_list *pmc, *pmc_prev;
	struct ip_sf_list *psf, *psf_next;

	spin_lock_bh(&in_dev->mc_tomb_lock);
	pmc_prev = NULL;
	for (pmc=in_dev->mc_tomb; pmc; pmc=pmc->next) {
		if (pmc->multiaddr == multiaddr)
			break;
		pmc_prev = pmc;
	}
	if (pmc) {
		if (pmc_prev)
			pmc_prev->next = pmc->next;
		else
			in_dev->mc_tomb = pmc->next;
	}
	spin_unlock_bh(&in_dev->mc_tomb_lock);
	if (pmc) {
		for (psf=pmc->tomb; psf; psf=psf_next) {
			psf_next = psf->sf_next;
			kfree(psf);
		}
		in_dev_put(pmc->interface);
		kfree(pmc);
	}
}

static void igmpv3_clear_delrec(struct in_device *in_dev)
{
	struct ip_mc_list *pmc, *nextpmc;

	spin_lock_bh(&in_dev->mc_tomb_lock);
	pmc = in_dev->mc_tomb;
	in_dev->mc_tomb = NULL;
	spin_unlock_bh(&in_dev->mc_tomb_lock);

	for (; pmc; pmc = nextpmc) {
		nextpmc = pmc->next;
		ip_mc_clear_src(pmc);
		in_dev_put(pmc->interface);
		kfree(pmc);
	}
	/* clear dead sources, too */
1134
1135
	rcu_read_lock();
	for_each_pmc_rcu(in_dev, pmc) {
Linus Torvalds's avatar
Linus Torvalds committed
1136
1137
1138
1139
1140
1141
1142
1143
1144
1145
1146
		struct ip_sf_list *psf, *psf_next;

		spin_lock_bh(&pmc->lock);
		psf = pmc->tomb;
		pmc->tomb = NULL;
		spin_unlock_bh(&pmc->lock);
		for (; psf; psf=psf_next) {
			psf_next = psf->sf_next;
			kfree(psf);
		}
	}
1147
	rcu_read_unlock();
Linus Torvalds's avatar
Linus Torvalds committed
1148
1149
1150
1151
1152
1153
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188
1189
1190
1191
1192
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
1203
1204
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226
}
#endif

static void igmp_group_dropped(struct ip_mc_list *im)
{
	struct in_device *in_dev = im->interface;
#ifdef CONFIG_IP_MULTICAST
	int reporter;
#endif

	if (im->loaded) {
		im->loaded = 0;
		ip_mc_filter_del(in_dev, im->multiaddr);
	}

#ifdef CONFIG_IP_MULTICAST
	if (im->multiaddr == IGMP_ALL_HOSTS)
		return;

	reporter = im->reporter;
	igmp_stop_timer(im);

	if (!in_dev->dead) {
		if (IGMP_V1_SEEN(in_dev))
			goto done;
		if (IGMP_V2_SEEN(in_dev)) {
			if (reporter)
				igmp_send_report(in_dev, im, IGMP_HOST_LEAVE_MESSAGE);
			goto done;
		}
		/* IGMPv3 */
		igmpv3_add_delrec(in_dev, im);

		igmp_ifc_event(in_dev);
	}
done:
#endif
	ip_mc_clear_src(im);
}

static void igmp_group_added(struct ip_mc_list *im)
{
	struct in_device *in_dev = im->interface;

	if (im->loaded == 0) {
		im->loaded = 1;
		ip_mc_filter_add(in_dev, im->multiaddr);
	}

#ifdef CONFIG_IP_MULTICAST
	if (im->multiaddr == IGMP_ALL_HOSTS)
		return;

	if (in_dev->dead)
		return;
	if (IGMP_V1_SEEN(in_dev) || IGMP_V2_SEEN(in_dev)) {
		spin_lock_bh(&im->lock);
		igmp_start_timer(im, IGMP_Initial_Report_Delay);
		spin_unlock_bh(&im->lock);
		return;
	}
	/* else, v3 */

	im->crcount = in_dev->mr_qrv ? in_dev->mr_qrv :
		IGMP_Unsolicited_Report_Count;
	igmp_ifc_event(in_dev);
#endif
}


/*
 *	Multicast list managers
 */


/*
 *	A socket has joined a multicast group on device dev.
 */

1227
void ip_mc_inc_group(struct in_device *in_dev, __be32 addr)
Linus Torvalds's avatar
Linus Torvalds committed
1228
1229
1230
1231
1232
{
	struct ip_mc_list *im;

	ASSERT_RTNL();

1233
	for_each_pmc_rtnl(in_dev, im) {
Linus Torvalds's avatar
Linus Torvalds committed
1234
1235
1236
1237
1238
1239
1240
		if (im->multiaddr == addr) {
			im->users++;
			ip_mc_add_src(in_dev, &addr, MCAST_EXCLUDE, 0, NULL, 0);
			goto out;
		}
	}

1241
	im = kzalloc(sizeof(*im), GFP_KERNEL);
Linus Torvalds's avatar
Linus Torvalds committed
1242
1243
1244
	if (!im)
		goto out;

Jianjun Kong's avatar
Jianjun Kong committed
1245
1246
	im->users = 1;
	im->interface = in_dev;
Linus Torvalds's avatar
Linus Torvalds committed
1247
	in_dev_hold(in_dev);
Jianjun Kong's avatar
Jianjun Kong committed
1248
	im->multiaddr = addr;
Linus Torvalds's avatar
Linus Torvalds committed
1249
1250
1251
1252
1253
1254
	/* initial mode is (EX, empty) */
	im->sfmode = MCAST_EXCLUDE;
	im->sfcount[MCAST_EXCLUDE] = 1;
	atomic_set(&im->refcnt, 1);
	spin_lock_init(&im->lock);
#ifdef CONFIG_IP_MULTICAST
1255
	setup_timer(&im->timer, &igmp_timer_expire, (unsigned long)im);
Linus Torvalds's avatar
Linus Torvalds committed
1256
1257
	im->unsolicit_count = IGMP_Unsolicited_Report_Count;
#endif
1258
1259

	im->next_rcu = in_dev->mc_list;
Rami Rosen's avatar
Rami Rosen committed
1260
	in_dev->mc_count++;
1261
1262
	rcu_assign_pointer(in_dev->mc_list, im);

Linus Torvalds's avatar
Linus Torvalds committed
1263
1264
1265
1266
1267
1268
1269
1270
1271
#ifdef CONFIG_IP_MULTICAST
	igmpv3_del_delrec(in_dev, im->multiaddr);
#endif
	igmp_group_added(im);
	if (!in_dev->dead)
		ip_rt_multicast_event(in_dev);
out:
	return;
}
1272
EXPORT_SYMBOL(ip_mc_inc_group);
Linus Torvalds's avatar
Linus Torvalds committed
1273

1274
1275
/*
 *	Resend IGMP JOIN report; used for bonding.
Eric Dumazet's avatar
Eric Dumazet committed
1276
 *	Called with rcu_read_lock()
1277
 */
Eric Dumazet's avatar
Eric Dumazet committed
1278
void ip_mc_rejoin_groups(struct in_device *in_dev)
1279
{
1280
#ifdef CONFIG_IP_MULTICAST
Eric Dumazet's avatar
Eric Dumazet committed
1281
1282
	struct ip_mc_list *im;
	int type;
1283

Eric Dumazet's avatar
Eric Dumazet committed
1284
1285
1286
	for_each_pmc_rcu(in_dev, im) {
		if (im->multiaddr == IGMP_ALL_HOSTS)
			continue;
1287

Eric Dumazet's avatar
Eric Dumazet committed
1288
1289
1290
1291
1292
1293
1294
1295
1296
1297
1298
		/* a failover is happening and switches
		 * must be notified immediately
		 */
		if (IGMP_V1_SEEN(in_dev))
			type = IGMP_HOST_MEMBERSHIP_REPORT;
		else if (IGMP_V2_SEEN(in_dev))
			type = IGMPV2_HOST_MEMBERSHIP_REPORT;
		else
			type = IGMPV3_HOST_MEMBERSHIP_REPORT;
		igmp_send_report(in_dev, im, type);
	}
1299
1300
#endif
}
Eric Dumazet's avatar
Eric Dumazet committed
1301
EXPORT_SYMBOL(ip_mc_rejoin_groups);
1302

Linus Torvalds's avatar
Linus Torvalds committed
1303
1304
1305
1306
/*
 *	A socket has left a multicast group on device dev
 */

1307
void ip_mc_dec_group(struct in_device *in_dev, __be32 addr)
Linus Torvalds's avatar
Linus Torvalds committed
1308
{
1309
1310
	struct ip_mc_list *i;
	struct ip_mc_list __rcu **ip;
1311

Linus Torvalds's avatar
Linus Torvalds committed
1312
	ASSERT_RTNL();
1313

1314
1315
1316
	for (ip = &in_dev->mc_list;
	     (i = rtnl_dereference(*ip)) != NULL;
	     ip = &i->next_rcu) {
Jianjun Kong's avatar
Jianjun Kong committed
1317
		if (i->multiaddr == addr) {
Linus Torvalds's avatar
Linus Torvalds committed
1318
			if (--i->users == 0) {
1319
				*ip = i->next_rcu;
Rami Rosen's avatar
Rami Rosen committed
1320
				in_dev->mc_count--;
Linus Torvalds's avatar
Linus Torvalds committed
1321
1322
1323
1324
1325
1326
1327
1328
1329
1330
1331
1332
				igmp_group_dropped(i);

				if (!in_dev->dead)
					ip_rt_multicast_event(in_dev);

				ip_ma_put(i);
				return;
			}
			break;
		}
	}
}
1333
EXPORT_SYMBOL(ip_mc_dec_group);
Linus Torvalds's avatar
Linus Torvalds committed
1334

1335
1336
1337
1338
/* Device changing type */

void ip_mc_unmap(struct in_device *in_dev)
{
1339
	struct ip_mc_list *pmc;
1340
1341
1342

	ASSERT_RTNL();

1343
1344
	for_each_pmc_rtnl(in_dev, pmc)
		igmp_group_dropped(pmc);
1345
1346
1347
1348
}

void ip_mc_remap(struct in_device *in_dev)
{
1349
	struct ip_mc_list *pmc;
1350
1351
1352

	ASSERT_RTNL();

1353
1354
	for_each_pmc_rtnl(in_dev, pmc)
		igmp_group_added(pmc);
1355
1356
}

Linus Torvalds's avatar
Linus Torvalds committed
1357
1358
1359
1360
/* Device going down */

void ip_mc_down(struct in_device *in_dev)
{
1361
	struct ip_mc_list *pmc;
Linus Torvalds's avatar
Linus Torvalds committed
1362
1363
1364

	ASSERT_RTNL();

1365
1366
	for_each_pmc_rtnl(in_dev, pmc)
		igmp_group_dropped(pmc);
Linus Torvalds's avatar
Linus Torvalds committed
1367
1368
1369
1370
1371
1372
1373
1374
1375
1376
1377
1378
1379
1380
1381
1382
1383
1384
1385
1386
1387

#ifdef CONFIG_IP_MULTICAST
	in_dev->mr_ifc_count = 0;
	if (del_timer(&in_dev->mr_ifc_timer))
		__in_dev_put(in_dev);
	in_dev->mr_gq_running = 0;
	if (del_timer(&in_dev->mr_gq_timer))
		__in_dev_put(in_dev);
	igmpv3_clear_delrec(in_dev);
#endif

	ip_mc_dec_group(in_dev, IGMP_ALL_HOSTS);
}

void ip_mc_init_dev(struct in_device *in_dev)
{
	ASSERT_RTNL();

	in_dev->mc_tomb = NULL;
#ifdef CONFIG_IP_MULTICAST
	in_dev->mr_gq_running = 0;
1388
1389
	setup_timer(&in_dev->mr_gq_timer, igmp_gq_timer_expire,
			(unsigned long)in_dev);
Linus Torvalds's avatar
Linus Torvalds committed
1390
	in_dev->mr_ifc_count = 0;
Rami Rosen's avatar
Rami Rosen committed
1391
	in_dev->mc_count     = 0;
1392
1393
	setup_timer(&in_dev->mr_ifc_timer, igmp_ifc_timer_expire,
			(unsigned long)in_dev);
Linus Torvalds's avatar
Linus Torvalds committed
1394
1395
1396
1397
1398
1399
1400
1401
1402
1403
	in_dev->mr_qrv = IGMP_Unsolicited_Report_Count;
#endif

	spin_lock_init(&in_dev->mc_tomb_lock);
}

/* Device going up */

void ip_mc_up(struct in_device *in_dev)
{
1404
	struct ip_mc_list *pmc;
Linus Torvalds's avatar
Linus Torvalds committed
1405
1406
1407
1408
1409

	ASSERT_RTNL();

	ip_mc_inc_group(in_dev, IGMP_ALL_HOSTS);

1410
1411
	for_each_pmc_rtnl(in_dev, pmc)
		igmp_group_added(pmc);
Linus Torvalds's avatar
Linus Torvalds committed
1412
1413
1414
1415
1416
1417
1418
1419
1420
1421
1422
1423
1424
1425
1426
}

/*
 *	Device is about to be destroyed: clean up.
 */

void ip_mc_destroy_dev(struct in_device *in_dev)
{
	struct ip_mc_list *i;

	ASSERT_RTNL();

	/* Deactivate timers */
	ip_mc_down(in_dev);

1427
1428
	while ((i = rtnl_dereference(in_dev->mc_list)) != NULL) {
		in_dev->mc_list = i->next_rcu;
Rami Rosen's avatar
Rami Rosen committed
1429
		in_dev->mc_count--;
1430

Linus Torvalds's avatar
Linus Torvalds committed
1431
1432
1433
1434
1435
		igmp_group_dropped(i);
		ip_ma_put(i);
	}
}

1436
/* RTNL is locked */
1437
static struct in_device *ip_mc_find_dev(struct net *net, struct ip_mreqn *imr)
Linus Torvalds's avatar
Linus Torvalds committed
1438
1439
1440
1441
1442
{
	struct net_device *dev = NULL;
	struct in_device *idev = NULL;

	if (imr->imr_ifindex) {
1443
		idev = inetdev_by_index(net, imr->imr_ifindex);
Linus Torvalds's avatar
Linus Torvalds committed
1444
1445
1446
		return idev;
	}
	if (imr->imr_address.s_addr) {
1447
		dev = __ip_dev_find(net, imr->imr_address.s_addr, false);
Linus Torvalds's avatar
Linus Torvalds committed
1448
1449
1450
1451
		if (!dev)
			return NULL;
	}

1452
	if (!dev) {
1453
1454
1455
		struct rtable *rt = ip_route_output(net,
						    imr->imr_multiaddr.s_addr,
						    0, 0, 0);
1456
1457
1458
1459
		if (!IS_ERR(rt)) {
			dev = rt->dst.dev;
			ip_rt_put(rt);
		}
Linus Torvalds's avatar
Linus Torvalds committed
1460
1461
1462
	}
	if (dev) {
		imr->imr_ifindex = dev->ifindex;
1463
		idev = __in_dev_get_rtnl(dev);
Linus Torvalds's avatar
Linus Torvalds committed
1464
1465
1466
1467
1468
1469
1470
	}
	return idev;
}

/*
 *	Join a socket to a group
 */
1471
1472
int sysctl_igmp_max_memberships __read_mostly = IP_MAX_MEMBERSHIPS;
int sysctl_igmp_max_msf __read_mostly = IP_MAX_MSF;
Linus Torvalds's avatar
Linus Torvalds committed
1473
1474
1475


static int ip_mc_del1_src(struct ip_mc_list *pmc, int sfmode,
1476
	__be32 *psfsrc)
Linus Torvalds's avatar
Linus Torvalds committed
1477
1478
1479
1480
1481
1482
1483
1484
1485
1486
1487
1488
1489
1490
1491
1492
1493
1494
1495
1496
1497
1498
1499
1500
1501
1502
1503
1504
1505
1506
1507
{
	struct ip_sf_list *psf, *psf_prev;
	int rv = 0;

	psf_prev = NULL;
	for (psf=pmc->sources; psf; psf=psf->sf_next) {
		if (psf->sf_inaddr == *psfsrc)
			break;
		psf_prev = psf;
	}
	if (!psf || psf->sf_count[sfmode] == 0) {
		/* source filter not found, or count wrong =>  bug */
		return -ESRCH;
	}
	psf->sf_count[sfmode]--;
	if (psf->sf_count[sfmode] == 0) {
		ip_rt_multicast_event(pmc->interface);
	}
	if (!psf->sf_count[MCAST_INCLUDE] && !psf->sf_count[MCAST_EXCLUDE]) {
#ifdef CONFIG_IP_MULTICAST
		struct in_device *in_dev = pmc->interface;
#endif

		/* no more filters for this source */
		if (psf_prev)
			psf_prev->sf_next = psf->sf_next;
		else
			pmc->sources = psf->sf_next;
#ifdef CONFIG_IP_MULTICAST
		if (psf->sf_oldin &&
		    !IGMP_V1_SEEN(in_dev) && !IGMP_V2_SEEN(in_dev)) {
1508
			psf->sf_crcount = in_dev->mr_qrv ? in_dev->mr_qrv :
Linus Torvalds's avatar
Linus Torvalds committed
1509
1510
1511
1512
1513
1514
1515
1516
1517
1518
1519
1520
1521
1522
1523
				IGMP_Unsolicited_Report_Count;
			psf->sf_next = pmc->tomb;
			pmc->tomb = psf;
			rv = 1;
		} else
#endif
			kfree(psf);
	}
	return rv;
}

#ifndef CONFIG_IP_MULTICAST
#define igmp_ifc_event(x)	do { } while (0)
#endif

1524
1525
static int ip_mc_del_src(struct in_device *in_dev, __be32 *pmca, int sfmode,
			 int sfcount, __be32 *psfsrc, int delta)
Linus Torvalds's avatar
Linus Torvalds committed
1526
1527
1528
1529
1530
1531
1532
{
	struct ip_mc_list *pmc;
	int	changerec = 0;
	int	i, err;

	if (!in_dev)
		return -ENODEV;
1533
1534
	rcu_read_lock();
	for_each_pmc_rcu(in_dev, pmc) {
Linus Torvalds's avatar
Linus Torvalds committed
1535
1536
1537
1538
1539
		if (*pmca == pmc->multiaddr)
			break;
	}
	if (!pmc) {
		/* MCA not found?? bug */
1540
		rcu_read_unlock();
Linus Torvalds's avatar
Linus Torvalds committed
1541
1542
1543
		return -ESRCH;
	}
	spin_lock_bh(&pmc->lock);
1544
	rcu_read_unlock();
Linus Torvalds's avatar
Linus Torvalds committed
1545
1546
1547
1548
1549
1550
1551
1552
1553
1554
1555
1556
1557
1558
1559
1560
1561
1562
1563
1564
1565
1566
1567
1568
1569
1570
1571
#ifdef CONFIG_IP_MULTICAST
	sf_markstate(pmc);
#endif
	if (!delta) {
		err = -EINVAL;
		if (!pmc->sfcount[sfmode])
			goto out_unlock;
		pmc->sfcount[sfmode]--;
	}
	err = 0;
	for (i=0; i<sfcount; i++) {
		int rv = ip_mc_del1_src(pmc, sfmode, &psfsrc[i]);

		changerec |= rv > 0;
		if (!err && rv < 0)
			err = rv;
	}
	if (pmc->sfmode == MCAST_EXCLUDE &&
	    pmc->sfcount[MCAST_EXCLUDE] == 0 &&
	    pmc->sfcount[MCAST_INCLUDE]) {
#ifdef CONFIG_IP_MULTICAST
		struct ip_sf_list *psf;
#endif

		/* filter mode change */
		pmc->sfmode = MCAST_INCLUDE;
#ifdef CONFIG_IP_MULTICAST
1572
		pmc->crcount = in_dev->mr_qrv ? in_dev->mr_qrv :
Linus Torvalds's avatar
Linus Torvalds committed
1573
1574
1575
1576
1577
1578
1579
1580
1581
1582
1583
1584
1585
1586
1587
1588
1589
1590
			IGMP_Unsolicited_Report_Count;
		in_dev->mr_ifc_count = pmc->crcount;
		for (psf=pmc->sources; psf; psf = psf->sf_next)
			psf->sf_crcount = 0;
		igmp_ifc_event(pmc->interface);
	} else if (sf_setstate(pmc) || changerec) {
		igmp_ifc_event(pmc->interface);
#endif
	}
out_unlock:
	spin_unlock_bh(&pmc->lock);
	return err;
}

/*
 * Add multicast single-source filter to the interface list
 */
static int ip_mc_add1_src(struct ip_mc_list *pmc, int sfmode,
1591
	__be32 *psfsrc, int delta)
Linus Torvalds's avatar
Linus Torvalds committed
1592
1593
1594
1595
1596
1597
1598
1599
1600
1601
{
	struct ip_sf_list *psf, *psf_prev;

	psf_prev = NULL;
	for (psf=pmc->sources; psf; psf=psf->sf_next) {
		if (psf->sf_inaddr == *psfsrc)
			break;
		psf_prev = psf;
	}
	if (!psf) {
1602
		psf = kzalloc(sizeof(*psf), GFP_ATOMIC);
Linus Torvalds's avatar
Linus Torvalds committed
1603
1604
1605
1606
1607
1608
1609
1610
1611
1612
1613
1614
1615
1616
1617
1618
1619
1620
1621
1622
1623
1624
1625
1626
1627
1628
1629
1630
1631
1632
1633
1634
		if (!psf)
			return -ENOBUFS;
		psf->sf_inaddr = *psfsrc;
		if (psf_prev) {
			psf_prev->sf_next = psf;
		} else
			pmc->sources = psf;
	}
	psf->sf_count[sfmode]++;
	if (psf->sf_count[sfmode] == 1) {
		ip_rt_multicast_event(pmc->interface);
	}
	return 0;
}

#ifdef CONFIG_IP_MULTICAST
static void sf_markstate(struct ip_mc_list *pmc)
{
	struct ip_sf_list *psf;
	int mca_xcount = pmc->sfcount[MCAST_EXCLUDE];

	for (psf=pmc->sources; psf; psf=psf->sf_next)
		if (pmc->sfcount[MCAST_EXCLUDE]) {
			psf->sf_oldin = mca_xcount ==
				psf->sf_count[MCAST_EXCLUDE] &&
				!psf->sf_count[MCAST_INCLUDE];
		} else
			psf->sf_oldin = psf->sf_count[MCAST_INCLUDE] != 0;
}

static int sf_setstate(struct ip_mc_list *pmc)
{
1635
	struct ip_sf_list *psf, *dpsf;
Linus Torvalds's avatar
Linus Torvalds committed
1636
1637
1638
1639
1640
1641
1642
1643
1644
1645
1646
	int mca_xcount = pmc->sfcount[MCAST_EXCLUDE];
	int qrv = pmc->interface->mr_qrv;
	int new_in, rv;

	rv = 0;
	for (psf=pmc->sources; psf; psf=psf->sf_next) {
		if (pmc->sfcount[MCAST_EXCLUDE]) {
			new_in = mca_xcount == psf->sf_count[MCAST_EXCLUDE] &&
				!psf->sf_count[MCAST_INCLUDE];
		} else
			new_in = psf->sf_count[MCAST_INCLUDE] != 0;
1647
1648
		if (new_in) {
			if (!psf->sf_oldin) {
Al Viro's avatar
Al Viro committed
1649
				struct ip_sf_list *prev = NULL;
1650
1651
1652
1653
1654
1655
1656
1657
1658
1659
1660
1661
1662
1663
1664
1665
1666
1667
1668
1669
1670
1671
1672
1673
1674
1675
1676

				for (dpsf=pmc->tomb; dpsf; dpsf=dpsf->sf_next) {
					if (dpsf->sf_inaddr == psf->sf_inaddr)
						break;
					prev = dpsf;
				}
				if (dpsf) {
					if (prev)
						prev->sf_next = dpsf->sf_next;
					else
						pmc->tomb = dpsf->sf_next;
					kfree(dpsf);
				}
				psf->sf_crcount = qrv;
				rv++;
			}
		} else if (psf->sf_oldin) {

			psf->sf_crcount = 0;
			/*
			 * add or update "delete" records if an active filter
			 * is now inactive
			 */
			for (dpsf=pmc->tomb; dpsf; dpsf=dpsf->sf_next)
				if (dpsf->sf_inaddr == psf->sf_inaddr)
					break;
			if (!dpsf) {
1677
				dpsf = kmalloc(sizeof(*dpsf), GFP_ATOMIC);
1678
1679
1680
1681
1682
1683
1684
1685
				if (!dpsf)
					continue;
				*dpsf = *psf;
				/* pmc->lock held by callers */
				dpsf->sf_next = pmc->tomb;
				pmc->tomb = dpsf;
			}
			dpsf->sf_crcount = qrv;