1 /*
2  *	Linux NET3:	Multicast List maintenance.
3  *
4  *	Authors:
5  *		Tim Kordas <tjk@nostromo.eeap.cwru.edu>
6  *		Richard Underwood <richard@wuzz.demon.co.uk>
7  *
8  *	Stir fried together from the IP multicast and CAP patches above
9  *		Alan Cox <Alan.Cox@linux.org>
10  *
11  *	Fixes:
12  *		Alan Cox	:	Update the device on a real delete
13  *					rather than any time but...
14  *		Alan Cox	:	IFF_ALLMULTI support.
15  *		Alan Cox	: 	New format set_multicast_list() calls.
16  *		Gleb Natapov    :       Remove dev_mc_lock.
17  *
18  *	This program is free software; you can redistribute it and/or
19  *	modify it under the terms of the GNU General Public License
20  *	as published by the Free Software Foundation; either version
21  *	2 of the License, or (at your option) any later version.
22  */
23 
24 #include <linux/config.h>
25 #include <asm/uaccess.h>
26 #include <asm/system.h>
27 #include <asm/bitops.h>
28 #include <linux/types.h>
29 #include <linux/kernel.h>
30 #include <linux/sched.h>
31 #include <linux/string.h>
32 #include <linux/mm.h>
33 #include <linux/socket.h>
34 #include <linux/sockios.h>
35 #include <linux/in.h>
36 #include <linux/errno.h>
37 #include <linux/interrupt.h>
38 #include <linux/if_ether.h>
39 #include <linux/inet.h>
40 #include <linux/netdevice.h>
41 #include <linux/etherdevice.h>
42 #include <linux/proc_fs.h>
43 #include <linux/init.h>
44 #include <net/ip.h>
45 #include <net/route.h>
46 #include <linux/skbuff.h>
47 #include <net/sock.h>
48 #include <net/arp.h>
49 
50 
51 /*
52  *	Device multicast list maintenance.
53  *
54  *	This is used both by IP and by the user level maintenance functions.
55  *	Unlike BSD we maintain a usage count on a given multicast address so
56  *	that a casual user application can add/delete multicasts used by
57  *	protocols without doing damage to the protocols when it deletes the
58  *	entries. It also helps IP as it tracks overlapping maps.
59  *
60  *	Device mc lists are changed by bh at least if IPv6 is enabled,
61  *	so that it must be bh protected.
62  *
63  *	We block accesses to device mc filters with dev->xmit_lock.
64  */
65 
66 /*
67  *	Update the multicast list into the physical NIC controller.
68  */
69 
__dev_mc_upload(struct net_device * dev)70 static void __dev_mc_upload(struct net_device *dev)
71 {
72 	/* Don't do anything till we up the interface
73 	 * [dev_open will call this function so the list will
74 	 * stay sane]
75 	 */
76 
77 	if (!(dev->flags&IFF_UP))
78 		return;
79 
80 	/*
81 	 *	Devices with no set multicast or which have been
82 	 *	detached don't get set.
83 	 */
84 
85 	if (dev->set_multicast_list == NULL ||
86 	    !netif_device_present(dev))
87 		return;
88 
89 	dev->set_multicast_list(dev);
90 }
91 
dev_mc_upload(struct net_device * dev)92 void dev_mc_upload(struct net_device *dev)
93 {
94 	spin_lock_bh(&dev->xmit_lock);
95 	__dev_mc_upload(dev);
96 	spin_unlock_bh(&dev->xmit_lock);
97 }
98 
99 /*
100  *	Delete a device level multicast
101  */
102 
dev_mc_delete(struct net_device * dev,void * addr,int alen,int glbl)103 int dev_mc_delete(struct net_device *dev, void *addr, int alen, int glbl)
104 {
105 	int err = 0;
106 	struct dev_mc_list *dmi, **dmip;
107 
108 	spin_lock_bh(&dev->xmit_lock);
109 
110 	for (dmip = &dev->mc_list; (dmi = *dmip) != NULL; dmip = &dmi->next) {
111 		/*
112 		 *	Find the entry we want to delete. The device could
113 		 *	have variable length entries so check these too.
114 		 */
115 		if (memcmp(dmi->dmi_addr, addr, dmi->dmi_addrlen) == 0 &&
116 		    alen == dmi->dmi_addrlen) {
117 			if (glbl) {
118 				int old_glbl = dmi->dmi_gusers;
119 				dmi->dmi_gusers = 0;
120 				if (old_glbl == 0)
121 					break;
122 			}
123 			if (--dmi->dmi_users)
124 				goto done;
125 
126 			/*
127 			 *	Last user. So delete the entry.
128 			 */
129 			*dmip = dmi->next;
130 			dev->mc_count--;
131 
132 			kfree(dmi);
133 
134 			/*
135 			 *	We have altered the list, so the card
136 			 *	loaded filter is now wrong. Fix it
137 			 */
138 			__dev_mc_upload(dev);
139 
140 			spin_unlock_bh(&dev->xmit_lock);
141 			return 0;
142 		}
143 	}
144 	err = -ENOENT;
145 done:
146 	spin_unlock_bh(&dev->xmit_lock);
147 	return err;
148 }
149 
150 /*
151  *	Add a device level multicast
152  */
153 
dev_mc_add(struct net_device * dev,void * addr,int alen,int glbl)154 int dev_mc_add(struct net_device *dev, void *addr, int alen, int glbl)
155 {
156 	int err = 0;
157 	struct dev_mc_list *dmi, *dmi1;
158 
159 	dmi1 = (struct dev_mc_list *)kmalloc(sizeof(*dmi), GFP_ATOMIC);
160 
161 	spin_lock_bh(&dev->xmit_lock);
162 	for (dmi = dev->mc_list; dmi != NULL; dmi = dmi->next) {
163 		if (memcmp(dmi->dmi_addr, addr, dmi->dmi_addrlen) == 0 &&
164 		    dmi->dmi_addrlen == alen) {
165 			if (glbl) {
166 				int old_glbl = dmi->dmi_gusers;
167 				dmi->dmi_gusers = 1;
168 				if (old_glbl)
169 					goto done;
170 			}
171 			dmi->dmi_users++;
172 			goto done;
173 		}
174 	}
175 
176 	if ((dmi = dmi1) == NULL) {
177 		spin_unlock_bh(&dev->xmit_lock);
178 		return -ENOMEM;
179 	}
180 	memcpy(dmi->dmi_addr, addr, alen);
181 	dmi->dmi_addrlen = alen;
182 	dmi->next = dev->mc_list;
183 	dmi->dmi_users = 1;
184 	dmi->dmi_gusers = glbl ? 1 : 0;
185 	dev->mc_list = dmi;
186 	dev->mc_count++;
187 
188 	__dev_mc_upload(dev);
189 
190 	spin_unlock_bh(&dev->xmit_lock);
191 	return 0;
192 
193 done:
194 	spin_unlock_bh(&dev->xmit_lock);
195 	if (dmi1)
196 		kfree(dmi1);
197 	return err;
198 }
199 
200 /*
201  *	Discard multicast list when a device is downed
202  */
203 
dev_mc_discard(struct net_device * dev)204 void dev_mc_discard(struct net_device *dev)
205 {
206 	spin_lock_bh(&dev->xmit_lock);
207 
208 	while (dev->mc_list != NULL) {
209 		struct dev_mc_list *tmp = dev->mc_list;
210 		dev->mc_list = tmp->next;
211 		if (tmp->dmi_users > tmp->dmi_gusers)
212 			printk("dev_mc_discard: multicast leakage! dmi_users=%d\n", tmp->dmi_users);
213 		kfree(tmp);
214 	}
215 	dev->mc_count = 0;
216 
217 	spin_unlock_bh(&dev->xmit_lock);
218 }
219 
220 #ifdef CONFIG_PROC_FS
dev_mc_read_proc(char * buffer,char ** start,off_t offset,int length,int * eof,void * data)221 static int dev_mc_read_proc(char *buffer, char **start, off_t offset,
222 			    int length, int *eof, void *data)
223 {
224 	off_t pos = 0, begin = 0;
225 	struct dev_mc_list *m;
226 	int len = 0;
227 	struct net_device *dev;
228 
229 	read_lock(&dev_base_lock);
230 	for (dev = dev_base; dev; dev = dev->next) {
231 		spin_lock_bh(&dev->xmit_lock);
232 		for (m = dev->mc_list; m; m = m->next) {
233 			int i;
234 
235 			len += sprintf(buffer+len,"%-4d %-15s %-5d %-5d ", dev->ifindex,
236 				       dev->name, m->dmi_users, m->dmi_gusers);
237 
238 			for (i = 0; i < m->dmi_addrlen; i++)
239 				len += sprintf(buffer+len, "%02x", m->dmi_addr[i]);
240 
241 			len += sprintf(buffer+len, "\n");
242 
243 			pos = begin + len;
244 			if (pos < offset) {
245 				len = 0;
246 				begin = pos;
247 			}
248 			if (pos > offset + length) {
249 				spin_unlock_bh(&dev->xmit_lock);
250 				goto done;
251 			}
252 		}
253 		spin_unlock_bh(&dev->xmit_lock);
254 	}
255 	*eof = 1;
256 
257 done:
258 	read_unlock(&dev_base_lock);
259 	*start = buffer + (offset - begin);
260 	len -= (offset - begin);
261 	if (len > length)
262 		len = length;
263 	if (len < 0)
264 		len = 0;
265 	return len;
266 }
267 #endif
268 
dev_mcast_init(void)269 void __init dev_mcast_init(void)
270 {
271 #ifdef CONFIG_PROC_FS
272 	create_proc_read_entry("net/dev_mcast", 0, 0, dev_mc_read_proc, NULL);
273 #endif
274 }
275 
276