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