1 /* net/atm/clip.c - RFC1577 Classical IP over ATM */
2 
3 /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
4 
5 #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
6 
7 #include <linux/string.h>
8 #include <linux/errno.h>
9 #include <linux/kernel.h> /* for UINT_MAX */
10 #include <linux/module.h>
11 #include <linux/init.h>
12 #include <linux/netdevice.h>
13 #include <linux/skbuff.h>
14 #include <linux/wait.h>
15 #include <linux/timer.h>
16 #include <linux/if_arp.h> /* for some manifest constants */
17 #include <linux/notifier.h>
18 #include <linux/atm.h>
19 #include <linux/atmdev.h>
20 #include <linux/atmclip.h>
21 #include <linux/atmarp.h>
22 #include <linux/capability.h>
23 #include <linux/ip.h> /* for net/route.h */
24 #include <linux/in.h> /* for struct sockaddr_in */
25 #include <linux/if.h> /* for IFF_UP */
26 #include <linux/inetdevice.h>
27 #include <linux/bitops.h>
28 #include <linux/poison.h>
29 #include <linux/proc_fs.h>
30 #include <linux/seq_file.h>
31 #include <linux/rcupdate.h>
32 #include <linux/jhash.h>
33 #include <linux/slab.h>
34 #include <net/route.h> /* for struct rtable and routing */
35 #include <net/icmp.h> /* icmp_send */
36 #include <net/arp.h>
37 #include <linux/param.h> /* for HZ */
38 #include <linux/uaccess.h>
39 #include <asm/byteorder.h> /* for htons etc. */
40 #include <asm/system.h> /* save/restore_flags */
41 #include <linux/atomic.h>
42 
43 #include "common.h"
44 #include "resources.h"
45 #include <net/atmclip.h>
46 
47 static struct net_device *clip_devs;
48 static struct atm_vcc *atmarpd;
49 static struct timer_list idle_timer;
50 static const struct neigh_ops clip_neigh_ops;
51 
to_atmarpd(enum atmarp_ctrl_type type,int itf,__be32 ip)52 static int to_atmarpd(enum atmarp_ctrl_type type, int itf, __be32 ip)
53 {
54 	struct sock *sk;
55 	struct atmarp_ctrl *ctrl;
56 	struct sk_buff *skb;
57 
58 	pr_debug("(%d)\n", type);
59 	if (!atmarpd)
60 		return -EUNATCH;
61 	skb = alloc_skb(sizeof(struct atmarp_ctrl), GFP_ATOMIC);
62 	if (!skb)
63 		return -ENOMEM;
64 	ctrl = (struct atmarp_ctrl *)skb_put(skb, sizeof(struct atmarp_ctrl));
65 	ctrl->type = type;
66 	ctrl->itf_num = itf;
67 	ctrl->ip = ip;
68 	atm_force_charge(atmarpd, skb->truesize);
69 
70 	sk = sk_atm(atmarpd);
71 	skb_queue_tail(&sk->sk_receive_queue, skb);
72 	sk->sk_data_ready(sk, skb->len);
73 	return 0;
74 }
75 
link_vcc(struct clip_vcc * clip_vcc,struct atmarp_entry * entry)76 static void link_vcc(struct clip_vcc *clip_vcc, struct atmarp_entry *entry)
77 {
78 	pr_debug("%p to entry %p (neigh %p)\n", clip_vcc, entry, entry->neigh);
79 	clip_vcc->entry = entry;
80 	clip_vcc->xoff = 0;	/* @@@ may overrun buffer by one packet */
81 	clip_vcc->next = entry->vccs;
82 	entry->vccs = clip_vcc;
83 	entry->neigh->used = jiffies;
84 }
85 
unlink_clip_vcc(struct clip_vcc * clip_vcc)86 static void unlink_clip_vcc(struct clip_vcc *clip_vcc)
87 {
88 	struct atmarp_entry *entry = clip_vcc->entry;
89 	struct clip_vcc **walk;
90 
91 	if (!entry) {
92 		pr_crit("!clip_vcc->entry (clip_vcc %p)\n", clip_vcc);
93 		return;
94 	}
95 	netif_tx_lock_bh(entry->neigh->dev);	/* block clip_start_xmit() */
96 	entry->neigh->used = jiffies;
97 	for (walk = &entry->vccs; *walk; walk = &(*walk)->next)
98 		if (*walk == clip_vcc) {
99 			int error;
100 
101 			*walk = clip_vcc->next;	/* atomic */
102 			clip_vcc->entry = NULL;
103 			if (clip_vcc->xoff)
104 				netif_wake_queue(entry->neigh->dev);
105 			if (entry->vccs)
106 				goto out;
107 			entry->expires = jiffies - 1;
108 			/* force resolution or expiration */
109 			error = neigh_update(entry->neigh, NULL, NUD_NONE,
110 					     NEIGH_UPDATE_F_ADMIN);
111 			if (error)
112 				pr_crit("neigh_update failed with %d\n", error);
113 			goto out;
114 		}
115 	pr_crit("ATMARP: failed (entry %p, vcc 0x%p)\n", entry, clip_vcc);
116 out:
117 	netif_tx_unlock_bh(entry->neigh->dev);
118 }
119 
120 /* The neighbour entry n->lock is held. */
neigh_check_cb(struct neighbour * n)121 static int neigh_check_cb(struct neighbour *n)
122 {
123 	struct atmarp_entry *entry = neighbour_priv(n);
124 	struct clip_vcc *cv;
125 
126 	if (n->ops != &clip_neigh_ops)
127 		return 0;
128 	for (cv = entry->vccs; cv; cv = cv->next) {
129 		unsigned long exp = cv->last_use + cv->idle_timeout;
130 
131 		if (cv->idle_timeout && time_after(jiffies, exp)) {
132 			pr_debug("releasing vcc %p->%p of entry %p\n",
133 				 cv, cv->vcc, entry);
134 			vcc_release_async(cv->vcc, -ETIMEDOUT);
135 		}
136 	}
137 
138 	if (entry->vccs || time_before(jiffies, entry->expires))
139 		return 0;
140 
141 	if (atomic_read(&n->refcnt) > 1) {
142 		struct sk_buff *skb;
143 
144 		pr_debug("destruction postponed with ref %d\n",
145 			 atomic_read(&n->refcnt));
146 
147 		while ((skb = skb_dequeue(&n->arp_queue)) != NULL)
148 			dev_kfree_skb(skb);
149 
150 		return 0;
151 	}
152 
153 	pr_debug("expired neigh %p\n", n);
154 	return 1;
155 }
156 
idle_timer_check(unsigned long dummy)157 static void idle_timer_check(unsigned long dummy)
158 {
159 	write_lock(&arp_tbl.lock);
160 	__neigh_for_each_release(&arp_tbl, neigh_check_cb);
161 	mod_timer(&idle_timer, jiffies + CLIP_CHECK_INTERVAL * HZ);
162 	write_unlock(&arp_tbl.lock);
163 }
164 
clip_arp_rcv(struct sk_buff * skb)165 static int clip_arp_rcv(struct sk_buff *skb)
166 {
167 	struct atm_vcc *vcc;
168 
169 	pr_debug("\n");
170 	vcc = ATM_SKB(skb)->vcc;
171 	if (!vcc || !atm_charge(vcc, skb->truesize)) {
172 		dev_kfree_skb_any(skb);
173 		return 0;
174 	}
175 	pr_debug("pushing to %p\n", vcc);
176 	pr_debug("using %p\n", CLIP_VCC(vcc)->old_push);
177 	CLIP_VCC(vcc)->old_push(vcc, skb);
178 	return 0;
179 }
180 
181 static const unsigned char llc_oui[] = {
182 	0xaa,	/* DSAP: non-ISO */
183 	0xaa,	/* SSAP: non-ISO */
184 	0x03,	/* Ctrl: Unnumbered Information Command PDU */
185 	0x00,	/* OUI: EtherType */
186 	0x00,
187 	0x00
188 };
189 
clip_push(struct atm_vcc * vcc,struct sk_buff * skb)190 static void clip_push(struct atm_vcc *vcc, struct sk_buff *skb)
191 {
192 	struct clip_vcc *clip_vcc = CLIP_VCC(vcc);
193 
194 	pr_debug("\n");
195 
196 	if (!clip_devs) {
197 		atm_return(vcc, skb->truesize);
198 		kfree_skb(skb);
199 		return;
200 	}
201 
202 	if (!skb) {
203 		pr_debug("removing VCC %p\n", clip_vcc);
204 		if (clip_vcc->entry)
205 			unlink_clip_vcc(clip_vcc);
206 		clip_vcc->old_push(vcc, NULL);	/* pass on the bad news */
207 		kfree(clip_vcc);
208 		return;
209 	}
210 	atm_return(vcc, skb->truesize);
211 	skb->dev = clip_vcc->entry ? clip_vcc->entry->neigh->dev : clip_devs;
212 	/* clip_vcc->entry == NULL if we don't have an IP address yet */
213 	if (!skb->dev) {
214 		dev_kfree_skb_any(skb);
215 		return;
216 	}
217 	ATM_SKB(skb)->vcc = vcc;
218 	skb_reset_mac_header(skb);
219 	if (!clip_vcc->encap ||
220 	    skb->len < RFC1483LLC_LEN ||
221 	    memcmp(skb->data, llc_oui, sizeof(llc_oui)))
222 		skb->protocol = htons(ETH_P_IP);
223 	else {
224 		skb->protocol = ((__be16 *)skb->data)[3];
225 		skb_pull(skb, RFC1483LLC_LEN);
226 		if (skb->protocol == htons(ETH_P_ARP)) {
227 			skb->dev->stats.rx_packets++;
228 			skb->dev->stats.rx_bytes += skb->len;
229 			clip_arp_rcv(skb);
230 			return;
231 		}
232 	}
233 	clip_vcc->last_use = jiffies;
234 	skb->dev->stats.rx_packets++;
235 	skb->dev->stats.rx_bytes += skb->len;
236 	memset(ATM_SKB(skb), 0, sizeof(struct atm_skb_data));
237 	netif_rx(skb);
238 }
239 
240 /*
241  * Note: these spinlocks _must_not_ block on non-SMP. The only goal is that
242  * clip_pop is atomic with respect to the critical section in clip_start_xmit.
243  */
244 
clip_pop(struct atm_vcc * vcc,struct sk_buff * skb)245 static void clip_pop(struct atm_vcc *vcc, struct sk_buff *skb)
246 {
247 	struct clip_vcc *clip_vcc = CLIP_VCC(vcc);
248 	struct net_device *dev = skb->dev;
249 	int old;
250 	unsigned long flags;
251 
252 	pr_debug("(vcc %p)\n", vcc);
253 	clip_vcc->old_pop(vcc, skb);
254 	/* skb->dev == NULL in outbound ARP packets */
255 	if (!dev)
256 		return;
257 	spin_lock_irqsave(&PRIV(dev)->xoff_lock, flags);
258 	if (atm_may_send(vcc, 0)) {
259 		old = xchg(&clip_vcc->xoff, 0);
260 		if (old)
261 			netif_wake_queue(dev);
262 	}
263 	spin_unlock_irqrestore(&PRIV(dev)->xoff_lock, flags);
264 }
265 
clip_neigh_solicit(struct neighbour * neigh,struct sk_buff * skb)266 static void clip_neigh_solicit(struct neighbour *neigh, struct sk_buff *skb)
267 {
268 	__be32 *ip = (__be32 *) neigh->primary_key;
269 
270 	pr_debug("(neigh %p, skb %p)\n", neigh, skb);
271 	to_atmarpd(act_need, PRIV(neigh->dev)->number, *ip);
272 }
273 
clip_neigh_error(struct neighbour * neigh,struct sk_buff * skb)274 static void clip_neigh_error(struct neighbour *neigh, struct sk_buff *skb)
275 {
276 #ifndef CONFIG_ATM_CLIP_NO_ICMP
277 	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_HOST_UNREACH, 0);
278 #endif
279 	kfree_skb(skb);
280 }
281 
282 static const struct neigh_ops clip_neigh_ops = {
283 	.family =		AF_INET,
284 	.solicit =		clip_neigh_solicit,
285 	.error_report =		clip_neigh_error,
286 	.output =		neigh_direct_output,
287 	.connected_output =	neigh_direct_output,
288 };
289 
clip_constructor(struct neighbour * neigh)290 static int clip_constructor(struct neighbour *neigh)
291 {
292 	struct atmarp_entry *entry = neighbour_priv(neigh);
293 
294 	if (neigh->tbl->family != AF_INET)
295 		return -EINVAL;
296 
297 	if (neigh->type != RTN_UNICAST)
298 		return -EINVAL;
299 
300 	neigh->nud_state = NUD_NONE;
301 	neigh->ops = &clip_neigh_ops;
302 	neigh->output = neigh->ops->output;
303 	entry->neigh = neigh;
304 	entry->vccs = NULL;
305 	entry->expires = jiffies - 1;
306 
307 	return 0;
308 }
309 
310 /* @@@ copy bh locking from arp.c -- need to bh-enable atm code before */
311 
312 /*
313  * We play with the resolve flag: 0 and 1 have the usual meaning, but -1 means
314  * to allocate the neighbour entry but not to ask atmarpd for resolution. Also,
315  * don't increment the usage count. This is used to create entries in
316  * clip_setentry.
317  */
318 
clip_encap(struct atm_vcc * vcc,int mode)319 static int clip_encap(struct atm_vcc *vcc, int mode)
320 {
321 	CLIP_VCC(vcc)->encap = mode;
322 	return 0;
323 }
324 
clip_start_xmit(struct sk_buff * skb,struct net_device * dev)325 static netdev_tx_t clip_start_xmit(struct sk_buff *skb,
326 				   struct net_device *dev)
327 {
328 	struct clip_priv *clip_priv = PRIV(dev);
329 	struct dst_entry *dst = skb_dst(skb);
330 	struct atmarp_entry *entry;
331 	struct neighbour *n;
332 	struct atm_vcc *vcc;
333 	int old;
334 	unsigned long flags;
335 
336 	pr_debug("(skb %p)\n", skb);
337 	if (!dst) {
338 		pr_err("skb_dst(skb) == NULL\n");
339 		dev_kfree_skb(skb);
340 		dev->stats.tx_dropped++;
341 		return NETDEV_TX_OK;
342 	}
343 	n = dst_get_neighbour_noref(dst);
344 	if (!n) {
345 		pr_err("NO NEIGHBOUR !\n");
346 		dev_kfree_skb(skb);
347 		dev->stats.tx_dropped++;
348 		return NETDEV_TX_OK;
349 	}
350 	entry = neighbour_priv(n);
351 	if (!entry->vccs) {
352 		if (time_after(jiffies, entry->expires)) {
353 			/* should be resolved */
354 			entry->expires = jiffies + ATMARP_RETRY_DELAY * HZ;
355 			to_atmarpd(act_need, PRIV(dev)->number, *((__be32 *)n->primary_key));
356 		}
357 		if (entry->neigh->arp_queue.qlen < ATMARP_MAX_UNRES_PACKETS)
358 			skb_queue_tail(&entry->neigh->arp_queue, skb);
359 		else {
360 			dev_kfree_skb(skb);
361 			dev->stats.tx_dropped++;
362 		}
363 		return NETDEV_TX_OK;
364 	}
365 	pr_debug("neigh %p, vccs %p\n", entry, entry->vccs);
366 	ATM_SKB(skb)->vcc = vcc = entry->vccs->vcc;
367 	pr_debug("using neighbour %p, vcc %p\n", n, vcc);
368 	if (entry->vccs->encap) {
369 		void *here;
370 
371 		here = skb_push(skb, RFC1483LLC_LEN);
372 		memcpy(here, llc_oui, sizeof(llc_oui));
373 		((__be16 *) here)[3] = skb->protocol;
374 	}
375 	atomic_add(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc);
376 	ATM_SKB(skb)->atm_options = vcc->atm_options;
377 	entry->vccs->last_use = jiffies;
378 	pr_debug("atm_skb(%p)->vcc(%p)->dev(%p)\n", skb, vcc, vcc->dev);
379 	old = xchg(&entry->vccs->xoff, 1);	/* assume XOFF ... */
380 	if (old) {
381 		pr_warning("XOFF->XOFF transition\n");
382 		return NETDEV_TX_OK;
383 	}
384 	dev->stats.tx_packets++;
385 	dev->stats.tx_bytes += skb->len;
386 	vcc->send(vcc, skb);
387 	if (atm_may_send(vcc, 0)) {
388 		entry->vccs->xoff = 0;
389 		return NETDEV_TX_OK;
390 	}
391 	spin_lock_irqsave(&clip_priv->xoff_lock, flags);
392 	netif_stop_queue(dev);	/* XOFF -> throttle immediately */
393 	barrier();
394 	if (!entry->vccs->xoff)
395 		netif_start_queue(dev);
396 	/* Oh, we just raced with clip_pop. netif_start_queue should be
397 	   good enough, because nothing should really be asleep because
398 	   of the brief netif_stop_queue. If this isn't true or if it
399 	   changes, use netif_wake_queue instead. */
400 	spin_unlock_irqrestore(&clip_priv->xoff_lock, flags);
401 	return NETDEV_TX_OK;
402 }
403 
clip_mkip(struct atm_vcc * vcc,int timeout)404 static int clip_mkip(struct atm_vcc *vcc, int timeout)
405 {
406 	struct clip_vcc *clip_vcc;
407 
408 	if (!vcc->push)
409 		return -EBADFD;
410 	clip_vcc = kmalloc(sizeof(struct clip_vcc), GFP_KERNEL);
411 	if (!clip_vcc)
412 		return -ENOMEM;
413 	pr_debug("%p vcc %p\n", clip_vcc, vcc);
414 	clip_vcc->vcc = vcc;
415 	vcc->user_back = clip_vcc;
416 	set_bit(ATM_VF_IS_CLIP, &vcc->flags);
417 	clip_vcc->entry = NULL;
418 	clip_vcc->xoff = 0;
419 	clip_vcc->encap = 1;
420 	clip_vcc->last_use = jiffies;
421 	clip_vcc->idle_timeout = timeout * HZ;
422 	clip_vcc->old_push = vcc->push;
423 	clip_vcc->old_pop = vcc->pop;
424 	vcc->push = clip_push;
425 	vcc->pop = clip_pop;
426 
427 	/* re-process everything received between connection setup and MKIP */
428 	vcc_process_recv_queue(vcc);
429 
430 	return 0;
431 }
432 
clip_setentry(struct atm_vcc * vcc,__be32 ip)433 static int clip_setentry(struct atm_vcc *vcc, __be32 ip)
434 {
435 	struct neighbour *neigh;
436 	struct atmarp_entry *entry;
437 	int error;
438 	struct clip_vcc *clip_vcc;
439 	struct rtable *rt;
440 
441 	if (vcc->push != clip_push) {
442 		pr_warning("non-CLIP VCC\n");
443 		return -EBADF;
444 	}
445 	clip_vcc = CLIP_VCC(vcc);
446 	if (!ip) {
447 		if (!clip_vcc->entry) {
448 			pr_err("hiding hidden ATMARP entry\n");
449 			return 0;
450 		}
451 		pr_debug("remove\n");
452 		unlink_clip_vcc(clip_vcc);
453 		return 0;
454 	}
455 	rt = ip_route_output(&init_net, ip, 0, 1, 0);
456 	if (IS_ERR(rt))
457 		return PTR_ERR(rt);
458 	neigh = __neigh_lookup(&arp_tbl, &ip, rt->dst.dev, 1);
459 	ip_rt_put(rt);
460 	if (!neigh)
461 		return -ENOMEM;
462 	entry = neighbour_priv(neigh);
463 	if (entry != clip_vcc->entry) {
464 		if (!clip_vcc->entry)
465 			pr_debug("add\n");
466 		else {
467 			pr_debug("update\n");
468 			unlink_clip_vcc(clip_vcc);
469 		}
470 		link_vcc(clip_vcc, entry);
471 	}
472 	error = neigh_update(neigh, llc_oui, NUD_PERMANENT,
473 			     NEIGH_UPDATE_F_OVERRIDE | NEIGH_UPDATE_F_ADMIN);
474 	neigh_release(neigh);
475 	return error;
476 }
477 
478 static const struct net_device_ops clip_netdev_ops = {
479 	.ndo_start_xmit		= clip_start_xmit,
480 	.ndo_neigh_construct	= clip_constructor,
481 };
482 
clip_setup(struct net_device * dev)483 static void clip_setup(struct net_device *dev)
484 {
485 	dev->netdev_ops = &clip_netdev_ops;
486 	dev->type = ARPHRD_ATM;
487 	dev->neigh_priv_len = sizeof(struct atmarp_entry);
488 	dev->hard_header_len = RFC1483LLC_LEN;
489 	dev->mtu = RFC1626_MTU;
490 	dev->tx_queue_len = 100;	/* "normal" queue (packets) */
491 	/* When using a "real" qdisc, the qdisc determines the queue */
492 	/* length. tx_queue_len is only used for the default case, */
493 	/* without any more elaborate queuing. 100 is a reasonable */
494 	/* compromise between decent burst-tolerance and protection */
495 	/* against memory hogs. */
496 	dev->priv_flags &= ~IFF_XMIT_DST_RELEASE;
497 }
498 
clip_create(int number)499 static int clip_create(int number)
500 {
501 	struct net_device *dev;
502 	struct clip_priv *clip_priv;
503 	int error;
504 
505 	if (number != -1) {
506 		for (dev = clip_devs; dev; dev = PRIV(dev)->next)
507 			if (PRIV(dev)->number == number)
508 				return -EEXIST;
509 	} else {
510 		number = 0;
511 		for (dev = clip_devs; dev; dev = PRIV(dev)->next)
512 			if (PRIV(dev)->number >= number)
513 				number = PRIV(dev)->number + 1;
514 	}
515 	dev = alloc_netdev(sizeof(struct clip_priv), "", clip_setup);
516 	if (!dev)
517 		return -ENOMEM;
518 	clip_priv = PRIV(dev);
519 	sprintf(dev->name, "atm%d", number);
520 	spin_lock_init(&clip_priv->xoff_lock);
521 	clip_priv->number = number;
522 	error = register_netdev(dev);
523 	if (error) {
524 		free_netdev(dev);
525 		return error;
526 	}
527 	clip_priv->next = clip_devs;
528 	clip_devs = dev;
529 	pr_debug("registered (net:%s)\n", dev->name);
530 	return number;
531 }
532 
clip_device_event(struct notifier_block * this,unsigned long event,void * arg)533 static int clip_device_event(struct notifier_block *this, unsigned long event,
534 			     void *arg)
535 {
536 	struct net_device *dev = arg;
537 
538 	if (!net_eq(dev_net(dev), &init_net))
539 		return NOTIFY_DONE;
540 
541 	if (event == NETDEV_UNREGISTER)
542 		return NOTIFY_DONE;
543 
544 	/* ignore non-CLIP devices */
545 	if (dev->type != ARPHRD_ATM || dev->netdev_ops != &clip_netdev_ops)
546 		return NOTIFY_DONE;
547 
548 	switch (event) {
549 	case NETDEV_UP:
550 		pr_debug("NETDEV_UP\n");
551 		to_atmarpd(act_up, PRIV(dev)->number, 0);
552 		break;
553 	case NETDEV_GOING_DOWN:
554 		pr_debug("NETDEV_DOWN\n");
555 		to_atmarpd(act_down, PRIV(dev)->number, 0);
556 		break;
557 	case NETDEV_CHANGE:
558 	case NETDEV_CHANGEMTU:
559 		pr_debug("NETDEV_CHANGE*\n");
560 		to_atmarpd(act_change, PRIV(dev)->number, 0);
561 		break;
562 	}
563 	return NOTIFY_DONE;
564 }
565 
clip_inet_event(struct notifier_block * this,unsigned long event,void * ifa)566 static int clip_inet_event(struct notifier_block *this, unsigned long event,
567 			   void *ifa)
568 {
569 	struct in_device *in_dev;
570 
571 	in_dev = ((struct in_ifaddr *)ifa)->ifa_dev;
572 	/*
573 	 * Transitions are of the down-change-up type, so it's sufficient to
574 	 * handle the change on up.
575 	 */
576 	if (event != NETDEV_UP)
577 		return NOTIFY_DONE;
578 	return clip_device_event(this, NETDEV_CHANGE, in_dev->dev);
579 }
580 
581 static struct notifier_block clip_dev_notifier = {
582 	.notifier_call = clip_device_event,
583 };
584 
585 
586 
587 static struct notifier_block clip_inet_notifier = {
588 	.notifier_call = clip_inet_event,
589 };
590 
591 
592 
atmarpd_close(struct atm_vcc * vcc)593 static void atmarpd_close(struct atm_vcc *vcc)
594 {
595 	pr_debug("\n");
596 
597 	rtnl_lock();
598 	atmarpd = NULL;
599 	skb_queue_purge(&sk_atm(vcc)->sk_receive_queue);
600 	rtnl_unlock();
601 
602 	pr_debug("(done)\n");
603 	module_put(THIS_MODULE);
604 }
605 
606 static struct atmdev_ops atmarpd_dev_ops = {
607 	.close = atmarpd_close
608 };
609 
610 
611 static struct atm_dev atmarpd_dev = {
612 	.ops =			&atmarpd_dev_ops,
613 	.type =			"arpd",
614 	.number = 		999,
615 	.lock =			__SPIN_LOCK_UNLOCKED(atmarpd_dev.lock)
616 };
617 
618 
atm_init_atmarp(struct atm_vcc * vcc)619 static int atm_init_atmarp(struct atm_vcc *vcc)
620 {
621 	rtnl_lock();
622 	if (atmarpd) {
623 		rtnl_unlock();
624 		return -EADDRINUSE;
625 	}
626 
627 	mod_timer(&idle_timer, jiffies + CLIP_CHECK_INTERVAL * HZ);
628 
629 	atmarpd = vcc;
630 	set_bit(ATM_VF_META, &vcc->flags);
631 	set_bit(ATM_VF_READY, &vcc->flags);
632 	    /* allow replies and avoid getting closed if signaling dies */
633 	vcc->dev = &atmarpd_dev;
634 	vcc_insert_socket(sk_atm(vcc));
635 	vcc->push = NULL;
636 	vcc->pop = NULL; /* crash */
637 	vcc->push_oam = NULL; /* crash */
638 	rtnl_unlock();
639 	return 0;
640 }
641 
clip_ioctl(struct socket * sock,unsigned int cmd,unsigned long arg)642 static int clip_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
643 {
644 	struct atm_vcc *vcc = ATM_SD(sock);
645 	int err = 0;
646 
647 	switch (cmd) {
648 	case SIOCMKCLIP:
649 	case ATMARPD_CTRL:
650 	case ATMARP_MKIP:
651 	case ATMARP_SETENTRY:
652 	case ATMARP_ENCAP:
653 		if (!capable(CAP_NET_ADMIN))
654 			return -EPERM;
655 		break;
656 	default:
657 		return -ENOIOCTLCMD;
658 	}
659 
660 	switch (cmd) {
661 	case SIOCMKCLIP:
662 		err = clip_create(arg);
663 		break;
664 	case ATMARPD_CTRL:
665 		err = atm_init_atmarp(vcc);
666 		if (!err) {
667 			sock->state = SS_CONNECTED;
668 			__module_get(THIS_MODULE);
669 		}
670 		break;
671 	case ATMARP_MKIP:
672 		err = clip_mkip(vcc, arg);
673 		break;
674 	case ATMARP_SETENTRY:
675 		err = clip_setentry(vcc, (__force __be32)arg);
676 		break;
677 	case ATMARP_ENCAP:
678 		err = clip_encap(vcc, arg);
679 		break;
680 	}
681 	return err;
682 }
683 
684 static struct atm_ioctl clip_ioctl_ops = {
685 	.owner = THIS_MODULE,
686 	.ioctl = clip_ioctl,
687 };
688 
689 #ifdef CONFIG_PROC_FS
690 
svc_addr(struct seq_file * seq,struct sockaddr_atmsvc * addr)691 static void svc_addr(struct seq_file *seq, struct sockaddr_atmsvc *addr)
692 {
693 	static int code[] = { 1, 2, 10, 6, 1, 0 };
694 	static int e164[] = { 1, 8, 4, 6, 1, 0 };
695 
696 	if (*addr->sas_addr.pub) {
697 		seq_printf(seq, "%s", addr->sas_addr.pub);
698 		if (*addr->sas_addr.prv)
699 			seq_putc(seq, '+');
700 	} else if (!*addr->sas_addr.prv) {
701 		seq_printf(seq, "%s", "(none)");
702 		return;
703 	}
704 	if (*addr->sas_addr.prv) {
705 		unsigned char *prv = addr->sas_addr.prv;
706 		int *fields;
707 		int i, j;
708 
709 		fields = *prv == ATM_AFI_E164 ? e164 : code;
710 		for (i = 0; fields[i]; i++) {
711 			for (j = fields[i]; j; j--)
712 				seq_printf(seq, "%02X", *prv++);
713 			if (fields[i + 1])
714 				seq_putc(seq, '.');
715 		}
716 	}
717 }
718 
719 /* This means the neighbour entry has no attached VCC objects. */
720 #define SEQ_NO_VCC_TOKEN	((void *) 2)
721 
atmarp_info(struct seq_file * seq,struct neighbour * n,struct atmarp_entry * entry,struct clip_vcc * clip_vcc)722 static void atmarp_info(struct seq_file *seq, struct neighbour *n,
723 			struct atmarp_entry *entry, struct clip_vcc *clip_vcc)
724 {
725 	struct net_device *dev = n->dev;
726 	unsigned long exp;
727 	char buf[17];
728 	int svc, llc, off;
729 
730 	svc = ((clip_vcc == SEQ_NO_VCC_TOKEN) ||
731 	       (sk_atm(clip_vcc->vcc)->sk_family == AF_ATMSVC));
732 
733 	llc = ((clip_vcc == SEQ_NO_VCC_TOKEN) || clip_vcc->encap);
734 
735 	if (clip_vcc == SEQ_NO_VCC_TOKEN)
736 		exp = entry->neigh->used;
737 	else
738 		exp = clip_vcc->last_use;
739 
740 	exp = (jiffies - exp) / HZ;
741 
742 	seq_printf(seq, "%-6s%-4s%-4s%5ld ",
743 		   dev->name, svc ? "SVC" : "PVC", llc ? "LLC" : "NULL", exp);
744 
745 	off = scnprintf(buf, sizeof(buf) - 1, "%pI4", n->primary_key);
746 	while (off < 16)
747 		buf[off++] = ' ';
748 	buf[off] = '\0';
749 	seq_printf(seq, "%s", buf);
750 
751 	if (clip_vcc == SEQ_NO_VCC_TOKEN) {
752 		if (time_before(jiffies, entry->expires))
753 			seq_printf(seq, "(resolving)\n");
754 		else
755 			seq_printf(seq, "(expired, ref %d)\n",
756 				   atomic_read(&entry->neigh->refcnt));
757 	} else if (!svc) {
758 		seq_printf(seq, "%d.%d.%d\n",
759 			   clip_vcc->vcc->dev->number,
760 			   clip_vcc->vcc->vpi, clip_vcc->vcc->vci);
761 	} else {
762 		svc_addr(seq, &clip_vcc->vcc->remote);
763 		seq_putc(seq, '\n');
764 	}
765 }
766 
767 struct clip_seq_state {
768 	/* This member must be first. */
769 	struct neigh_seq_state ns;
770 
771 	/* Local to clip specific iteration. */
772 	struct clip_vcc *vcc;
773 };
774 
clip_seq_next_vcc(struct atmarp_entry * e,struct clip_vcc * curr)775 static struct clip_vcc *clip_seq_next_vcc(struct atmarp_entry *e,
776 					  struct clip_vcc *curr)
777 {
778 	if (!curr) {
779 		curr = e->vccs;
780 		if (!curr)
781 			return SEQ_NO_VCC_TOKEN;
782 		return curr;
783 	}
784 	if (curr == SEQ_NO_VCC_TOKEN)
785 		return NULL;
786 
787 	curr = curr->next;
788 
789 	return curr;
790 }
791 
clip_seq_vcc_walk(struct clip_seq_state * state,struct atmarp_entry * e,loff_t * pos)792 static void *clip_seq_vcc_walk(struct clip_seq_state *state,
793 			       struct atmarp_entry *e, loff_t * pos)
794 {
795 	struct clip_vcc *vcc = state->vcc;
796 
797 	vcc = clip_seq_next_vcc(e, vcc);
798 	if (vcc && pos != NULL) {
799 		while (*pos) {
800 			vcc = clip_seq_next_vcc(e, vcc);
801 			if (!vcc)
802 				break;
803 			--(*pos);
804 		}
805 	}
806 	state->vcc = vcc;
807 
808 	return vcc;
809 }
810 
clip_seq_sub_iter(struct neigh_seq_state * _state,struct neighbour * n,loff_t * pos)811 static void *clip_seq_sub_iter(struct neigh_seq_state *_state,
812 			       struct neighbour *n, loff_t * pos)
813 {
814 	struct clip_seq_state *state = (struct clip_seq_state *)_state;
815 
816 	if (n->dev->type != ARPHRD_ATM)
817 		return NULL;
818 
819 	return clip_seq_vcc_walk(state, neighbour_priv(n), pos);
820 }
821 
clip_seq_start(struct seq_file * seq,loff_t * pos)822 static void *clip_seq_start(struct seq_file *seq, loff_t * pos)
823 {
824 	struct clip_seq_state *state = seq->private;
825 	state->ns.neigh_sub_iter = clip_seq_sub_iter;
826 	return neigh_seq_start(seq, pos, &arp_tbl, NEIGH_SEQ_NEIGH_ONLY);
827 }
828 
clip_seq_show(struct seq_file * seq,void * v)829 static int clip_seq_show(struct seq_file *seq, void *v)
830 {
831 	static char atm_arp_banner[] =
832 	    "IPitf TypeEncp Idle IP address      ATM address\n";
833 
834 	if (v == SEQ_START_TOKEN) {
835 		seq_puts(seq, atm_arp_banner);
836 	} else {
837 		struct clip_seq_state *state = seq->private;
838 		struct clip_vcc *vcc = state->vcc;
839 		struct neighbour *n = v;
840 
841 		atmarp_info(seq, n, neighbour_priv(n), vcc);
842 	}
843 	return 0;
844 }
845 
846 static const struct seq_operations arp_seq_ops = {
847 	.start	= clip_seq_start,
848 	.next	= neigh_seq_next,
849 	.stop	= neigh_seq_stop,
850 	.show	= clip_seq_show,
851 };
852 
arp_seq_open(struct inode * inode,struct file * file)853 static int arp_seq_open(struct inode *inode, struct file *file)
854 {
855 	return seq_open_net(inode, file, &arp_seq_ops,
856 			    sizeof(struct clip_seq_state));
857 }
858 
859 static const struct file_operations arp_seq_fops = {
860 	.open		= arp_seq_open,
861 	.read		= seq_read,
862 	.llseek		= seq_lseek,
863 	.release	= seq_release_net,
864 	.owner		= THIS_MODULE
865 };
866 #endif
867 
868 static void atm_clip_exit_noproc(void);
869 
atm_clip_init(void)870 static int __init atm_clip_init(void)
871 {
872 	register_atm_ioctl(&clip_ioctl_ops);
873 	register_netdevice_notifier(&clip_dev_notifier);
874 	register_inetaddr_notifier(&clip_inet_notifier);
875 
876 	setup_timer(&idle_timer, idle_timer_check, 0);
877 
878 #ifdef CONFIG_PROC_FS
879 	{
880 		struct proc_dir_entry *p;
881 
882 		p = proc_create("arp", S_IRUGO, atm_proc_root, &arp_seq_fops);
883 		if (!p) {
884 			pr_err("Unable to initialize /proc/net/atm/arp\n");
885 			atm_clip_exit_noproc();
886 			return -ENOMEM;
887 		}
888 	}
889 #endif
890 
891 	return 0;
892 }
893 
atm_clip_exit_noproc(void)894 static void atm_clip_exit_noproc(void)
895 {
896 	struct net_device *dev, *next;
897 
898 	unregister_inetaddr_notifier(&clip_inet_notifier);
899 	unregister_netdevice_notifier(&clip_dev_notifier);
900 
901 	deregister_atm_ioctl(&clip_ioctl_ops);
902 
903 	/* First, stop the idle timer, so it stops banging
904 	 * on the table.
905 	 */
906 	del_timer_sync(&idle_timer);
907 
908 	dev = clip_devs;
909 	while (dev) {
910 		next = PRIV(dev)->next;
911 		unregister_netdev(dev);
912 		free_netdev(dev);
913 		dev = next;
914 	}
915 }
916 
atm_clip_exit(void)917 static void __exit atm_clip_exit(void)
918 {
919 	remove_proc_entry("arp", atm_proc_root);
920 
921 	atm_clip_exit_noproc();
922 }
923 
924 module_init(atm_clip_init);
925 module_exit(atm_clip_exit);
926 MODULE_AUTHOR("Werner Almesberger");
927 MODULE_DESCRIPTION("Classical/IP over ATM interface");
928 MODULE_LICENSE("GPL");
929