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