RT-AC56 3.0.0.4.374.37 core
[tomato.git] / release / src-rt-6.x.4708 / linux / linux-2.6.36 / net / atm / clip.c
blob44528ef356523b565ceb31acf4a1f763405fdf1e
1 /* net/atm/clip.c - RFC1577 Classical IP over ATM */
3 /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
5 #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
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 <linux/param.h> /* for HZ */
37 #include <linux/uaccess.h>
38 #include <asm/byteorder.h> /* for htons etc. */
39 #include <asm/system.h> /* save/restore_flags */
40 #include <asm/atomic.h>
42 #include "common.h"
43 #include "resources.h"
44 #include <net/atmclip.h>
46 static struct net_device *clip_devs;
47 static struct atm_vcc *atmarpd;
48 static struct neigh_table clip_tbl;
49 static struct timer_list idle_timer;
51 static int to_atmarpd(enum atmarp_ctrl_type type, int itf, __be32 ip)
53 struct sock *sk;
54 struct atmarp_ctrl *ctrl;
55 struct sk_buff *skb;
57 pr_debug("(%d)\n", type);
58 if (!atmarpd)
59 return -EUNATCH;
60 skb = alloc_skb(sizeof(struct atmarp_ctrl), GFP_ATOMIC);
61 if (!skb)
62 return -ENOMEM;
63 ctrl = (struct atmarp_ctrl *)skb_put(skb, sizeof(struct atmarp_ctrl));
64 ctrl->type = type;
65 ctrl->itf_num = itf;
66 ctrl->ip = ip;
67 atm_force_charge(atmarpd, skb->truesize);
69 sk = sk_atm(atmarpd);
70 skb_queue_tail(&sk->sk_receive_queue, skb);
71 sk->sk_data_ready(sk, skb->len);
72 return 0;
75 static void link_vcc(struct clip_vcc *clip_vcc, struct atmarp_entry *entry)
77 pr_debug("%p to entry %p (neigh %p)\n", clip_vcc, entry, entry->neigh);
78 clip_vcc->entry = entry;
79 clip_vcc->xoff = 0; /* @@@ may overrun buffer by one packet */
80 clip_vcc->next = entry->vccs;
81 entry->vccs = clip_vcc;
82 entry->neigh->used = jiffies;
85 static void unlink_clip_vcc(struct clip_vcc *clip_vcc)
87 struct atmarp_entry *entry = clip_vcc->entry;
88 struct clip_vcc **walk;
90 if (!entry) {
91 pr_crit("!clip_vcc->entry (clip_vcc %p)\n", clip_vcc);
92 return;
94 netif_tx_lock_bh(entry->neigh->dev); /* block clip_start_xmit() */
95 entry->neigh->used = jiffies;
96 for (walk = &entry->vccs; *walk; walk = &(*walk)->next)
97 if (*walk == clip_vcc) {
98 int error;
100 *walk = clip_vcc->next; /* atomic */
101 clip_vcc->entry = NULL;
102 if (clip_vcc->xoff)
103 netif_wake_queue(entry->neigh->dev);
104 if (entry->vccs)
105 goto out;
106 entry->expires = jiffies - 1;
107 /* force resolution or expiration */
108 error = neigh_update(entry->neigh, NULL, NUD_NONE,
109 NEIGH_UPDATE_F_ADMIN);
110 if (error)
111 pr_crit("neigh_update failed with %d\n", error);
112 goto out;
114 pr_crit("ATMARP: failed (entry %p, vcc 0x%p)\n", entry, clip_vcc);
115 out:
116 netif_tx_unlock_bh(entry->neigh->dev);
119 /* The neighbour entry n->lock is held. */
120 static int neigh_check_cb(struct neighbour *n)
122 struct atmarp_entry *entry = NEIGH2ENTRY(n);
123 struct clip_vcc *cv;
125 for (cv = entry->vccs; cv; cv = cv->next) {
126 unsigned long exp = cv->last_use + cv->idle_timeout;
128 if (cv->idle_timeout && time_after(jiffies, exp)) {
129 pr_debug("releasing vcc %p->%p of entry %p\n",
130 cv, cv->vcc, entry);
131 vcc_release_async(cv->vcc, -ETIMEDOUT);
135 if (entry->vccs || time_before(jiffies, entry->expires))
136 return 0;
138 if (atomic_read(&n->refcnt) > 1) {
139 struct sk_buff *skb;
141 pr_debug("destruction postponed with ref %d\n",
142 atomic_read(&n->refcnt));
144 while ((skb = skb_dequeue(&n->arp_queue)) != NULL)
145 dev_kfree_skb(skb);
147 return 0;
150 pr_debug("expired neigh %p\n", n);
151 return 1;
154 static void idle_timer_check(unsigned long dummy)
156 write_lock(&clip_tbl.lock);
157 __neigh_for_each_release(&clip_tbl, neigh_check_cb);
158 mod_timer(&idle_timer, jiffies + CLIP_CHECK_INTERVAL * HZ);
159 write_unlock(&clip_tbl.lock);
162 static int clip_arp_rcv(struct sk_buff *skb)
164 struct atm_vcc *vcc;
166 pr_debug("\n");
167 vcc = ATM_SKB(skb)->vcc;
168 if (!vcc || !atm_charge(vcc, skb->truesize)) {
169 dev_kfree_skb_any(skb);
170 return 0;
172 pr_debug("pushing to %p\n", vcc);
173 pr_debug("using %p\n", CLIP_VCC(vcc)->old_push);
174 CLIP_VCC(vcc)->old_push(vcc, skb);
175 return 0;
178 static const unsigned char llc_oui[] = {
179 0xaa, /* DSAP: non-ISO */
180 0xaa, /* SSAP: non-ISO */
181 0x03, /* Ctrl: Unnumbered Information Command PDU */
182 0x00, /* OUI: EtherType */
183 0x00,
184 0x00
187 static void clip_push(struct atm_vcc *vcc, struct sk_buff *skb)
189 struct clip_vcc *clip_vcc = CLIP_VCC(vcc);
191 pr_debug("\n");
192 if (!skb) {
193 pr_debug("removing VCC %p\n", clip_vcc);
194 if (clip_vcc->entry)
195 unlink_clip_vcc(clip_vcc);
196 clip_vcc->old_push(vcc, NULL); /* pass on the bad news */
197 kfree(clip_vcc);
198 return;
200 atm_return(vcc, skb->truesize);
201 skb->dev = clip_vcc->entry ? clip_vcc->entry->neigh->dev : clip_devs;
202 /* clip_vcc->entry == NULL if we don't have an IP address yet */
203 if (!skb->dev) {
204 dev_kfree_skb_any(skb);
205 return;
207 ATM_SKB(skb)->vcc = vcc;
208 skb_reset_mac_header(skb);
209 if (!clip_vcc->encap ||
210 skb->len < RFC1483LLC_LEN ||
211 memcmp(skb->data, llc_oui, sizeof(llc_oui)))
212 skb->protocol = htons(ETH_P_IP);
213 else {
214 skb->protocol = ((__be16 *)skb->data)[3];
215 skb_pull(skb, RFC1483LLC_LEN);
216 if (skb->protocol == htons(ETH_P_ARP)) {
217 skb->dev->stats.rx_packets++;
218 skb->dev->stats.rx_bytes += skb->len;
219 clip_arp_rcv(skb);
220 return;
223 clip_vcc->last_use = jiffies;
224 skb->dev->stats.rx_packets++;
225 skb->dev->stats.rx_bytes += skb->len;
226 memset(ATM_SKB(skb), 0, sizeof(struct atm_skb_data));
227 netif_rx(skb);
231 * Note: these spinlocks _must_not_ block on non-SMP. The only goal is that
232 * clip_pop is atomic with respect to the critical section in clip_start_xmit.
235 static void clip_pop(struct atm_vcc *vcc, struct sk_buff *skb)
237 struct clip_vcc *clip_vcc = CLIP_VCC(vcc);
238 struct net_device *dev = skb->dev;
239 int old;
240 unsigned long flags;
242 pr_debug("(vcc %p)\n", vcc);
243 clip_vcc->old_pop(vcc, skb);
244 /* skb->dev == NULL in outbound ARP packets */
245 if (!dev)
246 return;
247 spin_lock_irqsave(&PRIV(dev)->xoff_lock, flags);
248 if (atm_may_send(vcc, 0)) {
249 old = xchg(&clip_vcc->xoff, 0);
250 if (old)
251 netif_wake_queue(dev);
253 spin_unlock_irqrestore(&PRIV(dev)->xoff_lock, flags);
256 static void clip_neigh_solicit(struct neighbour *neigh, struct sk_buff *skb)
258 pr_debug("(neigh %p, skb %p)\n", neigh, skb);
259 to_atmarpd(act_need, PRIV(neigh->dev)->number, NEIGH2ENTRY(neigh)->ip);
262 static void clip_neigh_error(struct neighbour *neigh, struct sk_buff *skb)
264 #ifndef CONFIG_ATM_CLIP_NO_ICMP
265 icmp_send(skb, ICMP_DEST_UNREACH, ICMP_HOST_UNREACH, 0);
266 #endif
267 kfree_skb(skb);
270 static const struct neigh_ops clip_neigh_ops = {
271 .family = AF_INET,
272 .solicit = clip_neigh_solicit,
273 .error_report = clip_neigh_error,
274 .output = dev_queue_xmit,
275 .connected_output = dev_queue_xmit,
276 .hh_output = dev_queue_xmit,
277 .queue_xmit = dev_queue_xmit,
280 static int clip_constructor(struct neighbour *neigh)
282 struct atmarp_entry *entry = NEIGH2ENTRY(neigh);
283 struct net_device *dev = neigh->dev;
284 struct in_device *in_dev;
285 struct neigh_parms *parms;
287 pr_debug("(neigh %p, entry %p)\n", neigh, entry);
288 neigh->type = inet_addr_type(&init_net, entry->ip);
289 if (neigh->type != RTN_UNICAST)
290 return -EINVAL;
292 rcu_read_lock();
293 in_dev = __in_dev_get_rcu(dev);
294 if (!in_dev) {
295 rcu_read_unlock();
296 return -EINVAL;
299 parms = in_dev->arp_parms;
300 __neigh_parms_put(neigh->parms);
301 neigh->parms = neigh_parms_clone(parms);
302 rcu_read_unlock();
304 neigh->ops = &clip_neigh_ops;
305 neigh->output = neigh->nud_state & NUD_VALID ?
306 neigh->ops->connected_output : neigh->ops->output;
307 entry->neigh = neigh;
308 entry->vccs = NULL;
309 entry->expires = jiffies - 1;
310 return 0;
313 static u32 clip_hash(const void *pkey, const struct net_device *dev)
315 return jhash_2words(*(u32 *) pkey, dev->ifindex, clip_tbl.hash_rnd);
318 static struct neigh_table clip_tbl = {
319 .family = AF_INET,
320 .entry_size = sizeof(struct neighbour)+sizeof(struct atmarp_entry),
321 .key_len = 4,
322 .hash = clip_hash,
323 .constructor = clip_constructor,
324 .id = "clip_arp_cache",
326 /* parameters are copied from ARP ... */
327 .parms = {
328 .tbl = &clip_tbl,
329 .base_reachable_time = 30 * HZ,
330 .retrans_time = 1 * HZ,
331 .gc_staletime = 60 * HZ,
332 .reachable_time = 30 * HZ,
333 .delay_probe_time = 5 * HZ,
334 .queue_len = 3,
335 .ucast_probes = 3,
336 .mcast_probes = 3,
337 .anycast_delay = 1 * HZ,
338 .proxy_delay = (8 * HZ) / 10,
339 .proxy_qlen = 64,
340 .locktime = 1 * HZ,
342 .gc_interval = 30 * HZ,
343 .gc_thresh1 = 128,
344 .gc_thresh2 = 512,
345 .gc_thresh3 = 1024,
348 /* @@@ copy bh locking from arp.c -- need to bh-enable atm code before */
351 * We play with the resolve flag: 0 and 1 have the usual meaning, but -1 means
352 * to allocate the neighbour entry but not to ask atmarpd for resolution. Also,
353 * don't increment the usage count. This is used to create entries in
354 * clip_setentry.
357 static int clip_encap(struct atm_vcc *vcc, int mode)
359 CLIP_VCC(vcc)->encap = mode;
360 return 0;
363 static netdev_tx_t clip_start_xmit(struct sk_buff *skb,
364 struct net_device *dev)
366 struct clip_priv *clip_priv = PRIV(dev);
367 struct atmarp_entry *entry;
368 struct atm_vcc *vcc;
369 int old;
370 unsigned long flags;
372 pr_debug("(skb %p)\n", skb);
373 if (!skb_dst(skb)) {
374 pr_err("skb_dst(skb) == NULL\n");
375 dev_kfree_skb(skb);
376 dev->stats.tx_dropped++;
377 return NETDEV_TX_OK;
379 if (!skb_dst(skb)->neighbour) {
380 pr_err("NO NEIGHBOUR !\n");
381 dev_kfree_skb(skb);
382 dev->stats.tx_dropped++;
383 return NETDEV_TX_OK;
385 entry = NEIGH2ENTRY(skb_dst(skb)->neighbour);
386 if (!entry->vccs) {
387 if (time_after(jiffies, entry->expires)) {
388 /* should be resolved */
389 entry->expires = jiffies + ATMARP_RETRY_DELAY * HZ;
390 to_atmarpd(act_need, PRIV(dev)->number, entry->ip);
392 if (entry->neigh->arp_queue.qlen < ATMARP_MAX_UNRES_PACKETS)
393 skb_queue_tail(&entry->neigh->arp_queue, skb);
394 else {
395 dev_kfree_skb(skb);
396 dev->stats.tx_dropped++;
398 return NETDEV_TX_OK;
400 pr_debug("neigh %p, vccs %p\n", entry, entry->vccs);
401 ATM_SKB(skb)->vcc = vcc = entry->vccs->vcc;
402 pr_debug("using neighbour %p, vcc %p\n", skb_dst(skb)->neighbour, vcc);
403 if (entry->vccs->encap) {
404 void *here;
406 here = skb_push(skb, RFC1483LLC_LEN);
407 memcpy(here, llc_oui, sizeof(llc_oui));
408 ((__be16 *) here)[3] = skb->protocol;
410 atomic_add(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc);
411 ATM_SKB(skb)->atm_options = vcc->atm_options;
412 entry->vccs->last_use = jiffies;
413 pr_debug("atm_skb(%p)->vcc(%p)->dev(%p)\n", skb, vcc, vcc->dev);
414 old = xchg(&entry->vccs->xoff, 1); /* assume XOFF ... */
415 if (old) {
416 pr_warning("XOFF->XOFF transition\n");
417 return NETDEV_TX_OK;
419 dev->stats.tx_packets++;
420 dev->stats.tx_bytes += skb->len;
421 vcc->send(vcc, skb);
422 if (atm_may_send(vcc, 0)) {
423 entry->vccs->xoff = 0;
424 return NETDEV_TX_OK;
426 spin_lock_irqsave(&clip_priv->xoff_lock, flags);
427 netif_stop_queue(dev); /* XOFF -> throttle immediately */
428 barrier();
429 if (!entry->vccs->xoff)
430 netif_start_queue(dev);
431 /* Oh, we just raced with clip_pop. netif_start_queue should be
432 good enough, because nothing should really be asleep because
433 of the brief netif_stop_queue. If this isn't true or if it
434 changes, use netif_wake_queue instead. */
435 spin_unlock_irqrestore(&clip_priv->xoff_lock, flags);
436 return NETDEV_TX_OK;
439 static int clip_mkip(struct atm_vcc *vcc, int timeout)
441 struct sk_buff_head *rq, queue;
442 struct clip_vcc *clip_vcc;
443 struct sk_buff *skb, *tmp;
444 unsigned long flags;
446 if (!vcc->push)
447 return -EBADFD;
448 clip_vcc = kmalloc(sizeof(struct clip_vcc), GFP_KERNEL);
449 if (!clip_vcc)
450 return -ENOMEM;
451 pr_debug("%p vcc %p\n", clip_vcc, vcc);
452 clip_vcc->vcc = vcc;
453 vcc->user_back = clip_vcc;
454 set_bit(ATM_VF_IS_CLIP, &vcc->flags);
455 clip_vcc->entry = NULL;
456 clip_vcc->xoff = 0;
457 clip_vcc->encap = 1;
458 clip_vcc->last_use = jiffies;
459 clip_vcc->idle_timeout = timeout * HZ;
460 clip_vcc->old_push = vcc->push;
461 clip_vcc->old_pop = vcc->pop;
462 vcc->push = clip_push;
463 vcc->pop = clip_pop;
465 __skb_queue_head_init(&queue);
466 rq = &sk_atm(vcc)->sk_receive_queue;
468 spin_lock_irqsave(&rq->lock, flags);
469 skb_queue_splice_init(rq, &queue);
470 spin_unlock_irqrestore(&rq->lock, flags);
472 /* re-process everything received between connection setup and MKIP */
473 skb_queue_walk_safe(&queue, skb, tmp) {
474 if (!clip_devs) {
475 atm_return(vcc, skb->truesize);
476 kfree_skb(skb);
477 } else {
478 struct net_device *dev = skb->dev;
479 unsigned int len = skb->len;
481 skb_get(skb);
482 clip_push(vcc, skb);
483 dev->stats.rx_packets--;
484 dev->stats.rx_bytes -= len;
485 kfree_skb(skb);
488 return 0;
491 static int clip_setentry(struct atm_vcc *vcc, __be32 ip)
493 struct neighbour *neigh;
494 struct atmarp_entry *entry;
495 int error;
496 struct clip_vcc *clip_vcc;
497 struct flowi fl = { .nl_u = { .ip4_u = { .daddr = ip, .tos = 1}} };
498 struct rtable *rt;
500 if (vcc->push != clip_push) {
501 pr_warning("non-CLIP VCC\n");
502 return -EBADF;
504 clip_vcc = CLIP_VCC(vcc);
505 if (!ip) {
506 if (!clip_vcc->entry) {
507 pr_err("hiding hidden ATMARP entry\n");
508 return 0;
510 pr_debug("remove\n");
511 unlink_clip_vcc(clip_vcc);
512 return 0;
514 error = ip_route_output_key(&init_net, &rt, &fl);
515 if (error)
516 return error;
517 neigh = __neigh_lookup(&clip_tbl, &ip, rt->dst.dev, 1);
518 ip_rt_put(rt);
519 if (!neigh)
520 return -ENOMEM;
521 entry = NEIGH2ENTRY(neigh);
522 if (entry != clip_vcc->entry) {
523 if (!clip_vcc->entry)
524 pr_debug("add\n");
525 else {
526 pr_debug("update\n");
527 unlink_clip_vcc(clip_vcc);
529 link_vcc(clip_vcc, entry);
531 error = neigh_update(neigh, llc_oui, NUD_PERMANENT,
532 NEIGH_UPDATE_F_OVERRIDE | NEIGH_UPDATE_F_ADMIN);
533 neigh_release(neigh);
534 return error;
537 static const struct net_device_ops clip_netdev_ops = {
538 .ndo_start_xmit = clip_start_xmit,
541 static void clip_setup(struct net_device *dev)
543 dev->netdev_ops = &clip_netdev_ops;
544 dev->type = ARPHRD_ATM;
545 dev->hard_header_len = RFC1483LLC_LEN;
546 dev->mtu = RFC1626_MTU;
547 dev->tx_queue_len = 100; /* "normal" queue (packets) */
548 /* When using a "real" qdisc, the qdisc determines the queue */
549 /* length. tx_queue_len is only used for the default case, */
550 /* without any more elaborate queuing. 100 is a reasonable */
551 /* compromise between decent burst-tolerance and protection */
552 /* against memory hogs. */
553 dev->priv_flags &= ~IFF_XMIT_DST_RELEASE;
556 static int clip_create(int number)
558 struct net_device *dev;
559 struct clip_priv *clip_priv;
560 int error;
562 if (number != -1) {
563 for (dev = clip_devs; dev; dev = PRIV(dev)->next)
564 if (PRIV(dev)->number == number)
565 return -EEXIST;
566 } else {
567 number = 0;
568 for (dev = clip_devs; dev; dev = PRIV(dev)->next)
569 if (PRIV(dev)->number >= number)
570 number = PRIV(dev)->number + 1;
572 dev = alloc_netdev(sizeof(struct clip_priv), "", clip_setup);
573 if (!dev)
574 return -ENOMEM;
575 clip_priv = PRIV(dev);
576 sprintf(dev->name, "atm%d", number);
577 spin_lock_init(&clip_priv->xoff_lock);
578 clip_priv->number = number;
579 error = register_netdev(dev);
580 if (error) {
581 free_netdev(dev);
582 return error;
584 clip_priv->next = clip_devs;
585 clip_devs = dev;
586 pr_debug("registered (net:%s)\n", dev->name);
587 return number;
590 static int clip_device_event(struct notifier_block *this, unsigned long event,
591 void *arg)
593 struct net_device *dev = arg;
595 if (!net_eq(dev_net(dev), &init_net))
596 return NOTIFY_DONE;
598 if (event == NETDEV_UNREGISTER) {
599 neigh_ifdown(&clip_tbl, dev);
600 return NOTIFY_DONE;
603 /* ignore non-CLIP devices */
604 if (dev->type != ARPHRD_ATM || dev->netdev_ops != &clip_netdev_ops)
605 return NOTIFY_DONE;
607 switch (event) {
608 case NETDEV_UP:
609 pr_debug("NETDEV_UP\n");
610 to_atmarpd(act_up, PRIV(dev)->number, 0);
611 break;
612 case NETDEV_GOING_DOWN:
613 pr_debug("NETDEV_DOWN\n");
614 to_atmarpd(act_down, PRIV(dev)->number, 0);
615 break;
616 case NETDEV_CHANGE:
617 case NETDEV_CHANGEMTU:
618 pr_debug("NETDEV_CHANGE*\n");
619 to_atmarpd(act_change, PRIV(dev)->number, 0);
620 break;
622 return NOTIFY_DONE;
625 static int clip_inet_event(struct notifier_block *this, unsigned long event,
626 void *ifa)
628 struct in_device *in_dev;
630 in_dev = ((struct in_ifaddr *)ifa)->ifa_dev;
632 * Transitions are of the down-change-up type, so it's sufficient to
633 * handle the change on up.
635 if (event != NETDEV_UP)
636 return NOTIFY_DONE;
637 return clip_device_event(this, NETDEV_CHANGE, in_dev->dev);
640 static struct notifier_block clip_dev_notifier = {
641 .notifier_call = clip_device_event,
646 static struct notifier_block clip_inet_notifier = {
647 .notifier_call = clip_inet_event,
652 static void atmarpd_close(struct atm_vcc *vcc)
654 pr_debug("\n");
656 rtnl_lock();
657 atmarpd = NULL;
658 skb_queue_purge(&sk_atm(vcc)->sk_receive_queue);
659 rtnl_unlock();
661 pr_debug("(done)\n");
662 module_put(THIS_MODULE);
665 static struct atmdev_ops atmarpd_dev_ops = {
666 .close = atmarpd_close
670 static struct atm_dev atmarpd_dev = {
671 .ops = &atmarpd_dev_ops,
672 .type = "arpd",
673 .number = 999,
674 .lock = __SPIN_LOCK_UNLOCKED(atmarpd_dev.lock)
678 static int atm_init_atmarp(struct atm_vcc *vcc)
680 rtnl_lock();
681 if (atmarpd) {
682 rtnl_unlock();
683 return -EADDRINUSE;
686 mod_timer(&idle_timer, jiffies + CLIP_CHECK_INTERVAL * HZ);
688 atmarpd = vcc;
689 set_bit(ATM_VF_META, &vcc->flags);
690 set_bit(ATM_VF_READY, &vcc->flags);
691 /* allow replies and avoid getting closed if signaling dies */
692 vcc->dev = &atmarpd_dev;
693 vcc_insert_socket(sk_atm(vcc));
694 vcc->push = NULL;
695 vcc->pop = NULL; /* crash */
696 vcc->push_oam = NULL; /* crash */
697 rtnl_unlock();
698 return 0;
701 static int clip_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
703 struct atm_vcc *vcc = ATM_SD(sock);
704 int err = 0;
706 switch (cmd) {
707 case SIOCMKCLIP:
708 case ATMARPD_CTRL:
709 case ATMARP_MKIP:
710 case ATMARP_SETENTRY:
711 case ATMARP_ENCAP:
712 if (!capable(CAP_NET_ADMIN))
713 return -EPERM;
714 break;
715 default:
716 return -ENOIOCTLCMD;
719 switch (cmd) {
720 case SIOCMKCLIP:
721 err = clip_create(arg);
722 break;
723 case ATMARPD_CTRL:
724 err = atm_init_atmarp(vcc);
725 if (!err) {
726 sock->state = SS_CONNECTED;
727 __module_get(THIS_MODULE);
729 break;
730 case ATMARP_MKIP:
731 err = clip_mkip(vcc, arg);
732 break;
733 case ATMARP_SETENTRY:
734 err = clip_setentry(vcc, (__force __be32)arg);
735 break;
736 case ATMARP_ENCAP:
737 err = clip_encap(vcc, arg);
738 break;
740 return err;
743 static struct atm_ioctl clip_ioctl_ops = {
744 .owner = THIS_MODULE,
745 .ioctl = clip_ioctl,
748 #ifdef CONFIG_PROC_FS
750 static void svc_addr(struct seq_file *seq, struct sockaddr_atmsvc *addr)
752 static int code[] = { 1, 2, 10, 6, 1, 0 };
753 static int e164[] = { 1, 8, 4, 6, 1, 0 };
755 if (*addr->sas_addr.pub) {
756 seq_printf(seq, "%s", addr->sas_addr.pub);
757 if (*addr->sas_addr.prv)
758 seq_putc(seq, '+');
759 } else if (!*addr->sas_addr.prv) {
760 seq_printf(seq, "%s", "(none)");
761 return;
763 if (*addr->sas_addr.prv) {
764 unsigned char *prv = addr->sas_addr.prv;
765 int *fields;
766 int i, j;
768 fields = *prv == ATM_AFI_E164 ? e164 : code;
769 for (i = 0; fields[i]; i++) {
770 for (j = fields[i]; j; j--)
771 seq_printf(seq, "%02X", *prv++);
772 if (fields[i + 1])
773 seq_putc(seq, '.');
778 /* This means the neighbour entry has no attached VCC objects. */
779 #define SEQ_NO_VCC_TOKEN ((void *) 2)
781 static void atmarp_info(struct seq_file *seq, struct net_device *dev,
782 struct atmarp_entry *entry, struct clip_vcc *clip_vcc)
784 unsigned long exp;
785 char buf[17];
786 int svc, llc, off;
788 svc = ((clip_vcc == SEQ_NO_VCC_TOKEN) ||
789 (sk_atm(clip_vcc->vcc)->sk_family == AF_ATMSVC));
791 llc = ((clip_vcc == SEQ_NO_VCC_TOKEN) || clip_vcc->encap);
793 if (clip_vcc == SEQ_NO_VCC_TOKEN)
794 exp = entry->neigh->used;
795 else
796 exp = clip_vcc->last_use;
798 exp = (jiffies - exp) / HZ;
800 seq_printf(seq, "%-6s%-4s%-4s%5ld ",
801 dev->name, svc ? "SVC" : "PVC", llc ? "LLC" : "NULL", exp);
803 off = scnprintf(buf, sizeof(buf) - 1, "%pI4",
804 &entry->ip);
805 while (off < 16)
806 buf[off++] = ' ';
807 buf[off] = '\0';
808 seq_printf(seq, "%s", buf);
810 if (clip_vcc == SEQ_NO_VCC_TOKEN) {
811 if (time_before(jiffies, entry->expires))
812 seq_printf(seq, "(resolving)\n");
813 else
814 seq_printf(seq, "(expired, ref %d)\n",
815 atomic_read(&entry->neigh->refcnt));
816 } else if (!svc) {
817 seq_printf(seq, "%d.%d.%d\n",
818 clip_vcc->vcc->dev->number,
819 clip_vcc->vcc->vpi, clip_vcc->vcc->vci);
820 } else {
821 svc_addr(seq, &clip_vcc->vcc->remote);
822 seq_putc(seq, '\n');
826 struct clip_seq_state {
827 /* This member must be first. */
828 struct neigh_seq_state ns;
830 /* Local to clip specific iteration. */
831 struct clip_vcc *vcc;
834 static struct clip_vcc *clip_seq_next_vcc(struct atmarp_entry *e,
835 struct clip_vcc *curr)
837 if (!curr) {
838 curr = e->vccs;
839 if (!curr)
840 return SEQ_NO_VCC_TOKEN;
841 return curr;
843 if (curr == SEQ_NO_VCC_TOKEN)
844 return NULL;
846 curr = curr->next;
848 return curr;
851 static void *clip_seq_vcc_walk(struct clip_seq_state *state,
852 struct atmarp_entry *e, loff_t * pos)
854 struct clip_vcc *vcc = state->vcc;
856 vcc = clip_seq_next_vcc(e, vcc);
857 if (vcc && pos != NULL) {
858 while (*pos) {
859 vcc = clip_seq_next_vcc(e, vcc);
860 if (!vcc)
861 break;
862 --(*pos);
865 state->vcc = vcc;
867 return vcc;
870 static void *clip_seq_sub_iter(struct neigh_seq_state *_state,
871 struct neighbour *n, loff_t * pos)
873 struct clip_seq_state *state = (struct clip_seq_state *)_state;
875 return clip_seq_vcc_walk(state, NEIGH2ENTRY(n), pos);
878 static void *clip_seq_start(struct seq_file *seq, loff_t * pos)
880 struct clip_seq_state *state = seq->private;
881 state->ns.neigh_sub_iter = clip_seq_sub_iter;
882 return neigh_seq_start(seq, pos, &clip_tbl, NEIGH_SEQ_NEIGH_ONLY);
885 static int clip_seq_show(struct seq_file *seq, void *v)
887 static char atm_arp_banner[] =
888 "IPitf TypeEncp Idle IP address ATM address\n";
890 if (v == SEQ_START_TOKEN) {
891 seq_puts(seq, atm_arp_banner);
892 } else {
893 struct clip_seq_state *state = seq->private;
894 struct neighbour *n = v;
895 struct clip_vcc *vcc = state->vcc;
897 atmarp_info(seq, n->dev, NEIGH2ENTRY(n), vcc);
899 return 0;
902 static const struct seq_operations arp_seq_ops = {
903 .start = clip_seq_start,
904 .next = neigh_seq_next,
905 .stop = neigh_seq_stop,
906 .show = clip_seq_show,
909 static int arp_seq_open(struct inode *inode, struct file *file)
911 return seq_open_net(inode, file, &arp_seq_ops,
912 sizeof(struct clip_seq_state));
915 static const struct file_operations arp_seq_fops = {
916 .open = arp_seq_open,
917 .read = seq_read,
918 .llseek = seq_lseek,
919 .release = seq_release_net,
920 .owner = THIS_MODULE
922 #endif
924 static void atm_clip_exit_noproc(void);
926 static int __init atm_clip_init(void)
928 neigh_table_init_no_netlink(&clip_tbl);
930 clip_tbl_hook = &clip_tbl;
931 register_atm_ioctl(&clip_ioctl_ops);
932 register_netdevice_notifier(&clip_dev_notifier);
933 register_inetaddr_notifier(&clip_inet_notifier);
935 setup_timer(&idle_timer, idle_timer_check, 0);
937 #ifdef CONFIG_PROC_FS
939 struct proc_dir_entry *p;
941 p = proc_create("arp", S_IRUGO, atm_proc_root, &arp_seq_fops);
942 if (!p) {
943 pr_err("Unable to initialize /proc/net/atm/arp\n");
944 atm_clip_exit_noproc();
945 return -ENOMEM;
948 #endif
950 return 0;
953 static void atm_clip_exit_noproc(void)
955 struct net_device *dev, *next;
957 unregister_inetaddr_notifier(&clip_inet_notifier);
958 unregister_netdevice_notifier(&clip_dev_notifier);
960 deregister_atm_ioctl(&clip_ioctl_ops);
962 /* First, stop the idle timer, so it stops banging
963 * on the table.
965 del_timer_sync(&idle_timer);
967 /* Next, purge the table, so that the device
968 * unregister loop below does not hang due to
969 * device references remaining in the table.
971 neigh_ifdown(&clip_tbl, NULL);
973 dev = clip_devs;
974 while (dev) {
975 next = PRIV(dev)->next;
976 unregister_netdev(dev);
977 free_netdev(dev);
978 dev = next;
981 /* Now it is safe to fully shutdown whole table. */
982 neigh_table_clear(&clip_tbl);
984 clip_tbl_hook = NULL;
987 static void __exit atm_clip_exit(void)
989 remove_proc_entry("arp", atm_proc_root);
991 atm_clip_exit_noproc();
994 module_init(atm_clip_init);
995 module_exit(atm_clip_exit);
996 MODULE_AUTHOR("Werner Almesberger");
997 MODULE_DESCRIPTION("Classical/IP over ATM interface");
998 MODULE_LICENSE("GPL");