clip.c 24 KB

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