net/atm/lec.c

   1 /*
   2  * lec.c: Lan Emulation driver
   3  * Marko Kiiskila mkiiskila@yahoo.com
   4  *
   5  */
   6
   7 #include <linux/config.h>
   8 #include <linux/kernel.h>
   9 #include <linux/bitops.h>
  10
  11 /* We are ethernet device */
  12 #include <linux/if_ether.h>
  13 #include <linux/netdevice.h>
  14 #include <linux/etherdevice.h>
  15 #include <net/sock.h>
  16 #include <linux/skbuff.h>
  17 #include <linux/ip.h>
  18 #include <asm/byteorder.h>
  19 #include <asm/uaccess.h>
  20 #include <net/arp.h>
  21 #include <net/dst.h>
  22 #include <linux/proc_fs.h>
  23 #include <linux/spinlock.h>
  24 #include <linux/proc_fs.h>
  25 #include <linux/seq_file.h>
  26
  27 /* TokenRing if needed */
  28 #ifdef CONFIG_TR
  29 #include <linux/trdevice.h>
  30 #endif
  31
  32 /* And atm device */
  33 #include <linux/atmdev.h>
  34 #include <linux/atmlec.h>
  35
  36 /* Proxy LEC knows about bridging */
  37 #if defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE)
  38 #include <linux/if_bridge.h>
  39 #include "../bridge/br_private.h"
  40
  41 static unsigned char bridge_ula_lec[] = {0x01, 0x80, 0xc2, 0x00, 0x00};
  42 #endif
  43
  44 /* Modular too */
  45 #include <linux/module.h>
  46 #include <linux/init.h>
  47
  48 #include "lec.h"
  49 #include "lec_arpc.h"
  50 #include "resources.h"
  51
  52 #if 0
  53 #define DPRINTK printk
  54 #else
  55 #define DPRINTK(format,args...)
  56 #endif
  57
  58 #define DUMP_PACKETS 0 /* 0 = None,
  59                         * 1 = 30 first bytes
  60                         * 2 = Whole packet
  61                         */
  62
  63 #define LEC_UNRES_QUE_LEN 8 /* number of tx packets to queue for a
  64                                single destination while waiting for SVC */
  65
  66 static int lec_open(struct net_device *dev);
  67 static int lec_start_xmit(struct sk_buff *skb, struct net_device *dev);
  68 static int lec_close(struct net_device *dev);
  69 static struct net_device_stats *lec_get_stats(struct net_device *dev);
  70 static void lec_init(struct net_device *dev);
  71 static struct lec_arp_table* lec_arp_find(struct lec_priv *priv,
  72                                                      unsigned char *mac_addr);
  73 static int lec_arp_remove(struct lec_priv *priv,
  74                                      struct lec_arp_table *to_remove);
  75 /* LANE2 functions */
  76 static void lane2_associate_ind (struct net_device *dev, u8 *mac_address,
  77                           u8 *tlvs, u32 sizeoftlvs);
  78 static int lane2_resolve(struct net_device *dev, u8 *dst_mac, int force,
  79                   u8 **tlvs, u32 *sizeoftlvs);
  80 static int lane2_associate_req (struct net_device *dev, u8 *lan_dst,
  81                          u8 *tlvs, u32 sizeoftlvs);
  82
  83 static int lec_addr_delete(struct lec_priv *priv, unsigned char *atm_addr,
  84                            unsigned long permanent);
  85 static void lec_arp_check_empties(struct lec_priv *priv,
  86                                   struct atm_vcc *vcc, struct sk_buff *skb);
  87 static void lec_arp_destroy(struct lec_priv *priv);
  88 static void lec_arp_init(struct lec_priv *priv);
  89 static struct atm_vcc* lec_arp_resolve(struct lec_priv *priv,
  90                                        unsigned char *mac_to_find,
  91                                        int is_rdesc,
  92                                        struct lec_arp_table **ret_entry);
  93 static void lec_arp_update(struct lec_priv *priv, unsigned char *mac_addr,
  94                            unsigned char *atm_addr, unsigned long remoteflag,
  95                            unsigned int targetless_le_arp);
  96 static void lec_flush_complete(struct lec_priv *priv, unsigned long tran_id);
  97 static int lec_mcast_make(struct lec_priv *priv, struct atm_vcc *vcc);
  98 static void lec_set_flush_tran_id(struct lec_priv *priv,
  99                                   unsigned char *atm_addr,
 100                                   unsigned long tran_id);
 101 static void lec_vcc_added(struct lec_priv *priv, struct atmlec_ioc *ioc_data,
 102                           struct atm_vcc *vcc,
 103                           void (*old_push)(struct atm_vcc *vcc, struct sk_buff *skb));
 104 static void lec_vcc_close(struct lec_priv *priv, struct atm_vcc *vcc);
 105
 106 static struct lane2_ops lane2_ops = {
 107         lane2_resolve,         /* resolve,             spec 3.1.3 */
 108         lane2_associate_req,   /* associate_req,       spec 3.1.4 */
 109         NULL                  /* associate indicator, spec 3.1.5 */
 110 };
 111
 112 static unsigned char bus_mac[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff};
 113
 114 /* Device structures */
 115 static struct net_device *dev_lec[MAX_LEC_ITF];
 116
 117 #if defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE)
 118 static void lec_handle_bridge(struct sk_buff *skb, struct net_device *dev)
 119 {
 120         struct ethhdr *eth;
 121         char *buff;
 122         struct lec_priv *priv;
 123
 124         /* Check if this is a BPDU. If so, ask zeppelin to send
 125          * LE_TOPOLOGY_REQUEST with the same value of Topology Change bit
 126          * as the Config BPDU has */
 127         eth = (struct ethhdr *)skb->data;
 128         buff = skb->data + skb->dev->hard_header_len;
 129         if (*buff++ == 0x42 && *buff++ == 0x42 && *buff++ == 0x03) {
 130                 struct sock *sk;
 131                 struct sk_buff *skb2;
 132                 struct atmlec_msg *mesg;
 133
 134                 skb2 = alloc_skb(sizeof(struct atmlec_msg), GFP_ATOMIC);
 135                 if (skb2 == NULL) return;
 136                 skb2->len = sizeof(struct atmlec_msg);
 137                 mesg = (struct atmlec_msg *)skb2->data;
 138                 mesg->type = l_topology_change;
 139                 buff += 4;
 140                 mesg->content.normal.flag = *buff & 0x01; /* 0x01 is topology change */
 141
 142                 priv = (struct lec_priv *)dev->priv;
 143                 atm_force_charge(priv->lecd, skb2->truesize);
 144                 sk = sk_atm(priv->lecd);
 145                 skb_queue_tail(&sk->sk_receive_queue, skb2);
 146                 sk->sk_data_ready(sk, skb2->len);
 147         }
 148
 149         return;
 150 }
 151 #endif /* defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE) */
 152
 153 /*
 154  * Modelled after tr_type_trans
 155  * All multicast and ARE or STE frames go to BUS.
 156  * Non source routed frames go by destination address.
 157  * Last hop source routed frames go by destination address.
 158  * Not last hop source routed frames go by _next_ route descriptor.
 159  * Returns pointer to destination MAC address or fills in rdesc
 160  * and returns NULL.
 161  */
 162 #ifdef CONFIG_TR
 163 static unsigned char *get_tr_dst(unsigned char *packet, unsigned char *rdesc)
 164 {
 165         struct trh_hdr *trh;
 166         int riflen, num_rdsc;
 167
 168         trh = (struct trh_hdr *)packet;
 169         if (trh->daddr[0] & (uint8_t)0x80)
 170                 return bus_mac; /* multicast */
 171
 172         if (trh->saddr[0] & TR_RII) {
 173                 riflen = (ntohs(trh->rcf) & TR_RCF_LEN_MASK) >> 8;
 174                 if ((ntohs(trh->rcf) >> 13) != 0)
 175                         return bus_mac; /* ARE or STE */
 176         }
 177         else
 178                 return trh->daddr; /* not source routed */
 179
 180         if (riflen < 6)
 181                 return trh->daddr; /* last hop, source routed */
 182
 183         /* riflen is 6 or more, packet has more than one route descriptor */
 184         num_rdsc = (riflen/2) - 1;
 185         memset(rdesc, 0, ETH_ALEN);
 186         /* offset 4 comes from LAN destination field in LE control frames */
 187         if (trh->rcf & htons((uint16_t)TR_RCF_DIR_BIT))
 188                 memcpy(&rdesc[4], &trh->rseg[num_rdsc-2], sizeof(uint16_t));
 189         else {
 190                 memcpy(&rdesc[4], &trh->rseg[1], sizeof(uint16_t));
 191                 rdesc[5] = ((ntohs(trh->rseg[0]) & 0x000f) | (rdesc[5] & 0xf0));
 192         }
 193
 194         return NULL;
 195 }
 196 #endif /* CONFIG_TR */
 197
 198 /*
 199  * Open/initialize the netdevice. This is called (in the current kernel)
 200  * sometime after booting when the 'ifconfig' program is run.
 201  *
 202  * This routine should set everything up anew at each open, even
 203  * registers that "should" only need to be set once at boot, so that
 204  * there is non-reboot way to recover if something goes wrong.
 205  */
 206
 207 static int
 208 lec_open(struct net_device *dev)
 209 {
 210         struct lec_priv *priv = (struct lec_priv *)dev->priv;
 211
 212         netif_start_queue(dev);
 213         memset(&priv->stats,0,sizeof(struct net_device_stats));
 214
 215         return 0;
 216 }
 217
 218 static __inline__ void
 219 lec_send(struct atm_vcc *vcc, struct sk_buff *skb, struct lec_priv *priv)
 220 {
 221         ATM_SKB(skb)->vcc = vcc;
 222         ATM_SKB(skb)->atm_options = vcc->atm_options;
 223
 224         atomic_add(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc);
 225         if (vcc->send(vcc, skb) < 0) {
 226                 priv->stats.tx_dropped++;
 227                 return;
 228         }
 229
 230         priv->stats.tx_packets++;
 231         priv->stats.tx_bytes += skb->len;
 232 }
 233
 234 static void
 235 lec_tx_timeout(struct net_device *dev)
 236 {
 237         printk(KERN_INFO "%s: tx timeout\n", dev->name);
 238         dev->trans_start = jiffies;
 239         netif_wake_queue(dev);
 240 }
 241
 242 static int
 243 lec_start_xmit(struct sk_buff *skb, struct net_device *dev)
 244 {
 245         struct sk_buff *skb2;
 246         struct lec_priv *priv = (struct lec_priv *)dev->priv;
 247         struct lecdatahdr_8023 *lec_h;
 248         struct atm_vcc *vcc;
 249         struct lec_arp_table *entry;
 250         unsigned char *dst;
 251         int min_frame_size;
 252 #ifdef CONFIG_TR
 253         unsigned char rdesc[ETH_ALEN]; /* Token Ring route descriptor */
 254 #endif
 255         int is_rdesc;
 256 #if DUMP_PACKETS > 0
 257         char buf[300];
 258         int i=0;
 259 #endif /* DUMP_PACKETS >0 */
 260
 261         DPRINTK("lec_start_xmit called\n");
 262         if (!priv->lecd) {
 263                 printk("%s:No lecd attached\n",dev->name);
 264                 priv->stats.tx_errors++;
 265                 netif_stop_queue(dev);
 266                 return -EUNATCH;
 267         }
 268
 269         DPRINTK("skbuff head:%lx data:%lx tail:%lx end:%lx\n",
 270                 (long)skb->head, (long)skb->data, (long)skb->tail,
 271                 (long)skb->end);
 272 #if defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE)
 273         if (memcmp(skb->data, bridge_ula_lec, sizeof(bridge_ula_lec)) == 0)
 274                 lec_handle_bridge(skb, dev);
 275 #endif
 276
 277         /* Make sure we have room for lec_id */
 278         if (skb_headroom(skb) < 2) {
 279
 280                 DPRINTK("lec_start_xmit: reallocating skb\n");
 281                 skb2 = skb_realloc_headroom(skb, LEC_HEADER_LEN);
 282                 kfree_skb(skb);
 283                 if (skb2 == NULL) return 0;
 284                 skb = skb2;
 285         }
 286         skb_push(skb, 2);
 287
 288         /* Put le header to place, works for TokenRing too */
 289         lec_h = (struct lecdatahdr_8023*)skb->data;
 290         lec_h->le_header = htons(priv->lecid);
 291
 292 #ifdef CONFIG_TR
 293         /* Ugly. Use this to realign Token Ring packets for
 294          * e.g. PCA-200E driver. */
 295         if (priv->is_trdev) {
 296                 skb2 = skb_realloc_headroom(skb, LEC_HEADER_LEN);
 297                 kfree_skb(skb);
 298                 if (skb2 == NULL) return 0;
 299                 skb = skb2;
 300         }
 301 #endif
 302
 303 #if DUMP_PACKETS > 0
 304         printk("%s: send datalen:%ld lecid:%4.4x\n", dev->name,
 305                skb->len, priv->lecid);
 306 #if DUMP_PACKETS >= 2
 307         for(i=0;i<skb->len && i <99;i++) {
 308                 sprintf(buf+i*3,"%2.2x ",0xff&skb->data[i]);
 309         }
 310 #elif DUMP_PACKETS >= 1
 311         for(i=0;i<skb->len && i < 30;i++) {
 312                 sprintf(buf+i*3,"%2.2x ", 0xff&skb->data[i]);
 313         }
 314 #endif /* DUMP_PACKETS >= 1 */
 315         if (i==skb->len)
 316                 printk("%s\n",buf);
 317         else
 318                 printk("%s...\n",buf);
 319 #endif /* DUMP_PACKETS > 0 */
 320
 321         /* Minimum ethernet-frame size */
 322 #ifdef CONFIG_TR
 323         if (priv->is_trdev)
 324                 min_frame_size = LEC_MINIMUM_8025_SIZE;
 325         else
 326 #endif
 327         min_frame_size = LEC_MINIMUM_8023_SIZE;
 328         if (skb->len < min_frame_size) {
 329                 if ((skb->len + skb_tailroom(skb)) < min_frame_size) {
 330                         skb2 = skb_copy_expand(skb, 0,
 331                             min_frame_size - skb->truesize, GFP_ATOMIC);
 332                                 dev_kfree_skb(skb);
 333                         if (skb2 == NULL) {
 334                                 priv->stats.tx_dropped++;
 335                                 return 0;
 336                         }
 337                         skb = skb2;
 338                 }
 339                 skb_put(skb, min_frame_size - skb->len);
 340         }
 341
 342         /* Send to right vcc */
 343         is_rdesc = 0;
 344         dst = lec_h->h_dest;
 345 #ifdef CONFIG_TR
 346         if (priv->is_trdev) {
 347                 dst = get_tr_dst(skb->data+2, rdesc);
 348                 if (dst == NULL) {
 349                         dst = rdesc;
 350                         is_rdesc = 1;
 351                 }
 352         }
 353 #endif
 354         entry = NULL;
 355         vcc = lec_arp_resolve(priv, dst, is_rdesc, &entry);
 356         DPRINTK("%s:vcc:%p vcc_flags:%x, entry:%p\n", dev->name,
 357                 vcc, vcc?vcc->flags:0, entry);
 358         if (!vcc || !test_bit(ATM_VF_READY,&vcc->flags)) {
 359                 if (entry && (entry->tx_wait.qlen < LEC_UNRES_QUE_LEN)) {
 360                         DPRINTK("%s:lec_start_xmit: queuing packet, ", dev->name);
 361                         DPRINTK("MAC address 0x%02x:%02x:%02x:%02x:%02x:%02x\n",
 362                                 lec_h->h_dest[0], lec_h->h_dest[1], lec_h->h_dest[2],
 363                                 lec_h->h_dest[3], lec_h->h_dest[4], lec_h->h_dest[5]);
 364                         skb_queue_tail(&entry->tx_wait, skb);
 365                 } else {
 366                         DPRINTK("%s:lec_start_xmit: tx queue full or no arp entry, dropping, ", dev->name);
 367                         DPRINTK("MAC address 0x%02x:%02x:%02x:%02x:%02x:%02x\n",
 368                                 lec_h->h_dest[0], lec_h->h_dest[1], lec_h->h_dest[2],
 369                                 lec_h->h_dest[3], lec_h->h_dest[4], lec_h->h_dest[5]);
 370                         priv->stats.tx_dropped++;
 371                         dev_kfree_skb(skb);
 372                 }
 373                 return 0;
 374         }
 375
 376 #if DUMP_PACKETS > 0
 377         printk("%s:sending to vpi:%d vci:%d\n", dev->name,
 378                vcc->vpi, vcc->vci);
 379 #endif /* DUMP_PACKETS > 0 */
 380
 381         while (entry && (skb2 = skb_dequeue(&entry->tx_wait))) {
 382                 DPRINTK("lec.c: emptying tx queue, ");
 383                 DPRINTK("MAC address 0x%02x:%02x:%02x:%02x:%02x:%02x\n",
 384                         lec_h->h_dest[0], lec_h->h_dest[1], lec_h->h_dest[2],
 385                         lec_h->h_dest[3], lec_h->h_dest[4], lec_h->h_dest[5]);
 386                 lec_send(vcc, skb2, priv);
 387         }
 388
 389         lec_send(vcc, skb, priv);
 390
 391         if (!atm_may_send(vcc, 0)) {
 392                 struct lec_vcc_priv *vpriv = LEC_VCC_PRIV(vcc);
 393
 394                 vpriv->xoff = 1;
 395                 netif_stop_queue(dev);
 396
 397                 /*
 398                  * vcc->pop() might have occurred in between, making
 399                  * the vcc usuable again.  Since xmit is serialized,
 400                  * this is the only situation we have to re-test.
 401                  */
 402
 403                 if (atm_may_send(vcc, 0))
 404                         netif_wake_queue(dev);
 405         }
 406
 407         dev->trans_start = jiffies;
 408         return 0;
 409 }
 410
 411 /* The inverse routine to net_open(). */
 412 static int
 413 lec_close(struct net_device *dev)
 414 {
 415         netif_stop_queue(dev);
 416         return 0;
 417 }
 418
 419 /*
 420  * Get the current statistics.
 421  * This may be called with the card open or closed.
 422  */
 423 static struct net_device_stats *
 424 lec_get_stats(struct net_device *dev)
 425 {
 426         return &((struct lec_priv *)dev->priv)->stats;
 427 }
 428
 429 static int
 430 lec_atm_send(struct atm_vcc *vcc, struct sk_buff *skb)
 431 {
 432         unsigned long flags;
 433         struct net_device *dev = (struct net_device*)vcc->proto_data;
 434         struct lec_priv *priv = (struct lec_priv*)dev->priv;
 435         struct atmlec_msg *mesg;
 436         struct lec_arp_table *entry;
 437         int i;
 438         char *tmp; /* FIXME */
 439
 440         atomic_sub(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc);
 441         mesg = (struct atmlec_msg *)skb->data;
 442         tmp = skb->data;
 443         tmp += sizeof(struct atmlec_msg);
 444         DPRINTK("%s: msg from zeppelin:%d\n", dev->name, mesg->type);
 445         switch(mesg->type) {
 446         case l_set_mac_addr:
 447                 for (i=0;i<6;i++) {
 448                         dev->dev_addr[i] = mesg->content.normal.mac_addr[i];
 449                 }
 450                 break;
 451         case l_del_mac_addr:
 452                 for(i=0;i<6;i++) {
 453                         dev->dev_addr[i] = 0;
 454                 }
 455                 break;
 456         case l_addr_delete:
 457                 lec_addr_delete(priv, mesg->content.normal.atm_addr,
 458                                 mesg->content.normal.flag);
 459                 break;
 460         case l_topology_change:
 461                 priv->topology_change = mesg->content.normal.flag;
 462                 break;
 463         case l_flush_complete:
 464                 lec_flush_complete(priv, mesg->content.normal.flag);
 465                 break;
 466         case l_narp_req: /* LANE2: see 7.1.35 in the lane2 spec */
 467                 spin_lock_irqsave(&priv->lec_arp_lock, flags);
 468                 entry = lec_arp_find(priv, mesg->content.normal.mac_addr);
 469                 lec_arp_remove(priv, entry);
 470                 spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
 471
 472                 if (mesg->content.normal.no_source_le_narp)
 473                         break;
 474                 /* FALL THROUGH */
 475         case l_arp_update:
 476                 lec_arp_update(priv, mesg->content.normal.mac_addr,
 477                                mesg->content.normal.atm_addr,
 478                                mesg->content.normal.flag,
 479                                mesg->content.normal.targetless_le_arp);
 480                 DPRINTK("lec: in l_arp_update\n");
 481                 if (mesg->sizeoftlvs != 0) { /* LANE2 3.1.5 */
 482                         DPRINTK("lec: LANE2 3.1.5, got tlvs, size %d\n", mesg->sizeoftlvs);
 483                         lane2_associate_ind(dev,
 484                                             mesg->content.normal.mac_addr,
 485                                             tmp, mesg->sizeoftlvs);
 486                 }
 487                 break;
 488         case l_config:
 489                 priv->maximum_unknown_frame_count =
 490                         mesg->content.config.maximum_unknown_frame_count;
 491                 priv->max_unknown_frame_time =
 492                         (mesg->content.config.max_unknown_frame_time*HZ);
 493                 priv->max_retry_count =
 494                         mesg->content.config.max_retry_count;
 495                 priv->aging_time = (mesg->content.config.aging_time*HZ);
 496                 priv->forward_delay_time =
 497                         (mesg->content.config.forward_delay_time*HZ);
 498                 priv->arp_response_time =
 499                         (mesg->content.config.arp_response_time*HZ);
 500                 priv->flush_timeout = (mesg->content.config.flush_timeout*HZ);
 501                 priv->path_switching_delay =
 502                         (mesg->content.config.path_switching_delay*HZ);
 503                 priv->lane_version = mesg->content.config.lane_version; /* LANE2 */
 504                 priv->lane2_ops = NULL;
 505                 if (priv->lane_version > 1)
 506                         priv->lane2_ops = &lane2_ops;
 507                 if (dev->change_mtu(dev, mesg->content.config.mtu))
 508                         printk("%s: change_mtu to %d failed\n", dev->name,
 509                             mesg->content.config.mtu);
 510                 priv->is_proxy = mesg->content.config.is_proxy;
 511                 break;
 512         case l_flush_tran_id:
 513                 lec_set_flush_tran_id(priv, mesg->content.normal.atm_addr,
 514                                       mesg->content.normal.flag);
 515                 break;
 516         case l_set_lecid:
 517                 priv->lecid=(unsigned short)(0xffff&mesg->content.normal.flag);
 518                 break;
 519         case l_should_bridge: {
 520 #if defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE)
 521                 struct net_bridge_fdb_entry *f;
 522
 523                 DPRINTK("%s: bridge zeppelin asks about 0x%02x:%02x:%02x:%02x:%02x:%02x\n",
 524                         dev->name,
 525                         mesg->content.proxy.mac_addr[0], mesg->content.proxy.mac_addr[1],
 526                         mesg->content.proxy.mac_addr[2], mesg->content.proxy.mac_addr[3],
 527                         mesg->content.proxy.mac_addr[4], mesg->content.proxy.mac_addr[5]);
 528
 529                 if (br_fdb_get_hook == NULL || dev->br_port == NULL)
 530                         break;
 531
 532                 f = br_fdb_get_hook(dev->br_port->br, mesg->content.proxy.mac_addr);
 533                 if (f != NULL &&
 534                     f->dst->dev != dev &&
 535                     f->dst->state == BR_STATE_FORWARDING) {
 536                                 /* hit from bridge table, send LE_ARP_RESPONSE */
 537                         struct sk_buff *skb2;
 538                         struct sock *sk;
 539
 540                         DPRINTK("%s: entry found, responding to zeppelin\n", dev->name);
 541                         skb2 = alloc_skb(sizeof(struct atmlec_msg), GFP_ATOMIC);
 542                         if (skb2 == NULL) {
 543                                 br_fdb_put_hook(f);
 544                                 break;
 545                         }
 546                         skb2->len = sizeof(struct atmlec_msg);
 547                         memcpy(skb2->data, mesg, sizeof(struct atmlec_msg));
 548                         atm_force_charge(priv->lecd, skb2->truesize);
 549                         sk = sk_atm(priv->lecd);
 550                         skb_queue_tail(&sk->sk_receive_queue, skb2);
 551                         sk->sk_data_ready(sk, skb2->len);
 552                 }
 553                 if (f != NULL) br_fdb_put_hook(f);
 554 #endif /* defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE) */
 555                 }
 556                 break;
 557         default:
 558                 printk("%s: Unknown message type %d\n", dev->name, mesg->type);
 559                 dev_kfree_skb(skb);
 560                 return -EINVAL;
 561         }
 562         dev_kfree_skb(skb);
 563         return 0;
 564 }
 565
 566 static void
 567 lec_atm_close(struct atm_vcc *vcc)
 568 {
 569         struct sk_buff *skb;
 570         struct net_device *dev = (struct net_device *)vcc->proto_data;
 571         struct lec_priv *priv = (struct lec_priv *)dev->priv;
 572
 573         priv->lecd = NULL;
 574         /* Do something needful? */
 575
 576         netif_stop_queue(dev);
 577         lec_arp_destroy(priv);
 578
 579         if (skb_peek(&sk_atm(vcc)->sk_receive_queue))
 580                 printk("%s lec_atm_close: closing with messages pending\n",
 581                        dev->name);
 582         while ((skb = skb_dequeue(&sk_atm(vcc)->sk_receive_queue)) != NULL) {
 583                 atm_return(vcc, skb->truesize);
 584                 dev_kfree_skb(skb);
 585         }
 586
 587         printk("%s: Shut down!\n", dev->name);
 588         module_put(THIS_MODULE);
 589 }
 590
 591 static struct atmdev_ops lecdev_ops = {
 592         .close  = lec_atm_close,
 593         .send   = lec_atm_send
 594 };
 595
 596 static struct atm_dev lecatm_dev = {
 597         .ops    = &lecdev_ops,
 598         .type   = "lec",
 599         .number = 999,  /* dummy device number */
 600         .lock   = SPIN_LOCK_UNLOCKED
 601 };
 602
 603 /*
 604  * LANE2: new argument struct sk_buff *data contains
 605  * the LE_ARP based TLVs introduced in the LANE2 spec
 606  */
 607 static int
 608 send_to_lecd(struct lec_priv *priv, atmlec_msg_type type,
 609              unsigned char *mac_addr, unsigned char *atm_addr,
 610              struct sk_buff *data)
 611 {
 612         struct sock *sk;
 613         struct sk_buff *skb;
 614         struct atmlec_msg *mesg;
 615
 616         if (!priv || !priv->lecd) {
 617                 return -1;
 618         }
 619         skb = alloc_skb(sizeof(struct atmlec_msg), GFP_ATOMIC);
 620         if (!skb)
 621                 return -1;
 622         skb->len = sizeof(struct atmlec_msg);
 623         mesg = (struct atmlec_msg *)skb->data;
 624         memset(mesg, 0, sizeof(struct atmlec_msg));
 625         mesg->type = type;
 626         if (data != NULL)
 627                 mesg->sizeoftlvs = data->len;
 628         if (mac_addr)
 629                 memcpy(&mesg->content.normal.mac_addr, mac_addr, ETH_ALEN);
 630         else
 631                 mesg->content.normal.targetless_le_arp = 1;
 632         if (atm_addr)
 633                 memcpy(&mesg->content.normal.atm_addr, atm_addr, ATM_ESA_LEN);
 634
 635         atm_force_charge(priv->lecd, skb->truesize);
 636         sk = sk_atm(priv->lecd);
 637         skb_queue_tail(&sk->sk_receive_queue, skb);
 638         sk->sk_data_ready(sk, skb->len);
 639
 640         if (data != NULL) {
 641                 DPRINTK("lec: about to send %d bytes of data\n", data->len);
 642                 atm_force_charge(priv->lecd, data->truesize);
 643                 skb_queue_tail(&sk->sk_receive_queue, data);
 644                 sk->sk_data_ready(sk, skb->len);
 645         }
 646
 647         return 0;
 648 }
 649
 650 /* shamelessly stolen from drivers/net/net_init.c */
 651 static int lec_change_mtu(struct net_device *dev, int new_mtu)
 652 {
 653         if ((new_mtu < 68) || (new_mtu > 18190))
 654                 return -EINVAL;
 655         dev->mtu = new_mtu;
 656         return 0;
 657 }
 658
 659 static void lec_set_multicast_list(struct net_device *dev)
 660 {
 661         /* by default, all multicast frames arrive over the bus.
 662          * eventually support selective multicast service
 663          */
 664         return;
 665 }
 666
 667 static void
 668 lec_init(struct net_device *dev)
 669 {
 670         dev->change_mtu = lec_change_mtu;
 671         dev->open = lec_open;
 672         dev->stop = lec_close;
 673         dev->hard_start_xmit = lec_start_xmit;
 674         dev->tx_timeout = lec_tx_timeout;
 675
 676         dev->get_stats = lec_get_stats;
 677         dev->set_multicast_list = lec_set_multicast_list;
 678         dev->do_ioctl  = NULL;
 679         printk("%s: Initialized!\n",dev->name);
 680         return;
 681 }
 682
 683 static unsigned char lec_ctrl_magic[] = {
 684         0xff,
 685         0x00,
 686         0x01,
 687         0x01 };
 688
 689 #define LEC_DATA_DIRECT_8023  2
 690 #define LEC_DATA_DIRECT_8025  3
 691
 692 static int lec_is_data_direct(struct atm_vcc *vcc)
 693 {
 694         return ((vcc->sap.blli[0].l3.tr9577.snap[4] == LEC_DATA_DIRECT_8023) ||
 695                 (vcc->sap.blli[0].l3.tr9577.snap[4] == LEC_DATA_DIRECT_8025));
 696 }
 697
 698 static void
 699 lec_push(struct atm_vcc *vcc, struct sk_buff *skb)
 700 {
 701         unsigned long flags;
 702         struct net_device *dev = (struct net_device *)vcc->proto_data;
 703         struct lec_priv *priv = (struct lec_priv *)dev->priv;
 704
 705 #if DUMP_PACKETS >0
 706         int i=0;
 707         char buf[300];
 708
 709         printk("%s: lec_push vcc vpi:%d vci:%d\n", dev->name,
 710                vcc->vpi, vcc->vci);
 711 #endif
 712         if (!skb) {
 713                 DPRINTK("%s: null skb\n",dev->name);
 714                 lec_vcc_close(priv, vcc);
 715                 return;
 716         }
 717 #if DUMP_PACKETS > 0
 718         printk("%s: rcv datalen:%ld lecid:%4.4x\n", dev->name,
 719                skb->len, priv->lecid);
 720 #if DUMP_PACKETS >= 2
 721         for(i=0;i<skb->len && i <99;i++) {
 722                 sprintf(buf+i*3,"%2.2x ",0xff&skb->data[i]);
 723         }
 724 #elif DUMP_PACKETS >= 1
 725         for(i=0;i<skb->len && i < 30;i++) {
 726                 sprintf(buf+i*3,"%2.2x ", 0xff&skb->data[i]);
 727         }
 728 #endif /* DUMP_PACKETS >= 1 */
 729         if (i==skb->len)
 730                 printk("%s\n",buf);
 731         else
 732                 printk("%s...\n",buf);
 733 #endif /* DUMP_PACKETS > 0 */
 734         if (memcmp(skb->data, lec_ctrl_magic, 4) ==0) { /* Control frame, to daemon*/
 735                 struct sock *sk = sk_atm(vcc);
 736
 737                 DPRINTK("%s: To daemon\n",dev->name);
 738                 skb_queue_tail(&sk->sk_receive_queue, skb);
 739                 sk->sk_data_ready(sk, skb->len);
 740         } else { /* Data frame, queue to protocol handlers */
 741                 struct lec_arp_table *entry;
 742                 unsigned char *src, *dst;
 743
 744                 atm_return(vcc,skb->truesize);
 745                 if (*(uint16_t *)skb->data == htons(priv->lecid) ||
 746                     !priv->lecd ||
 747                     !(dev->flags & IFF_UP)) {
 748                         /* Probably looping back, or if lecd is missing,
 749                            lecd has gone down */
 750                         DPRINTK("Ignoring frame...\n");
 751                         dev_kfree_skb(skb);
 752                         return;
 753                 }
 754 #ifdef CONFIG_TR
 755                 if (priv->is_trdev)
 756                         dst = ((struct lecdatahdr_8025 *) skb->data)->h_dest;
 757                 else
 758 #endif
 759                 dst = ((struct lecdatahdr_8023 *) skb->data)->h_dest;
 760
 761                 /* If this is a Data Direct VCC, and the VCC does not match
 762                  * the LE_ARP cache entry, delete the LE_ARP cache entry.
 763                  */
 764                 spin_lock_irqsave(&priv->lec_arp_lock, flags);
 765                 if (lec_is_data_direct(vcc)) {
 766 #ifdef CONFIG_TR
 767                         if (priv->is_trdev)
 768                                 src = ((struct lecdatahdr_8025 *) skb->data)->h_source;
 769                         else
 770 #endif
 771                         src = ((struct lecdatahdr_8023 *) skb->data)->h_source;
 772                         entry = lec_arp_find(priv, src);
 773                         if (entry && entry->vcc != vcc) {
 774                                 lec_arp_remove(priv, entry);
 775                                 kfree(entry);
 776                         }
 777                 }
 778                 spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
 779
 780                 if (!(dst[0]&0x01) &&   /* Never filter Multi/Broadcast */
 781                     !priv->is_proxy &&  /* Proxy wants all the packets */
 782                     memcmp(dst, dev->dev_addr, dev->addr_len)) {
 783                         dev_kfree_skb(skb);
 784                         return;
 785                 }
 786                 if (priv->lec_arp_empty_ones) {
 787                         lec_arp_check_empties(priv, vcc, skb);
 788                 }
 789                 skb->dev = dev;
 790                 skb_pull(skb, 2); /* skip lec_id */
 791 #ifdef CONFIG_TR
 792                 if (priv->is_trdev) skb->protocol = tr_type_trans(skb, dev);
 793                 else
 794 #endif
 795                 skb->protocol = eth_type_trans(skb, dev);
 796                 priv->stats.rx_packets++;
 797                 priv->stats.rx_bytes += skb->len;
 798                 memset(ATM_SKB(skb), 0, sizeof(struct atm_skb_data));
 799                 netif_rx(skb);
 800         }
 801 }
 802
 803 static void
 804 lec_pop(struct atm_vcc *vcc, struct sk_buff *skb)
 805 {
 806         struct lec_vcc_priv *vpriv = LEC_VCC_PRIV(vcc);
 807         struct net_device *dev = skb->dev;
 808
 809         if (vpriv == NULL) {
 810                 printk("lec_pop(): vpriv = NULL!?!?!?\n");
 811                 return;
 812         }
 813
 814         vpriv->old_pop(vcc, skb);
 815
 816         if (vpriv->xoff && atm_may_send(vcc, 0)) {
 817                 vpriv->xoff = 0;
 818                 if (netif_running(dev) && netif_queue_stopped(dev))
 819                         netif_wake_queue(dev);
 820         }
 821 }
 822
 823 static int
 824 lec_vcc_attach(struct atm_vcc *vcc, void __user *arg)
 825 {
 826         struct lec_vcc_priv *vpriv;
 827         int bytes_left;
 828         struct atmlec_ioc ioc_data;
 829
 830         /* Lecd must be up in this case */
 831         bytes_left = copy_from_user(&ioc_data, arg, sizeof(struct atmlec_ioc));
 832         if (bytes_left != 0) {
 833                 printk("lec: lec_vcc_attach, copy from user failed for %d bytes\n",
 834                        bytes_left);
 835         }
 836         if (ioc_data.dev_num < 0 || ioc_data.dev_num >= MAX_LEC_ITF ||
 837             !dev_lec[ioc_data.dev_num])
 838                 return -EINVAL;
 839         if (!(vpriv = kmalloc(sizeof(struct lec_vcc_priv), GFP_KERNEL)))
 840                 return -ENOMEM;
 841         vpriv->xoff = 0;
 842         vpriv->old_pop = vcc->pop;
 843         vcc->user_back = vpriv;
 844         vcc->pop = lec_pop;
 845         lec_vcc_added(dev_lec[ioc_data.dev_num]->priv,
 846                       &ioc_data, vcc, vcc->push);
 847         vcc->proto_data = dev_lec[ioc_data.dev_num];
 848         vcc->push = lec_push;
 849         return 0;
 850 }
 851
 852 static int
 853 lec_mcast_attach(struct atm_vcc *vcc, int arg)
 854 {
 855         if (arg <0 || arg >= MAX_LEC_ITF || !dev_lec[arg])
 856                 return -EINVAL;
 857         vcc->proto_data = dev_lec[arg];
 858         return (lec_mcast_make((struct lec_priv*)dev_lec[arg]->priv, vcc));
 859 }
 860
 861 /* Initialize device. */
 862 static int
 863 lecd_attach(struct atm_vcc *vcc, int arg)
 864 {
 865         int i;
 866         struct lec_priv *priv;
 867
 868         if (arg<0)
 869                 i = 0;
 870         else
 871                 i = arg;
 872 #ifdef CONFIG_TR
 873         if (arg >= MAX_LEC_ITF)
 874                 return -EINVAL;
 875 #else /* Reserve the top NUM_TR_DEVS for TR */
 876         if (arg >= (MAX_LEC_ITF-NUM_TR_DEVS))
 877                 return -EINVAL;
 878 #endif
 879         if (!dev_lec[i]) {
 880                 int is_trdev, size;
 881
 882                 is_trdev = 0;
 883                 if (i >= (MAX_LEC_ITF - NUM_TR_DEVS))
 884                         is_trdev = 1;
 885
 886                 size = sizeof(struct lec_priv);
 887 #ifdef CONFIG_TR
 888                 if (is_trdev)
 889                         dev_lec[i] = alloc_trdev(size);
 890                 else
 891 #endif
 892                 dev_lec[i] = alloc_etherdev(size);
 893                 if (!dev_lec[i])
 894                         return -ENOMEM;
 895                 snprintf(dev_lec[i]->name, IFNAMSIZ, "lec%d", i);
 896                 if (register_netdev(dev_lec[i])) {
 897                         free_netdev(dev_lec[i]);
 898                         return -EINVAL;
 899                 }
 900
 901                 priv = dev_lec[i]->priv;
 902                 priv->is_trdev = is_trdev;
 903                 lec_init(dev_lec[i]);
 904         } else {
 905                 priv = dev_lec[i]->priv;
 906                 if (priv->lecd)
 907                         return -EADDRINUSE;
 908         }
 909         lec_arp_init(priv);
 910         priv->itfnum = i;  /* LANE2 addition */
 911         priv->lecd = vcc;
 912         vcc->dev = &lecatm_dev;
 913         vcc_insert_socket(sk_atm(vcc));
 914
 915         vcc->proto_data = dev_lec[i];
 916         set_bit(ATM_VF_META,&vcc->flags);
 917         set_bit(ATM_VF_READY,&vcc->flags);
 918
 919         /* Set default values to these variables */
 920         priv->maximum_unknown_frame_count = 1;
 921         priv->max_unknown_frame_time = (1*HZ);
 922         priv->vcc_timeout_period = (1200*HZ);
 923         priv->max_retry_count = 1;
 924         priv->aging_time = (300*HZ);
 925         priv->forward_delay_time = (15*HZ);
 926         priv->topology_change = 0;
 927         priv->arp_response_time = (1*HZ);
 928         priv->flush_timeout = (4*HZ);
 929         priv->path_switching_delay = (6*HZ);
 930
 931         if (dev_lec[i]->flags & IFF_UP) {
 932                 netif_start_queue(dev_lec[i]);
 933         }
 934         __module_get(THIS_MODULE);
 935         return i;
 936 }
 937
 938 #ifdef CONFIG_PROC_FS
 939 static char* lec_arp_get_status_string(unsigned char status)
 940 {
 941         static char *lec_arp_status_string[] = {
 942                 "ESI_UNKNOWN       ",
 943                 "ESI_ARP_PENDING   ",
 944                 "ESI_VC_PENDING    ",
 945                 "<Undefined>       ",
 946                 "ESI_FLUSH_PENDING ",
 947                 "ESI_FORWARD_DIRECT"
 948         };
 949
 950         if (status > ESI_FORWARD_DIRECT)
 951                 status = 3;     /* ESI_UNDEFINED */
 952         return lec_arp_status_string[status];
 953 }
 954
 955 static void lec_info(struct seq_file *seq, struct lec_arp_table *entry)
 956 {
 957         int i;
 958
 959         for (i = 0; i < ETH_ALEN; i++)
 960                 seq_printf(seq, "%2.2x", entry->mac_addr[i] & 0xff);
 961         seq_printf(seq, " ");
 962         for (i = 0; i < ATM_ESA_LEN; i++)
 963                 seq_printf(seq, "%2.2x", entry->atm_addr[i] & 0xff);
 964         seq_printf(seq, " %s %4.4x", lec_arp_get_status_string(entry->status),
 965                    entry->flags & 0xffff);
 966         if (entry->vcc)
 967                 seq_printf(seq, "%3d %3d ", entry->vcc->vpi, entry->vcc->vci);
 968         else
 969                 seq_printf(seq, "        ");
 970         if (entry->recv_vcc) {
 971                 seq_printf(seq, "     %3d %3d", entry->recv_vcc->vpi,
 972                            entry->recv_vcc->vci);
 973         }
 974         seq_putc(seq, '\n');
 975 }
 976
 977
 978 struct lec_state {
 979         unsigned long flags;
 980         struct lec_priv *locked;
 981         struct lec_arp_table *entry;
 982         struct net_device *dev;
 983         int itf;
 984         int arp_table;
 985         int misc_table;
 986 };
 987
 988 static void *lec_tbl_walk(struct lec_state *state, struct lec_arp_table *tbl,
 989                           loff_t *l)
 990 {
 991         struct lec_arp_table *e = state->entry;
 992
 993         if (!e)
 994                 e = tbl;
 995         if (e == (void *)1) {
 996                 e = tbl;
 997                 --*l;
 998         }
 999         for (; e; e = e->next) {
1000                 if (--*l < 0)
1001                         break;
1002         }
1003         state->entry = e;
1004         return (*l < 0) ? state : NULL;
1005 }
1006
1007 static void *lec_arp_walk(struct lec_state *state, loff_t *l,
1008                               struct lec_priv *priv)
1009 {
1010         void *v = NULL;
1011         int p;
1012
1013         for (p = state->arp_table; p < LEC_ARP_TABLE_SIZE; p++) {
1014                 v = lec_tbl_walk(state, priv->lec_arp_tables[p], l);
1015                 if (v)
1016                         break;
1017         }
1018         state->arp_table = p;
1019         return v;
1020 }
1021
1022 static void *lec_misc_walk(struct lec_state *state, loff_t *l,
1023                            struct lec_priv *priv)
1024 {
1025         struct lec_arp_table *lec_misc_tables[] = {
1026                 priv->lec_arp_empty_ones,
1027                 priv->lec_no_forward,
1028                 priv->mcast_fwds
1029         };
1030         void *v = NULL;
1031         int q;
1032
1033         for (q = state->misc_table; q < ARRAY_SIZE(lec_misc_tables); q++) {
1034                 v = lec_tbl_walk(state, lec_misc_tables[q], l);
1035                 if (v)
1036                         break;
1037         }
1038         state->misc_table = q;
1039         return v;
1040 }
1041
1042 static void *lec_priv_walk(struct lec_state *state, loff_t *l,
1043                            struct lec_priv *priv)
1044 {
1045         if (!state->locked) {
1046                 state->locked = priv;
1047                 spin_lock_irqsave(&priv->lec_arp_lock, state->flags);
1048         }
1049         if (!lec_arp_walk(state, l, priv) &&
1050             !lec_misc_walk(state, l, priv)) {
1051                 spin_unlock_irqrestore(&priv->lec_arp_lock, state->flags);
1052                 state->locked = NULL;
1053                 /* Partial state reset for the next time we get called */
1054                 state->arp_table = state->misc_table = 0;
1055         }
1056         return state->locked;
1057 }
1058
1059 static void *lec_itf_walk(struct lec_state *state, loff_t *l)
1060 {
1061         struct net_device *dev;
1062         void *v;
1063
1064         dev = state->dev ? state->dev : dev_lec[state->itf];
1065         v = (dev && dev->priv) ? lec_priv_walk(state, l, dev->priv) : NULL;
1066         if (!v && dev) {
1067                 dev_put(dev);
1068                 /* Partial state reset for the next time we get called */
1069                 dev = NULL;
1070         }
1071         state->dev = dev;
1072         return v;
1073 }
1074
1075 static void *lec_get_idx(struct lec_state *state, loff_t l)
1076 {
1077         void *v = NULL;
1078
1079         for (; state->itf < MAX_LEC_ITF; state->itf++) {
1080                 v = lec_itf_walk(state, &l);
1081                 if (v)
1082                         break;
1083         }
1084         return v;
1085 }
1086
1087 static void *lec_seq_start(struct seq_file *seq, loff_t *pos)
1088 {
1089         struct lec_state *state = seq->private;
1090
1091         state->itf = 0;
1092         state->dev = NULL;
1093         state->locked = NULL;
1094         state->arp_table = 0;
1095         state->misc_table = 0;
1096         state->entry = (void *)1;
1097
1098         return *pos ? lec_get_idx(state, *pos) : (void*)1;
1099 }
1100
1101 static void lec_seq_stop(struct seq_file *seq, void *v)
1102 {
1103         struct lec_state *state = seq->private;
1104
1105         if (state->dev) {
1106                 spin_unlock_irqrestore(&state->locked->lec_arp_lock,
1107                                        state->flags);
1108                 dev_put(state->dev);
1109         }
1110 }
1111
1112 static void *lec_seq_next(struct seq_file *seq, void *v, loff_t *pos)
1113 {
1114         struct lec_state *state = seq->private;
1115
1116         v = lec_get_idx(state, 1);
1117         *pos += !!PTR_ERR(v);
1118         return v;
1119 }
1120
1121 static int lec_seq_show(struct seq_file *seq, void *v)
1122 {
1123         static char lec_banner[] = "Itf  MAC          ATM destination"
1124                 "                          Status            Flags "
1125                 "VPI/VCI Recv VPI/VCI\n";
1126
1127         if (v == (void *)1)
1128                 seq_puts(seq, lec_banner);
1129         else {
1130                 struct lec_state *state = seq->private;
1131                 struct net_device *dev = state->dev;
1132
1133                 seq_printf(seq, "%s ", dev->name);
1134                 lec_info(seq, state->entry);
1135         }
1136         return 0;
1137 }
1138
1139 static struct seq_operations lec_seq_ops = {
1140         .start  = lec_seq_start,
1141         .next   = lec_seq_next,
1142         .stop   = lec_seq_stop,
1143         .show   = lec_seq_show,
1144 };
1145
1146 static int lec_seq_open(struct inode *inode, struct file *file)
1147 {
1148         struct lec_state *state;
1149         struct seq_file *seq;
1150         int rc = -EAGAIN;
1151
1152         state = kmalloc(sizeof(*state), GFP_KERNEL);
1153         if (!state) {
1154                 rc = -ENOMEM;
1155                 goto out;
1156         }
1157
1158         rc = seq_open(file, &lec_seq_ops);
1159         if (rc)
1160                 goto out_kfree;
1161         seq = file->private_data;
1162         seq->private = state;
1163 out:
1164         return rc;
1165
1166 out_kfree:
1167         kfree(state);
1168         goto out;
1169 }
1170
1171 static int lec_seq_release(struct inode *inode, struct file *file)
1172 {
1173         return seq_release_private(inode, file);
1174 }
1175
1176 static struct file_operations lec_seq_fops = {
1177         .owner          = THIS_MODULE,
1178         .open           = lec_seq_open,
1179         .read           = seq_read,
1180         .llseek         = seq_lseek,
1181         .release        = lec_seq_release,
1182 };
1183 #endif
1184
1185 static int lane_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
1186 {
1187         struct atm_vcc *vcc = ATM_SD(sock);
1188         int err = 0;
1189
1190         switch (cmd) {
1191                 case ATMLEC_CTRL:
1192                 case ATMLEC_MCAST:
1193                 case ATMLEC_DATA:
1194                         if (!capable(CAP_NET_ADMIN))
1195                                 return -EPERM;
1196                         break;
1197                 default:
1198                         return -ENOIOCTLCMD;
1199         }
1200
1201         switch (cmd) {
1202                 case ATMLEC_CTRL:
1203                         err = lecd_attach(vcc, (int) arg);
1204                         if (err >= 0)
1205                                 sock->state = SS_CONNECTED;
1206                         break;
1207                 case ATMLEC_MCAST:
1208                         err = lec_mcast_attach(vcc, (int) arg);
1209                         break;
1210                 case ATMLEC_DATA:
1211                         err = lec_vcc_attach(vcc, (void __user *) arg);
1212                         break;
1213         }
1214
1215         return err;
1216 }
1217
1218 static struct atm_ioctl lane_ioctl_ops = {
1219         .owner  = THIS_MODULE,
1220         .ioctl  = lane_ioctl,
1221 };
1222
1223 static int __init lane_module_init(void)
1224 {
1225 #ifdef CONFIG_PROC_FS
1226         struct proc_dir_entry *p;
1227
1228         p = create_proc_entry("lec", S_IRUGO, atm_proc_root);
1229         if (p)
1230                 p->proc_fops = &lec_seq_fops;
1231 #endif
1232
1233         register_atm_ioctl(&lane_ioctl_ops);
1234         printk("lec.c: " __DATE__ " " __TIME__ " initialized\n");
1235         return 0;
1236 }
1237
1238 static void __exit lane_module_cleanup(void)
1239 {
1240         int i;
1241         struct lec_priv *priv;
1242
1243         remove_proc_entry("lec", atm_proc_root);
1244
1245         deregister_atm_ioctl(&lane_ioctl_ops);
1246
1247         for (i = 0; i < MAX_LEC_ITF; i++) {
1248                 if (dev_lec[i] != NULL) {
1249                         priv = (struct lec_priv *)dev_lec[i]->priv;
1250                         unregister_netdev(dev_lec[i]);
1251                         free_netdev(dev_lec[i]);
1252                         dev_lec[i] = NULL;
1253                 }
1254         }
1255
1256         return;
1257 }
1258
1259 module_init(lane_module_init);
1260 module_exit(lane_module_cleanup);
1261
1262 /*
1263  * LANE2: 3.1.3, LE_RESOLVE.request
1264  * Non force allocates memory and fills in *tlvs, fills in *sizeoftlvs.
1265  * If sizeoftlvs == NULL the default TLVs associated with with this
1266  * lec will be used.
1267  * If dst_mac == NULL, targetless LE_ARP will be sent
1268  */
1269 static int lane2_resolve(struct net_device *dev, u8 *dst_mac, int force,
1270     u8 **tlvs, u32 *sizeoftlvs)
1271 {
1272         unsigned long flags;
1273         struct lec_priv *priv = (struct lec_priv *)dev->priv;
1274         struct lec_arp_table *table;
1275         struct sk_buff *skb;
1276         int retval;
1277
1278         if (force == 0) {
1279                 spin_lock_irqsave(&priv->lec_arp_lock, flags);
1280                 table = lec_arp_find(priv, dst_mac);
1281                 spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
1282                 if(table == NULL)
1283                         return -1;
1284
1285                 *tlvs = kmalloc(table->sizeoftlvs, GFP_ATOMIC);
1286                 if (*tlvs == NULL)
1287                         return -1;
1288
1289                 memcpy(*tlvs, table->tlvs, table->sizeoftlvs);
1290                 *sizeoftlvs = table->sizeoftlvs;
1291
1292                 return 0;
1293         }
1294
1295         if (sizeoftlvs == NULL)
1296                 retval = send_to_lecd(priv, l_arp_xmt, dst_mac, NULL, NULL);
1297
1298         else {
1299                 skb = alloc_skb(*sizeoftlvs, GFP_ATOMIC);
1300                 if (skb == NULL)
1301                         return -1;
1302                 skb->len = *sizeoftlvs;
1303                 memcpy(skb->data, *tlvs, *sizeoftlvs);
1304                 retval = send_to_lecd(priv, l_arp_xmt, dst_mac, NULL, skb);
1305         }
1306         return retval;
1307 }
1308
1309
1310 /*
1311  * LANE2: 3.1.4, LE_ASSOCIATE.request
1312  * Associate the *tlvs with the *lan_dst address.
1313  * Will overwrite any previous association
1314  * Returns 1 for success, 0 for failure (out of memory)
1315  *
1316  */
1317 static int lane2_associate_req (struct net_device *dev, u8 *lan_dst,
1318                          u8 *tlvs, u32 sizeoftlvs)
1319 {
1320         int retval;
1321         struct sk_buff *skb;
1322         struct lec_priv *priv = (struct lec_priv*)dev->priv;
1323
1324         if ( memcmp(lan_dst, dev->dev_addr, ETH_ALEN) != 0 )
1325                 return (0);       /* not our mac address */
1326
1327         kfree(priv->tlvs); /* NULL if there was no previous association */
1328
1329         priv->tlvs = kmalloc(sizeoftlvs, GFP_KERNEL);
1330         if (priv->tlvs == NULL)
1331                 return (0);
1332         priv->sizeoftlvs = sizeoftlvs;
1333         memcpy(priv->tlvs, tlvs, sizeoftlvs);
1334
1335         skb = alloc_skb(sizeoftlvs, GFP_ATOMIC);
1336         if (skb == NULL)
1337                 return 0;
1338         skb->len = sizeoftlvs;
1339         memcpy(skb->data, tlvs, sizeoftlvs);
1340         retval = send_to_lecd(priv, l_associate_req, NULL, NULL, skb);
1341         if (retval != 0)
1342                 printk("lec.c: lane2_associate_req() failed\n");
1343         /* If the previous association has changed we must
1344          * somehow notify other LANE entities about the change
1345          */
1346         return (1);
1347 }
1348
1349 /*
1350  * LANE2: 3.1.5, LE_ASSOCIATE.indication
1351  *
1352  */
1353 static void lane2_associate_ind (struct net_device *dev, u8 *mac_addr,
1354     u8 *tlvs, u32 sizeoftlvs)
1355 {
1356 #if 0
1357         int i = 0;
1358 #endif
1359         struct lec_priv *priv = (struct lec_priv *)dev->priv;
1360 #if 0 /* Why have the TLVs in LE_ARP entries since we do not use them? When you
1361          uncomment this code, make sure the TLVs get freed when entry is killed */
1362         struct lec_arp_table *entry = lec_arp_find(priv, mac_addr);
1363
1364         if (entry == NULL)
1365                 return;     /* should not happen */
1366
1367         kfree(entry->tlvs);
1368
1369         entry->tlvs = kmalloc(sizeoftlvs, GFP_KERNEL);
1370         if (entry->tlvs == NULL)
1371                 return;
1372
1373         entry->sizeoftlvs = sizeoftlvs;
1374         memcpy(entry->tlvs, tlvs, sizeoftlvs);
1375 #endif
1376 #if 0
1377         printk("lec.c: lane2_associate_ind()\n");
1378         printk("dump of tlvs, sizeoftlvs=%d\n", sizeoftlvs);
1379         while (i < sizeoftlvs)
1380                 printk("%02x ", tlvs[i++]);
1381
1382         printk("\n");
1383 #endif
1384
1385         /* tell MPOA about the TLVs we saw */
1386         if (priv->lane2_ops && priv->lane2_ops->associate_indicator) {
1387                 priv->lane2_ops->associate_indicator(dev, mac_addr,
1388                                                      tlvs, sizeoftlvs);
1389         }
1390         return;
1391 }
1392
1393 /*
1394  * Here starts what used to lec_arpc.c
1395  *
1396  * lec_arpc.c was added here when making
1397  * lane client modular. October 1997
1398  *
1399  */
1400
1401 #include <linux/types.h>
1402 #include <linux/sched.h>
1403 #include <linux/timer.h>
1404 #include <asm/param.h>
1405 #include <asm/atomic.h>
1406 #include <linux/inetdevice.h>
1407 #include <net/route.h>
1408
1409
1410 #if 0
1411 #define DPRINTK(format,args...)
1412 /*
1413 #define DPRINTK printk
1414 */
1415 #endif
1416 #define DEBUG_ARP_TABLE 0
1417
1418 #define LEC_ARP_REFRESH_INTERVAL (3*HZ)
1419
1420 static void lec_arp_check_expire(unsigned long data);
1421 static void lec_arp_expire_arp(unsigned long data);
1422
1423 /*
1424  * Arp table funcs
1425  */
1426
1427 #define HASH(ch) (ch & (LEC_ARP_TABLE_SIZE -1))
1428
1429 /*
1430  * Initialization of arp-cache
1431  */
1432 static void
1433 lec_arp_init(struct lec_priv *priv)
1434 {
1435         unsigned short i;
1436
1437         for (i = 0; i < LEC_ARP_TABLE_SIZE; i++) {
1438                 priv->lec_arp_tables[i] = NULL;
1439         }
1440         spin_lock_init(&priv->lec_arp_lock);
1441         init_timer(&priv->lec_arp_timer);
1442         priv->lec_arp_timer.expires = jiffies + LEC_ARP_REFRESH_INTERVAL;
1443         priv->lec_arp_timer.data = (unsigned long)priv;
1444         priv->lec_arp_timer.function = lec_arp_check_expire;
1445         add_timer(&priv->lec_arp_timer);
1446 }
1447
1448 static void
1449 lec_arp_clear_vccs(struct lec_arp_table *entry)
1450 {
1451         if (entry->vcc) {
1452                 struct atm_vcc *vcc = entry->vcc;
1453                 struct lec_vcc_priv *vpriv = LEC_VCC_PRIV(vcc);
1454                 struct net_device *dev = (struct net_device*) vcc->proto_data;
1455
1456                 vcc->pop = vpriv->old_pop;
1457                 if (vpriv->xoff)
1458                         netif_wake_queue(dev);
1459                 kfree(vpriv);
1460                 vcc->user_back = NULL;
1461                 vcc->push = entry->old_push;
1462                 vcc_release_async(vcc, -EPIPE);
1463                 vcc = NULL;
1464         }
1465         if (entry->recv_vcc) {
1466                 entry->recv_vcc->push = entry->old_recv_push;
1467                 vcc_release_async(entry->recv_vcc, -EPIPE);
1468                 entry->recv_vcc = NULL;
1469         }
1470 }
1471
1472 /*
1473  * Insert entry to lec_arp_table
1474  * LANE2: Add to the end of the list to satisfy 8.1.13
1475  */
1476 static inline void
1477 lec_arp_add(struct lec_priv *priv, struct lec_arp_table *to_add)
1478 {
1479         unsigned short place;
1480         struct lec_arp_table *tmp;
1481
1482         place = HASH(to_add->mac_addr[ETH_ALEN-1]);
1483         tmp = priv->lec_arp_tables[place];
1484         to_add->next = NULL;
1485         if (tmp == NULL)
1486                 priv->lec_arp_tables[place] = to_add;
1487
1488         else {  /* add to the end */
1489                 while (tmp->next)
1490                         tmp = tmp->next;
1491                 tmp->next = to_add;
1492         }
1493
1494         DPRINTK("LEC_ARP: Added entry:%2.2x %2.2x %2.2x %2.2x %2.2x %2.2x\n",
1495                 0xff&to_add->mac_addr[0], 0xff&to_add->mac_addr[1],
1496                 0xff&to_add->mac_addr[2], 0xff&to_add->mac_addr[3],
1497                 0xff&to_add->mac_addr[4], 0xff&to_add->mac_addr[5]);
1498 }
1499
1500 /*
1501  * Remove entry from lec_arp_table
1502  */
1503 static int
1504 lec_arp_remove(struct lec_priv *priv,
1505                struct lec_arp_table *to_remove)
1506 {
1507         unsigned short place;
1508         struct lec_arp_table *tmp;
1509         int remove_vcc=1;
1510
1511         if (!to_remove) {
1512                 return -1;
1513         }
1514         place = HASH(to_remove->mac_addr[ETH_ALEN-1]);
1515         tmp = priv->lec_arp_tables[place];
1516         if (tmp == to_remove) {
1517                 priv->lec_arp_tables[place] = tmp->next;
1518         } else {
1519                 while(tmp && tmp->next != to_remove) {
1520                         tmp = tmp->next;
1521                 }
1522                 if (!tmp) {/* Entry was not found */
1523                         return -1;
1524                 }
1525         }
1526         tmp->next = to_remove->next;
1527         del_timer(&to_remove->timer);
1528
1529         /* If this is the only MAC connected to this VCC, also tear down
1530            the VCC */
1531         if (to_remove->status >= ESI_FLUSH_PENDING) {
1532                 /*
1533                  * ESI_FLUSH_PENDING, ESI_FORWARD_DIRECT
1534                  */
1535                 for(place = 0; place < LEC_ARP_TABLE_SIZE; place++) {
1536                         for(tmp = priv->lec_arp_tables[place]; tmp != NULL; tmp = tmp->next) {
1537                                 if (memcmp(tmp->atm_addr, to_remove->atm_addr,
1538                                            ATM_ESA_LEN)==0) {
1539                                         remove_vcc=0;
1540                                         break;
1541                                 }
1542                         }
1543                 }
1544                 if (remove_vcc)
1545                         lec_arp_clear_vccs(to_remove);
1546         }
1547         skb_queue_purge(&to_remove->tx_wait); /* FIXME: good place for this? */
1548
1549         DPRINTK("LEC_ARP: Removed entry:%2.2x %2.2x %2.2x %2.2x %2.2x %2.2x\n",
1550                 0xff&to_remove->mac_addr[0], 0xff&to_remove->mac_addr[1],
1551                 0xff&to_remove->mac_addr[2], 0xff&to_remove->mac_addr[3],
1552                 0xff&to_remove->mac_addr[4], 0xff&to_remove->mac_addr[5]);
1553         return 0;
1554 }
1555
1556 #if DEBUG_ARP_TABLE
1557 static char*
1558 get_status_string(unsigned char st)
1559 {
1560         switch(st) {
1561         case ESI_UNKNOWN:
1562                 return "ESI_UNKNOWN";
1563         case ESI_ARP_PENDING:
1564                 return "ESI_ARP_PENDING";
1565         case ESI_VC_PENDING:
1566                 return "ESI_VC_PENDING";
1567         case ESI_FLUSH_PENDING:
1568                 return "ESI_FLUSH_PENDING";
1569         case ESI_FORWARD_DIRECT:
1570                 return "ESI_FORWARD_DIRECT";
1571         default:
1572                 return "<UNKNOWN>";
1573         }
1574 }
1575 #endif
1576
1577 static void
1578 dump_arp_table(struct lec_priv *priv)
1579 {
1580 #if DEBUG_ARP_TABLE
1581         int i,j, offset;
1582         struct lec_arp_table *rulla;
1583         char buf[1024];
1584         struct lec_arp_table **lec_arp_tables =
1585                 (struct lec_arp_table **)priv->lec_arp_tables;
1586         struct lec_arp_table *lec_arp_empty_ones =
1587                 (struct lec_arp_table *)priv->lec_arp_empty_ones;
1588         struct lec_arp_table *lec_no_forward =
1589                 (struct lec_arp_table *)priv->lec_no_forward;
1590         struct lec_arp_table *mcast_fwds = priv->mcast_fwds;
1591
1592
1593         printk("Dump %p:\n",priv);
1594         for (i=0;i<LEC_ARP_TABLE_SIZE;i++) {
1595                 rulla = lec_arp_tables[i];
1596                 offset = 0;
1597                 offset += sprintf(buf,"%d: %p\n",i, rulla);
1598                 while (rulla) {
1599                         offset += sprintf(buf+offset,"Mac:");
1600                         for(j=0;j<ETH_ALEN;j++) {
1601                                 offset+=sprintf(buf+offset,
1602                                                 "%2.2x ",
1603                                                 rulla->mac_addr[j]&0xff);
1604                         }
1605                         offset +=sprintf(buf+offset,"Atm:");
1606                         for(j=0;j<ATM_ESA_LEN;j++) {
1607                                 offset+=sprintf(buf+offset,
1608                                                 "%2.2x ",
1609                                                 rulla->atm_addr[j]&0xff);
1610                         }
1611                         offset+=sprintf(buf+offset,
1612                                         "Vcc vpi:%d vci:%d, Recv_vcc vpi:%d vci:%d Last_used:%lx, Timestamp:%lx, No_tries:%d ",
1613                                         rulla->vcc?rulla->vcc->vpi:0,
1614                                         rulla->vcc?rulla->vcc->vci:0,
1615                                         rulla->recv_vcc?rulla->recv_vcc->vpi:0,
1616                                         rulla->recv_vcc?rulla->recv_vcc->vci:0,
1617                                         rulla->last_used,
1618                                         rulla->timestamp, rulla->no_tries);
1619                         offset+=sprintf(buf+offset,
1620                                         "Flags:%x, Packets_flooded:%x, Status: %s ",
1621                                         rulla->flags, rulla->packets_flooded,
1622                                         get_status_string(rulla->status));
1623                         offset+=sprintf(buf+offset,"->%p\n",rulla->next);
1624                         rulla = rulla->next;
1625                 }
1626                 printk("%s",buf);
1627         }
1628         rulla = lec_no_forward;
1629         if (rulla)
1630                 printk("No forward\n");
1631         while(rulla) {
1632                 offset=0;
1633                 offset += sprintf(buf+offset,"Mac:");
1634                 for(j=0;j<ETH_ALEN;j++) {
1635                         offset+=sprintf(buf+offset,"%2.2x ",
1636                                         rulla->mac_addr[j]&0xff);
1637                 }
1638                 offset +=sprintf(buf+offset,"Atm:");
1639                 for(j=0;j<ATM_ESA_LEN;j++) {
1640                         offset+=sprintf(buf+offset,"%2.2x ",
1641                                         rulla->atm_addr[j]&0xff);
1642                 }
1643                 offset+=sprintf(buf+offset,
1644                                 "Vcc vpi:%d vci:%d, Recv_vcc vpi:%d vci:%d Last_used:%lx, Timestamp:%lx, No_tries:%d ",
1645                                 rulla->vcc?rulla->vcc->vpi:0,
1646                                 rulla->vcc?rulla->vcc->vci:0,
1647                                 rulla->recv_vcc?rulla->recv_vcc->vpi:0,
1648                                 rulla->recv_vcc?rulla->recv_vcc->vci:0,
1649                                 rulla->last_used,
1650                                 rulla->timestamp, rulla->no_tries);
1651                 offset+=sprintf(buf+offset,
1652                                 "Flags:%x, Packets_flooded:%x, Status: %s ",
1653                                 rulla->flags, rulla->packets_flooded,
1654                                 get_status_string(rulla->status));
1655                 offset+=sprintf(buf+offset,"->%lx\n",(long)rulla->next);
1656                 rulla = rulla->next;
1657                 printk("%s",buf);
1658         }
1659         rulla = lec_arp_empty_ones;
1660         if (rulla)
1661                 printk("Empty ones\n");
1662         while(rulla) {
1663                 offset=0;
1664                 offset += sprintf(buf+offset,"Mac:");
1665                 for(j=0;j<ETH_ALEN;j++) {
1666                         offset+=sprintf(buf+offset,"%2.2x ",
1667                                         rulla->mac_addr[j]&0xff);
1668                 }
1669                 offset +=sprintf(buf+offset,"Atm:");
1670                 for(j=0;j<ATM_ESA_LEN;j++) {
1671                         offset+=sprintf(buf+offset,"%2.2x ",
1672                                         rulla->atm_addr[j]&0xff);
1673                 }
1674                 offset+=sprintf(buf+offset,
1675                                 "Vcc vpi:%d vci:%d, Recv_vcc vpi:%d vci:%d Last_used:%lx, Timestamp:%lx, No_tries:%d ",
1676                                 rulla->vcc?rulla->vcc->vpi:0,
1677                                 rulla->vcc?rulla->vcc->vci:0,
1678                                 rulla->recv_vcc?rulla->recv_vcc->vpi:0,
1679                                 rulla->recv_vcc?rulla->recv_vcc->vci:0,
1680                                 rulla->last_used,
1681                                 rulla->timestamp, rulla->no_tries);
1682                 offset+=sprintf(buf+offset,
1683                                 "Flags:%x, Packets_flooded:%x, Status: %s ",
1684                                 rulla->flags, rulla->packets_flooded,
1685                                 get_status_string(rulla->status));
1686                 offset+=sprintf(buf+offset,"->%lx\n",(long)rulla->next);
1687                 rulla = rulla->next;
1688                 printk("%s",buf);
1689         }
1690
1691         rulla = mcast_fwds;
1692         if (rulla)
1693                 printk("Multicast Forward VCCs\n");
1694         while(rulla) {
1695                 offset=0;
1696                 offset += sprintf(buf+offset,"Mac:");
1697                 for(j=0;j<ETH_ALEN;j++) {
1698                         offset+=sprintf(buf+offset,"%2.2x ",
1699                                         rulla->mac_addr[j]&0xff);
1700                 }
1701                 offset +=sprintf(buf+offset,"Atm:");
1702                 for(j=0;j<ATM_ESA_LEN;j++) {
1703                         offset+=sprintf(buf+offset,"%2.2x ",
1704                                         rulla->atm_addr[j]&0xff);
1705                 }
1706                 offset+=sprintf(buf+offset,
1707                                 "Vcc vpi:%d vci:%d, Recv_vcc vpi:%d vci:%d Last_used:%lx, Timestamp:%lx, No_tries:%d ",
1708                                 rulla->vcc?rulla->vcc->vpi:0,
1709                                 rulla->vcc?rulla->vcc->vci:0,
1710                                 rulla->recv_vcc?rulla->recv_vcc->vpi:0,
1711                                 rulla->recv_vcc?rulla->recv_vcc->vci:0,
1712                                 rulla->last_used,
1713                                 rulla->timestamp, rulla->no_tries);
1714                 offset+=sprintf(buf+offset,
1715                                 "Flags:%x, Packets_flooded:%x, Status: %s ",
1716                                 rulla->flags, rulla->packets_flooded,
1717                                 get_status_string(rulla->status));
1718                 offset+=sprintf(buf+offset,"->%lx\n",(long)rulla->next);
1719                 rulla = rulla->next;
1720                 printk("%s",buf);
1721         }
1722
1723 #endif
1724 }
1725
1726 /*
1727  * Destruction of arp-cache
1728  */
1729 static void
1730 lec_arp_destroy(struct lec_priv *priv)
1731 {
1732         unsigned long flags;
1733         struct lec_arp_table *entry, *next;
1734         int i;
1735
1736         del_timer_sync(&priv->lec_arp_timer);
1737
1738         /*
1739          * Remove all entries
1740          */
1741
1742         spin_lock_irqsave(&priv->lec_arp_lock, flags);
1743         for (i = 0; i < LEC_ARP_TABLE_SIZE; i++) {
1744                 for(entry = priv->lec_arp_tables[i]; entry != NULL; entry=next) {
1745                         next = entry->next;
1746                         lec_arp_remove(priv, entry);
1747                         kfree(entry);
1748                 }
1749         }
1750         entry = priv->lec_arp_empty_ones;
1751         while(entry) {
1752                 next = entry->next;
1753                 del_timer_sync(&entry->timer);
1754                 lec_arp_clear_vccs(entry);
1755                 kfree(entry);
1756                 entry = next;
1757         }
1758         priv->lec_arp_empty_ones = NULL;
1759         entry = priv->lec_no_forward;
1760         while(entry) {
1761                 next = entry->next;
1762                 del_timer_sync(&entry->timer);
1763                 lec_arp_clear_vccs(entry);
1764                 kfree(entry);
1765                 entry = next;
1766         }
1767         priv->lec_no_forward = NULL;
1768         entry = priv->mcast_fwds;
1769         while(entry) {
1770                 next = entry->next;
1771                 /* No timer, LANEv2 7.1.20 and 2.3.5.3 */
1772                 lec_arp_clear_vccs(entry);
1773                 kfree(entry);
1774                 entry = next;
1775         }
1776         priv->mcast_fwds = NULL;
1777         priv->mcast_vcc = NULL;
1778         memset(priv->lec_arp_tables, 0,
1779                sizeof(struct lec_arp_table *) * LEC_ARP_TABLE_SIZE);
1780         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
1781 }
1782
1783
1784 /*
1785  * Find entry by mac_address
1786  */
1787 static struct lec_arp_table*
1788 lec_arp_find(struct lec_priv *priv,
1789              unsigned char *mac_addr)
1790 {
1791         unsigned short place;
1792         struct lec_arp_table *to_return;
1793
1794         DPRINTK("LEC_ARP: lec_arp_find :%2.2x %2.2x %2.2x %2.2x %2.2x %2.2x\n",
1795                 mac_addr[0]&0xff, mac_addr[1]&0xff, mac_addr[2]&0xff,
1796                 mac_addr[3]&0xff, mac_addr[4]&0xff, mac_addr[5]&0xff);
1797         place = HASH(mac_addr[ETH_ALEN-1]);
1798
1799         to_return = priv->lec_arp_tables[place];
1800         while(to_return) {
1801                 if (memcmp(mac_addr, to_return->mac_addr, ETH_ALEN) == 0) {
1802                         return to_return;
1803                 }
1804                 to_return = to_return->next;
1805         }
1806         return NULL;
1807 }
1808
1809 static struct lec_arp_table*
1810 make_entry(struct lec_priv *priv, unsigned char *mac_addr)
1811 {
1812         struct lec_arp_table *to_return;
1813
1814         to_return = (struct lec_arp_table *) kmalloc(sizeof(struct lec_arp_table),
1815                                                      GFP_ATOMIC);
1816         if (!to_return) {
1817                 printk("LEC: Arp entry kmalloc failed\n");
1818                 return NULL;
1819         }
1820         memset(to_return, 0, sizeof(struct lec_arp_table));
1821         memcpy(to_return->mac_addr, mac_addr, ETH_ALEN);
1822         init_timer(&to_return->timer);
1823         to_return->timer.function = lec_arp_expire_arp;
1824         to_return->timer.data = (unsigned long) to_return;
1825         to_return->last_used = jiffies;
1826         to_return->priv = priv;
1827         skb_queue_head_init(&to_return->tx_wait);
1828         return to_return;
1829 }
1830
1831 /*
1832  *
1833  * Arp sent timer expired
1834  *
1835  */
1836 static void
1837 lec_arp_expire_arp(unsigned long data)
1838 {
1839         struct lec_arp_table *entry;
1840
1841         entry = (struct lec_arp_table *)data;
1842
1843         DPRINTK("lec_arp_expire_arp\n");
1844         if (entry->status == ESI_ARP_PENDING) {
1845                 if (entry->no_tries <= entry->priv->max_retry_count) {
1846                         if (entry->is_rdesc)
1847                                 send_to_lecd(entry->priv, l_rdesc_arp_xmt, entry->mac_addr, NULL, NULL);
1848                         else
1849                                 send_to_lecd(entry->priv, l_arp_xmt, entry->mac_addr, NULL, NULL);
1850                         entry->no_tries++;
1851                 }
1852                 mod_timer(&entry->timer, jiffies + (1*HZ));
1853         }
1854 }
1855
1856 /*
1857  *
1858  * Unknown/unused vcc expire, remove associated entry
1859  *
1860  */
1861 static void
1862 lec_arp_expire_vcc(unsigned long data)
1863 {
1864         unsigned long flags;
1865         struct lec_arp_table *to_remove = (struct lec_arp_table*)data;
1866         struct lec_priv *priv = (struct lec_priv *)to_remove->priv;
1867         struct lec_arp_table *entry = NULL;
1868
1869         del_timer(&to_remove->timer);
1870
1871         DPRINTK("LEC_ARP %p %p: lec_arp_expire_vcc vpi:%d vci:%d\n",
1872                 to_remove, priv,
1873                 to_remove->vcc?to_remove->recv_vcc->vpi:0,
1874                 to_remove->vcc?to_remove->recv_vcc->vci:0);
1875         DPRINTK("eo:%p nf:%p\n",priv->lec_arp_empty_ones,priv->lec_no_forward);
1876
1877         spin_lock_irqsave(&priv->lec_arp_lock, flags);
1878         if (to_remove == priv->lec_arp_empty_ones)
1879                 priv->lec_arp_empty_ones = to_remove->next;
1880         else {
1881                 entry = priv->lec_arp_empty_ones;
1882                 while (entry && entry->next != to_remove)
1883                         entry = entry->next;
1884                 if (entry)
1885                         entry->next = to_remove->next;
1886         }
1887         if (!entry) {
1888                 if (to_remove == priv->lec_no_forward) {
1889                         priv->lec_no_forward = to_remove->next;
1890                 } else {
1891                         entry = priv->lec_no_forward;
1892                         while (entry && entry->next != to_remove)
1893                                 entry = entry->next;
1894                         if (entry)
1895                                 entry->next = to_remove->next;
1896                 }
1897         }
1898         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
1899
1900         lec_arp_clear_vccs(to_remove);
1901         kfree(to_remove);
1902 }
1903
1904 /*
1905  * Expire entries.
1906  * 1. Re-set timer
1907  * 2. For each entry, delete entries that have aged past the age limit.
1908  * 3. For each entry, depending on the status of the entry, perform
1909  *    the following maintenance.
1910  *    a. If status is ESI_VC_PENDING or ESI_ARP_PENDING then if the
1911  *       tick_count is above the max_unknown_frame_time, clear
1912  *       the tick_count to zero and clear the packets_flooded counter
1913  *       to zero. This supports the packet rate limit per address
1914  *       while flooding unknowns.
1915  *    b. If the status is ESI_FLUSH_PENDING and the tick_count is greater
1916  *       than or equal to the path_switching_delay, change the status
1917  *       to ESI_FORWARD_DIRECT. This causes the flush period to end
1918  *       regardless of the progress of the flush protocol.
1919  */
1920 static void
1921 lec_arp_check_expire(unsigned long data)
1922 {
1923         unsigned long flags;
1924         struct lec_priv *priv = (struct lec_priv *)data;
1925         struct lec_arp_table *entry, *next;
1926         unsigned long now;
1927         unsigned long time_to_check;
1928         int i;
1929
1930         DPRINTK("lec_arp_check_expire %p\n",priv);
1931         DPRINTK("expire: eo:%p nf:%p\n",priv->lec_arp_empty_ones,
1932                 priv->lec_no_forward);
1933         now = jiffies;
1934         spin_lock_irqsave(&priv->lec_arp_lock, flags);
1935         for(i = 0; i < LEC_ARP_TABLE_SIZE; i++) {
1936                 for(entry = priv->lec_arp_tables[i]; entry != NULL; ) {
1937                         if ((entry->flags) & LEC_REMOTE_FLAG &&
1938                             priv->topology_change)
1939                                 time_to_check = priv->forward_delay_time;
1940                         else
1941                                 time_to_check = priv->aging_time;
1942
1943                         DPRINTK("About to expire: %lx - %lx > %lx\n",
1944                                 now,entry->last_used, time_to_check);
1945                         if( time_after(now, entry->last_used+
1946                            time_to_check) &&
1947                             !(entry->flags & LEC_PERMANENT_FLAG) &&
1948                             !(entry->mac_addr[0] & 0x01) ) { /* LANE2: 7.1.20 */
1949                                 /* Remove entry */
1950                                 DPRINTK("LEC:Entry timed out\n");
1951                                 next = entry->next;
1952                                 lec_arp_remove(priv, entry);
1953                                 kfree(entry);
1954                                 entry = next;
1955                         } else {
1956                                 /* Something else */
1957                                 if ((entry->status == ESI_VC_PENDING ||
1958                                      entry->status == ESI_ARP_PENDING)
1959                                     && time_after_eq(now,
1960                                     entry->timestamp +
1961                                     priv->max_unknown_frame_time)) {
1962                                         entry->timestamp = jiffies;
1963                                         entry->packets_flooded = 0;
1964                                         if (entry->status == ESI_VC_PENDING)
1965                                                 send_to_lecd(priv, l_svc_setup, entry->mac_addr, entry->atm_addr, NULL);
1966                                 }
1967                                 if (entry->status == ESI_FLUSH_PENDING
1968                                    &&
1969                                    time_after_eq(now, entry->timestamp+
1970                                    priv->path_switching_delay)) {
1971                                         struct sk_buff *skb;
1972
1973                                         while ((skb = skb_dequeue(&entry->tx_wait)) != NULL)
1974                                                 lec_send(entry->vcc, skb, entry->priv);
1975                                         entry->last_used = jiffies;
1976                                         entry->status =
1977                                                 ESI_FORWARD_DIRECT;
1978                                 }
1979                                 entry = entry->next;
1980                         }
1981                 }
1982         }
1983         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
1984
1985         mod_timer(&priv->lec_arp_timer, jiffies + LEC_ARP_REFRESH_INTERVAL);
1986 }
1987 /*
1988  * Try to find vcc where mac_address is attached.
1989  *
1990  */
1991 static struct atm_vcc*
1992 lec_arp_resolve(struct lec_priv *priv, unsigned char *mac_to_find,
1993                 int is_rdesc, struct lec_arp_table **ret_entry)
1994 {
1995         unsigned long flags;
1996         struct lec_arp_table *entry;
1997         struct atm_vcc *found;
1998
1999         if (mac_to_find[0] & 0x01) {
2000                 switch (priv->lane_version) {
2001                 case 1:
2002                         return priv->mcast_vcc;
2003                         break;
2004                 case 2:  /* LANE2 wants arp for multicast addresses */
2005                         if ( memcmp(mac_to_find, bus_mac, ETH_ALEN) == 0)
2006                                 return priv->mcast_vcc;
2007                         break;
2008                 default:
2009                         break;
2010                 }
2011         }
2012
2013         spin_lock_irqsave(&priv->lec_arp_lock, flags);
2014         entry = lec_arp_find(priv, mac_to_find);
2015
2016         if (entry) {
2017                 if (entry->status == ESI_FORWARD_DIRECT) {
2018                         /* Connection Ok */
2019                         entry->last_used = jiffies;
2020                         *ret_entry = entry;
2021                         found = entry->vcc;
2022                         goto out;
2023                 }
2024                 /* If the LE_ARP cache entry is still pending, reset count to 0
2025                  * so another LE_ARP request can be made for this frame.
2026                  */
2027                 if (entry->status == ESI_ARP_PENDING) {
2028                         entry->no_tries = 0;
2029                 }
2030                 /* Data direct VC not yet set up, check to see if the unknown
2031                    frame count is greater than the limit. If the limit has
2032                    not been reached, allow the caller to send packet to
2033                    BUS. */
2034                 if (entry->status != ESI_FLUSH_PENDING &&
2035                     entry->packets_flooded<priv->maximum_unknown_frame_count) {
2036                         entry->packets_flooded++;
2037                         DPRINTK("LEC_ARP: Flooding..\n");
2038                         found = priv->mcast_vcc;
2039                         goto out;
2040                 }
2041                 /* We got here because entry->status == ESI_FLUSH_PENDING
2042                  * or BUS flood limit was reached for an entry which is
2043                  * in ESI_ARP_PENDING or ESI_VC_PENDING state.
2044                  */
2045                 *ret_entry = entry;
2046                 DPRINTK("lec: entry->status %d entry->vcc %p\n", entry->status, entry->vcc);
2047                 found = NULL;
2048         } else {
2049                 /* No matching entry was found */
2050                 entry = make_entry(priv, mac_to_find);
2051                 DPRINTK("LEC_ARP: Making entry\n");
2052                 if (!entry) {
2053                         found = priv->mcast_vcc;
2054                         goto out;
2055                 }
2056                 lec_arp_add(priv, entry);
2057                 /* We want arp-request(s) to be sent */
2058                 entry->packets_flooded =1;
2059                 entry->status = ESI_ARP_PENDING;
2060                 entry->no_tries = 1;
2061                 entry->last_used = entry->timestamp = jiffies;
2062                 entry->is_rdesc = is_rdesc;
2063                 if (entry->is_rdesc)
2064                         send_to_lecd(priv, l_rdesc_arp_xmt, mac_to_find, NULL, NULL);
2065                 else
2066                         send_to_lecd(priv, l_arp_xmt, mac_to_find, NULL, NULL);
2067                 entry->timer.expires = jiffies + (1*HZ);
2068                 entry->timer.function = lec_arp_expire_arp;
2069                 add_timer(&entry->timer);
2070                 found = priv->mcast_vcc;
2071         }
2072
2073 out:
2074         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
2075         return found;
2076 }
2077
2078 static int
2079 lec_addr_delete(struct lec_priv *priv, unsigned char *atm_addr,
2080                 unsigned long permanent)
2081 {
2082         unsigned long flags;
2083         struct lec_arp_table *entry, *next;
2084         int i;
2085
2086         DPRINTK("lec_addr_delete\n");
2087         spin_lock_irqsave(&priv->lec_arp_lock, flags);
2088         for(i = 0; i < LEC_ARP_TABLE_SIZE; i++) {
2089                 for(entry = priv->lec_arp_tables[i]; entry != NULL; entry = next) {
2090                         next = entry->next;
2091                         if (!memcmp(atm_addr, entry->atm_addr, ATM_ESA_LEN)
2092                             && (permanent ||
2093                                 !(entry->flags & LEC_PERMANENT_FLAG))) {
2094                                 lec_arp_remove(priv, entry);
2095                                 kfree(entry);
2096                         }
2097                         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
2098                         return 0;
2099                 }
2100         }
2101         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
2102         return -1;
2103 }
2104
2105 /*
2106  * Notifies:  Response to arp_request (atm_addr != NULL)
2107  */
2108 static void
2109 lec_arp_update(struct lec_priv *priv, unsigned char *mac_addr,
2110                unsigned char *atm_addr, unsigned long remoteflag,
2111                unsigned int targetless_le_arp)
2112 {
2113         unsigned long flags;
2114         struct lec_arp_table *entry, *tmp;
2115         int i;
2116
2117         DPRINTK("lec:%s", (targetless_le_arp) ? "targetless ": " ");
2118         DPRINTK("lec_arp_update mac:%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x\n",
2119                 mac_addr[0],mac_addr[1],mac_addr[2],mac_addr[3],
2120                 mac_addr[4],mac_addr[5]);
2121
2122         spin_lock_irqsave(&priv->lec_arp_lock, flags);
2123         entry = lec_arp_find(priv, mac_addr);
2124         if (entry == NULL && targetless_le_arp)
2125                 goto out;   /* LANE2: ignore targetless LE_ARPs for which
2126                              * we have no entry in the cache. 7.1.30
2127                              */
2128         if (priv->lec_arp_empty_ones) {
2129                 entry = priv->lec_arp_empty_ones;
2130                 if (!memcmp(entry->atm_addr, atm_addr, ATM_ESA_LEN)) {
2131                         priv->lec_arp_empty_ones = entry->next;
2132                 } else {
2133                         while(entry->next && memcmp(entry->next->atm_addr,
2134                                                     atm_addr, ATM_ESA_LEN))
2135                                 entry = entry->next;
2136                         if (entry->next) {
2137                                 tmp = entry;
2138                                 entry = entry->next;
2139                                 tmp->next = entry->next;
2140                         } else
2141                                 entry = NULL;
2142
2143                 }
2144                 if (entry) {
2145                         del_timer(&entry->timer);
2146                         tmp = lec_arp_find(priv, mac_addr);
2147                         if (tmp) {
2148                                 del_timer(&tmp->timer);
2149                                 tmp->status = ESI_FORWARD_DIRECT;
2150                                 memcpy(tmp->atm_addr, atm_addr, ATM_ESA_LEN);
2151                                 tmp->vcc = entry->vcc;
2152                                 tmp->old_push = entry->old_push;
2153                                 tmp->last_used = jiffies;
2154                                 del_timer(&entry->timer);
2155                                 kfree(entry);
2156                                 entry=tmp;
2157                         } else {
2158                                 entry->status = ESI_FORWARD_DIRECT;
2159                                 memcpy(entry->mac_addr, mac_addr, ETH_ALEN);
2160                                 entry->last_used = jiffies;
2161                                 lec_arp_add(priv, entry);
2162                         }
2163                         if (remoteflag)
2164                                 entry->flags|=LEC_REMOTE_FLAG;
2165                         else
2166                                 entry->flags&=~LEC_REMOTE_FLAG;
2167                         DPRINTK("After update\n");
2168                         dump_arp_table(priv);
2169                         goto out;
2170                 }
2171         }
2172         entry = lec_arp_find(priv, mac_addr);
2173         if (!entry) {
2174                 entry = make_entry(priv, mac_addr);
2175                 if (!entry)
2176                         goto out;
2177                 entry->status = ESI_UNKNOWN;
2178                 lec_arp_add(priv, entry);
2179                 /* Temporary, changes before end of function */
2180         }
2181         memcpy(entry->atm_addr, atm_addr, ATM_ESA_LEN);
2182         del_timer(&entry->timer);
2183         for(i = 0; i < LEC_ARP_TABLE_SIZE; i++) {
2184                 for(tmp = priv->lec_arp_tables[i]; tmp; tmp=tmp->next) {
2185                         if (entry != tmp &&
2186                             !memcmp(tmp->atm_addr, atm_addr,
2187                                     ATM_ESA_LEN)) {
2188                                 /* Vcc to this host exists */
2189                                 if (tmp->status > ESI_VC_PENDING) {
2190                                         /*
2191                                          * ESI_FLUSH_PENDING,
2192                                          * ESI_FORWARD_DIRECT
2193                                          */
2194                                         entry->vcc = tmp->vcc;
2195                                         entry->old_push=tmp->old_push;
2196                                 }
2197                                 entry->status=tmp->status;
2198                                 break;
2199                         }
2200                 }
2201         }
2202         if (remoteflag)
2203                 entry->flags|=LEC_REMOTE_FLAG;
2204         else
2205                 entry->flags&=~LEC_REMOTE_FLAG;
2206         if (entry->status == ESI_ARP_PENDING ||
2207             entry->status == ESI_UNKNOWN) {
2208                 entry->status = ESI_VC_PENDING;
2209                 send_to_lecd(priv, l_svc_setup, entry->mac_addr, atm_addr, NULL);
2210         }
2211         DPRINTK("After update2\n");
2212         dump_arp_table(priv);
2213 out:
2214         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
2215 }
2216
2217 /*
2218  * Notifies: Vcc setup ready
2219  */
2220 static void
2221 lec_vcc_added(struct lec_priv *priv, struct atmlec_ioc *ioc_data,
2222               struct atm_vcc *vcc,
2223               void (*old_push)(struct atm_vcc *vcc, struct sk_buff *skb))
2224 {
2225         unsigned long flags;
2226         struct lec_arp_table *entry;
2227         int i, found_entry=0;
2228
2229         spin_lock_irqsave(&priv->lec_arp_lock, flags);
2230         if (ioc_data->receive == 2) {
2231                 /* Vcc for Multicast Forward. No timer, LANEv2 7.1.20 and 2.3.5.3 */
2232
2233                 DPRINTK("LEC_ARP: Attaching mcast forward\n");
2234 #if 0
2235                 entry = lec_arp_find(priv, bus_mac);
2236                 if (!entry) {
2237                         printk("LEC_ARP: Multicast entry not found!\n");
2238                         goto out;
2239                 }
2240                 memcpy(entry->atm_addr, ioc_data->atm_addr, ATM_ESA_LEN);
2241                 entry->recv_vcc = vcc;
2242                 entry->old_recv_push = old_push;
2243 #endif
2244                 entry = make_entry(priv, bus_mac);
2245                 if (entry == NULL)
2246                         goto out;
2247                 del_timer(&entry->timer);
2248                 memcpy(entry->atm_addr, ioc_data->atm_addr, ATM_ESA_LEN);
2249                 entry->recv_vcc = vcc;
2250                 entry->old_recv_push = old_push;
2251                 entry->next = priv->mcast_fwds;
2252                 priv->mcast_fwds = entry;
2253                 goto out;
2254         } else if (ioc_data->receive == 1) {
2255                 /* Vcc which we don't want to make default vcc, attach it
2256                    anyway. */
2257                 DPRINTK("LEC_ARP:Attaching data direct, not default :%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x\n",
2258                         ioc_data->atm_addr[0],ioc_data->atm_addr[1],
2259                         ioc_data->atm_addr[2],ioc_data->atm_addr[3],
2260                         ioc_data->atm_addr[4],ioc_data->atm_addr[5],
2261                         ioc_data->atm_addr[6],ioc_data->atm_addr[7],
2262                         ioc_data->atm_addr[8],ioc_data->atm_addr[9],
2263                         ioc_data->atm_addr[10],ioc_data->atm_addr[11],
2264                         ioc_data->atm_addr[12],ioc_data->atm_addr[13],
2265                         ioc_data->atm_addr[14],ioc_data->atm_addr[15],
2266                         ioc_data->atm_addr[16],ioc_data->atm_addr[17],
2267                         ioc_data->atm_addr[18],ioc_data->atm_addr[19]);
2268                 entry = make_entry(priv, bus_mac);
2269                 if (entry == NULL)
2270                         goto out;
2271                 memcpy(entry->atm_addr, ioc_data->atm_addr, ATM_ESA_LEN);
2272                 memset(entry->mac_addr, 0, ETH_ALEN);
2273                 entry->recv_vcc = vcc;
2274                 entry->old_recv_push = old_push;
2275                 entry->status = ESI_UNKNOWN;
2276                 entry->timer.expires = jiffies + priv->vcc_timeout_period;
2277                 entry->timer.function = lec_arp_expire_vcc;
2278                 add_timer(&entry->timer);
2279                 entry->next = priv->lec_no_forward;
2280                 priv->lec_no_forward = entry;
2281                 dump_arp_table(priv);
2282                 goto out;
2283         }
2284         DPRINTK("LEC_ARP:Attaching data direct, default:%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x%2.2x\n",
2285                 ioc_data->atm_addr[0],ioc_data->atm_addr[1],
2286                 ioc_data->atm_addr[2],ioc_data->atm_addr[3],
2287                 ioc_data->atm_addr[4],ioc_data->atm_addr[5],
2288                 ioc_data->atm_addr[6],ioc_data->atm_addr[7],
2289                 ioc_data->atm_addr[8],ioc_data->atm_addr[9],
2290                 ioc_data->atm_addr[10],ioc_data->atm_addr[11],
2291                 ioc_data->atm_addr[12],ioc_data->atm_addr[13],
2292                 ioc_data->atm_addr[14],ioc_data->atm_addr[15],
2293                 ioc_data->atm_addr[16],ioc_data->atm_addr[17],
2294                 ioc_data->atm_addr[18],ioc_data->atm_addr[19]);
2295         for (i = 0; i < LEC_ARP_TABLE_SIZE; i++) {
2296                 for (entry = priv->lec_arp_tables[i]; entry; entry=entry->next) {
2297                         if (memcmp(ioc_data->atm_addr, entry->atm_addr,
2298                                    ATM_ESA_LEN)==0) {
2299                                 DPRINTK("LEC_ARP: Attaching data direct\n");
2300                                 DPRINTK("Currently -> Vcc: %d, Rvcc:%d\n",
2301                                         entry->vcc?entry->vcc->vci:0,
2302                                         entry->recv_vcc?entry->recv_vcc->vci:0);
2303                                 found_entry=1;
2304                                 del_timer(&entry->timer);
2305                                 entry->vcc = vcc;
2306                                 entry->old_push = old_push;
2307                                 if (entry->status == ESI_VC_PENDING) {
2308                                         if(priv->maximum_unknown_frame_count
2309                                            ==0)
2310                                                 entry->status =
2311                                                         ESI_FORWARD_DIRECT;
2312                                         else {
2313                                                 entry->timestamp = jiffies;
2314                                                 entry->status =
2315                                                         ESI_FLUSH_PENDING;
2316 #if 0
2317                                                 send_to_lecd(priv,l_flush_xmt,
2318                                                              NULL,
2319                                                              entry->atm_addr,
2320                                                              NULL);
2321 #endif
2322                                         }
2323                                 } else {
2324                                         /* They were forming a connection
2325                                            to us, and we to them. Our
2326                                            ATM address is numerically lower
2327                                            than theirs, so we make connection
2328                                            we formed into default VCC (8.1.11).
2329                                            Connection they made gets torn
2330                                            down. This might confuse some
2331                                            clients. Can be changed if
2332                                            someone reports trouble... */
2333                                         ;
2334                                 }
2335                         }
2336                 }
2337         }
2338         if (found_entry) {
2339                 DPRINTK("After vcc was added\n");
2340                 dump_arp_table(priv);
2341                 goto out;
2342         }
2343         /* Not found, snatch address from first data packet that arrives from
2344            this vcc */
2345         entry = make_entry(priv, bus_mac);
2346         if (!entry)
2347                 goto out;
2348         entry->vcc = vcc;
2349         entry->old_push = old_push;
2350         memcpy(entry->atm_addr, ioc_data->atm_addr, ATM_ESA_LEN);
2351         memset(entry->mac_addr, 0, ETH_ALEN);
2352         entry->status = ESI_UNKNOWN;
2353         entry->next = priv->lec_arp_empty_ones;
2354         priv->lec_arp_empty_ones = entry;
2355         entry->timer.expires = jiffies + priv->vcc_timeout_period;
2356         entry->timer.function = lec_arp_expire_vcc;
2357         add_timer(&entry->timer);
2358         DPRINTK("After vcc was added\n");
2359         dump_arp_table(priv);
2360 out:
2361         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
2362 }
2363
2364 static void
2365 lec_flush_complete(struct lec_priv *priv, unsigned long tran_id)
2366 {
2367         unsigned long flags;
2368         struct lec_arp_table *entry;
2369         int i;
2370
2371         DPRINTK("LEC:lec_flush_complete %lx\n",tran_id);
2372         spin_lock_irqsave(&priv->lec_arp_lock, flags);
2373         for (i = 0; i < LEC_ARP_TABLE_SIZE; i++) {
2374                 for (entry = priv->lec_arp_tables[i]; entry; entry=entry->next) {
2375                         if (entry->flush_tran_id == tran_id &&
2376                             entry->status == ESI_FLUSH_PENDING) {
2377                                 struct sk_buff *skb;
2378
2379                                 while ((skb = skb_dequeue(&entry->tx_wait)) != NULL)
2380                                         lec_send(entry->vcc, skb, entry->priv);
2381                                 entry->status = ESI_FORWARD_DIRECT;
2382                                 DPRINTK("LEC_ARP: Flushed\n");
2383                         }
2384                 }
2385         }
2386         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
2387         dump_arp_table(priv);
2388 }
2389
2390 static void
2391 lec_set_flush_tran_id(struct lec_priv *priv,
2392                       unsigned char *atm_addr, unsigned long tran_id)
2393 {
2394         unsigned long flags;
2395         struct lec_arp_table *entry;
2396         int i;
2397
2398         spin_lock_irqsave(&priv->lec_arp_lock, flags);
2399         for (i = 0; i < LEC_ARP_TABLE_SIZE; i++)
2400                 for(entry = priv->lec_arp_tables[i]; entry; entry=entry->next)
2401                         if (!memcmp(atm_addr, entry->atm_addr, ATM_ESA_LEN)) {
2402                                 entry->flush_tran_id = tran_id;
2403                                 DPRINTK("Set flush transaction id to %lx for %p\n",tran_id,entry);
2404                         }
2405         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
2406 }
2407
2408 static int
2409 lec_mcast_make(struct lec_priv *priv, struct atm_vcc *vcc)
2410 {
2411         unsigned long flags;
2412         unsigned char mac_addr[] = {
2413                 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
2414         struct lec_arp_table *to_add;
2415         struct lec_vcc_priv *vpriv;
2416         int err = 0;
2417
2418         if (!(vpriv = kmalloc(sizeof(struct lec_vcc_priv), GFP_KERNEL)))
2419                 return -ENOMEM;
2420         vpriv->xoff = 0;
2421         vpriv->old_pop = vcc->pop;
2422         vcc->user_back = vpriv;
2423         vcc->pop = lec_pop;
2424         spin_lock_irqsave(&priv->lec_arp_lock, flags);
2425         to_add = make_entry(priv, mac_addr);
2426         if (!to_add) {
2427                 vcc->pop = vpriv->old_pop;
2428                 kfree(vpriv);
2429                 err = -ENOMEM;
2430                 goto out;
2431         }
2432         memcpy(to_add->atm_addr, vcc->remote.sas_addr.prv, ATM_ESA_LEN);
2433         to_add->status = ESI_FORWARD_DIRECT;
2434         to_add->flags |= LEC_PERMANENT_FLAG;
2435         to_add->vcc = vcc;
2436         to_add->old_push = vcc->push;
2437         vcc->push = lec_push;
2438         priv->mcast_vcc = vcc;
2439         lec_arp_add(priv, to_add);
2440 out:
2441         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
2442         return err;
2443 }
2444
2445 static void
2446 lec_vcc_close(struct lec_priv *priv, struct atm_vcc *vcc)
2447 {
2448         unsigned long flags;
2449         struct lec_arp_table *entry, *next;
2450         int i;
2451
2452         DPRINTK("LEC_ARP: lec_vcc_close vpi:%d vci:%d\n",vcc->vpi,vcc->vci);
2453         dump_arp_table(priv);
2454         spin_lock_irqsave(&priv->lec_arp_lock, flags);
2455         for(i=0;i<LEC_ARP_TABLE_SIZE;i++) {
2456                 for(entry = priv->lec_arp_tables[i];entry; entry=next) {
2457                         next = entry->next;
2458                         if (vcc == entry->vcc) {
2459                                 lec_arp_remove(priv, entry);
2460                                 kfree(entry);
2461                                 if (priv->mcast_vcc == vcc) {
2462                                         priv->mcast_vcc = NULL;
2463                                 }
2464                         }
2465                 }
2466         }
2467
2468         entry = priv->lec_arp_empty_ones;
2469         priv->lec_arp_empty_ones = NULL;
2470         while (entry != NULL) {
2471                 next = entry->next;
2472                 if (entry->vcc == vcc) { /* leave it out from the list */
2473                         lec_arp_clear_vccs(entry);
2474                         del_timer(&entry->timer);
2475                         kfree(entry);
2476                 }
2477                 else {              /* put it back to the list */
2478                         entry->next = priv->lec_arp_empty_ones;
2479                         priv->lec_arp_empty_ones = entry;
2480                 }
2481                 entry = next;
2482         }
2483
2484         entry = priv->lec_no_forward;
2485         priv->lec_no_forward = NULL;
2486         while (entry != NULL) {
2487                 next = entry->next;
2488                 if (entry->recv_vcc == vcc) {
2489                         lec_arp_clear_vccs(entry);
2490                         del_timer(&entry->timer);
2491                         kfree(entry);
2492                 }
2493                 else {
2494                         entry->next = priv->lec_no_forward;
2495                         priv->lec_no_forward = entry;
2496                 }
2497                 entry = next;
2498         }
2499
2500         entry = priv->mcast_fwds;
2501         priv->mcast_fwds = NULL;
2502         while (entry != NULL) {
2503                 next = entry->next;
2504                 if (entry->recv_vcc == vcc) {
2505                         lec_arp_clear_vccs(entry);
2506                         /* No timer, LANEv2 7.1.20 and 2.3.5.3 */
2507                         kfree(entry);
2508                 }
2509                 else {
2510                         entry->next = priv->mcast_fwds;
2511                         priv->mcast_fwds = entry;
2512                 }
2513                 entry = next;
2514         }
2515
2516         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
2517         dump_arp_table(priv);
2518 }
2519
2520 static void
2521 lec_arp_check_empties(struct lec_priv *priv,
2522                       struct atm_vcc *vcc, struct sk_buff *skb)
2523 {
2524         unsigned long flags;
2525         struct lec_arp_table *entry, *prev;
2526         struct lecdatahdr_8023 *hdr = (struct lecdatahdr_8023 *)skb->data;
2527         unsigned char *src;
2528 #ifdef CONFIG_TR
2529         struct lecdatahdr_8025 *tr_hdr = (struct lecdatahdr_8025 *)skb->data;
2530
2531         if (priv->is_trdev) src = tr_hdr->h_source;
2532         else
2533 #endif
2534         src = hdr->h_source;
2535
2536         spin_lock_irqsave(&priv->lec_arp_lock, flags);
2537         entry = priv->lec_arp_empty_ones;
2538         if (vcc == entry->vcc) {
2539                 del_timer(&entry->timer);
2540                 memcpy(entry->mac_addr, src, ETH_ALEN);
2541                 entry->status = ESI_FORWARD_DIRECT;
2542                 entry->last_used = jiffies;
2543                 priv->lec_arp_empty_ones = entry->next;
2544                 /* We might have got an entry */
2545                 if ((prev = lec_arp_find(priv,src))) {
2546                         lec_arp_remove(priv, prev);
2547                         kfree(prev);
2548                 }
2549                 lec_arp_add(priv, entry);
2550                 goto out;
2551         }
2552         prev = entry;
2553         entry = entry->next;
2554         while (entry && entry->vcc != vcc) {
2555                 prev= entry;
2556                 entry = entry->next;
2557         }
2558         if (!entry) {
2559                 DPRINTK("LEC_ARP: Arp_check_empties: entry not found!\n");
2560                 goto out;
2561         }
2562         del_timer(&entry->timer);
2563         memcpy(entry->mac_addr, src, ETH_ALEN);
2564         entry->status = ESI_FORWARD_DIRECT;
2565         entry->last_used = jiffies;
2566         prev->next = entry->next;
2567         if ((prev = lec_arp_find(priv, src))) {
2568                 lec_arp_remove(priv, prev);
2569                 kfree(prev);
2570         }
2571         lec_arp_add(priv, entry);
2572 out:
2573         spin_unlock_irqrestore(&priv->lec_arp_lock, flags);
2574 }
2575 MODULE_LICENSE("GPL");