net/appletalk/aarp.c

   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
  32 #include <linux/if_arp.h>
  33 #include <linux/slab.h>
  34 #include <net/sock.h>
  35 #include <net/datalink.h>
  36 #include <net/psnap.h>
  37 #include <linux/atalk.h>
  38 #include <linux/delay.h>
  39 #include <linux/init.h>
  40 #include <linux/proc_fs.h>
  41 #include <linux/seq_file.h>
  42 #include <linux/export.h>
  43
  44 int sysctl_aarp_expiry_time = AARP_EXPIRY_TIME;
  45 int sysctl_aarp_tick_time = AARP_TICK_TIME;
  46 int sysctl_aarp_retransmit_limit = AARP_RETRANSMIT_LIMIT;
  47 int sysctl_aarp_resolve_time = AARP_RESOLVE_TIME;
  48
  49 /* Lists of aarp entries */
  50 /**
  51  *      struct aarp_entry - AARP entry
  52  *      @last_sent - Last time we xmitted the aarp request
  53  *      @packet_queue - Queue of frames wait for resolution
  54  *      @status - Used for proxy AARP
  55  *      expires_at - Entry expiry time
  56  *      target_addr - DDP Address
  57  *      dev - Device to use
  58  *      hwaddr - Physical i/f address of target/router
  59  *      xmit_count - When this hits 10 we give up
  60  *      next - Next entry in chain
  61  */
  62 struct aarp_entry {
  63         /* These first two are only used for unresolved entries */
  64         unsigned long           last_sent;
  65         struct sk_buff_head     packet_queue;
  66         int                     status;
  67         unsigned long           expires_at;
  68         struct atalk_addr       target_addr;
  69         struct net_device       *dev;
  70         char                    hwaddr[6];
  71         unsigned short          xmit_count;
  72         struct aarp_entry       *next;
  73 };
  74
  75 /* Hashed list of resolved, unresolved and proxy entries */
  76 static struct aarp_entry *resolved[AARP_HASH_SIZE];
  77 static struct aarp_entry *unresolved[AARP_HASH_SIZE];
  78 static struct aarp_entry *proxies[AARP_HASH_SIZE];
  79 static int unresolved_count;
  80
  81 /* One lock protects it all. */
  82 static DEFINE_RWLOCK(aarp_lock);
  83
  84 /* Used to walk the list and purge/kick entries.  */
  85 static struct timer_list aarp_timer;
  86
  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 /*
  99  *      Send an aarp queue entry request
 100  *
 101  *      Must run under aarp_lock.
 102  */
 103 static void __aarp_send_query(struct aarp_entry *a)
 104 {
 105         static unsigned char aarp_eth_multicast[ETH_ALEN] =
 106                                         { 0x09, 0x00, 0x07, 0xFF, 0xFF, 0xFF };
 107         struct net_device *dev = a->dev;
 108         struct elapaarp *eah;
 109         int len = dev->hard_header_len + sizeof(*eah) + aarp_dl->header_length;
 110         struct sk_buff *skb = alloc_skb(len, GFP_ATOMIC);
 111         struct atalk_addr *sat = atalk_find_dev_addr(dev);
 112
 113         if (!skb)
 114                 return;
 115
 116         if (!sat) {
 117                 kfree_skb(skb);
 118                 return;
 119         }
 120
 121         /* Set up the buffer */
 122         skb_reserve(skb, dev->hard_header_len + aarp_dl->header_length);
 123         skb_reset_network_header(skb);
 124         skb_reset_transport_header(skb);
 125         skb_put(skb, sizeof(*eah));
 126         skb->protocol    = htons(ETH_P_ATALK);
 127         skb->dev         = dev;
 128         eah              = aarp_hdr(skb);
 129
 130         /* Set up the ARP */
 131         eah->hw_type     = htons(AARP_HW_TYPE_ETHERNET);
 132         eah->pa_type     = htons(ETH_P_ATALK);
 133         eah->hw_len      = ETH_ALEN;
 134         eah->pa_len      = AARP_PA_ALEN;
 135         eah->function    = htons(AARP_REQUEST);
 136
 137         memcpy(eah->hw_src, dev->dev_addr, ETH_ALEN);
 138
 139         eah->pa_src_zero = 0;
 140         eah->pa_src_net  = sat->s_net;
 141         eah->pa_src_node = sat->s_node;
 142
 143         memset(eah->hw_dst, '\0', ETH_ALEN);
 144
 145         eah->pa_dst_zero = 0;
 146         eah->pa_dst_net  = a->target_addr.s_net;
 147         eah->pa_dst_node = a->target_addr.s_node;
 148
 149         /* Send it */
 150         aarp_dl->request(aarp_dl, skb, aarp_eth_multicast);
 151         /* Update the sending count */
 152         a->xmit_count++;
 153         a->last_sent = jiffies;
 154 }
 155
 156 /* This runs under aarp_lock and in softint context, so only atomic memory
 157  * allocations can be used. */
 158 static void aarp_send_reply(struct net_device *dev, struct atalk_addr *us,
 159                             struct atalk_addr *them, unsigned char *sha)
 160 {
 161         struct elapaarp *eah;
 162         int len = dev->hard_header_len + sizeof(*eah) + aarp_dl->header_length;
 163         struct sk_buff *skb = alloc_skb(len, GFP_ATOMIC);
 164
 165         if (!skb)
 166                 return;
 167
 168         /* Set up the buffer */
 169         skb_reserve(skb, dev->hard_header_len + aarp_dl->header_length);
 170         skb_reset_network_header(skb);
 171         skb_reset_transport_header(skb);
 172         skb_put(skb, sizeof(*eah));
 173         skb->protocol    = htons(ETH_P_ATALK);
 174         skb->dev         = dev;
 175         eah              = aarp_hdr(skb);
 176
 177         /* Set up the ARP */
 178         eah->hw_type     = htons(AARP_HW_TYPE_ETHERNET);
 179         eah->pa_type     = htons(ETH_P_ATALK);
 180         eah->hw_len      = ETH_ALEN;
 181         eah->pa_len      = AARP_PA_ALEN;
 182         eah->function    = htons(AARP_REPLY);
 183
 184         memcpy(eah->hw_src, dev->dev_addr, ETH_ALEN);
 185
 186         eah->pa_src_zero = 0;
 187         eah->pa_src_net  = us->s_net;
 188         eah->pa_src_node = us->s_node;
 189
 190         if (!sha)
 191                 memset(eah->hw_dst, '\0', ETH_ALEN);
 192         else
 193                 memcpy(eah->hw_dst, sha, ETH_ALEN);
 194
 195         eah->pa_dst_zero = 0;
 196         eah->pa_dst_net  = them->s_net;
 197         eah->pa_dst_node = them->s_node;
 198
 199         /* Send it */
 200         aarp_dl->request(aarp_dl, skb, sha);
 201 }
 202
 203 /*
 204  *      Send probe frames. Called from aarp_probe_network and
 205  *      aarp_proxy_probe_network.
 206  */
 207
 208 static void aarp_send_probe(struct net_device *dev, struct atalk_addr *us)
 209 {
 210         struct elapaarp *eah;
 211         int len = dev->hard_header_len + sizeof(*eah) + aarp_dl->header_length;
 212         struct sk_buff *skb = alloc_skb(len, GFP_ATOMIC);
 213         static unsigned char aarp_eth_multicast[ETH_ALEN] =
 214                                         { 0x09, 0x00, 0x07, 0xFF, 0xFF, 0xFF };
 215
 216         if (!skb)
 217                 return;
 218
 219         /* Set up the buffer */
 220         skb_reserve(skb, dev->hard_header_len + aarp_dl->header_length);
 221         skb_reset_network_header(skb);
 222         skb_reset_transport_header(skb);
 223         skb_put(skb, sizeof(*eah));
 224         skb->protocol    = htons(ETH_P_ATALK);
 225         skb->dev         = dev;
 226         eah              = aarp_hdr(skb);
 227
 228         /* Set up the ARP */
 229         eah->hw_type     = htons(AARP_HW_TYPE_ETHERNET);
 230         eah->pa_type     = htons(ETH_P_ATALK);
 231         eah->hw_len      = ETH_ALEN;
 232         eah->pa_len      = AARP_PA_ALEN;
 233         eah->function    = htons(AARP_PROBE);
 234
 235         memcpy(eah->hw_src, dev->dev_addr, ETH_ALEN);
 236
 237         eah->pa_src_zero = 0;
 238         eah->pa_src_net  = us->s_net;
 239         eah->pa_src_node = us->s_node;
 240
 241         memset(eah->hw_dst, '\0', ETH_ALEN);
 242
 243         eah->pa_dst_zero = 0;
 244         eah->pa_dst_net  = us->s_net;
 245         eah->pa_dst_node = us->s_node;
 246
 247         /* Send it */
 248         aarp_dl->request(aarp_dl, skb, aarp_eth_multicast);
 249 }
 250
 251 /*
 252  *      Handle an aarp timer expire
 253  *
 254  *      Must run under the aarp_lock.
 255  */
 256
 257 static void __aarp_expire_timer(struct aarp_entry **n)
 258 {
 259         struct aarp_entry *t;
 260
 261         while (*n)
 262                 /* Expired ? */
 263                 if (time_after(jiffies, (*n)->expires_at)) {
 264                         t = *n;
 265                         *n = (*n)->next;
 266                         __aarp_expire(t);
 267                 } else
 268                         n = &((*n)->next);
 269 }
 270
 271 /*
 272  *      Kick all pending requests 5 times a second.
 273  *
 274  *      Must run under the aarp_lock.
 275  */
 276 static void __aarp_kick(struct aarp_entry **n)
 277 {
 278         struct aarp_entry *t;
 279
 280         while (*n)
 281                 /* Expired: if this will be the 11th tx, we delete instead. */
 282                 if ((*n)->xmit_count >= sysctl_aarp_retransmit_limit) {
 283                         t = *n;
 284                         *n = (*n)->next;
 285                         __aarp_expire(t);
 286                 } else {
 287                         __aarp_send_query(*n);
 288                         n = &((*n)->next);
 289                 }
 290 }
 291
 292 /*
 293  *      A device has gone down. Take all entries referring to the device
 294  *      and remove them.
 295  *
 296  *      Must run under the aarp_lock.
 297  */
 298 static void __aarp_expire_device(struct aarp_entry **n, struct net_device *dev)
 299 {
 300         struct aarp_entry *t;
 301
 302         while (*n)
 303                 if ((*n)->dev == dev) {
 304                         t = *n;
 305                         *n = (*n)->next;
 306                         __aarp_expire(t);
 307                 } else
 308                         n = &((*n)->next);
 309 }
 310
 311 /* Handle the timer event */
 312 static void aarp_expire_timeout(unsigned long unused)
 313 {
 314         int ct;
 315
 316         write_lock_bh(&aarp_lock);
 317
 318         for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
 319                 __aarp_expire_timer(&resolved[ct]);
 320                 __aarp_kick(&unresolved[ct]);
 321                 __aarp_expire_timer(&unresolved[ct]);
 322                 __aarp_expire_timer(&proxies[ct]);
 323         }
 324
 325         write_unlock_bh(&aarp_lock);
 326         mod_timer(&aarp_timer, jiffies +
 327                                (unresolved_count ? sysctl_aarp_tick_time :
 328                                 sysctl_aarp_expiry_time));
 329 }
 330
 331 /* Network device notifier chain handler. */
 332 static int aarp_device_event(struct notifier_block *this, unsigned long event,
 333                              void *ptr)
 334 {
 335         struct net_device *dev = ptr;
 336         int ct;
 337
 338         if (!net_eq(dev_net(dev), &init_net))
 339                 return NOTIFY_DONE;
 340
 341         if (event == NETDEV_DOWN) {
 342                 write_lock_bh(&aarp_lock);
 343
 344                 for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
 345                         __aarp_expire_device(&resolved[ct], dev);
 346                         __aarp_expire_device(&unresolved[ct], dev);
 347                         __aarp_expire_device(&proxies[ct], dev);
 348                 }
 349
 350                 write_unlock_bh(&aarp_lock);
 351         }
 352         return NOTIFY_DONE;
 353 }
 354
 355 /* Expire all entries in a hash chain */
 356 static void __aarp_expire_all(struct aarp_entry **n)
 357 {
 358         struct aarp_entry *t;
 359
 360         while (*n) {
 361                 t = *n;
 362                 *n = (*n)->next;
 363                 __aarp_expire(t);
 364         }
 365 }
 366
 367 /* Cleanup all hash chains -- module unloading */
 368 static void aarp_purge(void)
 369 {
 370         int ct;
 371
 372         write_lock_bh(&aarp_lock);
 373         for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
 374                 __aarp_expire_all(&resolved[ct]);
 375                 __aarp_expire_all(&unresolved[ct]);
 376                 __aarp_expire_all(&proxies[ct]);
 377         }
 378         write_unlock_bh(&aarp_lock);
 379 }
 380
 381 /*
 382  *      Create a new aarp entry.  This must use GFP_ATOMIC because it
 383  *      runs while holding spinlocks.
 384  */
 385 static struct aarp_entry *aarp_alloc(void)
 386 {
 387         struct aarp_entry *a = kmalloc(sizeof(*a), GFP_ATOMIC);
 388
 389         if (a)
 390                 skb_queue_head_init(&a->packet_queue);
 391         return a;
 392 }
 393
 394 /*
 395  * Find an entry. We might return an expired but not yet purged entry. We
 396  * don't care as it will do no harm.
 397  *
 398  * This must run under the aarp_lock.
 399  */
 400 static struct aarp_entry *__aarp_find_entry(struct aarp_entry *list,
 401                                             struct net_device *dev,
 402                                             struct atalk_addr *sat)
 403 {
 404         while (list) {
 405                 if (list->target_addr.s_net == sat->s_net &&
 406                     list->target_addr.s_node == sat->s_node &&
 407                     list->dev == dev)
 408                         break;
 409                 list = list->next;
 410         }
 411
 412         return list;
 413 }
 414
 415 /* Called from the DDP code, and thus must be exported. */
 416 void aarp_proxy_remove(struct net_device *dev, struct atalk_addr *sa)
 417 {
 418         int hash = sa->s_node % (AARP_HASH_SIZE - 1);
 419         struct aarp_entry *a;
 420
 421         write_lock_bh(&aarp_lock);
 422
 423         a = __aarp_find_entry(proxies[hash], dev, sa);
 424         if (a)
 425                 a->expires_at = jiffies - 1;
 426
 427         write_unlock_bh(&aarp_lock);
 428 }
 429
 430 /* This must run under aarp_lock. */
 431 static struct atalk_addr *__aarp_proxy_find(struct net_device *dev,
 432                                             struct atalk_addr *sa)
 433 {
 434         int hash = sa->s_node % (AARP_HASH_SIZE - 1);
 435         struct aarp_entry *a = __aarp_find_entry(proxies[hash], dev, sa);
 436
 437         return a ? sa : NULL;
 438 }
 439
 440 /*
 441  * Probe a Phase 1 device or a device that requires its Net:Node to
 442  * be set via an ioctl.
 443  */
 444 static void aarp_send_probe_phase1(struct atalk_iface *iface)
 445 {
 446         struct ifreq atreq;
 447         struct sockaddr_at *sa = (struct sockaddr_at *)&atreq.ifr_addr;
 448         const struct net_device_ops *ops = iface->dev->netdev_ops;
 449
 450         sa->sat_addr.s_node = iface->address.s_node;
 451         sa->sat_addr.s_net = ntohs(iface->address.s_net);
 452
 453         /* We pass the Net:Node to the drivers/cards by a Device ioctl. */
 454         if (!(ops->ndo_do_ioctl(iface->dev, &atreq, SIOCSIFADDR))) {
 455                 ops->ndo_do_ioctl(iface->dev, &atreq, SIOCGIFADDR);
 456                 if (iface->address.s_net != htons(sa->sat_addr.s_net) ||
 457                     iface->address.s_node != sa->sat_addr.s_node)
 458                         iface->status |= ATIF_PROBE_FAIL;
 459
 460                 iface->address.s_net  = htons(sa->sat_addr.s_net);
 461                 iface->address.s_node = sa->sat_addr.s_node;
 462         }
 463 }
 464
 465
 466 void aarp_probe_network(struct atalk_iface *atif)
 467 {
 468         if (atif->dev->type == ARPHRD_LOCALTLK ||
 469             atif->dev->type == ARPHRD_PPP)
 470                 aarp_send_probe_phase1(atif);
 471         else {
 472                 unsigned int count;
 473
 474                 for (count = 0; count < AARP_RETRANSMIT_LIMIT; count++) {
 475                         aarp_send_probe(atif->dev, &atif->address);
 476
 477                         /* Defer 1/10th */
 478                         msleep(100);
 479
 480                         if (atif->status & ATIF_PROBE_FAIL)
 481                                 break;
 482                 }
 483         }
 484 }
 485
 486 int aarp_proxy_probe_network(struct atalk_iface *atif, struct atalk_addr *sa)
 487 {
 488         int hash, retval = -EPROTONOSUPPORT;
 489         struct aarp_entry *entry;
 490         unsigned int count;
 491
 492         /*
 493          * we don't currently support LocalTalk or PPP for proxy AARP;
 494          * if someone wants to try and add it, have fun
 495          */
 496         if (atif->dev->type == ARPHRD_LOCALTLK ||
 497             atif->dev->type == ARPHRD_PPP)
 498                 goto out;
 499
 500         /*
 501          * create a new AARP entry with the flags set to be published --
 502          * we need this one to hang around even if it's in use
 503          */
 504         entry = aarp_alloc();
 505         retval = -ENOMEM;
 506         if (!entry)
 507                 goto out;
 508
 509         entry->expires_at = -1;
 510         entry->status = ATIF_PROBE;
 511         entry->target_addr.s_node = sa->s_node;
 512         entry->target_addr.s_net = sa->s_net;
 513         entry->dev = atif->dev;
 514
 515         write_lock_bh(&aarp_lock);
 516
 517         hash = sa->s_node % (AARP_HASH_SIZE - 1);
 518         entry->next = proxies[hash];
 519         proxies[hash] = entry;
 520
 521         for (count = 0; count < AARP_RETRANSMIT_LIMIT; count++) {
 522                 aarp_send_probe(atif->dev, sa);
 523
 524                 /* Defer 1/10th */
 525                 write_unlock_bh(&aarp_lock);
 526                 msleep(100);
 527                 write_lock_bh(&aarp_lock);
 528
 529                 if (entry->status & ATIF_PROBE_FAIL)
 530                         break;
 531         }
 532
 533         if (entry->status & ATIF_PROBE_FAIL) {
 534                 entry->expires_at = jiffies - 1; /* free the entry */
 535                 retval = -EADDRINUSE; /* return network full */
 536         } else { /* clear the probing flag */
 537                 entry->status &= ~ATIF_PROBE;
 538                 retval = 1;
 539         }
 540
 541         write_unlock_bh(&aarp_lock);
 542 out:
 543         return retval;
 544 }
 545
 546 /* Send a DDP frame */
 547 int aarp_send_ddp(struct net_device *dev, struct sk_buff *skb,
 548                   struct atalk_addr *sa, void *hwaddr)
 549 {
 550         static char ddp_eth_multicast[ETH_ALEN] =
 551                 { 0x09, 0x00, 0x07, 0xFF, 0xFF, 0xFF };
 552         int hash;
 553         struct aarp_entry *a;
 554
 555         skb_reset_network_header(skb);
 556
 557         /* Check for LocalTalk first */
 558         if (dev->type == ARPHRD_LOCALTLK) {
 559                 struct atalk_addr *at = atalk_find_dev_addr(dev);
 560                 struct ddpehdr *ddp = (struct ddpehdr *)skb->data;
 561                 int ft = 2;
 562
 563                 /*
 564                  * Compressible ?
 565                  *
 566                  * IFF: src_net == dest_net == device_net
 567                  * (zero matches anything)
 568                  */
 569
 570                 if ((!ddp->deh_snet || at->s_net == ddp->deh_snet) &&
 571                     (!ddp->deh_dnet || at->s_net == ddp->deh_dnet)) {
 572                         skb_pull(skb, sizeof(*ddp) - 4);
 573
 574                         /*
 575                          *      The upper two remaining bytes are the port
 576                          *      numbers we just happen to need. Now put the
 577                          *      length in the lower two.
 578                          */
 579                         *((__be16 *)skb->data) = htons(skb->len);
 580                         ft = 1;
 581                 }
 582                 /*
 583                  * Nice and easy. No AARP type protocols occur here so we can
 584                  * just shovel it out with a 3 byte LLAP header
 585                  */
 586
 587                 skb_push(skb, 3);
 588                 skb->data[0] = sa->s_node;
 589                 skb->data[1] = at->s_node;
 590                 skb->data[2] = ft;
 591                 skb->dev     = dev;
 592                 goto sendit;
 593         }
 594
 595         /* On a PPP link we neither compress nor aarp.  */
 596         if (dev->type == ARPHRD_PPP) {
 597                 skb->protocol = htons(ETH_P_PPPTALK);
 598                 skb->dev = dev;
 599                 goto sendit;
 600         }
 601
 602         /* Non ELAP we cannot do. */
 603         if (dev->type != ARPHRD_ETHER)
 604                 goto free_it;
 605
 606         skb->dev = dev;
 607         skb->protocol = htons(ETH_P_ATALK);
 608         hash = sa->s_node % (AARP_HASH_SIZE - 1);
 609
 610         /* Do we have a resolved entry? */
 611         if (sa->s_node == ATADDR_BCAST) {
 612                 /* Send it */
 613                 ddp_dl->request(ddp_dl, skb, ddp_eth_multicast);
 614                 goto sent;
 615         }
 616
 617         write_lock_bh(&aarp_lock);
 618         a = __aarp_find_entry(resolved[hash], dev, sa);
 619
 620         if (a) { /* Return 1 and fill in the address */
 621                 a->expires_at = jiffies + (sysctl_aarp_expiry_time * 10);
 622                 ddp_dl->request(ddp_dl, skb, a->hwaddr);
 623                 write_unlock_bh(&aarp_lock);
 624                 goto sent;
 625         }
 626
 627         /* Do we have an unresolved entry: This is the less common path */
 628         a = __aarp_find_entry(unresolved[hash], dev, sa);
 629         if (a) { /* Queue onto the unresolved queue */
 630                 skb_queue_tail(&a->packet_queue, skb);
 631                 goto out_unlock;
 632         }
 633
 634         /* Allocate a new entry */
 635         a = aarp_alloc();
 636         if (!a) {
 637                 /* Whoops slipped... good job it's an unreliable protocol 8) */
 638                 write_unlock_bh(&aarp_lock);
 639                 goto free_it;
 640         }
 641
 642         /* Set up the queue */
 643         skb_queue_tail(&a->packet_queue, skb);
 644         a->expires_at    = jiffies + sysctl_aarp_resolve_time;
 645         a->dev           = dev;
 646         a->next          = unresolved[hash];
 647         a->target_addr   = *sa;
 648         a->xmit_count    = 0;
 649         unresolved[hash] = a;
 650         unresolved_count++;
 651
 652         /* Send an initial request for the address */
 653         __aarp_send_query(a);
 654
 655         /*
 656          * Switch to fast timer if needed (That is if this is the first
 657          * unresolved entry to get added)
 658          */
 659
 660         if (unresolved_count == 1)
 661                 mod_timer(&aarp_timer, jiffies + sysctl_aarp_tick_time);
 662
 663         /* Now finally, it is safe to drop the lock. */
 664 out_unlock:
 665         write_unlock_bh(&aarp_lock);
 666
 667         /* Tell the ddp layer we have taken over for this frame. */
 668         goto sent;
 669
 670 sendit:
 671         if (skb->sk)
 672                 skb->priority = skb->sk->sk_priority;
 673         if (dev_queue_xmit(skb))
 674                 goto drop;
 675 sent:
 676         return NET_XMIT_SUCCESS;
 677 free_it:
 678         kfree_skb(skb);
 679 drop:
 680         return NET_XMIT_DROP;
 681 }
 682 EXPORT_SYMBOL(aarp_send_ddp);
 683
 684 /*
 685  *      An entry in the aarp unresolved queue has become resolved. Send
 686  *      all the frames queued under it.
 687  *
 688  *      Must run under aarp_lock.
 689  */
 690 static void __aarp_resolved(struct aarp_entry **list, struct aarp_entry *a,
 691                             int hash)
 692 {
 693         struct sk_buff *skb;
 694
 695         while (*list)
 696                 if (*list == a) {
 697                         unresolved_count--;
 698                         *list = a->next;
 699
 700                         /* Move into the resolved list */
 701                         a->next = resolved[hash];
 702                         resolved[hash] = a;
 703
 704                         /* Kick frames off */
 705                         while ((skb = skb_dequeue(&a->packet_queue)) != NULL) {
 706                                 a->expires_at = jiffies +
 707                                                 sysctl_aarp_expiry_time * 10;
 708                                 ddp_dl->request(ddp_dl, skb, a->hwaddr);
 709                         }
 710                 } else
 711                         list = &((*list)->next);
 712 }
 713
 714 /*
 715  *      This is called by the SNAP driver whenever we see an AARP SNAP
 716  *      frame. We currently only support Ethernet.
 717  */
 718 static int aarp_rcv(struct sk_buff *skb, struct net_device *dev,
 719                     struct packet_type *pt, struct net_device *orig_dev)
 720 {
 721         struct elapaarp *ea = aarp_hdr(skb);
 722         int hash, ret = 0;
 723         __u16 function;
 724         struct aarp_entry *a;
 725         struct atalk_addr sa, *ma, da;
 726         struct atalk_iface *ifa;
 727
 728         if (!net_eq(dev_net(dev), &init_net))
 729                 goto out0;
 730
 731         /* We only do Ethernet SNAP AARP. */
 732         if (dev->type != ARPHRD_ETHER)
 733                 goto out0;
 734
 735         /* Frame size ok? */
 736         if (!skb_pull(skb, sizeof(*ea)))
 737                 goto out0;
 738
 739         function = ntohs(ea->function);
 740
 741         /* Sanity check fields. */
 742         if (function < AARP_REQUEST || function > AARP_PROBE ||
 743             ea->hw_len != ETH_ALEN || ea->pa_len != AARP_PA_ALEN ||
 744             ea->pa_src_zero || ea->pa_dst_zero)
 745                 goto out0;
 746
 747         /* Looks good. */
 748         hash = ea->pa_src_node % (AARP_HASH_SIZE - 1);
 749
 750         /* Build an address. */
 751         sa.s_node = ea->pa_src_node;
 752         sa.s_net = ea->pa_src_net;
 753
 754         /* Process the packet. Check for replies of me. */
 755         ifa = atalk_find_dev(dev);
 756         if (!ifa)
 757                 goto out1;
 758
 759         if (ifa->status & ATIF_PROBE &&
 760             ifa->address.s_node == ea->pa_dst_node &&
 761             ifa->address.s_net == ea->pa_dst_net) {
 762                 ifa->status |= ATIF_PROBE_FAIL; /* Fail the probe (in use) */
 763                 goto out1;
 764         }
 765
 766         /* Check for replies of proxy AARP entries */
 767         da.s_node = ea->pa_dst_node;
 768         da.s_net  = ea->pa_dst_net;
 769
 770         write_lock_bh(&aarp_lock);
 771         a = __aarp_find_entry(proxies[hash], dev, &da);
 772
 773         if (a && a->status & ATIF_PROBE) {
 774                 a->status |= ATIF_PROBE_FAIL;
 775                 /*
 776                  * we do not respond to probe or request packets for
 777                  * this address while we are probing this address
 778                  */
 779                 goto unlock;
 780         }
 781
 782         switch (function) {
 783         case AARP_REPLY:
 784                 if (!unresolved_count)  /* Speed up */
 785                         break;
 786
 787                 /* Find the entry.  */
 788                 a = __aarp_find_entry(unresolved[hash], dev, &sa);
 789                 if (!a || dev != a->dev)
 790                         break;
 791
 792                 /* We can fill one in - this is good. */
 793                 memcpy(a->hwaddr, ea->hw_src, ETH_ALEN);
 794                 __aarp_resolved(&unresolved[hash], a, hash);
 795                 if (!unresolved_count)
 796                         mod_timer(&aarp_timer,
 797                                   jiffies + sysctl_aarp_expiry_time);
 798                 break;
 799
 800         case AARP_REQUEST:
 801         case AARP_PROBE:
 802
 803                 /*
 804                  * If it is my address set ma to my address and reply.
 805                  * We can treat probe and request the same.  Probe
 806                  * simply means we shouldn't cache the querying host,
 807                  * as in a probe they are proposing an address not
 808                  * using one.
 809                  *
 810                  * Support for proxy-AARP added. We check if the
 811                  * address is one of our proxies before we toss the
 812                  * packet out.
 813                  */
 814
 815                 sa.s_node = ea->pa_dst_node;
 816                 sa.s_net  = ea->pa_dst_net;
 817
 818                 /* See if we have a matching proxy. */
 819                 ma = __aarp_proxy_find(dev, &sa);
 820                 if (!ma)
 821                         ma = &ifa->address;
 822                 else { /* We need to make a copy of the entry. */
 823                         da.s_node = sa.s_node;
 824                         da.s_net = sa.s_net;
 825                         ma = &da;
 826                 }
 827
 828                 if (function == AARP_PROBE) {
 829                         /*
 830                          * A probe implies someone trying to get an
 831                          * address. So as a precaution flush any
 832                          * entries we have for this address.
 833                          */
 834                         a = __aarp_find_entry(resolved[sa.s_node %
 835                                                        (AARP_HASH_SIZE - 1)],
 836                                               skb->dev, &sa);
 837
 838                         /*
 839                          * Make it expire next tick - that avoids us
 840                          * getting into a probe/flush/learn/probe/
 841                          * flush/learn cycle during probing of a slow
 842                          * to respond host addr.
 843                          */
 844                         if (a) {
 845                                 a->expires_at = jiffies - 1;
 846                                 mod_timer(&aarp_timer, jiffies +
 847                                           sysctl_aarp_tick_time);
 848                         }
 849                 }
 850
 851                 if (sa.s_node != ma->s_node)
 852                         break;
 853
 854                 if (sa.s_net && ma->s_net && sa.s_net != ma->s_net)
 855                         break;
 856
 857                 sa.s_node = ea->pa_src_node;
 858                 sa.s_net = ea->pa_src_net;
 859
 860                 /* aarp_my_address has found the address to use for us.
 861                  */
 862                 aarp_send_reply(dev, ma, &sa, ea->hw_src);
 863                 break;
 864         }
 865
 866 unlock:
 867         write_unlock_bh(&aarp_lock);
 868 out1:
 869         ret = 1;
 870 out0:
 871         kfree_skb(skb);
 872         return ret;
 873 }
 874
 875 static struct notifier_block aarp_notifier = {
 876         .notifier_call = aarp_device_event,
 877 };
 878
 879 static unsigned char aarp_snap_id[] = { 0x00, 0x00, 0x00, 0x80, 0xF3 };
 880
 881 void __init aarp_proto_init(void)
 882 {
 883         aarp_dl = register_snap_client(aarp_snap_id, aarp_rcv);
 884         if (!aarp_dl)
 885                 printk(KERN_CRIT "Unable to register AARP with SNAP.\n");
 886         setup_timer(&aarp_timer, aarp_expire_timeout, 0);
 887         aarp_timer.expires  = jiffies + sysctl_aarp_expiry_time;
 888         add_timer(&aarp_timer);
 889         register_netdevice_notifier(&aarp_notifier);
 890 }
 891
 892 /* Remove the AARP entries associated with a device. */
 893 void aarp_device_down(struct net_device *dev)
 894 {
 895         int ct;
 896
 897         write_lock_bh(&aarp_lock);
 898
 899         for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
 900                 __aarp_expire_device(&resolved[ct], dev);
 901                 __aarp_expire_device(&unresolved[ct], dev);
 902                 __aarp_expire_device(&proxies[ct], dev);
 903         }
 904
 905         write_unlock_bh(&aarp_lock);
 906 }
 907
 908 #ifdef CONFIG_PROC_FS
 909 struct aarp_iter_state {
 910         int bucket;
 911         struct aarp_entry **table;
 912 };
 913
 914 /*
 915  * Get the aarp entry that is in the chain described
 916  * by the iterator.
 917  * If pos is set then skip till that index.
 918  * pos = 1 is the first entry
 919  */
 920 static struct aarp_entry *iter_next(struct aarp_iter_state *iter, loff_t *pos)
 921 {
 922         int ct = iter->bucket;
 923         struct aarp_entry **table = iter->table;
 924         loff_t off = 0;
 925         struct aarp_entry *entry;
 926
 927  rescan:
 928         while(ct < AARP_HASH_SIZE) {
 929                 for (entry = table[ct]; entry; entry = entry->next) {
 930                         if (!pos || ++off == *pos) {
 931                                 iter->table = table;
 932                                 iter->bucket = ct;
 933                                 return entry;
 934                         }
 935                 }
 936                 ++ct;
 937         }
 938
 939         if (table == resolved) {
 940                 ct = 0;
 941                 table = unresolved;
 942                 goto rescan;
 943         }
 944         if (table == unresolved) {
 945                 ct = 0;
 946                 table = proxies;
 947                 goto rescan;
 948         }
 949         return NULL;
 950 }
 951
 952 static void *aarp_seq_start(struct seq_file *seq, loff_t *pos)
 953         __acquires(aarp_lock)
 954 {
 955         struct aarp_iter_state *iter = seq->private;
 956
 957         read_lock_bh(&aarp_lock);
 958         iter->table     = resolved;
 959         iter->bucket    = 0;
 960
 961         return *pos ? iter_next(iter, pos) : SEQ_START_TOKEN;
 962 }
 963
 964 static void *aarp_seq_next(struct seq_file *seq, void *v, loff_t *pos)
 965 {
 966         struct aarp_entry *entry = v;
 967         struct aarp_iter_state *iter = seq->private;
 968
 969         ++*pos;
 970
 971         /* first line after header */
 972         if (v == SEQ_START_TOKEN)
 973                 entry = iter_next(iter, NULL);
 974
 975         /* next entry in current bucket */
 976         else if (entry->next)
 977                 entry = entry->next;
 978
 979         /* next bucket or table */
 980         else {
 981                 ++iter->bucket;
 982                 entry = iter_next(iter, NULL);
 983         }
 984         return entry;
 985 }
 986
 987 static void aarp_seq_stop(struct seq_file *seq, void *v)
 988         __releases(aarp_lock)
 989 {
 990         read_unlock_bh(&aarp_lock);
 991 }
 992
 993 static const char *dt2str(unsigned long ticks)
 994 {
 995         static char buf[32];
 996
 997         sprintf(buf, "%ld.%02ld", ticks / HZ, ((ticks % HZ) * 100 ) / HZ);
 998
 999         return buf;
1000 }
1001
1002 static int aarp_seq_show(struct seq_file *seq, void *v)
1003 {
1004         struct aarp_iter_state *iter = seq->private;
1005         struct aarp_entry *entry = v;
1006         unsigned long now = jiffies;
1007
1008         if (v == SEQ_START_TOKEN)
1009                 seq_puts(seq,
1010                          "Address  Interface   Hardware Address"
1011                          "   Expires LastSend  Retry Status\n");
1012         else {
1013                 seq_printf(seq, "%04X:%02X  %-12s",
1014                            ntohs(entry->target_addr.s_net),
1015                            (unsigned int) entry->target_addr.s_node,
1016                            entry->dev ? entry->dev->name : "????");
1017                 seq_printf(seq, "%pM", entry->hwaddr);
1018                 seq_printf(seq, " %8s",
1019                            dt2str((long)entry->expires_at - (long)now));
1020                 if (iter->table == unresolved)
1021                         seq_printf(seq, " %8s %6hu",
1022                                    dt2str(now - entry->last_sent),
1023                                    entry->xmit_count);
1024                 else
1025                         seq_puts(seq, "                ");
1026                 seq_printf(seq, " %s\n",
1027                            (iter->table == resolved) ? "resolved"
1028                            : (iter->table == unresolved) ? "unresolved"
1029                            : (iter->table == proxies) ? "proxies"
1030                            : "unknown");
1031         }
1032         return 0;
1033 }
1034
1035 static const struct seq_operations aarp_seq_ops = {
1036         .start  = aarp_seq_start,
1037         .next   = aarp_seq_next,
1038         .stop   = aarp_seq_stop,
1039         .show   = aarp_seq_show,
1040 };
1041
1042 static int aarp_seq_open(struct inode *inode, struct file *file)
1043 {
1044         return seq_open_private(file, &aarp_seq_ops,
1045                         sizeof(struct aarp_iter_state));
1046 }
1047
1048 const struct file_operations atalk_seq_arp_fops = {
1049         .owner          = THIS_MODULE,
1050         .open           = aarp_seq_open,
1051         .read           = seq_read,
1052         .llseek         = seq_lseek,
1053         .release        = seq_release_private,
1054 };
1055 #endif
1056
1057 /* General module cleanup. Called from cleanup_module() in ddp.c. */
1058 void aarp_cleanup_module(void)
1059 {
1060         del_timer_sync(&aarp_timer);
1061         unregister_netdevice_notifier(&aarp_notifier);
1062         unregister_snap_client(aarp_dl);
1063         aarp_purge();
1064 }