aarp.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:25k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * AARP: An implementation of the AppleTalk AARP protocol for
  3.  * Ethernet 'ELAP'.
  4.  *
  5.  * Alan Cox  <Alan.Cox@linux.org>
  6.  *
  7.  * This doesn't fit cleanly with the IP arp. Potentially we can use
  8.  * the generic neighbour discovery code to clean this up.
  9.  *
  10.  * FIXME:
  11.  * We ought to handle the retransmits with a single list and a 
  12.  * separate fast timer for when it is needed.
  13.  * Use neighbour discovery code.
  14.  * Token Ring Support.
  15.  *
  16.  * This program is free software; you can redistribute it and/or
  17.  * modify it under the terms of the GNU General Public License
  18.  * as published by the Free Software Foundation; either version
  19.  * 2 of the License, or (at your option) any later version.
  20.  *
  21.  *
  22.  * References:
  23.  * Inside AppleTalk (2nd Ed).
  24.  * Fixes:
  25.  * Jaume Grau - flush caches on AARP_PROBE
  26.  * Rob Newberry - Added proxy AARP and AARP proc fs, 
  27.  * moved probing from DDP module.
  28.  * Arnaldo C. Melo - don't mangle rx packets
  29.  *
  30.  */
  31. #include <linux/config.h>
  32. #if defined(CONFIG_ATALK) || defined(CONFIG_ATALK_MODULE) 
  33. #include <asm/uaccess.h>
  34. #include <asm/system.h>
  35. #include <asm/bitops.h>
  36. #include <linux/types.h>
  37. #include <linux/kernel.h>
  38. #include <linux/sched.h>
  39. #include <linux/string.h>
  40. #include <linux/mm.h>
  41. #include <linux/socket.h>
  42. #include <linux/sockios.h>
  43. #include <linux/in.h>
  44. #include <linux/errno.h>
  45. #include <linux/interrupt.h>
  46. #include <linux/if_ether.h>
  47. #include <linux/inet.h>
  48. #include <linux/notifier.h>
  49. #include <linux/netdevice.h>
  50. #include <linux/etherdevice.h>
  51. #include <linux/if_arp.h>
  52. #include <linux/skbuff.h>
  53. #include <linux/spinlock.h>
  54. #include <net/sock.h>
  55. #include <net/datalink.h>
  56. #include <net/psnap.h>
  57. #include <linux/atalk.h>
  58. #include <linux/init.h>
  59. #include <linux/proc_fs.h>
  60. #include <linux/module.h>
  61. int sysctl_aarp_expiry_time = AARP_EXPIRY_TIME;
  62. int sysctl_aarp_tick_time = AARP_TICK_TIME;
  63. int sysctl_aarp_retransmit_limit = AARP_RETRANSMIT_LIMIT;
  64. int sysctl_aarp_resolve_time = AARP_RESOLVE_TIME;
  65. /* Lists of aarp entries */
  66. struct aarp_entry {
  67. /* These first two are only used for unresolved entries */
  68. unsigned long last_sent; /* Last time we xmitted the aarp request */
  69. struct sk_buff_head packet_queue; /* Queue of frames wait for resolution */
  70. int status; /* Used for proxy AARP */
  71. unsigned long expires_at; /* Entry expiry time */
  72. struct at_addr target_addr; /* DDP Address */
  73. struct net_device *dev; /* Device to use */
  74. char hwaddr[6]; /* Physical i/f address of target/router */
  75. unsigned short xmit_count; /* When this hits 10 we give up */
  76. struct aarp_entry *next; /* Next entry in chain */
  77. };
  78. /* Hashed list of resolved, unresolved and proxy entries */
  79. static struct aarp_entry *resolved[AARP_HASH_SIZE];
  80. static struct aarp_entry *unresolved[AARP_HASH_SIZE];
  81. static struct aarp_entry *proxies[AARP_HASH_SIZE];
  82. static int unresolved_count;
  83. /* One lock protects it all. */
  84. static spinlock_t aarp_lock = SPIN_LOCK_UNLOCKED;
  85. /* Used to walk the list and purge/kick entries.  */
  86. static struct timer_list aarp_timer;
  87. /*
  88.  * Delete an aarp queue
  89.  *
  90.  * Must run under aarp_lock.
  91.  */
  92. static void __aarp_expire(struct aarp_entry *a)
  93. {
  94. skb_queue_purge(&a->packet_queue);
  95. kfree(a);
  96. }
  97. /*
  98.  * Send an aarp queue entry request
  99.  *
  100.  * Must run under aarp_lock.
  101.  */
  102.  
  103. static void __aarp_send_query(struct aarp_entry *a)
  104. {
  105. static char aarp_eth_multicast[ETH_ALEN] =
  106. { 0x09, 0x00, 0x07, 0xFF, 0xFF, 0xFF };
  107. struct net_device *dev = a->dev;
  108. int len = dev->hard_header_len + sizeof(struct elapaarp) +
  109. aarp_dl->header_length;
  110. struct sk_buff *skb = alloc_skb(len, GFP_ATOMIC);
  111. struct at_addr *sat = atalk_find_dev_addr(dev);
  112. struct elapaarp *eah;
  113. if (!skb)
  114. return;
  115. if (!sat) {
  116. kfree_skb(skb);
  117. return;
  118. }
  119. /* Set up the buffer */
  120. skb_reserve(skb, dev->hard_header_len + aarp_dl->header_length);
  121. eah = (struct elapaarp *)skb_put(skb,
  122. sizeof(struct elapaarp));
  123. skb->protocol   =       htons(ETH_P_ATALK);
  124. skb->nh.raw     =       skb->h.raw = (void *) eah;
  125. skb->dev = dev;
  126. /* Set up the ARP */
  127. eah->hw_type = htons(AARP_HW_TYPE_ETHERNET);
  128. eah->pa_type = htons(ETH_P_ATALK);
  129. eah->hw_len = ETH_ALEN;
  130. eah->pa_len = AARP_PA_ALEN;
  131. eah->function = htons(AARP_REQUEST);
  132. memcpy(eah->hw_src, dev->dev_addr, ETH_ALEN);
  133. eah->pa_src_zero= 0;
  134. eah->pa_src_net = sat->s_net;
  135. eah->pa_src_node= sat->s_node;
  136. memset(eah->hw_dst, '', ETH_ALEN);
  137. eah->pa_dst_zero= 0;
  138. eah->pa_dst_net = a->target_addr.s_net;
  139. eah->pa_dst_node= a->target_addr.s_node;
  140. /* Add ELAP headers and set target to the AARP multicast */
  141. aarp_dl->datalink_header(aarp_dl, skb, aarp_eth_multicast);
  142. /* Send it */
  143. dev_queue_xmit(skb);
  144. /* Update the sending count */
  145. a->xmit_count++;
  146. }
  147. /* This runs under aarp_lock and in softint context, so only atomic memory
  148.  * allocations can be used. */
  149. static void aarp_send_reply(struct net_device *dev, struct at_addr *us,
  150.     struct at_addr *them, unsigned char *sha)
  151. {
  152. int len = dev->hard_header_len + sizeof(struct elapaarp) +
  153. aarp_dl->header_length;
  154. struct sk_buff *skb = alloc_skb(len, GFP_ATOMIC);
  155. struct elapaarp *eah;
  156. if (!skb)
  157. return;
  158. /* Set up the buffer */
  159. skb_reserve(skb, dev->hard_header_len + aarp_dl->header_length);
  160. eah = (struct elapaarp *)skb_put(skb,
  161. sizeof(struct elapaarp));  
  162. skb->protocol   =       htons(ETH_P_ATALK);
  163. skb->nh.raw     =       skb->h.raw = (void *) eah;
  164. skb->dev = dev;
  165. /* Set up the ARP */
  166. eah->hw_type = htons(AARP_HW_TYPE_ETHERNET);
  167. eah->pa_type = htons(ETH_P_ATALK);
  168. eah->hw_len = ETH_ALEN;
  169. eah->pa_len = AARP_PA_ALEN;
  170. eah->function = htons(AARP_REPLY);
  171. memcpy(eah->hw_src, dev->dev_addr, ETH_ALEN);
  172. eah->pa_src_zero= 0;
  173. eah->pa_src_net = us->s_net;
  174. eah->pa_src_node= us->s_node;
  175. if (!sha)
  176. memset(eah->hw_dst, '', ETH_ALEN);
  177. else
  178. memcpy(eah->hw_dst, sha, ETH_ALEN);
  179. eah->pa_dst_zero= 0;
  180. eah->pa_dst_net = them->s_net;
  181. eah->pa_dst_node= them->s_node;
  182. /* Add ELAP headers and set target to the AARP multicast */
  183. aarp_dl->datalink_header(aarp_dl, skb, sha);
  184. /* Send it */
  185. dev_queue_xmit(skb);
  186. }
  187. /*
  188.  * Send probe frames. Called from aarp_probe_network and
  189.  * aarp_proxy_probe_network.
  190.  */
  191. void aarp_send_probe(struct net_device *dev, struct at_addr *us)
  192. {
  193. int len = dev->hard_header_len + sizeof(struct elapaarp) +
  194. aarp_dl->header_length;
  195. struct sk_buff *skb = alloc_skb(len, GFP_ATOMIC);
  196. static char aarp_eth_multicast[ETH_ALEN] =
  197. { 0x09, 0x00, 0x07, 0xFF, 0xFF, 0xFF };
  198. struct elapaarp *eah;
  199. if (!skb)
  200. return;
  201. /* Set up the buffer */
  202. skb_reserve(skb, dev->hard_header_len + aarp_dl->header_length);
  203. eah = (struct elapaarp *)skb_put(skb,
  204. sizeof(struct elapaarp));
  205. skb->protocol   =       htons(ETH_P_ATALK);
  206. skb->nh.raw     =       skb->h.raw = (void *) eah;
  207. skb->dev = dev;
  208. /* Set up the ARP */
  209. eah->hw_type = htons(AARP_HW_TYPE_ETHERNET);
  210. eah->pa_type = htons(ETH_P_ATALK);
  211. eah->hw_len = ETH_ALEN;
  212. eah->pa_len = AARP_PA_ALEN;
  213. eah->function = htons(AARP_PROBE);
  214. memcpy(eah->hw_src, dev->dev_addr, ETH_ALEN);
  215. eah->pa_src_zero= 0;
  216. eah->pa_src_net = us->s_net;
  217. eah->pa_src_node= us->s_node;
  218. memset(eah->hw_dst, '', ETH_ALEN);
  219. eah->pa_dst_zero= 0;
  220. eah->pa_dst_net = us->s_net;
  221. eah->pa_dst_node= us->s_node;
  222. /* Add ELAP headers and set target to the AARP multicast */
  223. aarp_dl->datalink_header(aarp_dl, skb, aarp_eth_multicast);
  224. /* Send it */
  225. dev_queue_xmit(skb);
  226. }
  227. /*
  228.  * Handle an aarp timer expire
  229.  *
  230.  * Must run under the aarp_lock.
  231.  */
  232. static void __aarp_expire_timer(struct aarp_entry **n)
  233. {
  234. struct aarp_entry *t;
  235. while (*n)
  236. /* Expired ? */
  237. if (time_after(jiffies, (*n)->expires_at)) {
  238. t = *n;
  239. *n = (*n)->next;
  240. __aarp_expire(t);
  241. } else
  242. n = &((*n)->next);
  243. }
  244. /*
  245.  * Kick all pending requests 5 times a second.
  246.  *
  247.  * Must run under the aarp_lock.
  248.  */
  249.  
  250. static void __aarp_kick(struct aarp_entry **n)
  251. {
  252. struct aarp_entry *t;
  253. while (*n)
  254. /* Expired: if this will be the 11th tx, we delete instead. */
  255. if ((*n)->xmit_count >= sysctl_aarp_retransmit_limit) {
  256. t = *n;
  257. *n = (*n)->next;
  258. __aarp_expire(t);
  259. } else {
  260. __aarp_send_query(*n);
  261. n = &((*n)->next);
  262. }
  263. }
  264. /*
  265.  * A device has gone down. Take all entries referring to the device
  266.  * and remove them.
  267.  *
  268.  * Must run under the aarp_lock.
  269.  */
  270.  
  271. static void __aarp_expire_device(struct aarp_entry **n, struct net_device *dev)
  272. {
  273. struct aarp_entry *t;
  274. while (*n)
  275. if ((*n)->dev == dev) {
  276. t = *n;
  277. *n = (*n)->next;
  278. __aarp_expire(t);
  279. } else
  280. n = &((*n)->next);
  281. }
  282. /* Handle the timer event */
  283. static void aarp_expire_timeout(unsigned long unused)
  284. {
  285. int ct;
  286. spin_lock_bh(&aarp_lock);
  287. for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
  288. __aarp_expire_timer(&resolved[ct]);
  289. __aarp_kick(&unresolved[ct]);
  290. __aarp_expire_timer(&unresolved[ct]);
  291. __aarp_expire_timer(&proxies[ct]);
  292. }
  293. spin_unlock_bh(&aarp_lock);
  294. mod_timer(&aarp_timer, jiffies + 
  295.   (unresolved_count ? sysctl_aarp_tick_time :
  296.    sysctl_aarp_expiry_time));
  297. }
  298. /* Network device notifier chain handler. */
  299. static int aarp_device_event(struct notifier_block *this, unsigned long event,
  300. void *ptr)
  301. {
  302. int ct;
  303. if (event == NETDEV_DOWN) {
  304. spin_lock_bh(&aarp_lock);
  305. for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
  306. __aarp_expire_device(&resolved[ct], ptr);
  307. __aarp_expire_device(&unresolved[ct], ptr);
  308. __aarp_expire_device(&proxies[ct], ptr);
  309. }
  310. spin_unlock_bh(&aarp_lock);
  311. }
  312. return NOTIFY_DONE;
  313. }
  314. /*
  315.  * Create a new aarp entry.  This must use GFP_ATOMIC because it
  316.  * runs while holding spinlocks.
  317.  */
  318.  
  319. static struct aarp_entry *aarp_alloc(void)
  320. {
  321. struct aarp_entry *a = kmalloc(sizeof(struct aarp_entry), GFP_ATOMIC);
  322. if (a)
  323. skb_queue_head_init(&a->packet_queue);
  324. return a;
  325. }
  326. /*
  327.  * Find an entry. We might return an expired but not yet purged entry. We
  328.  * don't care as it will do no harm.
  329.  *
  330.  * This must run under the aarp_lock.
  331.  */
  332. static struct aarp_entry *__aarp_find_entry(struct aarp_entry *list,
  333.     struct net_device *dev,
  334.     struct at_addr *sat)
  335. {
  336. while (list) {
  337. if (list->target_addr.s_net == sat->s_net &&
  338.     list->target_addr.s_node == sat->s_node &&
  339.     list->dev == dev)
  340. break;
  341. list = list->next;
  342. }
  343. return list;
  344. }
  345. /* Called from the DDP code, and thus must be exported. */
  346. void aarp_proxy_remove(struct net_device *dev, struct at_addr *sa)
  347. {
  348. int hash = sa->s_node % (AARP_HASH_SIZE - 1);
  349. struct aarp_entry *a;
  350. spin_lock_bh(&aarp_lock);
  351. a = __aarp_find_entry(proxies[hash], dev, sa);
  352. if (a)
  353. a->expires_at = jiffies - 1;
  354. spin_unlock_bh(&aarp_lock);
  355. }
  356. /* This must run under aarp_lock. */
  357. static struct at_addr *__aarp_proxy_find(struct net_device *dev,
  358.  struct at_addr *sa)
  359. {
  360. int hash = sa->s_node % (AARP_HASH_SIZE - 1);
  361. struct aarp_entry *a = __aarp_find_entry(proxies[hash], dev, sa);
  362. return a ? sa : NULL;
  363. }
  364. /*
  365.  * Probe a Phase 1 device or a device that requires its Net:Node to
  366.  * be set via an ioctl.
  367.  */
  368. void aarp_send_probe_phase1(struct atalk_iface *iface)
  369. {
  370.     struct ifreq atreq;
  371.     struct sockaddr_at *sa = (struct sockaddr_at *)&atreq.ifr_addr;
  372.     sa->sat_addr.s_node = iface->address.s_node;
  373.     sa->sat_addr.s_net = ntohs(iface->address.s_net);
  374.     /* We pass the Net:Node to the drivers/cards by a Device ioctl. */
  375.     if (!(iface->dev->do_ioctl(iface->dev, &atreq, SIOCSIFADDR))) {
  376.     (void)iface->dev->do_ioctl(iface->dev, &atreq, SIOCGIFADDR);
  377.     if (iface->address.s_net != htons(sa->sat_addr.s_net) ||
  378. iface->address.s_node != sa->sat_addr.s_node)
  379.     iface->status |= ATIF_PROBE_FAIL;
  380.     iface->address.s_net  = htons(sa->sat_addr.s_net);
  381.     iface->address.s_node = sa->sat_addr.s_node;
  382.     }
  383. }
  384. void aarp_probe_network(struct atalk_iface *atif)
  385. {
  386. if (atif->dev->type == ARPHRD_LOCALTLK ||
  387.     atif->dev->type == ARPHRD_PPP) 
  388. aarp_send_probe_phase1(atif);
  389. else {
  390. unsigned int count;
  391. for (count = 0; count < AARP_RETRANSMIT_LIMIT; count++) {
  392. aarp_send_probe(atif->dev, &atif->address);
  393. /* Defer 1/10th */
  394. current->state = TASK_INTERRUPTIBLE;
  395. schedule_timeout(HZ/10);
  396. if (atif->status & ATIF_PROBE_FAIL)
  397. break;
  398. }
  399. }
  400. }
  401. int aarp_proxy_probe_network(struct atalk_iface *atif, struct at_addr *sa)
  402. {
  403. int hash, retval = 1;
  404. struct aarp_entry *entry;
  405. unsigned int count;
  406. /*
  407.  * we don't currently support LocalTalk or PPP for proxy AARP;
  408.  * if someone wants to try and add it, have fun
  409.  */
  410. if (atif->dev->type == ARPHRD_LOCALTLK)
  411. return -EPROTONOSUPPORT;
  412. if (atif->dev->type == ARPHRD_PPP)
  413. return -EPROTONOSUPPORT;
  414. /* 
  415.  * create a new AARP entry with the flags set to be published -- 
  416.  * we need this one to hang around even if it's in use
  417.  */
  418. entry = aarp_alloc();
  419. if (!entry)
  420. return -ENOMEM;
  421. entry->expires_at = -1;
  422. entry->status = ATIF_PROBE;
  423. entry->target_addr.s_node = sa->s_node;
  424. entry->target_addr.s_net = sa->s_net;
  425. entry->dev = atif->dev;
  426. spin_lock_bh(&aarp_lock);
  427. hash = sa->s_node % (AARP_HASH_SIZE - 1);
  428. entry->next = proxies[hash];
  429. proxies[hash] = entry;
  430. for (count = 0; count < AARP_RETRANSMIT_LIMIT; count++) {
  431. aarp_send_probe(atif->dev, sa);
  432. /* Defer 1/10th */
  433. current->state = TASK_INTERRUPTIBLE;
  434. spin_unlock_bh(&aarp_lock);
  435. schedule_timeout(HZ/10);
  436. spin_lock_bh(&aarp_lock);
  437. if (entry->status & ATIF_PROBE_FAIL)
  438. break;
  439. }
  440. if (entry->status & ATIF_PROBE_FAIL) {
  441. entry->expires_at = jiffies - 1; /* free the entry */
  442. retval = -EADDRINUSE; /* return network full */
  443. } else /* clear the probing flag */
  444. entry->status &= ~ATIF_PROBE;
  445. spin_unlock_bh(&aarp_lock);
  446. return retval;
  447. }
  448. /* Send a DDP frame */
  449. int aarp_send_ddp(struct net_device *dev,struct sk_buff *skb,
  450. struct at_addr *sa, void *hwaddr)
  451. {
  452. static char ddp_eth_multicast[ETH_ALEN] =
  453. { 0x09, 0x00, 0x07, 0xFF, 0xFF, 0xFF };
  454. int hash;
  455. struct aarp_entry *a;
  456. skb->nh.raw = skb->data;
  457. /* Check for LocalTalk first */
  458. if (dev->type == ARPHRD_LOCALTLK) {
  459. struct at_addr *at = atalk_find_dev_addr(dev);
  460. struct ddpehdr *ddp = (struct ddpehdr *)skb->data;
  461. int ft = 2;
  462. /*
  463.  * Compressible ?
  464.  * 
  465.  * IFF: src_net==dest_net==device_net
  466.  * (zero matches anything)
  467.  */
  468.  
  469. if ((!ddp->deh_snet || at->s_net == ddp->deh_snet) &&
  470.     (!ddp->deh_dnet || at->s_net == ddp->deh_dnet)) {
  471. skb_pull(skb, sizeof(struct ddpehdr) - 4);
  472. /*
  473.  * The upper two remaining bytes are the port 
  474.  * numbers we just happen to need. Now put the 
  475.  * length in the lower two.
  476.  */
  477. *((__u16 *)skb->data) = htons(skb->len);
  478. ft = 1;
  479. }
  480. /*
  481.  * Nice and easy. No AARP type protocols occur here
  482.  * so we can just shovel it out with a 3 byte LLAP header
  483.  */
  484.  
  485. skb_push(skb, 3);
  486. skb->data[0] = sa->s_node;
  487. skb->data[1] = at->s_node;
  488. skb->data[2] = ft;
  489. skb->dev = dev;
  490. goto sendit;
  491. }
  492. /* On a PPP link we neither compress nor aarp.  */
  493. if (dev->type == ARPHRD_PPP) {
  494. skb->protocol = htons(ETH_P_PPPTALK);
  495. skb->dev = dev;
  496. goto sendit;
  497. }
  498.  
  499. /* Non ELAP we cannot do. */
  500. if (dev->type != ARPHRD_ETHER)
  501. return -1;
  502. skb->dev = dev;
  503. skb->protocol = htons(ETH_P_ATALK);
  504. hash = sa->s_node % (AARP_HASH_SIZE - 1);
  505. /* Do we have a resolved entry? */
  506. if (sa->s_node == ATADDR_BCAST) {
  507. ddp_dl->datalink_header(ddp_dl, skb, ddp_eth_multicast);
  508. goto sendit;
  509. }
  510. spin_lock_bh(&aarp_lock);
  511. a = __aarp_find_entry(resolved[hash], dev, sa);
  512. if (a) { /* Return 1 and fill in the address */
  513. a->expires_at = jiffies + (sysctl_aarp_expiry_time * 10);
  514. ddp_dl->datalink_header(ddp_dl, skb, a->hwaddr);
  515. spin_unlock_bh(&aarp_lock);
  516. goto sendit;
  517. }
  518. /* Do we have an unresolved entry: This is the less common path */
  519. a = __aarp_find_entry(unresolved[hash], dev, sa);
  520. if (a) { /* Queue onto the unresolved queue */
  521. skb_queue_tail(&a->packet_queue, skb);
  522. spin_unlock_bh(&aarp_lock);
  523. return 0;
  524. }
  525. /* Allocate a new entry */
  526. a = aarp_alloc();
  527. if (!a) {
  528. /* Whoops slipped... good job it's an unreliable protocol 8) */
  529. spin_unlock_bh(&aarp_lock);
  530. return -1;
  531. }
  532. /* Set up the queue */
  533. skb_queue_tail(&a->packet_queue, skb);
  534. a->expires_at = jiffies + sysctl_aarp_resolve_time;
  535. a->dev = dev;
  536. a->next = unresolved[hash];
  537. a->target_addr = *sa;
  538. a->xmit_count = 0;
  539. unresolved[hash] = a;
  540. unresolved_count++;
  541. /* Send an initial request for the address */
  542. __aarp_send_query(a);
  543. /*
  544.  * Switch to fast timer if needed (That is if this is the
  545.  * first unresolved entry to get added)
  546.  */
  547. if (unresolved_count == 1)
  548. mod_timer(&aarp_timer, jiffies + sysctl_aarp_tick_time);
  549. /* Now finally, it is safe to drop the lock. */
  550. spin_unlock_bh(&aarp_lock);
  551. /* Tell the ddp layer we have taken over for this frame. */
  552. return 0;
  553. sendit: if (skb->sk)
  554. skb->priority = skb->sk->priority;
  555. dev_queue_xmit(skb);
  556. return 1;
  557. }
  558. /*
  559.  * An entry in the aarp unresolved queue has become resolved. Send
  560.  * all the frames queued under it.
  561.  *
  562.  * Must run under aarp_lock.
  563.  */
  564. static void __aarp_resolved(struct aarp_entry **list, struct aarp_entry *a,
  565. int hash)
  566. {
  567. struct sk_buff *skb;
  568. while (*list)
  569. if (*list == a) {
  570. unresolved_count--;
  571. *list = a->next;
  572. /* Move into the resolved list */
  573. a->next = resolved[hash];
  574. resolved[hash] = a;
  575. /* Kick frames off */
  576. while ((skb = skb_dequeue(&a->packet_queue)) != NULL) {
  577. a->expires_at = jiffies +
  578. sysctl_aarp_expiry_time * 10;
  579. ddp_dl->datalink_header(ddp_dl, skb, a->hwaddr);
  580. if (skb->sk)
  581. skb->priority = skb->sk->priority;
  582. dev_queue_xmit(skb);
  583. }
  584. } else 
  585. list = &((*list)->next);
  586. }
  587. /*
  588.  * This is called by the SNAP driver whenever we see an AARP SNAP
  589.  * frame. We currently only support Ethernet.
  590.  */
  591. static int aarp_rcv(struct sk_buff *skb, struct net_device *dev,
  592. struct packet_type *pt)
  593. {
  594. struct elapaarp *ea = (struct elapaarp *)skb->h.raw;
  595. int hash, ret = 0;
  596. __u16 function;
  597. struct aarp_entry *a;
  598. struct at_addr sa, *ma, da;
  599. struct atalk_iface *ifa;
  600. /* We only do Ethernet SNAP AARP. */
  601. if (dev->type != ARPHRD_ETHER)
  602. goto out0;
  603. /* Frame size ok? */
  604. if (!skb_pull(skb, sizeof(*ea)))
  605. goto out0;
  606. function = ntohs(ea->function);
  607. /* Sanity check fields. */
  608. if (function < AARP_REQUEST || function > AARP_PROBE ||
  609.     ea->hw_len != ETH_ALEN || ea->pa_len != AARP_PA_ALEN ||
  610.     ea->pa_src_zero || ea->pa_dst_zero)
  611. goto out0;
  612. /* Looks good. */
  613. hash = ea->pa_src_node % (AARP_HASH_SIZE - 1);
  614. /* Build an address. */
  615. sa.s_node = ea->pa_src_node;
  616. sa.s_net = ea->pa_src_net;
  617. /* Process the packet. Check for replies of me. */
  618. ifa = atalk_find_dev(dev);
  619. if (!ifa)
  620. goto out1;
  621. if (ifa->status & ATIF_PROBE &&
  622.     ifa->address.s_node == ea->pa_dst_node &&
  623.     ifa->address.s_net == ea->pa_dst_net) {
  624. ifa->status |= ATIF_PROBE_FAIL; /* Fail the probe (in use) */
  625. goto out1;
  626. }
  627. /* Check for replies of proxy AARP entries */
  628. da.s_node = ea->pa_dst_node;
  629. da.s_net = ea->pa_dst_net;
  630. spin_lock_bh(&aarp_lock);
  631. a = __aarp_find_entry(proxies[hash], dev, &da);
  632. if (a && a->status & ATIF_PROBE) {
  633. a->status |= ATIF_PROBE_FAIL;
  634. /*
  635.  * we do not respond to probe or request packets for
  636.  * this address while we are probing this address
  637.  */
  638. goto unlock;
  639. }
  640. switch (function) {
  641. case AARP_REPLY:
  642. if (!unresolved_count) /* Speed up */
  643. break;
  644. /* Find the entry.  */
  645. a = __aarp_find_entry(unresolved[hash],dev,&sa);
  646. if (!a || dev != a->dev)
  647. break;
  648. /* We can fill one in - this is good. */
  649. memcpy(a->hwaddr,ea->hw_src,ETH_ALEN);
  650. __aarp_resolved(&unresolved[hash],a,hash);
  651. if (!unresolved_count)
  652. mod_timer(&aarp_timer,
  653.   jiffies + sysctl_aarp_expiry_time);
  654. break;
  655. case AARP_REQUEST:
  656. case AARP_PROBE:
  657. /*
  658.  * If it is my address set ma to my address and
  659.  * reply. We can treat probe and request the
  660.  * same. Probe simply means we shouldn't cache
  661.  * the querying host, as in a probe they are
  662.  * proposing an address not using one.
  663.  *
  664.  * Support for proxy-AARP added. We check if the
  665.  * address is one of our proxies before we toss
  666.  * the packet out.
  667.  */
  668.  
  669. sa.s_node = ea->pa_dst_node;
  670. sa.s_net = ea->pa_dst_net;
  671. /* See if we have a matching proxy. */
  672. ma = __aarp_proxy_find(dev, &sa);
  673. if (!ma)
  674. ma = &ifa->address;
  675. else { /* We need to make a copy of the entry. */
  676. da.s_node = sa.s_node;
  677. da.s_net = da.s_net;
  678. ma = &da;
  679. }
  680. if (function == AARP_PROBE) {
  681. /* A probe implies someone trying to get an
  682.  * address. So as a precaution flush any
  683.  * entries we have for this address. */
  684. struct aarp_entry *a = __aarp_find_entry(
  685. resolved[sa.s_node%(AARP_HASH_SIZE-1)],
  686. skb->dev, &sa);
  687. /* Make it expire next tick - that avoids us
  688.  * getting into a probe/flush/learn/probe/
  689.  * flush/learn cycle during probing of a slow
  690.  * to respond host addr. */
  691. if (a) {
  692. a->expires_at = jiffies - 1;
  693. mod_timer(&aarp_timer, jiffies +
  694. sysctl_aarp_tick_time);
  695. }
  696. }
  697. if (sa.s_node != ma->s_node)
  698. break;
  699. if (sa.s_net && ma->s_net && sa.s_net != ma->s_net)
  700. break;
  701. sa.s_node = ea->pa_src_node;
  702. sa.s_net = ea->pa_src_net;
  703. /* aarp_my_address has found the address to use for us.
  704. */
  705. aarp_send_reply(dev, ma, &sa, ea->hw_src);
  706. break;
  707. }
  708. unlock: spin_unlock_bh(&aarp_lock);
  709. out1: ret = 1;
  710. out0: kfree_skb(skb);
  711. return ret;
  712. }
  713. static struct notifier_block aarp_notifier = {
  714. notifier_call: aarp_device_event,
  715. };
  716. static char aarp_snap_id[] = { 0x00, 0x00, 0x00, 0x80, 0xF3 };
  717. void __init aarp_proto_init(void)
  718. {
  719. aarp_dl = register_snap_client(aarp_snap_id, aarp_rcv);
  720. if (!aarp_dl)
  721. printk(KERN_CRIT "Unable to register AARP with SNAP.n");
  722. init_timer(&aarp_timer);
  723. aarp_timer.function = aarp_expire_timeout;
  724. aarp_timer.data = 0;
  725. aarp_timer.expires = jiffies + sysctl_aarp_expiry_time;
  726. add_timer(&aarp_timer);
  727. register_netdevice_notifier(&aarp_notifier);
  728. }
  729. /* Remove the AARP entries associated with a device. */
  730. void aarp_device_down(struct net_device *dev)
  731. {
  732. int ct;
  733. spin_lock_bh(&aarp_lock);
  734. for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
  735. __aarp_expire_device(&resolved[ct], dev);
  736. __aarp_expire_device(&unresolved[ct], dev);
  737. __aarp_expire_device(&proxies[ct], dev);
  738. }
  739. spin_unlock_bh(&aarp_lock);
  740. }
  741. /* Called from proc fs */
  742. static int aarp_get_info(char *buffer, char **start, off_t offset, int length)
  743. {
  744. /* we should dump all our AARP entries */
  745. struct aarp_entry *entry;
  746. int len, ct;
  747. len = sprintf(buffer,
  748. "%-10.10s  %-10.10s%-18.18s%12.12s%12.12s xmit_count  statusn",
  749. "address", "device", "hw addr", "last_sent", "expires");
  750. spin_lock_bh(&aarp_lock);
  751. for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
  752. for (entry = resolved[ct]; entry; entry = entry->next) {
  753. len+= sprintf(buffer+len,"%6u:%-3u  ",
  754. (unsigned int)ntohs(entry->target_addr.s_net),
  755. (unsigned int)(entry->target_addr.s_node));
  756. len+= sprintf(buffer+len,"%-10.10s",
  757. entry->dev->name);
  758. len+= sprintf(buffer+len,"%2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X",
  759. (int)(entry->hwaddr[0] & 0x000000FF),
  760. (int)(entry->hwaddr[1] & 0x000000FF),
  761. (int)(entry->hwaddr[2] & 0x000000FF),
  762. (int)(entry->hwaddr[3] & 0x000000FF),
  763. (int)(entry->hwaddr[4] & 0x000000FF),
  764. (int)(entry->hwaddr[5] & 0x000000FF));
  765. len+= sprintf(buffer+len,"%12lu ""%12lu ",
  766. (unsigned long)entry->last_sent,
  767. (unsigned long)entry->expires_at);
  768. len+=sprintf(buffer+len,"%10u",
  769. (unsigned int)entry->xmit_count);
  770. len+=sprintf(buffer+len,"   resolvedn");
  771. }
  772. }
  773. for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
  774. for (entry = unresolved[ct]; entry; entry = entry->next) {
  775. len+= sprintf(buffer+len,"%6u:%-3u  ",
  776. (unsigned int)ntohs(entry->target_addr.s_net),
  777. (unsigned int)(entry->target_addr.s_node));
  778. len+= sprintf(buffer+len,"%-10.10s",
  779. entry->dev->name);
  780. len+= sprintf(buffer+len,"%2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X",
  781. (int)(entry->hwaddr[0] & 0x000000FF),
  782. (int)(entry->hwaddr[1] & 0x000000FF),
  783. (int)(entry->hwaddr[2] & 0x000000FF),
  784. (int)(entry->hwaddr[3] & 0x000000FF),
  785. (int)(entry->hwaddr[4] & 0x000000FF),
  786. (int)(entry->hwaddr[5] & 0x000000FF));
  787. len+= sprintf(buffer+len,"%12lu ""%12lu ",
  788. (unsigned long)entry->last_sent,
  789. (unsigned long)entry->expires_at);
  790. len+=sprintf(buffer+len,"%10u",
  791. (unsigned int)entry->xmit_count);
  792. len+=sprintf(buffer+len," unresolvedn");
  793. }
  794. }
  795. for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
  796. for (entry = proxies[ct]; entry; entry = entry->next) {
  797. len+= sprintf(buffer+len,"%6u:%-3u  ",
  798. (unsigned int)ntohs(entry->target_addr.s_net),
  799. (unsigned int)(entry->target_addr.s_node));
  800. len+= sprintf(buffer+len,"%-10.10s",
  801. entry->dev->name);
  802. len+= sprintf(buffer+len,"%2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X",
  803. (int)(entry->hwaddr[0] & 0x000000FF),
  804. (int)(entry->hwaddr[1] & 0x000000FF),
  805. (int)(entry->hwaddr[2] & 0x000000FF),
  806. (int)(entry->hwaddr[3] & 0x000000FF),
  807. (int)(entry->hwaddr[4] & 0x000000FF),
  808. (int)(entry->hwaddr[5] & 0x000000FF));
  809. len+= sprintf(buffer+len,"%12lu ""%12lu ",
  810. (unsigned long)entry->last_sent,
  811. (unsigned long)entry->expires_at);
  812. len+=sprintf(buffer+len,"%10u",
  813. (unsigned int)entry->xmit_count);
  814. len+=sprintf(buffer+len,"      proxyn");
  815. }
  816. }
  817. spin_unlock_bh(&aarp_lock);
  818. return len;
  819. }
  820. #ifdef MODULE
  821. /* General module cleanup. Called from cleanup_module() in ddp.c. */
  822. void aarp_cleanup_module(void)
  823. {
  824. del_timer(&aarp_timer);
  825. unregister_netdevice_notifier(&aarp_notifier);
  826. unregister_snap_client(aarp_snap_id);
  827. }
  828. #endif  /* MODULE */
  829. #ifdef CONFIG_PROC_FS
  830. void aarp_register_proc_fs(void)
  831. {
  832. proc_net_create("aarp", 0, aarp_get_info);
  833. }
  834. void aarp_unregister_proc_fs(void)
  835. {
  836. proc_net_remove("aarp");
  837. }
  838. #endif
  839. #endif  /* CONFIG_ATALK || CONFIG_ATALK_MODULE */
  840. MODULE_LICENSE("GPL");