2005-04-17 06:20:36 +08:00
/*
2007-02-09 22:24:29 +08:00
* lec . c : Lan Emulation driver
2005-04-17 06:20:36 +08:00
*
2006-09-30 08:11:14 +08:00
* Marko Kiiskila < mkiiskila @ yahoo . com >
2005-04-17 06:20:36 +08:00
*/
2010-01-26 19:40:00 +08:00
# define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
2005-04-17 06:20:36 +08:00
# include <linux/kernel.h>
# include <linux/bitops.h>
2006-01-12 04:17:47 +08:00
# include <linux/capability.h>
2005-04-17 06:20:36 +08:00
/* We are ethernet device */
# include <linux/if_ether.h>
# include <linux/netdevice.h>
# include <linux/etherdevice.h>
# include <net/sock.h>
# include <linux/skbuff.h>
# include <linux/ip.h>
# include <asm/byteorder.h>
2010-01-26 19:40:08 +08:00
# include <linux/uaccess.h>
2005-04-17 06:20:36 +08:00
# include <net/arp.h>
# include <net/dst.h>
# include <linux/proc_fs.h>
# include <linux/spinlock.h>
# include <linux/seq_file.h>
/* TokenRing if needed */
# ifdef CONFIG_TR
# include <linux/trdevice.h>
# endif
/* And atm device */
# include <linux/atmdev.h>
# include <linux/atmlec.h>
/* Proxy LEC knows about bridging */
# if defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE)
# include "../bridge/br_private.h"
2006-09-30 08:11:14 +08:00
static unsigned char bridge_ula_lec [ ] = { 0x01 , 0x80 , 0xc2 , 0x00 , 0x00 } ;
2005-04-17 06:20:36 +08:00
# endif
/* Modular too */
# include <linux/module.h>
# include <linux/init.h>
# include "lec.h"
# include "lec_arpc.h"
# include "resources.h"
2006-09-30 08:11:14 +08:00
# define DUMP_PACKETS 0 / *
* 0 = None ,
* 1 = 30 first bytes
* 2 = Whole packet
*/
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
# define LEC_UNRES_QUE_LEN 8 / *
* number of tx packets to queue for a
* single destination while waiting for SVC
*/
2005-04-17 06:20:36 +08:00
static int lec_open ( struct net_device * dev ) ;
2009-09-01 03:50:42 +08:00
static netdev_tx_t lec_start_xmit ( struct sk_buff * skb ,
struct net_device * dev ) ;
2005-04-17 06:20:36 +08:00
static int lec_close ( struct net_device * dev ) ;
2006-09-30 08:11:14 +08:00
static struct lec_arp_table * lec_arp_find ( struct lec_priv * priv ,
2008-06-18 07:20:06 +08:00
const unsigned char * mac_addr ) ;
2005-04-17 06:20:36 +08:00
static int lec_arp_remove ( struct lec_priv * priv ,
2006-09-30 08:11:14 +08:00
struct lec_arp_table * to_remove ) ;
2005-04-17 06:20:36 +08:00
/* LANE2 functions */
2008-06-18 07:20:06 +08:00
static void lane2_associate_ind ( struct net_device * dev , const u8 * mac_address ,
const u8 * tlvs , u32 sizeoftlvs ) ;
static int lane2_resolve ( struct net_device * dev , const u8 * dst_mac , int force ,
2006-09-30 08:11:14 +08:00
u8 * * tlvs , u32 * sizeoftlvs ) ;
2008-06-18 07:20:06 +08:00
static int lane2_associate_req ( struct net_device * dev , const u8 * lan_dst ,
const u8 * tlvs , u32 sizeoftlvs ) ;
2005-04-17 06:20:36 +08:00
2008-06-18 07:20:06 +08:00
static int lec_addr_delete ( struct lec_priv * priv , const unsigned char * atm_addr ,
2005-04-17 06:20:36 +08:00
unsigned long permanent ) ;
static void lec_arp_check_empties ( struct lec_priv * priv ,
struct atm_vcc * vcc , struct sk_buff * skb ) ;
static void lec_arp_destroy ( struct lec_priv * priv ) ;
static void lec_arp_init ( struct lec_priv * priv ) ;
2006-09-30 08:11:14 +08:00
static struct atm_vcc * lec_arp_resolve ( struct lec_priv * priv ,
2008-06-18 07:20:06 +08:00
const unsigned char * mac_to_find ,
2005-04-17 06:20:36 +08:00
int is_rdesc ,
struct lec_arp_table * * ret_entry ) ;
2008-06-18 07:20:06 +08:00
static void lec_arp_update ( struct lec_priv * priv , const unsigned char * mac_addr ,
2010-01-26 19:40:08 +08:00
const unsigned char * atm_addr ,
unsigned long remoteflag ,
2005-04-17 06:20:36 +08:00
unsigned int targetless_le_arp ) ;
static void lec_flush_complete ( struct lec_priv * priv , unsigned long tran_id ) ;
static int lec_mcast_make ( struct lec_priv * priv , struct atm_vcc * vcc ) ;
static void lec_set_flush_tran_id ( struct lec_priv * priv ,
2008-06-18 07:20:06 +08:00
const unsigned char * atm_addr ,
2005-04-17 06:20:36 +08:00
unsigned long tran_id ) ;
2010-01-26 19:40:08 +08:00
static void lec_vcc_added ( struct lec_priv * priv ,
const struct atmlec_ioc * ioc_data ,
2005-04-17 06:20:36 +08:00
struct atm_vcc * vcc ,
2010-01-26 19:40:08 +08:00
void ( * old_push ) ( struct atm_vcc * vcc ,
struct sk_buff * skb ) ) ;
2005-04-17 06:20:36 +08:00
static void lec_vcc_close ( struct lec_priv * priv , struct atm_vcc * vcc ) ;
2006-09-30 08:16:48 +08:00
/* must be done under lec_arp_lock */
static inline void lec_arp_hold ( struct lec_arp_table * entry )
{
atomic_inc ( & entry - > usage ) ;
}
static inline void lec_arp_put ( struct lec_arp_table * entry )
{
if ( atomic_dec_and_test ( & entry - > usage ) )
kfree ( entry ) ;
}
2005-04-17 06:20:36 +08:00
static struct lane2_ops lane2_ops = {
2006-09-30 08:11:14 +08:00
lane2_resolve , /* resolve, spec 3.1.3 */
lane2_associate_req , /* associate_req, spec 3.1.4 */
NULL /* associate indicator, spec 3.1.5 */
2005-04-17 06:20:36 +08:00
} ;
2006-09-30 08:11:14 +08:00
static unsigned char bus_mac [ ETH_ALEN ] = { 0xff , 0xff , 0xff , 0xff , 0xff , 0xff } ;
2005-04-17 06:20:36 +08:00
/* Device structures */
static struct net_device * dev_lec [ MAX_LEC_ITF ] ;
# if defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE)
static void lec_handle_bridge ( struct sk_buff * skb , struct net_device * dev )
{
2006-09-30 08:11:14 +08:00
struct ethhdr * eth ;
char * buff ;
struct lec_priv * priv ;
/*
* Check if this is a BPDU . If so , ask zeppelin to send
* LE_TOPOLOGY_REQUEST with the same value of Topology Change bit
* as the Config BPDU has
*/
eth = ( struct ethhdr * ) skb - > data ;
buff = skb - > data + skb - > dev - > hard_header_len ;
if ( * buff + + = = 0x42 & & * buff + + = = 0x42 & & * buff + + = = 0x03 ) {
2005-04-17 06:20:36 +08:00
struct sock * sk ;
2006-09-30 08:11:14 +08:00
struct sk_buff * skb2 ;
struct atmlec_msg * mesg ;
skb2 = alloc_skb ( sizeof ( struct atmlec_msg ) , GFP_ATOMIC ) ;
if ( skb2 = = NULL )
return ;
skb2 - > len = sizeof ( struct atmlec_msg ) ;
mesg = ( struct atmlec_msg * ) skb2 - > data ;
mesg - > type = l_topology_change ;
buff + = 4 ;
2010-01-26 19:40:08 +08:00
mesg - > content . normal . flag = * buff & 0x01 ;
/* 0x01 is topology change */
2006-09-30 08:11:14 +08:00
2008-11-13 15:39:10 +08:00
priv = netdev_priv ( dev ) ;
2006-09-30 08:11:14 +08:00
atm_force_charge ( priv - > lecd , skb2 - > truesize ) ;
2005-04-17 06:20:36 +08:00
sk = sk_atm ( priv - > lecd ) ;
2006-09-30 08:11:14 +08:00
skb_queue_tail ( & sk - > sk_receive_queue , skb2 ) ;
sk - > sk_data_ready ( sk , skb2 - > len ) ;
}
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
return ;
2005-04-17 06:20:36 +08:00
}
# endif /* defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE) */
/*
* Modelled after tr_type_trans
* All multicast and ARE or STE frames go to BUS .
* Non source routed frames go by destination address .
* Last hop source routed frames go by destination address .
* Not last hop source routed frames go by _next_ route descriptor .
* Returns pointer to destination MAC address or fills in rdesc
* and returns NULL .
*/
# ifdef CONFIG_TR
static unsigned char * get_tr_dst ( unsigned char * packet , unsigned char * rdesc )
{
2006-09-30 08:11:14 +08:00
struct trh_hdr * trh ;
2008-01-15 19:29:50 +08:00
unsigned int riflen , num_rdsc ;
2006-09-30 08:11:14 +08:00
trh = ( struct trh_hdr * ) packet ;
if ( trh - > daddr [ 0 ] & ( uint8_t ) 0x80 )
return bus_mac ; /* multicast */
if ( trh - > saddr [ 0 ] & TR_RII ) {
riflen = ( ntohs ( trh - > rcf ) & TR_RCF_LEN_MASK ) > > 8 ;
if ( ( ntohs ( trh - > rcf ) > > 13 ) ! = 0 )
return bus_mac ; /* ARE or STE */
} else
return trh - > daddr ; /* not source routed */
if ( riflen < 6 )
return trh - > daddr ; /* last hop, source routed */
/* riflen is 6 or more, packet has more than one route descriptor */
num_rdsc = ( riflen / 2 ) - 1 ;
memset ( rdesc , 0 , ETH_ALEN ) ;
/* offset 4 comes from LAN destination field in LE control frames */
if ( trh - > rcf & htons ( ( uint16_t ) TR_RCF_DIR_BIT ) )
2006-11-15 13:11:29 +08:00
memcpy ( & rdesc [ 4 ] , & trh - > rseg [ num_rdsc - 2 ] , sizeof ( __be16 ) ) ;
2006-09-30 08:11:14 +08:00
else {
2006-11-15 13:11:29 +08:00
memcpy ( & rdesc [ 4 ] , & trh - > rseg [ 1 ] , sizeof ( __be16 ) ) ;
2006-09-30 08:11:14 +08:00
rdesc [ 5 ] = ( ( ntohs ( trh - > rseg [ 0 ] ) & 0x000f ) | ( rdesc [ 5 ] & 0xf0 ) ) ;
}
return NULL ;
2005-04-17 06:20:36 +08:00
}
# endif /* CONFIG_TR */
/*
* Open / initialize the netdevice . This is called ( in the current kernel )
* sometime after booting when the ' ifconfig ' program is run .
*
* This routine should set everything up anew at each open , even
* registers that " should " only need to be set once at boot , so that
* there is non - reboot way to recover if something goes wrong .
*/
2006-09-30 08:11:14 +08:00
static int lec_open ( struct net_device * dev )
2005-04-17 06:20:36 +08:00
{
netif_start_queue ( dev ) ;
2009-01-09 21:01:01 +08:00
memset ( & dev - > stats , 0 , sizeof ( struct net_device_stats ) ) ;
2006-09-30 08:11:14 +08:00
return 0 ;
2005-04-17 06:20:36 +08:00
}
2009-01-09 21:01:01 +08:00
static void
lec_send ( struct atm_vcc * vcc , struct sk_buff * skb )
2005-04-17 06:20:36 +08:00
{
2009-01-09 21:01:01 +08:00
struct net_device * dev = skb - > dev ;
2005-04-17 06:20:36 +08:00
ATM_SKB ( skb ) - > vcc = vcc ;
ATM_SKB ( skb ) - > atm_options = vcc - > atm_options ;
atomic_add ( skb - > truesize , & sk_atm ( vcc ) - > sk_wmem_alloc ) ;
if ( vcc - > send ( vcc , skb ) < 0 ) {
2009-01-09 21:01:01 +08:00
dev - > stats . tx_dropped + + ;
2005-04-17 06:20:36 +08:00
return ;
}
2009-01-09 21:01:01 +08:00
dev - > stats . tx_packets + + ;
dev - > stats . tx_bytes + = skb - > len ;
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:14 +08:00
static void lec_tx_timeout ( struct net_device * dev )
2005-04-17 06:20:36 +08:00
{
2010-01-26 19:40:00 +08:00
pr_info ( " %s \n " , dev - > name ) ;
2005-04-17 06:20:36 +08:00
dev - > trans_start = jiffies ;
netif_wake_queue ( dev ) ;
}
2009-09-01 03:50:42 +08:00
static netdev_tx_t lec_start_xmit ( struct sk_buff * skb ,
struct net_device * dev )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:14 +08:00
struct sk_buff * skb2 ;
2008-11-13 15:39:10 +08:00
struct lec_priv * priv = netdev_priv ( dev ) ;
2006-09-30 08:11:14 +08:00
struct lecdatahdr_8023 * lec_h ;
struct atm_vcc * vcc ;
2005-04-17 06:20:36 +08:00
struct lec_arp_table * entry ;
2006-09-30 08:11:14 +08:00
unsigned char * dst ;
2005-04-17 06:20:36 +08:00
int min_frame_size ;
# ifdef CONFIG_TR
2006-09-30 08:11:14 +08:00
unsigned char rdesc [ ETH_ALEN ] ; /* Token Ring route descriptor */
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:14 +08:00
int is_rdesc ;
2010-01-26 19:40:00 +08:00
pr_debug ( " called \n " ) ;
2006-09-30 08:11:14 +08:00
if ( ! priv - > lecd ) {
2010-01-26 19:40:08 +08:00
pr_info ( " %s:No lecd attached \n " , dev - > name ) ;
2009-01-09 21:01:01 +08:00
dev - > stats . tx_errors + + ;
2006-09-30 08:11:14 +08:00
netif_stop_queue ( dev ) ;
2009-06-12 13:34:37 +08:00
kfree_skb ( skb ) ;
return NETDEV_TX_OK ;
2006-09-30 08:11:14 +08:00
}
2007-08-29 06:22:09 +08:00
pr_debug ( " skbuff head:%lx data:%lx tail:%lx end:%lx \n " ,
2010-01-26 19:40:00 +08:00
( long ) skb - > head , ( long ) skb - > data , ( long ) skb_tail_pointer ( skb ) ,
( long ) skb_end_pointer ( skb ) ) ;
2005-04-17 06:20:36 +08:00
# if defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE)
2006-09-30 08:11:14 +08:00
if ( memcmp ( skb - > data , bridge_ula_lec , sizeof ( bridge_ula_lec ) ) = = 0 )
lec_handle_bridge ( skb , dev ) ;
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:14 +08:00
/* Make sure we have room for lec_id */
if ( skb_headroom ( skb ) < 2 ) {
2005-04-17 06:20:36 +08:00
2010-01-26 19:40:00 +08:00
pr_debug ( " reallocating skb \n " ) ;
2006-09-30 08:11:14 +08:00
skb2 = skb_realloc_headroom ( skb , LEC_HEADER_LEN ) ;
kfree_skb ( skb ) ;
if ( skb2 = = NULL )
2009-06-23 14:03:08 +08:00
return NETDEV_TX_OK ;
2006-09-30 08:11:14 +08:00
skb = skb2 ;
}
skb_push ( skb , 2 ) ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
/* Put le header to place, works for TokenRing too */
lec_h = ( struct lecdatahdr_8023 * ) skb - > data ;
lec_h - > le_header = htons ( priv - > lecid ) ;
2005-04-17 06:20:36 +08:00
# ifdef CONFIG_TR
2006-09-30 08:11:14 +08:00
/*
* Ugly . Use this to realign Token Ring packets for
* e . g . PCA - 200 E driver .
*/
if ( priv - > is_trdev ) {
skb2 = skb_realloc_headroom ( skb , LEC_HEADER_LEN ) ;
kfree_skb ( skb ) ;
if ( skb2 = = NULL )
2009-06-23 14:03:08 +08:00
return NETDEV_TX_OK ;
2006-09-30 08:11:14 +08:00
skb = skb2 ;
}
2005-04-17 06:20:36 +08:00
# endif
# if DUMP_PACKETS >= 2
2010-01-26 19:40:08 +08:00
# define MAX_DUMP_SKB 99
2005-04-17 06:20:36 +08:00
# elif DUMP_PACKETS >= 1
2010-01-26 19:40:08 +08:00
# define MAX_DUMP_SKB 30
# endif
# if DUMP_PACKETS >= 1
printk ( KERN_DEBUG " %s: send datalen:%ld lecid:%4.4x \n " ,
dev - > name , skb - > len , priv - > lecid ) ;
print_hex_dump ( KERN_DEBUG , " " , DUMP_OFFSET , 16 , 1 ,
skb - > data , min ( skb - > len , MAX_DUMP_SKB ) , true ) ;
2005-04-17 06:20:36 +08:00
# endif /* DUMP_PACKETS >= 1 */
2006-09-30 08:11:14 +08:00
/* Minimum ethernet-frame size */
2005-04-17 06:20:36 +08:00
# ifdef CONFIG_TR
2006-09-30 08:11:14 +08:00
if ( priv - > is_trdev )
min_frame_size = LEC_MINIMUM_8025_SIZE ;
2005-04-17 06:20:36 +08:00
else
# endif
2006-09-30 08:11:14 +08:00
min_frame_size = LEC_MINIMUM_8023_SIZE ;
if ( skb - > len < min_frame_size ) {
if ( ( skb - > len + skb_tailroom ( skb ) ) < min_frame_size ) {
skb2 = skb_copy_expand ( skb , 0 ,
min_frame_size - skb - > truesize ,
GFP_ATOMIC ) ;
dev_kfree_skb ( skb ) ;
if ( skb2 = = NULL ) {
2009-01-09 21:01:01 +08:00
dev - > stats . tx_dropped + + ;
2009-06-23 14:03:08 +08:00
return NETDEV_TX_OK ;
2006-09-30 08:11:14 +08:00
}
skb = skb2 ;
}
2005-04-17 06:20:36 +08:00
skb_put ( skb , min_frame_size - skb - > len ) ;
2006-09-30 08:11:14 +08:00
}
/* Send to right vcc */
is_rdesc = 0 ;
dst = lec_h - > h_dest ;
2005-04-17 06:20:36 +08:00
# ifdef CONFIG_TR
2006-09-30 08:11:14 +08:00
if ( priv - > is_trdev ) {
dst = get_tr_dst ( skb - > data + 2 , rdesc ) ;
if ( dst = = NULL ) {
dst = rdesc ;
is_rdesc = 1 ;
}
}
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:14 +08:00
entry = NULL ;
vcc = lec_arp_resolve ( priv , dst , is_rdesc , & entry ) ;
2010-01-26 19:40:00 +08:00
pr_debug ( " %s:vcc:%p vcc_flags:%lx, entry:%p \n " ,
dev - > name , vcc , vcc ? vcc - > flags : 0 , entry ) ;
2006-09-30 08:11:14 +08:00
if ( ! vcc | | ! test_bit ( ATM_VF_READY , & vcc - > flags ) ) {
if ( entry & & ( entry - > tx_wait . qlen < LEC_UNRES_QUE_LEN ) ) {
2010-01-26 19:40:00 +08:00
pr_debug ( " %s:queuing packet, MAC address %pM \n " ,
dev - > name , lec_h - > h_dest ) ;
2006-09-30 08:11:14 +08:00
skb_queue_tail ( & entry - > tx_wait , skb ) ;
} else {
2010-01-26 19:40:00 +08:00
pr_debug ( " %s:tx queue full or no arp entry, dropping, MAC address: %pM \n " ,
dev - > name , lec_h - > h_dest ) ;
2009-01-09 21:01:01 +08:00
dev - > stats . tx_dropped + + ;
2006-09-30 08:11:14 +08:00
dev_kfree_skb ( skb ) ;
}
2006-09-30 08:17:17 +08:00
goto out ;
2006-09-30 08:11:14 +08:00
}
# if DUMP_PACKETS > 0
2010-01-26 19:40:08 +08:00
printk ( KERN_DEBUG " %s:sending to vpi:%d vci:%d \n " ,
dev - > name , vcc - > vpi , vcc - > vci ) ;
2005-04-17 06:20:36 +08:00
# endif /* DUMP_PACKETS > 0 */
2006-09-30 08:11:14 +08:00
while ( entry & & ( skb2 = skb_dequeue ( & entry - > tx_wait ) ) ) {
2010-01-26 19:40:00 +08:00
pr_debug ( " emptying tx queue, MAC address %pM \n " , lec_h - > h_dest ) ;
2009-01-09 21:01:01 +08:00
lec_send ( vcc , skb2 ) ;
2006-09-30 08:11:14 +08:00
}
2005-04-17 06:20:36 +08:00
2009-01-09 21:01:01 +08:00
lec_send ( vcc , skb ) ;
2005-04-17 06:20:36 +08:00
if ( ! atm_may_send ( vcc , 0 ) ) {
struct lec_vcc_priv * vpriv = LEC_VCC_PRIV ( vcc ) ;
vpriv - > xoff = 1 ;
netif_stop_queue ( dev ) ;
/*
* vcc - > pop ( ) might have occurred in between , making
* the vcc usuable again . Since xmit is serialized ,
* this is the only situation we have to re - test .
*/
if ( atm_may_send ( vcc , 0 ) )
netif_wake_queue ( dev ) ;
}
2006-09-30 08:17:17 +08:00
out :
if ( entry )
lec_arp_put ( entry ) ;
2005-04-17 06:20:36 +08:00
dev - > trans_start = jiffies ;
2009-06-23 14:03:08 +08:00
return NETDEV_TX_OK ;
2005-04-17 06:20:36 +08:00
}
/* The inverse routine to net_open(). */
2006-09-30 08:11:14 +08:00
static int lec_close ( struct net_device * dev )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:14 +08:00
netif_stop_queue ( dev ) ;
return 0 ;
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:14 +08:00
static int lec_atm_send ( struct atm_vcc * vcc , struct sk_buff * skb )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:11:14 +08:00
struct net_device * dev = ( struct net_device * ) vcc - > proto_data ;
2008-11-13 15:39:10 +08:00
struct lec_priv * priv = netdev_priv ( dev ) ;
2006-09-30 08:11:14 +08:00
struct atmlec_msg * mesg ;
struct lec_arp_table * entry ;
int i ;
char * tmp ; /* FIXME */
2005-04-17 06:20:36 +08:00
atomic_sub ( skb - > truesize , & sk_atm ( vcc ) - > sk_wmem_alloc ) ;
2006-09-30 08:11:14 +08:00
mesg = ( struct atmlec_msg * ) skb - > data ;
tmp = skb - > data ;
tmp + = sizeof ( struct atmlec_msg ) ;
2007-08-29 06:22:09 +08:00
pr_debug ( " %s: msg from zeppelin:%d \n " , dev - > name , mesg - > type ) ;
2006-09-30 08:11:14 +08:00
switch ( mesg - > type ) {
case l_set_mac_addr :
2010-01-26 19:40:08 +08:00
for ( i = 0 ; i < 6 ; i + + )
2006-09-30 08:11:14 +08:00
dev - > dev_addr [ i ] = mesg - > content . normal . mac_addr [ i ] ;
break ;
case l_del_mac_addr :
2010-01-26 19:40:08 +08:00
for ( i = 0 ; i < 6 ; i + + )
2006-09-30 08:11:14 +08:00
dev - > dev_addr [ i ] = 0 ;
break ;
case l_addr_delete :
lec_addr_delete ( priv , mesg - > content . normal . atm_addr ,
mesg - > content . normal . flag ) ;
break ;
case l_topology_change :
priv - > topology_change = mesg - > content . normal . flag ;
break ;
case l_flush_complete :
lec_flush_complete ( priv , mesg - > content . normal . flag ) ;
break ;
case l_narp_req : /* LANE2: see 7.1.35 in the lane2 spec */
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:14 +08:00
entry = lec_arp_find ( priv , mesg - > content . normal . mac_addr ) ;
lec_arp_remove ( priv , entry ) ;
2005-04-17 06:20:36 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:14 +08:00
if ( mesg - > content . normal . no_source_le_narp )
break ;
/* FALL THROUGH */
case l_arp_update :
lec_arp_update ( priv , mesg - > content . normal . mac_addr ,
mesg - > content . normal . atm_addr ,
mesg - > content . normal . flag ,
mesg - > content . normal . targetless_le_arp ) ;
2010-01-26 19:40:00 +08:00
pr_debug ( " in l_arp_update \n " ) ;
2006-09-30 08:11:14 +08:00
if ( mesg - > sizeoftlvs ! = 0 ) { /* LANE2 3.1.5 */
2010-01-26 19:40:00 +08:00
pr_debug ( " LANE2 3.1.5, got tlvs, size %d \n " ,
mesg - > sizeoftlvs ) ;
2006-09-30 08:11:14 +08:00
lane2_associate_ind ( dev , mesg - > content . normal . mac_addr ,
tmp , mesg - > sizeoftlvs ) ;
}
break ;
case l_config :
priv - > maximum_unknown_frame_count =
mesg - > content . config . maximum_unknown_frame_count ;
priv - > max_unknown_frame_time =
( mesg - > content . config . max_unknown_frame_time * HZ ) ;
priv - > max_retry_count = mesg - > content . config . max_retry_count ;
priv - > aging_time = ( mesg - > content . config . aging_time * HZ ) ;
priv - > forward_delay_time =
( mesg - > content . config . forward_delay_time * HZ ) ;
priv - > arp_response_time =
( mesg - > content . config . arp_response_time * HZ ) ;
priv - > flush_timeout = ( mesg - > content . config . flush_timeout * HZ ) ;
priv - > path_switching_delay =
( mesg - > content . config . path_switching_delay * HZ ) ;
2010-01-26 19:40:08 +08:00
priv - > lane_version = mesg - > content . config . lane_version ;
/* LANE2 */
2005-04-17 06:20:36 +08:00
priv - > lane2_ops = NULL ;
if ( priv - > lane_version > 1 )
priv - > lane2_ops = & lane2_ops ;
2009-03-22 04:37:28 +08:00
if ( dev_set_mtu ( dev , mesg - > content . config . mtu ) )
2010-01-26 19:40:08 +08:00
pr_info ( " %s: change_mtu to %d failed \n " ,
dev - > name , mesg - > content . config . mtu ) ;
2005-04-17 06:20:36 +08:00
priv - > is_proxy = mesg - > content . config . is_proxy ;
2006-09-30 08:11:14 +08:00
break ;
case l_flush_tran_id :
lec_set_flush_tran_id ( priv , mesg - > content . normal . atm_addr ,
mesg - > content . normal . flag ) ;
break ;
case l_set_lecid :
priv - > lecid =
( unsigned short ) ( 0xffff & mesg - > content . normal . flag ) ;
break ;
case l_should_bridge :
2005-04-17 06:20:36 +08:00
# if defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE)
2006-09-30 08:11:14 +08:00
{
2008-10-28 06:59:26 +08:00
pr_debug ( " %s: bridge zeppelin asks about %pM \n " ,
dev - > name , mesg - > content . proxy . mac_addr ) ;
2006-09-30 08:11:14 +08:00
2009-06-05 13:35:28 +08:00
if ( br_fdb_test_addr_hook = = NULL )
2006-09-30 08:11:14 +08:00
break ;
2009-06-05 13:35:28 +08:00
if ( br_fdb_test_addr_hook ( dev ,
2010-01-26 19:40:08 +08:00
mesg - > content . proxy . mac_addr ) ) {
2006-09-30 08:11:14 +08:00
/* hit from bridge table, send LE_ARP_RESPONSE */
struct sk_buff * skb2 ;
struct sock * sk ;
2010-01-26 19:40:00 +08:00
pr_debug ( " %s: entry found, responding to zeppelin \n " ,
dev - > name ) ;
2010-01-26 19:40:08 +08:00
skb2 = alloc_skb ( sizeof ( struct atmlec_msg ) ,
GFP_ATOMIC ) ;
2009-06-05 13:35:28 +08:00
if ( skb2 = = NULL )
2006-09-30 08:11:14 +08:00
break ;
skb2 - > len = sizeof ( struct atmlec_msg ) ;
2007-03-31 22:55:19 +08:00
skb_copy_to_linear_data ( skb2 , mesg ,
sizeof ( * mesg ) ) ;
2006-09-30 08:11:14 +08:00
atm_force_charge ( priv - > lecd , skb2 - > truesize ) ;
sk = sk_atm ( priv - > lecd ) ;
skb_queue_tail ( & sk - > sk_receive_queue , skb2 ) ;
sk - > sk_data_ready ( sk , skb2 - > len ) ;
}
}
2005-04-17 06:20:36 +08:00
# endif /* defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE) */
2006-09-30 08:11:14 +08:00
break ;
default :
2010-01-26 19:40:08 +08:00
pr_info ( " %s: Unknown message type %d \n " , dev - > name , mesg - > type ) ;
2006-09-30 08:11:14 +08:00
dev_kfree_skb ( skb ) ;
return - EINVAL ;
}
dev_kfree_skb ( skb ) ;
return 0 ;
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:14 +08:00
static void lec_atm_close ( struct atm_vcc * vcc )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:14 +08:00
struct sk_buff * skb ;
struct net_device * dev = ( struct net_device * ) vcc - > proto_data ;
2008-11-13 15:39:10 +08:00
struct lec_priv * priv = netdev_priv ( dev ) ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
priv - > lecd = NULL ;
/* Do something needful? */
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
netif_stop_queue ( dev ) ;
lec_arp_destroy ( priv ) ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
if ( skb_peek ( & sk_atm ( vcc ) - > sk_receive_queue ) )
2010-01-26 19:40:08 +08:00
pr_info ( " %s closing with messages pending \n " , dev - > name ) ;
2006-09-30 08:11:14 +08:00
while ( ( skb = skb_dequeue ( & sk_atm ( vcc ) - > sk_receive_queue ) ) ! = NULL ) {
atm_return ( vcc , skb - > truesize ) ;
2005-04-17 06:20:36 +08:00
dev_kfree_skb ( skb ) ;
2006-09-30 08:11:14 +08:00
}
2010-01-26 19:40:08 +08:00
pr_info ( " %s: Shut down! \n " , dev - > name ) ;
2006-09-30 08:11:14 +08:00
module_put ( THIS_MODULE ) ;
2005-04-17 06:20:36 +08:00
}
static struct atmdev_ops lecdev_ops = {
2006-09-30 08:11:14 +08:00
. close = lec_atm_close ,
. send = lec_atm_send
2005-04-17 06:20:36 +08:00
} ;
static struct atm_dev lecatm_dev = {
2006-09-30 08:11:14 +08:00
. ops = & lecdev_ops ,
. type = " lec " ,
. number = 999 , /* dummy device number */
2007-04-26 16:37:44 +08:00
. lock = __SPIN_LOCK_UNLOCKED ( lecatm_dev . lock )
2005-04-17 06:20:36 +08:00
} ;
/*
* LANE2 : new argument struct sk_buff * data contains
* the LE_ARP based TLVs introduced in the LANE2 spec
*/
2006-09-30 08:11:14 +08:00
static int
send_to_lecd ( struct lec_priv * priv , atmlec_msg_type type ,
2008-06-18 07:20:06 +08:00
const unsigned char * mac_addr , const unsigned char * atm_addr ,
2006-09-30 08:11:14 +08:00
struct sk_buff * data )
2005-04-17 06:20:36 +08:00
{
struct sock * sk ;
struct sk_buff * skb ;
struct atmlec_msg * mesg ;
2010-01-26 19:40:08 +08:00
if ( ! priv | | ! priv - > lecd )
2005-04-17 06:20:36 +08:00
return - 1 ;
skb = alloc_skb ( sizeof ( struct atmlec_msg ) , GFP_ATOMIC ) ;
if ( ! skb )
return - 1 ;
skb - > len = sizeof ( struct atmlec_msg ) ;
mesg = ( struct atmlec_msg * ) skb - > data ;
2006-09-30 08:11:14 +08:00
memset ( mesg , 0 , sizeof ( struct atmlec_msg ) ) ;
2005-04-17 06:20:36 +08:00
mesg - > type = type ;
2006-09-30 08:11:14 +08:00
if ( data ! = NULL )
mesg - > sizeoftlvs = data - > len ;
2005-04-17 06:20:36 +08:00
if ( mac_addr )
memcpy ( & mesg - > content . normal . mac_addr , mac_addr , ETH_ALEN ) ;
2006-09-30 08:11:14 +08:00
else
mesg - > content . normal . targetless_le_arp = 1 ;
2005-04-17 06:20:36 +08:00
if ( atm_addr )
memcpy ( & mesg - > content . normal . atm_addr , atm_addr , ATM_ESA_LEN ) ;
2006-09-30 08:11:14 +08:00
atm_force_charge ( priv - > lecd , skb - > truesize ) ;
2005-04-17 06:20:36 +08:00
sk = sk_atm ( priv - > lecd ) ;
skb_queue_tail ( & sk - > sk_receive_queue , skb ) ;
2006-09-30 08:11:14 +08:00
sk - > sk_data_ready ( sk , skb - > len ) ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
if ( data ! = NULL ) {
2010-01-26 19:40:00 +08:00
pr_debug ( " about to send %d bytes of data \n " , data - > len ) ;
2006-09-30 08:11:14 +08:00
atm_force_charge ( priv - > lecd , data - > truesize ) ;
skb_queue_tail ( & sk - > sk_receive_queue , data ) ;
sk - > sk_data_ready ( sk , skb - > len ) ;
}
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
return 0 ;
2005-04-17 06:20:36 +08:00
}
/* shamelessly stolen from drivers/net/net_init.c */
static int lec_change_mtu ( struct net_device * dev , int new_mtu )
{
2006-09-30 08:11:14 +08:00
if ( ( new_mtu < 68 ) | | ( new_mtu > 18190 ) )
return - EINVAL ;
dev - > mtu = new_mtu ;
return 0 ;
2005-04-17 06:20:36 +08:00
}
static void lec_set_multicast_list ( struct net_device * dev )
{
2006-09-30 08:11:14 +08:00
/*
* by default , all multicast frames arrive over the bus .
* eventually support selective multicast service
*/
return ;
2005-04-17 06:20:36 +08:00
}
2009-01-09 21:01:02 +08:00
static const struct net_device_ops lec_netdev_ops = {
. ndo_open = lec_open ,
. ndo_stop = lec_close ,
. ndo_start_xmit = lec_start_xmit ,
. ndo_change_mtu = lec_change_mtu ,
. ndo_tx_timeout = lec_tx_timeout ,
. ndo_set_multicast_list = lec_set_multicast_list ,
} ;
2008-06-18 07:20:06 +08:00
static const unsigned char lec_ctrl_magic [ ] = {
2006-09-30 08:11:14 +08:00
0xff ,
0x00 ,
0x01 ,
0x01
} ;
2005-04-17 06:20:36 +08:00
2005-09-30 08:30:54 +08:00
# define LEC_DATA_DIRECT_8023 2
# define LEC_DATA_DIRECT_8025 3
static int lec_is_data_direct ( struct atm_vcc * vcc )
2006-09-30 08:11:14 +08:00
{
2005-09-30 08:30:54 +08:00
return ( ( vcc - > sap . blli [ 0 ] . l3 . tr9577 . snap [ 4 ] = = LEC_DATA_DIRECT_8023 ) | |
( vcc - > sap . blli [ 0 ] . l3 . tr9577 . snap [ 4 ] = = LEC_DATA_DIRECT_8025 ) ) ;
2006-09-30 08:11:14 +08:00
}
2005-09-30 08:30:54 +08:00
2006-09-30 08:11:14 +08:00
static void lec_push ( struct atm_vcc * vcc , struct sk_buff * skb )
2005-04-17 06:20:36 +08:00
{
2005-09-30 08:30:54 +08:00
unsigned long flags ;
2006-09-30 08:11:14 +08:00
struct net_device * dev = ( struct net_device * ) vcc - > proto_data ;
2008-11-13 15:39:10 +08:00
struct lec_priv * priv = netdev_priv ( dev ) ;
2005-04-17 06:20:36 +08:00
2010-01-26 19:40:08 +08:00
# if DUMP_PACKETS > 0
2010-01-26 19:40:00 +08:00
printk ( KERN_DEBUG " %s: vcc vpi:%d vci:%d \n " ,
dev - > name , vcc - > vpi , vcc - > vci ) ;
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:14 +08:00
if ( ! skb ) {
2007-08-29 06:22:09 +08:00
pr_debug ( " %s: null skb \n " , dev - > name ) ;
2006-09-30 08:11:14 +08:00
lec_vcc_close ( priv , vcc ) ;
return ;
}
2005-04-17 06:20:36 +08:00
# if DUMP_PACKETS >= 2
2010-01-26 19:40:00 +08:00
# define MAX_SKB_DUMP 99
2005-04-17 06:20:36 +08:00
# elif DUMP_PACKETS >= 1
2010-01-26 19:40:00 +08:00
# define MAX_SKB_DUMP 30
# endif
# if DUMP_PACKETS > 0
printk ( KERN_DEBUG " %s: rcv datalen:%ld lecid:%4.4x \n " ,
dev - > name , skb - > len , priv - > lecid ) ;
print_hex_dump ( KERN_DEBUG , " " , DUMP_OFFSET , 16 , 1 ,
skb - > data , min ( MAX_SKB_DUMP , skb - > len ) , true ) ;
2005-04-17 06:20:36 +08:00
# endif /* DUMP_PACKETS > 0 */
2010-01-26 19:40:00 +08:00
if ( memcmp ( skb - > data , lec_ctrl_magic , 4 ) = = 0 ) {
/* Control frame, to daemon */
2005-04-17 06:20:36 +08:00
struct sock * sk = sk_atm ( vcc ) ;
2007-08-29 06:22:09 +08:00
pr_debug ( " %s: To daemon \n " , dev - > name ) ;
2006-09-30 08:11:14 +08:00
skb_queue_tail ( & sk - > sk_receive_queue , skb ) ;
sk - > sk_data_ready ( sk , skb - > len ) ;
} else { /* Data frame, queue to protocol handlers */
2005-09-30 08:30:54 +08:00
struct lec_arp_table * entry ;
2006-09-30 08:11:14 +08:00
unsigned char * src , * dst ;
atm_return ( vcc , skb - > truesize ) ;
2006-11-15 13:11:29 +08:00
if ( * ( __be16 * ) skb - > data = = htons ( priv - > lecid ) | |
2006-09-30 08:11:14 +08:00
! priv - > lecd | | ! ( dev - > flags & IFF_UP ) ) {
/*
* Probably looping back , or if lecd is missing ,
* lecd has gone down
*/
2007-08-29 06:22:09 +08:00
pr_debug ( " Ignoring frame... \n " ) ;
2006-09-30 08:11:14 +08:00
dev_kfree_skb ( skb ) ;
return ;
}
2005-04-17 06:20:36 +08:00
# ifdef CONFIG_TR
2006-09-30 08:11:14 +08:00
if ( priv - > is_trdev )
dst = ( ( struct lecdatahdr_8025 * ) skb - > data ) - > h_dest ;
else
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:14 +08:00
dst = ( ( struct lecdatahdr_8023 * ) skb - > data ) - > h_dest ;
2005-09-30 08:30:54 +08:00
2006-09-30 08:11:14 +08:00
/*
* If this is a Data Direct VCC , and the VCC does not match
2005-09-30 08:30:54 +08:00
* the LE_ARP cache entry , delete the LE_ARP cache entry .
*/
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
if ( lec_is_data_direct ( vcc ) ) {
# ifdef CONFIG_TR
if ( priv - > is_trdev )
2006-09-30 08:11:14 +08:00
src =
( ( struct lecdatahdr_8025 * ) skb - > data ) - >
h_source ;
2005-09-30 08:30:54 +08:00
else
# endif
2006-09-30 08:11:14 +08:00
src =
( ( struct lecdatahdr_8023 * ) skb - > data ) - >
h_source ;
2005-09-30 08:30:54 +08:00
entry = lec_arp_find ( priv , src ) ;
if ( entry & & entry - > vcc ! = vcc ) {
lec_arp_remove ( priv , entry ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2005-09-30 08:30:54 +08:00
}
}
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
if ( ! ( dst [ 0 ] & 0x01 ) & & /* Never filter Multi/Broadcast */
! priv - > is_proxy & & /* Proxy wants all the packets */
2005-04-17 06:20:36 +08:00
memcmp ( dst , dev - > dev_addr , dev - > addr_len ) ) {
2006-09-30 08:11:14 +08:00
dev_kfree_skb ( skb ) ;
return ;
}
2010-01-26 19:40:08 +08:00
if ( ! hlist_empty ( & priv - > lec_arp_empty_ones ) )
2006-09-30 08:11:14 +08:00
lec_arp_check_empties ( priv , vcc , skb ) ;
skb_pull ( skb , 2 ) ; /* skip lec_id */
2005-04-17 06:20:36 +08:00
# ifdef CONFIG_TR
2006-09-30 08:11:14 +08:00
if ( priv - > is_trdev )
skb - > protocol = tr_type_trans ( skb , dev ) ;
else
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:14 +08:00
skb - > protocol = eth_type_trans ( skb , dev ) ;
2009-01-09 21:01:01 +08:00
dev - > stats . rx_packets + + ;
dev - > stats . rx_bytes + = skb - > len ;
2006-09-30 08:11:14 +08:00
memset ( ATM_SKB ( skb ) , 0 , sizeof ( struct atm_skb_data ) ) ;
netif_rx ( skb ) ;
}
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:14 +08:00
static void lec_pop ( struct atm_vcc * vcc , struct sk_buff * skb )
2005-04-17 06:20:36 +08:00
{
struct lec_vcc_priv * vpriv = LEC_VCC_PRIV ( vcc ) ;
struct net_device * dev = skb - > dev ;
if ( vpriv = = NULL ) {
2010-01-26 19:40:00 +08:00
pr_info ( " vpriv = NULL!?!?!? \n " ) ;
2005-04-17 06:20:36 +08:00
return ;
}
vpriv - > old_pop ( vcc , skb ) ;
if ( vpriv - > xoff & & atm_may_send ( vcc , 0 ) ) {
vpriv - > xoff = 0 ;
if ( netif_running ( dev ) & & netif_queue_stopped ( dev ) )
netif_wake_queue ( dev ) ;
}
}
2006-09-30 08:11:14 +08:00
static int lec_vcc_attach ( struct atm_vcc * vcc , void __user * arg )
2005-04-17 06:20:36 +08:00
{
struct lec_vcc_priv * vpriv ;
2006-09-30 08:11:14 +08:00
int bytes_left ;
struct atmlec_ioc ioc_data ;
/* Lecd must be up in this case */
bytes_left = copy_from_user ( & ioc_data , arg , sizeof ( struct atmlec_ioc ) ) ;
2010-01-26 19:40:00 +08:00
if ( bytes_left ! = 0 )
pr_info ( " copy from user failed for %d bytes \n " , bytes_left ) ;
2006-09-30 08:11:14 +08:00
if ( ioc_data . dev_num < 0 | | ioc_data . dev_num > = MAX_LEC_ITF | |
! dev_lec [ ioc_data . dev_num ] )
return - EINVAL ;
2010-01-26 19:40:08 +08:00
vpriv = kmalloc ( sizeof ( struct lec_vcc_priv ) , GFP_KERNEL ) ;
if ( ! vpriv )
2005-04-17 06:20:36 +08:00
return - ENOMEM ;
vpriv - > xoff = 0 ;
vpriv - > old_pop = vcc - > pop ;
vcc - > user_back = vpriv ;
vcc - > pop = lec_pop ;
2008-11-13 15:39:10 +08:00
lec_vcc_added ( netdev_priv ( dev_lec [ ioc_data . dev_num ] ) ,
2006-09-30 08:11:14 +08:00
& ioc_data , vcc , vcc - > push ) ;
vcc - > proto_data = dev_lec [ ioc_data . dev_num ] ;
vcc - > push = lec_push ;
return 0 ;
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:14 +08:00
static int lec_mcast_attach ( struct atm_vcc * vcc , int arg )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:14 +08:00
if ( arg < 0 | | arg > = MAX_LEC_ITF | | ! dev_lec [ arg ] )
return - EINVAL ;
vcc - > proto_data = dev_lec [ arg ] ;
2008-11-13 15:39:10 +08:00
return lec_mcast_make ( ( struct lec_priv * ) netdev_priv ( dev_lec [ arg ] ) ,
vcc ) ;
2005-04-17 06:20:36 +08:00
}
/* Initialize device. */
2006-09-30 08:11:14 +08:00
static int lecd_attach ( struct atm_vcc * vcc , int arg )
{
int i ;
struct lec_priv * priv ;
if ( arg < 0 )
i = 0 ;
else
i = arg ;
2005-04-17 06:20:36 +08:00
# ifdef CONFIG_TR
2006-09-30 08:11:14 +08:00
if ( arg > = MAX_LEC_ITF )
return - EINVAL ;
# else /* Reserve the top NUM_TR_DEVS for TR */
if ( arg > = ( MAX_LEC_ITF - NUM_TR_DEVS ) )
return - EINVAL ;
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:14 +08:00
if ( ! dev_lec [ i ] ) {
int is_trdev , size ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
is_trdev = 0 ;
if ( i > = ( MAX_LEC_ITF - NUM_TR_DEVS ) )
is_trdev = 1 ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
size = sizeof ( struct lec_priv ) ;
2005-04-17 06:20:36 +08:00
# ifdef CONFIG_TR
2006-09-30 08:11:14 +08:00
if ( is_trdev )
dev_lec [ i ] = alloc_trdev ( size ) ;
else
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:14 +08:00
dev_lec [ i ] = alloc_etherdev ( size ) ;
if ( ! dev_lec [ i ] )
return - ENOMEM ;
2009-12-04 13:19:30 +08:00
dev_lec [ i ] - > netdev_ops = & lec_netdev_ops ;
2006-09-30 08:11:14 +08:00
snprintf ( dev_lec [ i ] - > name , IFNAMSIZ , " lec%d " , i ) ;
if ( register_netdev ( dev_lec [ i ] ) ) {
free_netdev ( dev_lec [ i ] ) ;
return - EINVAL ;
}
2008-11-13 15:39:10 +08:00
priv = netdev_priv ( dev_lec [ i ] ) ;
2006-09-30 08:11:14 +08:00
priv - > is_trdev = is_trdev ;
} else {
2008-11-13 15:39:10 +08:00
priv = netdev_priv ( dev_lec [ i ] ) ;
2006-09-30 08:11:14 +08:00
if ( priv - > lecd )
return - EADDRINUSE ;
}
lec_arp_init ( priv ) ;
priv - > itfnum = i ; /* LANE2 addition */
priv - > lecd = vcc ;
vcc - > dev = & lecatm_dev ;
vcc_insert_socket ( sk_atm ( vcc ) ) ;
vcc - > proto_data = dev_lec [ i ] ;
set_bit ( ATM_VF_META , & vcc - > flags ) ;
set_bit ( ATM_VF_READY , & vcc - > flags ) ;
/* Set default values to these variables */
priv - > maximum_unknown_frame_count = 1 ;
priv - > max_unknown_frame_time = ( 1 * HZ ) ;
priv - > vcc_timeout_period = ( 1200 * HZ ) ;
priv - > max_retry_count = 1 ;
priv - > aging_time = ( 300 * HZ ) ;
priv - > forward_delay_time = ( 15 * HZ ) ;
priv - > topology_change = 0 ;
priv - > arp_response_time = ( 1 * HZ ) ;
priv - > flush_timeout = ( 4 * HZ ) ;
priv - > path_switching_delay = ( 6 * HZ ) ;
2010-01-26 19:40:08 +08:00
if ( dev_lec [ i ] - > flags & IFF_UP )
2006-09-30 08:11:14 +08:00
netif_start_queue ( dev_lec [ i ] ) ;
__module_get ( THIS_MODULE ) ;
return i ;
2005-04-17 06:20:36 +08:00
}
# ifdef CONFIG_PROC_FS
2009-08-06 01:42:58 +08:00
static const char * lec_arp_get_status_string ( unsigned char status )
2005-04-17 06:20:36 +08:00
{
2009-08-06 01:42:58 +08:00
static const char * const lec_arp_status_string [ ] = {
2005-04-17 06:20:36 +08:00
" ESI_UNKNOWN " ,
" ESI_ARP_PENDING " ,
" ESI_VC_PENDING " ,
" <Undefined> " ,
" ESI_FLUSH_PENDING " ,
" ESI_FORWARD_DIRECT "
} ;
if ( status > ESI_FORWARD_DIRECT )
status = 3 ; /* ESI_UNDEFINED */
return lec_arp_status_string [ status ] ;
}
static void lec_info ( struct seq_file * seq , struct lec_arp_table * entry )
{
int i ;
for ( i = 0 ; i < ETH_ALEN ; i + + )
seq_printf ( seq , " %2.2x " , entry - > mac_addr [ i ] & 0xff ) ;
seq_printf ( seq , " " ) ;
for ( i = 0 ; i < ATM_ESA_LEN ; i + + )
seq_printf ( seq , " %2.2x " , entry - > atm_addr [ i ] & 0xff ) ;
seq_printf ( seq , " %s %4.4x " , lec_arp_get_status_string ( entry - > status ) ,
entry - > flags & 0xffff ) ;
if ( entry - > vcc )
seq_printf ( seq , " %3d %3d " , entry - > vcc - > vpi , entry - > vcc - > vci ) ;
else
2006-09-30 08:11:14 +08:00
seq_printf ( seq , " " ) ;
2005-04-17 06:20:36 +08:00
if ( entry - > recv_vcc ) {
seq_printf ( seq , " %3d %3d " , entry - > recv_vcc - > vpi ,
entry - > recv_vcc - > vci ) ;
2006-09-30 08:11:14 +08:00
}
seq_putc ( seq , ' \n ' ) ;
2005-04-17 06:20:36 +08:00
}
struct lec_state {
unsigned long flags ;
struct lec_priv * locked ;
2006-09-30 08:14:27 +08:00
struct hlist_node * node ;
2005-04-17 06:20:36 +08:00
struct net_device * dev ;
int itf ;
int arp_table ;
int misc_table ;
} ;
2006-09-30 08:14:27 +08:00
static void * lec_tbl_walk ( struct lec_state * state , struct hlist_head * tbl ,
2005-04-17 06:20:36 +08:00
loff_t * l )
{
2006-09-30 08:14:27 +08:00
struct hlist_node * e = state - > node ;
struct lec_arp_table * tmp ;
2005-04-17 06:20:36 +08:00
if ( ! e )
2006-09-30 08:14:27 +08:00
e = tbl - > first ;
2008-04-10 18:33:03 +08:00
if ( e = = SEQ_START_TOKEN ) {
2006-09-30 08:14:27 +08:00
e = tbl - > first ;
2005-04-17 06:20:36 +08:00
- - * l ;
}
2006-09-30 08:14:27 +08:00
hlist_for_each_entry_from ( tmp , e , next ) {
2005-04-17 06:20:36 +08:00
if ( - - * l < 0 )
break ;
}
2006-09-30 08:14:27 +08:00
state - > node = e ;
2005-04-17 06:20:36 +08:00
return ( * l < 0 ) ? state : NULL ;
}
static void * lec_arp_walk ( struct lec_state * state , loff_t * l ,
2006-09-30 08:11:14 +08:00
struct lec_priv * priv )
2005-04-17 06:20:36 +08:00
{
void * v = NULL ;
int p ;
for ( p = state - > arp_table ; p < LEC_ARP_TABLE_SIZE ; p + + ) {
2006-09-30 08:14:27 +08:00
v = lec_tbl_walk ( state , & priv - > lec_arp_tables [ p ] , l ) ;
2005-04-17 06:20:36 +08:00
if ( v )
break ;
}
state - > arp_table = p ;
return v ;
}
static void * lec_misc_walk ( struct lec_state * state , loff_t * l ,
struct lec_priv * priv )
{
2006-09-30 08:14:27 +08:00
struct hlist_head * lec_misc_tables [ ] = {
& priv - > lec_arp_empty_ones ,
& priv - > lec_no_forward ,
& priv - > mcast_fwds
2005-04-17 06:20:36 +08:00
} ;
void * v = NULL ;
int q ;
for ( q = state - > misc_table ; q < ARRAY_SIZE ( lec_misc_tables ) ; q + + ) {
v = lec_tbl_walk ( state , lec_misc_tables [ q ] , l ) ;
if ( v )
break ;
}
state - > misc_table = q ;
return v ;
}
static void * lec_priv_walk ( struct lec_state * state , loff_t * l ,
struct lec_priv * priv )
{
if ( ! state - > locked ) {
state - > locked = priv ;
spin_lock_irqsave ( & priv - > lec_arp_lock , state - > flags ) ;
}
2006-09-30 08:11:14 +08:00
if ( ! lec_arp_walk ( state , l , priv ) & & ! lec_misc_walk ( state , l , priv ) ) {
2005-04-17 06:20:36 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock , state - > flags ) ;
state - > locked = NULL ;
/* Partial state reset for the next time we get called */
state - > arp_table = state - > misc_table = 0 ;
}
return state - > locked ;
}
static void * lec_itf_walk ( struct lec_state * state , loff_t * l )
{
struct net_device * dev ;
void * v ;
dev = state - > dev ? state - > dev : dev_lec [ state - > itf ] ;
2008-11-13 15:39:10 +08:00
v = ( dev & & netdev_priv ( dev ) ) ?
lec_priv_walk ( state , l , netdev_priv ( dev ) ) : NULL ;
2005-04-17 06:20:36 +08:00
if ( ! v & & dev ) {
dev_put ( dev ) ;
/* Partial state reset for the next time we get called */
dev = NULL ;
}
state - > dev = dev ;
return v ;
}
static void * lec_get_idx ( struct lec_state * state , loff_t l )
{
void * v = NULL ;
for ( ; state - > itf < MAX_LEC_ITF ; state - > itf + + ) {
v = lec_itf_walk ( state , & l ) ;
if ( v )
break ;
}
2006-09-30 08:11:14 +08:00
return v ;
2005-04-17 06:20:36 +08:00
}
static void * lec_seq_start ( struct seq_file * seq , loff_t * pos )
{
struct lec_state * state = seq - > private ;
state - > itf = 0 ;
state - > dev = NULL ;
state - > locked = NULL ;
state - > arp_table = 0 ;
state - > misc_table = 0 ;
2008-04-10 18:33:03 +08:00
state - > node = SEQ_START_TOKEN ;
2005-04-17 06:20:36 +08:00
2008-04-10 18:33:03 +08:00
return * pos ? lec_get_idx ( state , * pos ) : SEQ_START_TOKEN ;
2005-04-17 06:20:36 +08:00
}
static void lec_seq_stop ( struct seq_file * seq , void * v )
{
struct lec_state * state = seq - > private ;
if ( state - > dev ) {
spin_unlock_irqrestore ( & state - > locked - > lec_arp_lock ,
state - > flags ) ;
dev_put ( state - > dev ) ;
}
}
static void * lec_seq_next ( struct seq_file * seq , void * v , loff_t * pos )
{
struct lec_state * state = seq - > private ;
v = lec_get_idx ( state , 1 ) ;
* pos + = ! ! PTR_ERR ( v ) ;
return v ;
}
static int lec_seq_show ( struct seq_file * seq , void * v )
{
2009-08-06 01:42:58 +08:00
static const char lec_banner [ ] =
" Itf MAC ATM destination "
2006-09-30 08:11:14 +08:00
" Status Flags "
" VPI/VCI Recv VPI/VCI \n " ;
2005-04-17 06:20:36 +08:00
2008-04-10 18:33:03 +08:00
if ( v = = SEQ_START_TOKEN )
2005-04-17 06:20:36 +08:00
seq_puts ( seq , lec_banner ) ;
else {
struct lec_state * state = seq - > private ;
2006-09-30 08:11:14 +08:00
struct net_device * dev = state - > dev ;
2010-01-26 19:40:08 +08:00
struct lec_arp_table * entry = hlist_entry ( state - > node ,
struct lec_arp_table ,
next ) ;
2005-04-17 06:20:36 +08:00
seq_printf ( seq , " %s " , dev - > name ) ;
2006-09-30 08:14:27 +08:00
lec_info ( seq , entry ) ;
2005-04-17 06:20:36 +08:00
}
return 0 ;
}
2007-07-11 14:07:31 +08:00
static const struct seq_operations lec_seq_ops = {
2006-09-30 08:11:14 +08:00
. start = lec_seq_start ,
. next = lec_seq_next ,
. stop = lec_seq_stop ,
. show = lec_seq_show ,
2005-04-17 06:20:36 +08:00
} ;
static int lec_seq_open ( struct inode * inode , struct file * file )
{
2008-03-01 03:37:02 +08:00
return seq_open_private ( file , & lec_seq_ops , sizeof ( struct lec_state ) ) ;
2005-04-17 06:20:36 +08:00
}
2007-02-12 16:55:35 +08:00
static const struct file_operations lec_seq_fops = {
2006-09-30 08:11:14 +08:00
. owner = THIS_MODULE ,
. open = lec_seq_open ,
. read = seq_read ,
. llseek = seq_lseek ,
2008-03-01 03:37:02 +08:00
. release = seq_release_private ,
2005-04-17 06:20:36 +08:00
} ;
# endif
static int lane_ioctl ( struct socket * sock , unsigned int cmd , unsigned long arg )
{
struct atm_vcc * vcc = ATM_SD ( sock ) ;
int err = 0 ;
2006-09-30 08:11:14 +08:00
2005-04-17 06:20:36 +08:00
switch ( cmd ) {
2006-09-30 08:11:14 +08:00
case ATMLEC_CTRL :
case ATMLEC_MCAST :
case ATMLEC_DATA :
if ( ! capable ( CAP_NET_ADMIN ) )
return - EPERM ;
break ;
default :
return - ENOIOCTLCMD ;
2005-04-17 06:20:36 +08:00
}
switch ( cmd ) {
2006-09-30 08:11:14 +08:00
case ATMLEC_CTRL :
err = lecd_attach ( vcc , ( int ) arg ) ;
if ( err > = 0 )
sock - > state = SS_CONNECTED ;
break ;
case ATMLEC_MCAST :
err = lec_mcast_attach ( vcc , ( int ) arg ) ;
break ;
case ATMLEC_DATA :
err = lec_vcc_attach ( vcc , ( void __user * ) arg ) ;
break ;
2005-04-17 06:20:36 +08:00
}
return err ;
}
static struct atm_ioctl lane_ioctl_ops = {
2006-09-30 08:11:14 +08:00
. owner = THIS_MODULE ,
. ioctl = lane_ioctl ,
2005-04-17 06:20:36 +08:00
} ;
static int __init lane_module_init ( void )
{
# ifdef CONFIG_PROC_FS
struct proc_dir_entry * p ;
2008-02-29 05:55:45 +08:00
p = proc_create ( " lec " , S_IRUGO , atm_proc_root , & lec_seq_fops ) ;
2008-03-24 12:45:36 +08:00
if ( ! p ) {
2010-01-26 19:40:00 +08:00
pr_err ( " Unable to initialize /proc/net/atm/lec \n " ) ;
2008-03-24 12:45:36 +08:00
return - ENOMEM ;
}
2005-04-17 06:20:36 +08:00
# endif
register_atm_ioctl ( & lane_ioctl_ops ) ;
2010-01-26 19:40:08 +08:00
pr_info ( " lec.c: " __DATE__ " " __TIME__ " initialized \n " ) ;
2006-09-30 08:11:14 +08:00
return 0 ;
2005-04-17 06:20:36 +08:00
}
static void __exit lane_module_cleanup ( void )
{
2006-09-30 08:11:14 +08:00
int i ;
struct lec_priv * priv ;
2005-04-17 06:20:36 +08:00
remove_proc_entry ( " lec " , atm_proc_root ) ;
deregister_atm_ioctl ( & lane_ioctl_ops ) ;
2006-09-30 08:11:14 +08:00
for ( i = 0 ; i < MAX_LEC_ITF ; i + + ) {
if ( dev_lec [ i ] ! = NULL ) {
2008-11-13 15:39:10 +08:00
priv = netdev_priv ( dev_lec [ i ] ) ;
2005-04-17 06:20:36 +08:00
unregister_netdev ( dev_lec [ i ] ) ;
2006-09-30 08:11:14 +08:00
free_netdev ( dev_lec [ i ] ) ;
dev_lec [ i ] = NULL ;
}
}
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
return ;
2005-04-17 06:20:36 +08:00
}
module_init ( lane_module_init ) ;
module_exit ( lane_module_cleanup ) ;
/*
* LANE2 : 3.1 .3 , LE_RESOLVE . request
* Non force allocates memory and fills in * tlvs , fills in * sizeoftlvs .
* If sizeoftlvs = = NULL the default TLVs associated with with this
* lec will be used .
* If dst_mac = = NULL , targetless LE_ARP will be sent
*/
2008-06-18 07:20:06 +08:00
static int lane2_resolve ( struct net_device * dev , const u8 * dst_mac , int force ,
2006-09-30 08:11:14 +08:00
u8 * * tlvs , u32 * sizeoftlvs )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2008-11-13 15:39:10 +08:00
struct lec_priv * priv = netdev_priv ( dev ) ;
2006-09-30 08:11:14 +08:00
struct lec_arp_table * table ;
struct sk_buff * skb ;
int retval ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
if ( force = = 0 ) {
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:14 +08:00
table = lec_arp_find ( priv , dst_mac ) ;
2005-04-17 06:20:36 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:14 +08:00
if ( table = = NULL )
return - 1 ;
2006-11-21 11:14:33 +08:00
* tlvs = kmemdup ( table - > tlvs , table - > sizeoftlvs , GFP_ATOMIC ) ;
2006-09-30 08:11:14 +08:00
if ( * tlvs = = NULL )
return - 1 ;
* sizeoftlvs = table - > sizeoftlvs ;
return 0 ;
}
2005-04-17 06:20:36 +08:00
if ( sizeoftlvs = = NULL )
retval = send_to_lecd ( priv , l_arp_xmt , dst_mac , NULL , NULL ) ;
2006-09-30 08:11:14 +08:00
2005-04-17 06:20:36 +08:00
else {
skb = alloc_skb ( * sizeoftlvs , GFP_ATOMIC ) ;
if ( skb = = NULL )
return - 1 ;
skb - > len = * sizeoftlvs ;
2007-03-31 22:55:19 +08:00
skb_copy_to_linear_data ( skb , * tlvs , * sizeoftlvs ) ;
2005-04-17 06:20:36 +08:00
retval = send_to_lecd ( priv , l_arp_xmt , dst_mac , NULL , skb ) ;
}
2006-09-30 08:11:14 +08:00
return retval ;
}
2005-04-17 06:20:36 +08:00
/*
* LANE2 : 3.1 .4 , LE_ASSOCIATE . request
* Associate the * tlvs with the * lan_dst address .
* Will overwrite any previous association
* Returns 1 for success , 0 for failure ( out of memory )
*
*/
2008-06-18 07:20:06 +08:00
static int lane2_associate_req ( struct net_device * dev , const u8 * lan_dst ,
const u8 * tlvs , u32 sizeoftlvs )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:14 +08:00
int retval ;
struct sk_buff * skb ;
2008-11-13 15:39:10 +08:00
struct lec_priv * priv = netdev_priv ( dev ) ;
2006-09-30 08:11:14 +08:00
if ( compare_ether_addr ( lan_dst , dev - > dev_addr ) )
2010-01-26 19:40:08 +08:00
return 0 ; /* not our mac address */
2006-09-30 08:11:14 +08:00
kfree ( priv - > tlvs ) ; /* NULL if there was no previous association */
2006-11-21 11:14:33 +08:00
priv - > tlvs = kmemdup ( tlvs , sizeoftlvs , GFP_KERNEL ) ;
2006-09-30 08:11:14 +08:00
if ( priv - > tlvs = = NULL )
2010-01-26 19:40:08 +08:00
return 0 ;
2006-09-30 08:11:14 +08:00
priv - > sizeoftlvs = sizeoftlvs ;
skb = alloc_skb ( sizeoftlvs , GFP_ATOMIC ) ;
if ( skb = = NULL )
return 0 ;
skb - > len = sizeoftlvs ;
2007-03-31 22:55:19 +08:00
skb_copy_to_linear_data ( skb , tlvs , sizeoftlvs ) ;
2006-09-30 08:11:14 +08:00
retval = send_to_lecd ( priv , l_associate_req , NULL , NULL , skb ) ;
if ( retval ! = 0 )
2010-01-26 19:40:08 +08:00
pr_info ( " lec.c: lane2_associate_req() failed \n " ) ;
2006-09-30 08:11:14 +08:00
/*
* If the previous association has changed we must
* somehow notify other LANE entities about the change
*/
2010-01-26 19:40:08 +08:00
return 1 ;
2005-04-17 06:20:36 +08:00
}
/*
* LANE2 : 3.1 .5 , LE_ASSOCIATE . indication
*
*/
2008-06-18 07:20:06 +08:00
static void lane2_associate_ind ( struct net_device * dev , const u8 * mac_addr ,
const u8 * tlvs , u32 sizeoftlvs )
2005-04-17 06:20:36 +08:00
{
#if 0
2006-09-30 08:11:14 +08:00
int i = 0 ;
2005-04-17 06:20:36 +08:00
# endif
2008-11-13 15:39:10 +08:00
struct lec_priv * priv = netdev_priv ( dev ) ;
2006-09-30 08:11:14 +08:00
#if 0 /*
* Why have the TLVs in LE_ARP entries
* since we do not use them ? When you
* uncomment this code , make sure the
* TLVs get freed when entry is killed
*/
struct lec_arp_table * entry = lec_arp_find ( priv , mac_addr ) ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
if ( entry = = NULL )
return ; /* should not happen */
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:14 +08:00
kfree ( entry - > tlvs ) ;
2005-04-17 06:20:36 +08:00
2006-11-21 11:14:33 +08:00
entry - > tlvs = kmemdup ( tlvs , sizeoftlvs , GFP_KERNEL ) ;
2006-09-30 08:11:14 +08:00
if ( entry - > tlvs = = NULL )
return ;
entry - > sizeoftlvs = sizeoftlvs ;
2005-04-17 06:20:36 +08:00
# endif
#if 0
2010-01-26 19:40:08 +08:00
pr_info ( " \n " ) ;
pr_info ( " dump of tlvs, sizeoftlvs=%d \n " , sizeoftlvs ) ;
2006-09-30 08:11:14 +08:00
while ( i < sizeoftlvs )
2010-01-26 19:40:08 +08:00
pr_cont ( " %02x " , tlvs [ i + + ] ) ;
2006-09-30 08:11:14 +08:00
2010-01-26 19:40:08 +08:00
pr_cont ( " \n " ) ;
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:14 +08:00
/* tell MPOA about the TLVs we saw */
if ( priv - > lane2_ops & & priv - > lane2_ops - > associate_indicator ) {
priv - > lane2_ops - > associate_indicator ( dev , mac_addr ,
tlvs , sizeoftlvs ) ;
}
return ;
2005-04-17 06:20:36 +08:00
}
/*
* Here starts what used to lec_arpc . c
*
* lec_arpc . c was added here when making
* lane client modular . October 1997
*/
# include <linux/types.h>
# include <linux/timer.h>
2010-01-26 19:40:08 +08:00
# include <linux/param.h>
2005-04-17 06:20:36 +08:00
# include <asm/atomic.h>
# include <linux/inetdevice.h>
# include <net/route.h>
#if 0
2010-01-26 19:40:08 +08:00
# define pr_debug(format, args...)
2005-04-17 06:20:36 +08:00
/*
2010-01-26 19:40:00 +08:00
# define pr_debug printk
2005-04-17 06:20:36 +08:00
*/
# endif
# define DEBUG_ARP_TABLE 0
# define LEC_ARP_REFRESH_INTERVAL (3*HZ)
2006-11-22 22:57:56 +08:00
static void lec_arp_check_expire ( struct work_struct * work ) ;
2005-04-17 06:20:36 +08:00
static void lec_arp_expire_arp ( unsigned long data ) ;
2007-02-09 22:24:29 +08:00
/*
2005-04-17 06:20:36 +08:00
* Arp table funcs
*/
2010-01-26 19:40:08 +08:00
# define HASH(ch) (ch & (LEC_ARP_TABLE_SIZE - 1))
2005-04-17 06:20:36 +08:00
/*
* Initialization of arp - cache
*/
2006-09-30 08:11:47 +08:00
static void lec_arp_init ( struct lec_priv * priv )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:47 +08:00
unsigned short i ;
2005-04-17 06:20:36 +08:00
2010-01-26 19:40:08 +08:00
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + )
2006-09-30 08:14:27 +08:00
INIT_HLIST_HEAD ( & priv - > lec_arp_tables [ i ] ) ;
2007-02-09 22:24:29 +08:00
INIT_HLIST_HEAD ( & priv - > lec_arp_empty_ones ) ;
INIT_HLIST_HEAD ( & priv - > lec_no_forward ) ;
INIT_HLIST_HEAD ( & priv - > mcast_fwds ) ;
2005-04-17 06:20:36 +08:00
spin_lock_init ( & priv - > lec_arp_lock ) ;
2006-11-22 22:57:56 +08:00
INIT_DELAYED_WORK ( & priv - > lec_arp_work , lec_arp_check_expire ) ;
2006-09-30 08:15:59 +08:00
schedule_delayed_work ( & priv - > lec_arp_work , LEC_ARP_REFRESH_INTERVAL ) ;
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:47 +08:00
static void lec_arp_clear_vccs ( struct lec_arp_table * entry )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:47 +08:00
if ( entry - > vcc ) {
2005-04-17 06:20:36 +08:00
struct atm_vcc * vcc = entry - > vcc ;
struct lec_vcc_priv * vpriv = LEC_VCC_PRIV ( vcc ) ;
2006-09-30 08:11:47 +08:00
struct net_device * dev = ( struct net_device * ) vcc - > proto_data ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:47 +08:00
vcc - > pop = vpriv - > old_pop ;
2005-04-17 06:20:36 +08:00
if ( vpriv - > xoff )
netif_wake_queue ( dev ) ;
kfree ( vpriv ) ;
vcc - > user_back = NULL ;
2006-09-30 08:11:47 +08:00
vcc - > push = entry - > old_push ;
2005-04-17 06:20:36 +08:00
vcc_release_async ( vcc , - EPIPE ) ;
2006-09-30 08:14:27 +08:00
entry - > vcc = NULL ;
2006-09-30 08:11:47 +08:00
}
if ( entry - > recv_vcc ) {
entry - > recv_vcc - > push = entry - > old_recv_push ;
2005-04-17 06:20:36 +08:00
vcc_release_async ( entry - > recv_vcc , - EPIPE ) ;
2006-09-30 08:11:47 +08:00
entry - > recv_vcc = NULL ;
}
2005-04-17 06:20:36 +08:00
}
/*
* Insert entry to lec_arp_table
* LANE2 : Add to the end of the list to satisfy 8.1 .13
*/
2006-09-30 08:11:47 +08:00
static inline void
2006-09-30 08:14:27 +08:00
lec_arp_add ( struct lec_priv * priv , struct lec_arp_table * entry )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:14:27 +08:00
struct hlist_head * tmp ;
2006-09-30 08:11:47 +08:00
2006-09-30 08:14:27 +08:00
tmp = & priv - > lec_arp_tables [ HASH ( entry - > mac_addr [ ETH_ALEN - 1 ] ) ] ;
hlist_add_head ( & entry - > next , tmp ) ;
2006-09-30 08:11:47 +08:00
2010-01-26 19:40:00 +08:00
pr_debug ( " Added entry:%pM \n " , entry - > mac_addr ) ;
2005-04-17 06:20:36 +08:00
}
/*
* Remove entry from lec_arp_table
*/
2006-09-30 08:11:47 +08:00
static int
lec_arp_remove ( struct lec_priv * priv , struct lec_arp_table * to_remove )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:14:27 +08:00
struct hlist_node * node ;
struct lec_arp_table * entry ;
int i , remove_vcc = 1 ;
2006-09-30 08:11:47 +08:00
2010-01-26 19:40:08 +08:00
if ( ! to_remove )
2006-09-30 08:11:47 +08:00
return - 1 ;
2006-09-30 08:14:27 +08:00
hlist_del ( & to_remove - > next ) ;
2006-09-30 08:11:47 +08:00
del_timer ( & to_remove - > timer ) ;
2010-01-26 19:40:08 +08:00
/*
* If this is the only MAC connected to this VCC ,
* also tear down the VCC
*/
2006-09-30 08:11:47 +08:00
if ( to_remove - > status > = ESI_FLUSH_PENDING ) {
/*
* ESI_FLUSH_PENDING , ESI_FORWARD_DIRECT
*/
2006-09-30 08:14:27 +08:00
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + ) {
2010-01-26 19:40:08 +08:00
hlist_for_each_entry ( entry , node ,
& priv - > lec_arp_tables [ i ] , next ) {
2006-09-30 08:14:27 +08:00
if ( memcmp ( to_remove - > atm_addr ,
entry - > atm_addr , ATM_ESA_LEN ) = = 0 ) {
2006-09-30 08:11:47 +08:00
remove_vcc = 0 ;
break ;
}
}
}
if ( remove_vcc )
lec_arp_clear_vccs ( to_remove ) ;
}
skb_queue_purge ( & to_remove - > tx_wait ) ; /* FIXME: good place for this? */
2010-01-26 19:40:00 +08:00
pr_debug ( " Removed entry:%pM \n " , to_remove - > mac_addr ) ;
2006-09-30 08:11:47 +08:00
return 0 ;
2005-04-17 06:20:36 +08:00
}
# if DEBUG_ARP_TABLE
2009-08-06 01:42:58 +08:00
static const char * get_status_string ( unsigned char st )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:47 +08:00
switch ( st ) {
case ESI_UNKNOWN :
return " ESI_UNKNOWN " ;
case ESI_ARP_PENDING :
return " ESI_ARP_PENDING " ;
case ESI_VC_PENDING :
return " ESI_VC_PENDING " ;
case ESI_FLUSH_PENDING :
return " ESI_FLUSH_PENDING " ;
case ESI_FORWARD_DIRECT :
return " ESI_FORWARD_DIRECT " ;
}
2010-01-26 19:40:08 +08:00
return " <UNKNOWN> " ;
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:47 +08:00
static void dump_arp_table ( struct lec_priv * priv )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:14:27 +08:00
struct hlist_node * node ;
2006-09-30 08:11:47 +08:00
struct lec_arp_table * rulla ;
2006-09-30 08:14:27 +08:00
char buf [ 256 ] ;
int i , j , offset ;
2006-09-30 08:11:47 +08:00
2010-01-26 19:40:08 +08:00
pr_info ( " Dump %p: \n " , priv ) ;
2006-09-30 08:11:47 +08:00
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + ) {
2010-01-26 19:40:08 +08:00
hlist_for_each_entry ( rulla , node ,
& priv - > lec_arp_tables [ i ] , next ) {
2006-09-30 08:14:27 +08:00
offset = 0 ;
offset + = sprintf ( buf , " %d: %p \n " , i , rulla ) ;
2010-01-26 19:40:08 +08:00
offset + = sprintf ( buf + offset , " Mac: %pM " ,
rulla - > mac_addr ) ;
offset + = sprintf ( buf + offset , " Atm: " ) ;
2006-09-30 08:11:47 +08:00
for ( j = 0 ; j < ATM_ESA_LEN ; j + + ) {
offset + = sprintf ( buf + offset ,
" %2.2x " ,
rulla - > atm_addr [ j ] & 0xff ) ;
}
offset + = sprintf ( buf + offset ,
" Vcc vpi:%d vci:%d, Recv_vcc vpi:%d vci:%d Last_used:%lx, Timestamp:%lx, No_tries:%d " ,
rulla - > vcc ? rulla - > vcc - > vpi : 0 ,
rulla - > vcc ? rulla - > vcc - > vci : 0 ,
rulla - > recv_vcc ? rulla - > recv_vcc - >
vpi : 0 ,
rulla - > recv_vcc ? rulla - > recv_vcc - >
vci : 0 , rulla - > last_used ,
rulla - > timestamp , rulla - > no_tries ) ;
offset + =
sprintf ( buf + offset ,
" Flags:%x, Packets_flooded:%x, Status: %s " ,
rulla - > flags , rulla - > packets_flooded ,
get_status_string ( rulla - > status ) ) ;
2010-01-26 19:40:08 +08:00
pr_info ( " %s \n " , buf ) ;
2006-09-30 08:11:47 +08:00
}
}
2006-09-30 08:14:27 +08:00
if ( ! hlist_empty ( & priv - > lec_no_forward ) )
2010-01-26 19:40:08 +08:00
pr_info ( " No forward \n " ) ;
2006-09-30 08:14:27 +08:00
hlist_for_each_entry ( rulla , node , & priv - > lec_no_forward , next ) {
2006-09-30 08:11:47 +08:00
offset = 0 ;
2010-01-26 19:40:08 +08:00
offset + = sprintf ( buf + offset , " Mac: %pM " , rulla - > mac_addr ) ;
offset + = sprintf ( buf + offset , " Atm: " ) ;
2006-09-30 08:11:47 +08:00
for ( j = 0 ; j < ATM_ESA_LEN ; j + + ) {
offset + = sprintf ( buf + offset , " %2.2x " ,
rulla - > atm_addr [ j ] & 0xff ) ;
}
offset + = sprintf ( buf + offset ,
" Vcc vpi:%d vci:%d, Recv_vcc vpi:%d vci:%d Last_used:%lx, Timestamp:%lx, No_tries:%d " ,
rulla - > vcc ? rulla - > vcc - > vpi : 0 ,
rulla - > vcc ? rulla - > vcc - > vci : 0 ,
rulla - > recv_vcc ? rulla - > recv_vcc - > vpi : 0 ,
rulla - > recv_vcc ? rulla - > recv_vcc - > vci : 0 ,
rulla - > last_used ,
rulla - > timestamp , rulla - > no_tries ) ;
offset + = sprintf ( buf + offset ,
" Flags:%x, Packets_flooded:%x, Status: %s " ,
rulla - > flags , rulla - > packets_flooded ,
get_status_string ( rulla - > status ) ) ;
2010-01-26 19:40:08 +08:00
pr_info ( " %s \n " , buf ) ;
2006-09-30 08:11:47 +08:00
}
2006-09-30 08:14:27 +08:00
if ( ! hlist_empty ( & priv - > lec_arp_empty_ones ) )
2010-01-26 19:40:08 +08:00
pr_info ( " Empty ones \n " ) ;
2006-09-30 08:14:27 +08:00
hlist_for_each_entry ( rulla , node , & priv - > lec_arp_empty_ones , next ) {
2006-09-30 08:11:47 +08:00
offset = 0 ;
2010-01-26 19:40:08 +08:00
offset + = sprintf ( buf + offset , " Mac: %pM " , rulla - > mac_addr ) ;
offset + = sprintf ( buf + offset , " Atm: " ) ;
2006-09-30 08:11:47 +08:00
for ( j = 0 ; j < ATM_ESA_LEN ; j + + ) {
offset + = sprintf ( buf + offset , " %2.2x " ,
rulla - > atm_addr [ j ] & 0xff ) ;
}
offset + = sprintf ( buf + offset ,
" Vcc vpi:%d vci:%d, Recv_vcc vpi:%d vci:%d Last_used:%lx, Timestamp:%lx, No_tries:%d " ,
rulla - > vcc ? rulla - > vcc - > vpi : 0 ,
rulla - > vcc ? rulla - > vcc - > vci : 0 ,
rulla - > recv_vcc ? rulla - > recv_vcc - > vpi : 0 ,
rulla - > recv_vcc ? rulla - > recv_vcc - > vci : 0 ,
rulla - > last_used ,
rulla - > timestamp , rulla - > no_tries ) ;
offset + = sprintf ( buf + offset ,
" Flags:%x, Packets_flooded:%x, Status: %s " ,
rulla - > flags , rulla - > packets_flooded ,
get_status_string ( rulla - > status ) ) ;
2010-01-26 19:40:08 +08:00
pr_info ( " %s " , buf ) ;
2006-09-30 08:11:47 +08:00
}
2006-09-30 08:14:27 +08:00
if ( ! hlist_empty ( & priv - > mcast_fwds ) )
2010-01-26 19:40:08 +08:00
pr_info ( " Multicast Forward VCCs \n " ) ;
2006-09-30 08:14:27 +08:00
hlist_for_each_entry ( rulla , node , & priv - > mcast_fwds , next ) {
2006-09-30 08:11:47 +08:00
offset = 0 ;
2010-01-26 19:40:08 +08:00
offset + = sprintf ( buf + offset , " Mac: %pM " , rulla - > mac_addr ) ;
offset + = sprintf ( buf + offset , " Atm: " ) ;
2006-09-30 08:11:47 +08:00
for ( j = 0 ; j < ATM_ESA_LEN ; j + + ) {
offset + = sprintf ( buf + offset , " %2.2x " ,
rulla - > atm_addr [ j ] & 0xff ) ;
}
offset + = sprintf ( buf + offset ,
" Vcc vpi:%d vci:%d, Recv_vcc vpi:%d vci:%d Last_used:%lx, Timestamp:%lx, No_tries:%d " ,
rulla - > vcc ? rulla - > vcc - > vpi : 0 ,
rulla - > vcc ? rulla - > vcc - > vci : 0 ,
rulla - > recv_vcc ? rulla - > recv_vcc - > vpi : 0 ,
rulla - > recv_vcc ? rulla - > recv_vcc - > vci : 0 ,
rulla - > last_used ,
rulla - > timestamp , rulla - > no_tries ) ;
offset + = sprintf ( buf + offset ,
" Flags:%x, Packets_flooded:%x, Status: %s " ,
rulla - > flags , rulla - > packets_flooded ,
get_status_string ( rulla - > status ) ) ;
2010-01-26 19:40:08 +08:00
pr_info ( " %s \n " , buf ) ;
2006-09-30 08:11:47 +08:00
}
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:14:27 +08:00
# else
# define dump_arp_table(priv) do { } while (0)
# endif
2005-04-17 06:20:36 +08:00
/*
* Destruction of arp - cache
*/
2006-09-30 08:11:47 +08:00
static void lec_arp_destroy ( struct lec_priv * priv )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:14:27 +08:00
struct hlist_node * node , * next ;
struct lec_arp_table * entry ;
2006-09-30 08:11:47 +08:00
int i ;
2006-09-30 08:15:59 +08:00
cancel_rearming_delayed_work ( & priv - > lec_arp_work ) ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:47 +08:00
/*
* Remove all entries
*/
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + ) {
2010-01-26 19:40:08 +08:00
hlist_for_each_entry_safe ( entry , node , next ,
& priv - > lec_arp_tables [ i ] , next ) {
2006-09-30 08:11:47 +08:00
lec_arp_remove ( priv , entry ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2006-09-30 08:11:47 +08:00
}
2006-09-30 08:14:27 +08:00
INIT_HLIST_HEAD ( & priv - > lec_arp_tables [ i ] ) ;
2006-09-30 08:11:47 +08:00
}
2006-09-30 08:14:27 +08:00
2010-01-26 19:40:08 +08:00
hlist_for_each_entry_safe ( entry , node , next ,
& priv - > lec_arp_empty_ones , next ) {
2006-09-30 08:11:47 +08:00
del_timer_sync ( & entry - > timer ) ;
lec_arp_clear_vccs ( entry ) ;
2006-09-30 08:14:27 +08:00
hlist_del ( & entry - > next ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2006-09-30 08:11:47 +08:00
}
2006-09-30 08:14:27 +08:00
INIT_HLIST_HEAD ( & priv - > lec_arp_empty_ones ) ;
2010-01-26 19:40:08 +08:00
hlist_for_each_entry_safe ( entry , node , next ,
& priv - > lec_no_forward , next ) {
2006-09-30 08:11:47 +08:00
del_timer_sync ( & entry - > timer ) ;
lec_arp_clear_vccs ( entry ) ;
2006-09-30 08:14:27 +08:00
hlist_del ( & entry - > next ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2006-09-30 08:11:47 +08:00
}
2006-09-30 08:14:27 +08:00
INIT_HLIST_HEAD ( & priv - > lec_no_forward ) ;
hlist_for_each_entry_safe ( entry , node , next , & priv - > mcast_fwds , next ) {
2006-09-30 08:11:47 +08:00
/* No timer, LANEv2 7.1.20 and 2.3.5.3 */
lec_arp_clear_vccs ( entry ) ;
2006-09-30 08:14:27 +08:00
hlist_del ( & entry - > next ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2006-09-30 08:11:47 +08:00
}
2006-09-30 08:14:27 +08:00
INIT_HLIST_HEAD ( & priv - > mcast_fwds ) ;
2006-09-30 08:11:47 +08:00
priv - > mcast_vcc = NULL ;
2005-04-17 06:20:36 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
}
2007-02-09 22:24:29 +08:00
/*
2005-04-17 06:20:36 +08:00
* Find entry by mac_address
*/
2006-09-30 08:11:47 +08:00
static struct lec_arp_table * lec_arp_find ( struct lec_priv * priv ,
2008-06-18 07:20:06 +08:00
const unsigned char * mac_addr )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:14:27 +08:00
struct hlist_node * node ;
struct hlist_head * head ;
struct lec_arp_table * entry ;
2006-09-30 08:11:47 +08:00
2010-01-26 19:40:00 +08:00
pr_debug ( " %pM \n " , mac_addr ) ;
2006-09-30 08:11:47 +08:00
2006-09-30 08:14:27 +08:00
head = & priv - > lec_arp_tables [ HASH ( mac_addr [ ETH_ALEN - 1 ] ) ] ;
hlist_for_each_entry ( entry , node , head , next ) {
2010-01-26 19:40:08 +08:00
if ( ! compare_ether_addr ( mac_addr , entry - > mac_addr ) )
2006-09-30 08:14:27 +08:00
return entry ;
2006-09-30 08:11:47 +08:00
}
return NULL ;
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:47 +08:00
static struct lec_arp_table * make_entry ( struct lec_priv * priv ,
2008-06-18 07:20:06 +08:00
const unsigned char * mac_addr )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:47 +08:00
struct lec_arp_table * to_return ;
to_return = kzalloc ( sizeof ( struct lec_arp_table ) , GFP_ATOMIC ) ;
if ( ! to_return ) {
2010-01-26 19:40:08 +08:00
pr_info ( " LEC: Arp entry kmalloc failed \n " ) ;
2006-09-30 08:11:47 +08:00
return NULL ;
}
memcpy ( to_return - > mac_addr , mac_addr , ETH_ALEN ) ;
2006-09-30 08:14:27 +08:00
INIT_HLIST_NODE ( & to_return - > next ) ;
2008-01-24 13:20:07 +08:00
setup_timer ( & to_return - > timer , lec_arp_expire_arp ,
( unsigned long ) to_return ) ;
2006-09-30 08:11:47 +08:00
to_return - > last_used = jiffies ;
to_return - > priv = priv ;
skb_queue_head_init ( & to_return - > tx_wait ) ;
2006-09-30 08:16:48 +08:00
atomic_set ( & to_return - > usage , 1 ) ;
2006-09-30 08:11:47 +08:00
return to_return ;
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:47 +08:00
/* Arp sent timer expired */
static void lec_arp_expire_arp ( unsigned long data )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:47 +08:00
struct lec_arp_table * entry ;
entry = ( struct lec_arp_table * ) data ;
2010-01-26 19:40:00 +08:00
pr_debug ( " \n " ) ;
2006-09-30 08:11:47 +08:00
if ( entry - > status = = ESI_ARP_PENDING ) {
if ( entry - > no_tries < = entry - > priv - > max_retry_count ) {
if ( entry - > is_rdesc )
send_to_lecd ( entry - > priv , l_rdesc_arp_xmt ,
entry - > mac_addr , NULL , NULL ) ;
else
send_to_lecd ( entry - > priv , l_arp_xmt ,
entry - > mac_addr , NULL , NULL ) ;
entry - > no_tries + + ;
}
mod_timer ( & entry - > timer , jiffies + ( 1 * HZ ) ) ;
}
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:47 +08:00
/* Unknown/unused vcc expire, remove associated entry */
static void lec_arp_expire_vcc ( unsigned long data )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:11:47 +08:00
struct lec_arp_table * to_remove = ( struct lec_arp_table * ) data ;
struct lec_priv * priv = ( struct lec_priv * ) to_remove - > priv ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:47 +08:00
del_timer ( & to_remove - > timer ) ;
2005-04-17 06:20:36 +08:00
2010-01-26 19:40:00 +08:00
pr_debug ( " %p %p: vpi:%d vci:%d \n " ,
to_remove , priv ,
to_remove - > vcc ? to_remove - > recv_vcc - > vpi : 0 ,
to_remove - > vcc ? to_remove - > recv_vcc - > vci : 0 ) ;
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:14:27 +08:00
hlist_del ( & to_remove - > next ) ;
2005-04-17 06:20:36 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
lec_arp_clear_vccs ( to_remove ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( to_remove ) ;
2005-04-17 06:20:36 +08:00
}
/*
* Expire entries .
* 1. Re - set timer
* 2. For each entry , delete entries that have aged past the age limit .
* 3. For each entry , depending on the status of the entry , perform
* the following maintenance .
* a . If status is ESI_VC_PENDING or ESI_ARP_PENDING then if the
* tick_count is above the max_unknown_frame_time , clear
* the tick_count to zero and clear the packets_flooded counter
* to zero . This supports the packet rate limit per address
* while flooding unknowns .
* b . If the status is ESI_FLUSH_PENDING and the tick_count is greater
* than or equal to the path_switching_delay , change the status
* to ESI_FORWARD_DIRECT . This causes the flush period to end
* regardless of the progress of the flush protocol .
*/
2006-11-22 22:57:56 +08:00
static void lec_arp_check_expire ( struct work_struct * work )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-11-22 22:57:56 +08:00
struct lec_priv * priv =
container_of ( work , struct lec_priv , lec_arp_work . work ) ;
2006-09-30 08:14:27 +08:00
struct hlist_node * node , * next ;
struct lec_arp_table * entry ;
2006-09-30 08:11:47 +08:00
unsigned long now ;
unsigned long time_to_check ;
int i ;
2010-01-26 19:40:00 +08:00
pr_debug ( " %p \n " , priv ) ;
2005-04-17 06:20:36 +08:00
now = jiffies ;
2006-09-30 08:17:17 +08:00
restart :
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + ) {
2010-01-26 19:40:08 +08:00
hlist_for_each_entry_safe ( entry , node , next ,
& priv - > lec_arp_tables [ i ] , next ) {
2006-09-30 08:11:47 +08:00
if ( ( entry - > flags ) & LEC_REMOTE_FLAG & &
2005-04-17 06:20:36 +08:00
priv - > topology_change )
time_to_check = priv - > forward_delay_time ;
else
time_to_check = priv - > aging_time ;
2007-08-29 06:22:09 +08:00
pr_debug ( " About to expire: %lx - %lx > %lx \n " ,
2010-01-26 19:40:00 +08:00
now , entry - > last_used , time_to_check ) ;
2010-01-26 19:40:08 +08:00
if ( time_after ( now , entry - > last_used + time_to_check ) & &
! ( entry - > flags & LEC_PERMANENT_FLAG ) & &
! ( entry - > mac_addr [ 0 ] & 0x01 ) ) { /* LANE2: 7.1.20 */
2005-04-17 06:20:36 +08:00
/* Remove entry */
2010-01-26 19:40:00 +08:00
pr_debug ( " Entry timed out \n " ) ;
2005-04-17 06:20:36 +08:00
lec_arp_remove ( priv , entry ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2005-04-17 06:20:36 +08:00
} else {
/* Something else */
if ( ( entry - > status = = ESI_VC_PENDING | |
2010-01-26 19:40:08 +08:00
entry - > status = = ESI_ARP_PENDING ) & &
time_after_eq ( now ,
entry - > timestamp +
priv - > max_unknown_frame_time ) ) {
2005-04-17 06:20:36 +08:00
entry - > timestamp = jiffies ;
entry - > packets_flooded = 0 ;
if ( entry - > status = = ESI_VC_PENDING )
2006-09-30 08:11:47 +08:00
send_to_lecd ( priv , l_svc_setup ,
entry - > mac_addr ,
entry - > atm_addr ,
NULL ) ;
2005-04-17 06:20:36 +08:00
}
2010-01-26 19:40:08 +08:00
if ( entry - > status = = ESI_FLUSH_PENDING & &
2006-09-30 08:11:47 +08:00
time_after_eq ( now , entry - > timestamp +
priv - > path_switching_delay ) ) {
2005-04-17 06:20:36 +08:00
struct sk_buff * skb ;
2006-09-30 08:17:17 +08:00
struct atm_vcc * vcc = entry - > vcc ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:17:17 +08:00
lec_arp_hold ( entry ) ;
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
while ( ( skb = skb_dequeue ( & entry - > tx_wait ) ) ! = NULL )
2009-01-09 21:01:01 +08:00
lec_send ( vcc , skb ) ;
2005-04-17 06:20:36 +08:00
entry - > last_used = jiffies ;
2006-09-30 08:11:47 +08:00
entry - > status = ESI_FORWARD_DIRECT ;
2006-09-30 08:17:17 +08:00
lec_arp_put ( entry ) ;
goto restart ;
2005-04-17 06:20:36 +08:00
}
}
}
}
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:15:59 +08:00
schedule_delayed_work ( & priv - > lec_arp_work , LEC_ARP_REFRESH_INTERVAL ) ;
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:47 +08:00
2005-04-17 06:20:36 +08:00
/*
* Try to find vcc where mac_address is attached .
2007-02-09 22:24:29 +08:00
*
2005-04-17 06:20:36 +08:00
*/
2006-09-30 08:11:47 +08:00
static struct atm_vcc * lec_arp_resolve ( struct lec_priv * priv ,
2010-01-26 19:40:08 +08:00
const unsigned char * mac_to_find ,
int is_rdesc ,
2006-09-30 08:11:47 +08:00
struct lec_arp_table * * ret_entry )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:11:47 +08:00
struct lec_arp_table * entry ;
2005-04-17 06:20:36 +08:00
struct atm_vcc * found ;
2006-09-30 08:11:47 +08:00
if ( mac_to_find [ 0 ] & 0x01 ) {
switch ( priv - > lane_version ) {
case 1 :
return priv - > mcast_vcc ;
case 2 : /* LANE2 wants arp for multicast addresses */
if ( ! compare_ether_addr ( mac_to_find , bus_mac ) )
return priv - > mcast_vcc ;
break ;
default :
break ;
}
}
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
entry = lec_arp_find ( priv , mac_to_find ) ;
if ( entry ) {
if ( entry - > status = = ESI_FORWARD_DIRECT ) {
/* Connection Ok */
entry - > last_used = jiffies ;
2006-09-30 08:17:17 +08:00
lec_arp_hold ( entry ) ;
2006-09-30 08:11:47 +08:00
* ret_entry = entry ;
found = entry - > vcc ;
2005-04-17 06:20:36 +08:00
goto out ;
2006-09-30 08:11:47 +08:00
}
/*
* If the LE_ARP cache entry is still pending , reset count to 0
2005-09-30 08:31:30 +08:00
* so another LE_ARP request can be made for this frame .
*/
2010-01-26 19:40:08 +08:00
if ( entry - > status = = ESI_ARP_PENDING )
2005-09-30 08:31:30 +08:00
entry - > no_tries = 0 ;
2006-09-30 08:11:47 +08:00
/*
* Data direct VC not yet set up , check to see if the unknown
* frame count is greater than the limit . If the limit has
* not been reached , allow the caller to send packet to
* BUS .
*/
if ( entry - > status ! = ESI_FLUSH_PENDING & &
entry - > packets_flooded <
priv - > maximum_unknown_frame_count ) {
entry - > packets_flooded + + ;
2010-01-26 19:40:00 +08:00
pr_debug ( " Flooding.. \n " ) ;
2006-09-30 08:11:47 +08:00
found = priv - > mcast_vcc ;
2005-04-17 06:20:36 +08:00
goto out ;
2006-09-30 08:11:47 +08:00
}
/*
* We got here because entry - > status = = ESI_FLUSH_PENDING
2005-04-17 06:20:36 +08:00
* or BUS flood limit was reached for an entry which is
* in ESI_ARP_PENDING or ESI_VC_PENDING state .
*/
2006-09-30 08:17:17 +08:00
lec_arp_hold ( entry ) ;
2006-09-30 08:11:47 +08:00
* ret_entry = entry ;
2010-01-26 19:40:00 +08:00
pr_debug ( " entry->status %d entry->vcc %p \n " , entry - > status ,
entry - > vcc ) ;
2006-09-30 08:11:47 +08:00
found = NULL ;
} else {
/* No matching entry was found */
entry = make_entry ( priv , mac_to_find ) ;
2010-01-26 19:40:00 +08:00
pr_debug ( " Making entry \n " ) ;
2006-09-30 08:11:47 +08:00
if ( ! entry ) {
found = priv - > mcast_vcc ;
2005-04-17 06:20:36 +08:00
goto out ;
2006-09-30 08:11:47 +08:00
}
lec_arp_add ( priv , entry ) ;
/* We want arp-request(s) to be sent */
entry - > packets_flooded = 1 ;
entry - > status = ESI_ARP_PENDING ;
entry - > no_tries = 1 ;
entry - > last_used = entry - > timestamp = jiffies ;
entry - > is_rdesc = is_rdesc ;
if ( entry - > is_rdesc )
send_to_lecd ( priv , l_rdesc_arp_xmt , mac_to_find , NULL ,
NULL ) ;
else
send_to_lecd ( priv , l_arp_xmt , mac_to_find , NULL , NULL ) ;
entry - > timer . expires = jiffies + ( 1 * HZ ) ;
entry - > timer . function = lec_arp_expire_arp ;
add_timer ( & entry - > timer ) ;
found = priv - > mcast_vcc ;
}
2005-04-17 06:20:36 +08:00
out :
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
return found ;
}
static int
2008-06-18 07:20:06 +08:00
lec_addr_delete ( struct lec_priv * priv , const unsigned char * atm_addr ,
2006-09-30 08:11:47 +08:00
unsigned long permanent )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:14:27 +08:00
struct hlist_node * node , * next ;
struct lec_arp_table * entry ;
2006-09-30 08:11:47 +08:00
int i ;
2005-04-17 06:20:36 +08:00
2010-01-26 19:40:00 +08:00
pr_debug ( " \n " ) ;
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + ) {
2010-01-26 19:40:08 +08:00
hlist_for_each_entry_safe ( entry , node , next ,
& priv - > lec_arp_tables [ i ] , next ) {
if ( ! memcmp ( atm_addr , entry - > atm_addr , ATM_ESA_LEN ) & &
( permanent | |
! ( entry - > flags & LEC_PERMANENT_FLAG ) ) ) {
2005-04-17 06:20:36 +08:00
lec_arp_remove ( priv , entry ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2006-09-30 08:11:47 +08:00
}
2005-04-17 06:20:36 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
return 0 ;
}
}
2005-04-17 06:20:36 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
return - 1 ;
2005-04-17 06:20:36 +08:00
}
/*
2007-02-09 22:24:29 +08:00
* Notifies : Response to arp_request ( atm_addr ! = NULL )
2005-04-17 06:20:36 +08:00
*/
static void
2008-06-18 07:20:06 +08:00
lec_arp_update ( struct lec_priv * priv , const unsigned char * mac_addr ,
const unsigned char * atm_addr , unsigned long remoteflag ,
2006-09-30 08:11:47 +08:00
unsigned int targetless_le_arp )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:14:27 +08:00
struct hlist_node * node , * next ;
2006-09-30 08:11:47 +08:00
struct lec_arp_table * entry , * tmp ;
int i ;
2005-04-17 06:20:36 +08:00
2010-01-26 19:40:00 +08:00
pr_debug ( " %smac:%pM \n " ,
( targetless_le_arp ) ? " targetless " : " " , mac_addr ) ;
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
entry = lec_arp_find ( priv , mac_addr ) ;
if ( entry = = NULL & & targetless_le_arp )
goto out ; /*
* LANE2 : ignore targetless LE_ARPs for which
* we have no entry in the cache . 7.1 .30
*/
2006-09-30 08:14:27 +08:00
if ( ! hlist_empty ( & priv - > lec_arp_empty_ones ) ) {
2010-01-26 19:40:08 +08:00
hlist_for_each_entry_safe ( entry , node , next ,
& priv - > lec_arp_empty_ones , next ) {
2006-09-30 08:14:27 +08:00
if ( memcmp ( entry - > atm_addr , atm_addr , ATM_ESA_LEN ) = = 0 ) {
hlist_del ( & entry - > next ) ;
2006-09-30 08:11:47 +08:00
del_timer ( & entry - > timer ) ;
2006-09-30 08:14:27 +08:00
tmp = lec_arp_find ( priv , mac_addr ) ;
if ( tmp ) {
del_timer ( & tmp - > timer ) ;
tmp - > status = ESI_FORWARD_DIRECT ;
memcpy ( tmp - > atm_addr , atm_addr , ATM_ESA_LEN ) ;
tmp - > vcc = entry - > vcc ;
tmp - > old_push = entry - > old_push ;
tmp - > last_used = jiffies ;
del_timer ( & entry - > timer ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2006-09-30 08:14:27 +08:00
entry = tmp ;
} else {
entry - > status = ESI_FORWARD_DIRECT ;
memcpy ( entry - > mac_addr , mac_addr , ETH_ALEN ) ;
entry - > last_used = jiffies ;
lec_arp_add ( priv , entry ) ;
}
if ( remoteflag )
entry - > flags | = LEC_REMOTE_FLAG ;
else
entry - > flags & = ~ LEC_REMOTE_FLAG ;
2007-08-29 06:22:09 +08:00
pr_debug ( " After update \n " ) ;
2006-09-30 08:14:27 +08:00
dump_arp_table ( priv ) ;
goto out ;
2006-09-30 08:11:47 +08:00
}
}
}
2006-09-30 08:14:27 +08:00
2006-09-30 08:11:47 +08:00
entry = lec_arp_find ( priv , mac_addr ) ;
if ( ! entry ) {
entry = make_entry ( priv , mac_addr ) ;
if ( ! entry )
goto out ;
entry - > status = ESI_UNKNOWN ;
lec_arp_add ( priv , entry ) ;
/* Temporary, changes before end of function */
}
memcpy ( entry - > atm_addr , atm_addr , ATM_ESA_LEN ) ;
del_timer ( & entry - > timer ) ;
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + ) {
2010-01-26 19:40:08 +08:00
hlist_for_each_entry ( tmp , node ,
& priv - > lec_arp_tables [ i ] , next ) {
2006-09-30 08:11:47 +08:00
if ( entry ! = tmp & &
! memcmp ( tmp - > atm_addr , atm_addr , ATM_ESA_LEN ) ) {
/* Vcc to this host exists */
if ( tmp - > status > ESI_VC_PENDING ) {
/*
* ESI_FLUSH_PENDING ,
* ESI_FORWARD_DIRECT
*/
entry - > vcc = tmp - > vcc ;
entry - > old_push = tmp - > old_push ;
}
entry - > status = tmp - > status ;
break ;
}
}
}
if ( remoteflag )
entry - > flags | = LEC_REMOTE_FLAG ;
else
entry - > flags & = ~ LEC_REMOTE_FLAG ;
if ( entry - > status = = ESI_ARP_PENDING | | entry - > status = = ESI_UNKNOWN ) {
entry - > status = ESI_VC_PENDING ;
2006-09-30 08:14:27 +08:00
send_to_lecd ( priv , l_svc_setup , entry - > mac_addr , atm_addr , NULL ) ;
2006-09-30 08:11:47 +08:00
}
2007-08-29 06:22:09 +08:00
pr_debug ( " After update2 \n " ) ;
2006-09-30 08:11:47 +08:00
dump_arp_table ( priv ) ;
2005-04-17 06:20:36 +08:00
out :
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
}
/*
2007-02-09 22:24:29 +08:00
* Notifies : Vcc setup ready
2005-04-17 06:20:36 +08:00
*/
static void
2008-06-18 07:20:06 +08:00
lec_vcc_added ( struct lec_priv * priv , const struct atmlec_ioc * ioc_data ,
2006-09-30 08:11:47 +08:00
struct atm_vcc * vcc ,
void ( * old_push ) ( struct atm_vcc * vcc , struct sk_buff * skb ) )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:14:27 +08:00
struct hlist_node * node ;
2006-09-30 08:11:47 +08:00
struct lec_arp_table * entry ;
int i , found_entry = 0 ;
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2010-01-26 19:40:08 +08:00
/* Vcc for Multicast Forward. No timer, LANEv2 7.1.20 and 2.3.5.3 */
2006-09-30 08:11:47 +08:00
if ( ioc_data - > receive = = 2 ) {
2007-08-29 06:22:09 +08:00
pr_debug ( " LEC_ARP: Attaching mcast forward \n " ) ;
2005-04-17 06:20:36 +08:00
#if 0
2006-09-30 08:11:47 +08:00
entry = lec_arp_find ( priv , bus_mac ) ;
if ( ! entry ) {
2010-01-26 19:40:08 +08:00
pr_info ( " LEC_ARP: Multicast entry not found! \n " ) ;
2005-04-17 06:20:36 +08:00
goto out ;
2006-09-30 08:11:47 +08:00
}
memcpy ( entry - > atm_addr , ioc_data - > atm_addr , ATM_ESA_LEN ) ;
entry - > recv_vcc = vcc ;
entry - > old_recv_push = old_push ;
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:47 +08:00
entry = make_entry ( priv , bus_mac ) ;
if ( entry = = NULL )
2005-04-17 06:20:36 +08:00
goto out ;
2006-09-30 08:11:47 +08:00
del_timer ( & entry - > timer ) ;
memcpy ( entry - > atm_addr , ioc_data - > atm_addr , ATM_ESA_LEN ) ;
entry - > recv_vcc = vcc ;
entry - > old_recv_push = old_push ;
2006-09-30 08:14:27 +08:00
hlist_add_head ( & entry - > next , & priv - > mcast_fwds ) ;
2006-09-30 08:11:47 +08:00
goto out ;
} else if ( ioc_data - > receive = = 1 ) {
/*
* Vcc which we don ' t want to make default vcc ,
* attach it anyway .
*/
2010-01-26 19:40:00 +08:00
pr_debug ( " 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 " ,
ioc_data - > atm_addr [ 0 ] , ioc_data - > atm_addr [ 1 ] ,
ioc_data - > atm_addr [ 2 ] , ioc_data - > atm_addr [ 3 ] ,
ioc_data - > atm_addr [ 4 ] , ioc_data - > atm_addr [ 5 ] ,
ioc_data - > atm_addr [ 6 ] , ioc_data - > atm_addr [ 7 ] ,
ioc_data - > atm_addr [ 8 ] , ioc_data - > atm_addr [ 9 ] ,
ioc_data - > atm_addr [ 10 ] , ioc_data - > atm_addr [ 11 ] ,
ioc_data - > atm_addr [ 12 ] , ioc_data - > atm_addr [ 13 ] ,
ioc_data - > atm_addr [ 14 ] , ioc_data - > atm_addr [ 15 ] ,
ioc_data - > atm_addr [ 16 ] , ioc_data - > atm_addr [ 17 ] ,
ioc_data - > atm_addr [ 18 ] , ioc_data - > atm_addr [ 19 ] ) ;
2006-09-30 08:11:47 +08:00
entry = make_entry ( priv , bus_mac ) ;
if ( entry = = NULL )
2005-04-17 06:20:36 +08:00
goto out ;
2006-09-30 08:11:47 +08:00
memcpy ( entry - > atm_addr , ioc_data - > atm_addr , ATM_ESA_LEN ) ;
memset ( entry - > mac_addr , 0 , ETH_ALEN ) ;
entry - > recv_vcc = vcc ;
entry - > old_recv_push = old_push ;
entry - > status = ESI_UNKNOWN ;
entry - > timer . expires = jiffies + priv - > vcc_timeout_period ;
entry - > timer . function = lec_arp_expire_vcc ;
2006-09-30 08:14:27 +08:00
hlist_add_head ( & entry - > next , & priv - > lec_no_forward ) ;
2006-09-30 08:11:47 +08:00
add_timer ( & entry - > timer ) ;
2005-04-17 06:20:36 +08:00
dump_arp_table ( priv ) ;
goto out ;
2006-09-30 08:11:47 +08:00
}
2010-01-26 19:40:00 +08:00
pr_debug ( " 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 " ,
ioc_data - > atm_addr [ 0 ] , ioc_data - > atm_addr [ 1 ] ,
ioc_data - > atm_addr [ 2 ] , ioc_data - > atm_addr [ 3 ] ,
ioc_data - > atm_addr [ 4 ] , ioc_data - > atm_addr [ 5 ] ,
ioc_data - > atm_addr [ 6 ] , ioc_data - > atm_addr [ 7 ] ,
ioc_data - > atm_addr [ 8 ] , ioc_data - > atm_addr [ 9 ] ,
ioc_data - > atm_addr [ 10 ] , ioc_data - > atm_addr [ 11 ] ,
ioc_data - > atm_addr [ 12 ] , ioc_data - > atm_addr [ 13 ] ,
ioc_data - > atm_addr [ 14 ] , ioc_data - > atm_addr [ 15 ] ,
ioc_data - > atm_addr [ 16 ] , ioc_data - > atm_addr [ 17 ] ,
ioc_data - > atm_addr [ 18 ] , ioc_data - > atm_addr [ 19 ] ) ;
2006-09-30 08:11:47 +08:00
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + ) {
2010-01-26 19:40:08 +08:00
hlist_for_each_entry ( entry , node ,
& priv - > lec_arp_tables [ i ] , next ) {
2006-09-30 08:11:47 +08:00
if ( memcmp
( ioc_data - > atm_addr , entry - > atm_addr ,
ATM_ESA_LEN ) = = 0 ) {
2007-08-29 06:22:09 +08:00
pr_debug ( " LEC_ARP: Attaching data direct \n " ) ;
pr_debug ( " Currently -> Vcc: %d, Rvcc:%d \n " ,
2010-01-26 19:40:00 +08:00
entry - > vcc ? entry - > vcc - > vci : 0 ,
entry - > recv_vcc ? entry - > recv_vcc - >
vci : 0 ) ;
2006-09-30 08:11:47 +08:00
found_entry = 1 ;
del_timer ( & entry - > timer ) ;
entry - > vcc = vcc ;
entry - > old_push = old_push ;
if ( entry - > status = = ESI_VC_PENDING ) {
if ( priv - > maximum_unknown_frame_count
= = 0 )
entry - > status =
ESI_FORWARD_DIRECT ;
else {
entry - > timestamp = jiffies ;
entry - > status =
ESI_FLUSH_PENDING ;
2005-04-17 06:20:36 +08:00
#if 0
2006-09-30 08:11:47 +08:00
send_to_lecd ( priv , l_flush_xmt ,
NULL ,
entry - > atm_addr ,
NULL ) ;
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:47 +08:00
}
} else {
/*
* They were forming a connection
* to us , and we to them . Our
* ATM address is numerically lower
* than theirs , so we make connection
* we formed into default VCC ( 8.1 .11 ) .
* Connection they made gets torn
* down . This might confuse some
* clients . Can be changed if
* someone reports trouble . . .
*/
;
}
}
}
}
if ( found_entry ) {
2007-08-29 06:22:09 +08:00
pr_debug ( " After vcc was added \n " ) ;
2006-09-30 08:11:47 +08:00
dump_arp_table ( priv ) ;
2005-04-17 06:20:36 +08:00
goto out ;
2006-09-30 08:11:47 +08:00
}
/*
* Not found , snatch address from first data packet that arrives
* from this vcc
*/
entry = make_entry ( priv , bus_mac ) ;
if ( ! entry )
2005-04-17 06:20:36 +08:00
goto out ;
2006-09-30 08:11:47 +08:00
entry - > vcc = vcc ;
entry - > old_push = old_push ;
memcpy ( entry - > atm_addr , ioc_data - > atm_addr , ATM_ESA_LEN ) ;
memset ( entry - > mac_addr , 0 , ETH_ALEN ) ;
entry - > status = ESI_UNKNOWN ;
2006-09-30 08:14:27 +08:00
hlist_add_head ( & entry - > next , & priv - > lec_arp_empty_ones ) ;
2006-09-30 08:11:47 +08:00
entry - > timer . expires = jiffies + priv - > vcc_timeout_period ;
entry - > timer . function = lec_arp_expire_vcc ;
add_timer ( & entry - > timer ) ;
2007-08-29 06:22:09 +08:00
pr_debug ( " After vcc was added \n " ) ;
2005-04-17 06:20:36 +08:00
dump_arp_table ( priv ) ;
out :
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
}
2006-09-30 08:11:47 +08:00
static void lec_flush_complete ( struct lec_priv * priv , unsigned long tran_id )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:14:27 +08:00
struct hlist_node * node ;
2006-09-30 08:11:47 +08:00
struct lec_arp_table * entry ;
int i ;
2005-04-17 06:20:36 +08:00
2010-01-26 19:40:00 +08:00
pr_debug ( " %lx \n " , tran_id ) ;
2006-09-30 08:17:17 +08:00
restart :
2006-09-30 08:11:47 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + ) {
2010-01-26 19:40:08 +08:00
hlist_for_each_entry ( entry , node ,
& priv - > lec_arp_tables [ i ] , next ) {
if ( entry - > flush_tran_id = = tran_id & &
entry - > status = = ESI_FLUSH_PENDING ) {
2006-09-30 08:11:47 +08:00
struct sk_buff * skb ;
2006-09-30 08:17:17 +08:00
struct atm_vcc * vcc = entry - > vcc ;
2006-09-30 08:11:47 +08:00
2006-09-30 08:17:17 +08:00
lec_arp_hold ( entry ) ;
2010-01-26 19:40:08 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock ,
flags ) ;
2006-09-30 08:17:17 +08:00
while ( ( skb = skb_dequeue ( & entry - > tx_wait ) ) ! = NULL )
2009-01-09 21:01:01 +08:00
lec_send ( vcc , skb ) ;
2006-09-30 08:17:17 +08:00
entry - > last_used = jiffies ;
2006-09-30 08:11:47 +08:00
entry - > status = ESI_FORWARD_DIRECT ;
2006-09-30 08:17:17 +08:00
lec_arp_put ( entry ) ;
2007-08-29 06:22:09 +08:00
pr_debug ( " LEC_ARP: Flushed \n " ) ;
2006-09-30 08:17:17 +08:00
goto restart ;
2006-09-30 08:11:47 +08:00
}
}
}
2005-04-17 06:20:36 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
dump_arp_table ( priv ) ;
2005-04-17 06:20:36 +08:00
}
static void
lec_set_flush_tran_id ( struct lec_priv * priv ,
2008-06-18 07:20:06 +08:00
const unsigned char * atm_addr , unsigned long tran_id )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:14:27 +08:00
struct hlist_node * node ;
2006-09-30 08:11:47 +08:00
struct lec_arp_table * entry ;
int i ;
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + )
2010-01-26 19:40:08 +08:00
hlist_for_each_entry ( entry , node ,
& priv - > lec_arp_tables [ i ] , next ) {
2006-09-30 08:11:47 +08:00
if ( ! memcmp ( atm_addr , entry - > atm_addr , ATM_ESA_LEN ) ) {
entry - > flush_tran_id = tran_id ;
2007-08-29 06:22:09 +08:00
pr_debug ( " Set flush transaction id to %lx for %p \n " ,
2010-01-26 19:40:00 +08:00
tran_id , entry ) ;
2006-09-30 08:11:47 +08:00
}
2006-09-30 08:14:27 +08:00
}
2005-04-17 06:20:36 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
}
2006-09-30 08:11:47 +08:00
static int lec_mcast_make ( struct lec_priv * priv , struct atm_vcc * vcc )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:11:47 +08:00
unsigned char mac_addr [ ] = {
0xff , 0xff , 0xff , 0xff , 0xff , 0xff
} ;
struct lec_arp_table * to_add ;
2005-04-17 06:20:36 +08:00
struct lec_vcc_priv * vpriv ;
int err = 0 ;
2006-09-30 08:11:47 +08:00
2010-01-26 19:40:08 +08:00
vpriv = kmalloc ( sizeof ( struct lec_vcc_priv ) , GFP_KERNEL ) ;
if ( ! vpriv )
2005-04-17 06:20:36 +08:00
return - ENOMEM ;
vpriv - > xoff = 0 ;
vpriv - > old_pop = vcc - > pop ;
vcc - > user_back = vpriv ;
2006-09-30 08:11:47 +08:00
vcc - > pop = lec_pop ;
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
to_add = make_entry ( priv , mac_addr ) ;
if ( ! to_add ) {
2005-04-17 06:20:36 +08:00
vcc - > pop = vpriv - > old_pop ;
kfree ( vpriv ) ;
2006-09-30 08:11:47 +08:00
err = - ENOMEM ;
2005-04-17 06:20:36 +08:00
goto out ;
2006-09-30 08:11:47 +08:00
}
memcpy ( to_add - > atm_addr , vcc - > remote . sas_addr . prv , ATM_ESA_LEN ) ;
to_add - > status = ESI_FORWARD_DIRECT ;
to_add - > flags | = LEC_PERMANENT_FLAG ;
to_add - > vcc = vcc ;
to_add - > old_push = vcc - > push ;
vcc - > push = lec_push ;
priv - > mcast_vcc = vcc ;
lec_arp_add ( priv , to_add ) ;
2005-04-17 06:20:36 +08:00
out :
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:11:47 +08:00
return err ;
2005-04-17 06:20:36 +08:00
}
2006-09-30 08:11:47 +08:00
static void lec_vcc_close ( struct lec_priv * priv , struct atm_vcc * vcc )
2005-04-17 06:20:36 +08:00
{
unsigned long flags ;
2006-09-30 08:14:27 +08:00
struct hlist_node * node , * next ;
struct lec_arp_table * entry ;
2006-09-30 08:11:47 +08:00
int i ;
2005-04-17 06:20:36 +08:00
2007-08-29 06:22:09 +08:00
pr_debug ( " LEC_ARP: lec_vcc_close vpi:%d vci:%d \n " , vcc - > vpi , vcc - > vci ) ;
2006-09-30 08:11:47 +08:00
dump_arp_table ( priv ) ;
2006-09-30 08:14:27 +08:00
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2006-09-30 08:14:27 +08:00
2006-09-30 08:11:47 +08:00
for ( i = 0 ; i < LEC_ARP_TABLE_SIZE ; i + + ) {
2010-01-26 19:40:08 +08:00
hlist_for_each_entry_safe ( entry , node , next ,
& priv - > lec_arp_tables [ i ] , next ) {
2006-09-30 08:11:47 +08:00
if ( vcc = = entry - > vcc ) {
lec_arp_remove ( priv , entry ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2010-01-26 19:40:08 +08:00
if ( priv - > mcast_vcc = = vcc )
2006-09-30 08:11:47 +08:00
priv - > mcast_vcc = NULL ;
}
}
}
2010-01-26 19:40:08 +08:00
hlist_for_each_entry_safe ( entry , node , next ,
& priv - > lec_arp_empty_ones , next ) {
2006-09-30 08:14:27 +08:00
if ( entry - > vcc = = vcc ) {
2006-09-30 08:11:47 +08:00
lec_arp_clear_vccs ( entry ) ;
del_timer ( & entry - > timer ) ;
2006-09-30 08:14:27 +08:00
hlist_del ( & entry - > next ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2006-09-30 08:11:47 +08:00
}
}
2010-01-26 19:40:08 +08:00
hlist_for_each_entry_safe ( entry , node , next ,
& priv - > lec_no_forward , next ) {
2006-09-30 08:11:47 +08:00
if ( entry - > recv_vcc = = vcc ) {
lec_arp_clear_vccs ( entry ) ;
del_timer ( & entry - > timer ) ;
2006-09-30 08:14:27 +08:00
hlist_del ( & entry - > next ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2006-09-30 08:11:47 +08:00
}
}
2006-09-30 08:14:27 +08:00
hlist_for_each_entry_safe ( entry , node , next , & priv - > mcast_fwds , next ) {
2006-09-30 08:11:47 +08:00
if ( entry - > recv_vcc = = vcc ) {
lec_arp_clear_vccs ( entry ) ;
/* No timer, LANEv2 7.1.20 and 2.3.5.3 */
2006-09-30 08:14:27 +08:00
hlist_del ( & entry - > next ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( entry ) ;
2006-09-30 08:11:47 +08:00
}
}
2005-04-17 06:20:36 +08:00
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
dump_arp_table ( priv ) ;
}
static void
lec_arp_check_empties ( struct lec_priv * priv ,
2006-09-30 08:11:47 +08:00
struct atm_vcc * vcc , struct sk_buff * skb )
2005-04-17 06:20:36 +08:00
{
2006-09-30 08:11:47 +08:00
unsigned long flags ;
2006-09-30 08:14:27 +08:00
struct hlist_node * node , * next ;
struct lec_arp_table * entry , * tmp ;
2006-09-30 08:11:47 +08:00
struct lecdatahdr_8023 * hdr = ( struct lecdatahdr_8023 * ) skb - > data ;
unsigned char * src ;
2005-04-17 06:20:36 +08:00
# ifdef CONFIG_TR
2006-09-30 08:11:47 +08:00
struct lecdatahdr_8025 * tr_hdr = ( struct lecdatahdr_8025 * ) skb - > data ;
2005-04-17 06:20:36 +08:00
2006-09-30 08:11:47 +08:00
if ( priv - > is_trdev )
src = tr_hdr - > h_source ;
else
2005-04-17 06:20:36 +08:00
# endif
2006-09-30 08:11:47 +08:00
src = hdr - > h_source ;
2005-04-17 06:20:36 +08:00
spin_lock_irqsave ( & priv - > lec_arp_lock , flags ) ;
2010-01-26 19:40:08 +08:00
hlist_for_each_entry_safe ( entry , node , next ,
& priv - > lec_arp_empty_ones , next ) {
2006-09-30 08:14:27 +08:00
if ( vcc = = entry - > vcc ) {
del_timer ( & entry - > timer ) ;
memcpy ( entry - > mac_addr , src , ETH_ALEN ) ;
entry - > status = ESI_FORWARD_DIRECT ;
entry - > last_used = jiffies ;
/* We might have got an entry */
2010-01-26 19:40:08 +08:00
tmp = lec_arp_find ( priv , src ) ;
if ( tmp ) {
2006-09-30 08:14:27 +08:00
lec_arp_remove ( priv , tmp ) ;
2006-09-30 08:16:48 +08:00
lec_arp_put ( tmp ) ;
2006-09-30 08:14:27 +08:00
}
hlist_del ( & entry - > next ) ;
lec_arp_add ( priv , entry ) ;
goto out ;
2006-09-30 08:11:47 +08:00
}
}
2007-08-29 06:22:09 +08:00
pr_debug ( " LEC_ARP: Arp_check_empties: entry not found! \n " ) ;
2005-04-17 06:20:36 +08:00
out :
spin_unlock_irqrestore ( & priv - > lec_arp_lock , flags ) ;
}
2006-09-30 08:11:47 +08:00
2005-04-17 06:20:36 +08:00
MODULE_LICENSE ( " GPL " ) ;