📄 wanpipe_multppp.c
字号:
/****************************************************************************** wanpipe_multppp.c Multi-Port PPP driver module.** Authors: Nenad Corbic <ncorbic@sangoma.com>** Copyright: (c) 1995-2001 Sangoma Technologies Inc.** This program is free software; you can redistribute it and/or* modify it under the terms of the GNU General Public License* as published by the Free Software Foundation; either version* 2 of the License, or (at your option) any later version.* ============================================================================* Dec 15 2000 Updated for 2.4.X kernel* Nov 15 2000 Fixed the SyncPPP support for kernels 2.2.16 and higher.* The pppstruct has changed.* Jul 13 2000 Using the kernel Syncppp module on top of RAW Wanpipe CHDLC* module.*****************************************************************************/#include <linux/module.h>#include <linux/kernel.h> /* printk(), and other useful stuff */#include <linux/stddef.h> /* offsetof(), etc. */#include <linux/errno.h> /* return codes */#include <linux/string.h> /* inline memset(), etc. */#include <linux/slab.h> /* kmalloc(), kfree() */#include <linux/wanrouter.h> /* WAN router definitions */#include <linux/wanpipe.h> /* WANPIPE common user API definitions */#include <linux/if_arp.h> /* ARPHRD_* defines */#include <linux/jiffies.h> /* time_after() macro */#include <linux/in.h> /* sockaddr_in */#include <linux/inet.h> #include <linux/if.h>#include <asm/byteorder.h> /* htons(), etc. */#include <linux/sdlapci.h>#include <asm/io.h>#include <linux/sdla_chdlc.h> /* CHDLC firmware API definitions */#include <linux/sdla_asy.h> /* CHDLC (async) API definitions */#include <linux/if_wanpipe_common.h> /* Socket Driver common area */#include <linux/if_wanpipe.h> #include <linux/inetdevice.h>#include <asm/uaccess.h>#include <net/syncppp.h>/****** Defines & Macros ****************************************************/#ifdef _DEBUG_#define STATIC#else#define STATIC static#endif/* reasons for enabling the timer interrupt on the adapter */#define TMR_INT_ENABLED_UDP 0x01#define TMR_INT_ENABLED_UPDATE 0x02#define TMR_INT_ENABLED_CONFIG 0x04 #define CHDLC_DFLT_DATA_LEN 1500 /* default MTU */#define CHDLC_HDR_LEN 1#define IFF_POINTTOPOINT 0x10#define CHDLC_API 0x01#define PORT(x) (x == 0 ? "PRIMARY" : "SECONDARY" )#define MAX_BH_BUFF 10#define CRC_LENGTH 2 #define PPP_HEADER_LEN 4 /******Data Structures*****************************************************//* This structure is placed in the private data area of the device structure. * The card structure used to occupy the private area but now the following * structure will incorporate the card structure along with CHDLC specific data */typedef struct chdlc_private_area{ void *if_ptr; /* General Pointer used by SPPP */ wanpipe_common_t common; sdla_t *card; int TracingEnabled; /* For enabling Tracing */ unsigned long curr_trace_addr; /* Used for Tracing */ unsigned long start_trace_addr; unsigned long end_trace_addr; unsigned long base_addr_trace_buffer; unsigned long end_addr_trace_buffer; unsigned short number_trace_elements; unsigned available_buffer_space; unsigned long router_start_time; unsigned char route_status; unsigned char route_removed; unsigned long tick_counter; /* For 5s timeout counter */ unsigned long router_up_time; u32 IP_address; /* IP addressing */ u32 IP_netmask; unsigned char mc; /* Mulitcast support on/off */ unsigned short udp_pkt_lgth; /* udp packet processing */ char udp_pkt_src; char udp_pkt_data[MAX_LGTH_UDP_MGNT_PKT]; unsigned short timer_int_enabled; char update_comms_stats; /* updating comms stats */ //FIXME: add driver stats as per frame relay!} chdlc_private_area_t;/* Route Status options */#define NO_ROUTE 0x00#define ADD_ROUTE 0x01#define ROUTE_ADDED 0x02#define REMOVE_ROUTE 0x03/* variable for keeping track of enabling/disabling FT1 monitor status */static int rCount = 0;/* variable for tracking how many interfaces to open for WANPIPE on the two ports */extern void disable_irq(unsigned int);extern void enable_irq(unsigned int);/****** Function Prototypes *************************************************//* WAN link driver entry points. These are called by the WAN router module. */static int update(struct wan_device* wandev);static int new_if(struct wan_device* wandev, struct net_device* dev, wanif_conf_t* conf);static int del_if(struct wan_device* wandev, struct net_device* dev);/* Network device interface */static int if_init(struct net_device* dev);static int if_open(struct net_device* dev);static int if_close(struct net_device* dev);static int if_send(struct sk_buff* skb, struct net_device* dev);static struct net_device_stats* if_stats(struct net_device* dev);static void if_tx_timeout(struct net_device *dev);/* CHDLC Firmware interface functions */static int chdlc_configure (sdla_t* card, void* data);static int chdlc_comm_enable (sdla_t* card);static int chdlc_comm_disable (sdla_t* card);static int chdlc_read_version (sdla_t* card, char* str);static int chdlc_set_intr_mode (sdla_t* card, unsigned mode);static int chdlc_send (sdla_t* card, void* data, unsigned len);static int chdlc_read_comm_err_stats (sdla_t* card);static int chdlc_read_op_stats (sdla_t* card);static int config_chdlc (sdla_t *card);/* Miscellaneous CHDLC Functions */static int set_chdlc_config (sdla_t* card);static void init_chdlc_tx_rx_buff(sdla_t* card, struct net_device *dev);static int chdlc_error (sdla_t *card, int err, CHDLC_MAILBOX_STRUCT *mb);static int process_chdlc_exception(sdla_t *card);static int process_global_exception(sdla_t *card);static int update_comms_stats(sdla_t* card, chdlc_private_area_t* chdlc_priv_area);static void port_set_state (sdla_t *card, int);/* Interrupt handlers */static void wsppp_isr (sdla_t* card);static void rx_intr (sdla_t* card);static void timer_intr(sdla_t *);/* Miscellaneous functions */static int reply_udp( unsigned char *data, unsigned int mbox_len );static int intr_test( sdla_t* card);static int udp_pkt_type( struct sk_buff *skb , sdla_t* card);static int store_udp_mgmt_pkt(char udp_pkt_src, sdla_t* card, struct sk_buff *skb, struct net_device* dev, chdlc_private_area_t* chdlc_priv_area);static int process_udp_mgmt_pkt(sdla_t* card, struct net_device* dev, chdlc_private_area_t* chdlc_priv_area);static unsigned short calc_checksum (char *, int);static void s508_lock (sdla_t *card, unsigned long *smp_flags);static void s508_unlock (sdla_t *card, unsigned long *smp_flags);static void send_ppp_term_request(struct net_device *dev);static int Intr_test_counter;/****** Public Functions ****************************************************//*============================================================================ * Cisco HDLC protocol initialization routine. * * This routine is called by the main WANPIPE module during setup. At this * point adapter is completely initialized and firmware is running. * o read firmware version (to make sure it's alive) * o configure adapter * o initialize protocol-specific fields of the adapter data space. * * Return: 0 o.k. * < 0 failure. */int wsppp_init (sdla_t* card, wandev_conf_t* conf){ unsigned char port_num; int err; unsigned long max_permitted_baud = 0; SHARED_MEMORY_INFO_STRUCT *flags; union { char str[80]; } u; volatile CHDLC_MAILBOX_STRUCT* mb; CHDLC_MAILBOX_STRUCT* mb1; unsigned long timeout; /* Verify configuration ID */ if (conf->config_id != WANCONFIG_MPPP) { printk(KERN_INFO "%s: invalid configuration ID %u!\n", card->devname, conf->config_id); return -EINVAL; } /* Find out which Port to use */ if ((conf->comm_port == WANOPT_PRI) || (conf->comm_port == WANOPT_SEC)){ if (card->next){ if (conf->comm_port != card->next->u.c.comm_port){ card->u.c.comm_port = conf->comm_port; }else{ printk(KERN_ERR "%s: ERROR - %s port used!\n", card->wandev.name, PORT(conf->comm_port)); return -EINVAL; } }else{ card->u.c.comm_port = conf->comm_port; } }else{ printk(KERN_ERR "%s: ERROR - Invalid Port Selected!\n", card->wandev.name); return -EINVAL; } /* Initialize protocol-specific fields */ if(card->hw.type != SDLA_S514){ if (card->u.c.comm_port == WANOPT_PRI){ card->mbox = (void *) card->hw.dpmbase; }else{ card->mbox = (void *) card->hw.dpmbase + SEC_BASE_ADDR_MB_STRUCT - PRI_BASE_ADDR_MB_STRUCT; } }else{ /* for a S514 adapter, set a pointer to the actual mailbox in the */ /* allocated virtual memory area */ if (card->u.c.comm_port == WANOPT_PRI){ card->mbox = (void *) card->hw.dpmbase + PRI_BASE_ADDR_MB_STRUCT; }else{ card->mbox = (void *) card->hw.dpmbase + SEC_BASE_ADDR_MB_STRUCT; } } mb = mb1 = card->mbox; if (!card->configured){ /* The board will place an 'I' in the return code to indicate that it is ready to accept commands. We expect this to be completed in less than 1 second. */ timeout = jiffies + 1 * HZ; while (mb->return_code != 'I') /* Wait 1s for board to initialize */ if (time_after(jiffies, timeout)) break; if (mb->return_code != 'I') { printk(KERN_INFO "%s: Initialization not completed by adapter\n", card->devname); printk(KERN_INFO "Please contact Sangoma representative.\n"); return -EIO; } } /* Read firmware version. Note that when adapter initializes, it * clears the mailbox, so it may appear that the first command was * executed successfully when in fact it was merely erased. To work * around this, we execute the first command twice. */ if (chdlc_read_version(card, u.str)) return -EIO; printk(KERN_INFO "%s: Running Raw CHDLC firmware v%s\n" "%s: for Multi-Port PPP protocol.\n", card->devname,u.str,card->devname); card->isr = &wsppp_isr; card->poll = NULL; card->exec = NULL; card->wandev.update = &update; card->wandev.new_if = &new_if; card->wandev.del_if = &del_if; card->wandev.udp_port = conf->udp_port; card->wandev.new_if_cnt = 0; /* reset the number of times the 'update()' proc has been called */ card->u.c.update_call_count = 0; card->wandev.ttl = conf->ttl; card->wandev.interface = conf->interface; if ((card->u.c.comm_port == WANOPT_SEC && conf->interface == WANOPT_V35)&& card->hw.type != SDLA_S514){ printk(KERN_INFO "%s: ERROR - V35 Interface not supported on S508 %s port \n", card->devname, PORT(card->u.c.comm_port)); return -EIO; } card->wandev.clocking = conf->clocking; port_num = card->u.c.comm_port; /* Setup Port Bps */ if(card->wandev.clocking) { if((port_num == WANOPT_PRI) || card->u.c.receive_only) { /* For Primary Port 0 */ max_permitted_baud = (card->hw.type == SDLA_S514) ? PRI_MAX_BAUD_RATE_S514 : PRI_MAX_BAUD_RATE_S508; } else if(port_num == WANOPT_SEC) { /* For Secondary Port 1 */ max_permitted_baud = (card->hw.type == SDLA_S514) ? SEC_MAX_BAUD_RATE_S514 : SEC_MAX_BAUD_RATE_S508; } if(conf->bps > max_permitted_baud) { conf->bps = max_permitted_baud; printk(KERN_INFO "%s: Baud too high!\n", card->wandev.name); printk(KERN_INFO "%s: Baud rate set to %lu bps\n", card->wandev.name, max_permitted_baud); } card->wandev.bps = conf->bps; }else{ card->wandev.bps = 0; } /* Setup the Port MTU */ if((port_num == WANOPT_PRI) || card->u.c.receive_only) { /* For Primary Port 0 */ card->wandev.mtu = (conf->mtu >= MIN_LGTH_CHDLC_DATA_CFG) ? min_t(unsigned int, conf->mtu, PRI_MAX_NO_DATA_BYTES_IN_FRAME) : CHDLC_DFLT_DATA_LEN; } else if(port_num == WANOPT_SEC) { /* For Secondary Port 1 */ card->wandev.mtu = (conf->mtu >= MIN_LGTH_CHDLC_DATA_CFG) ? min_t(unsigned int, conf->mtu, SEC_MAX_NO_DATA_BYTES_IN_FRAME) : CHDLC_DFLT_DATA_LEN; } /* Add on a PPP Header */ card->wandev.mtu += PPP_HEADER_LEN; /* Set up the interrupt status area */ /* Read the CHDLC Configuration and obtain: * Ptr to shared memory infor struct * Use this pointer to calculate the value of card->u.c.flags ! */ mb1->buffer_length = 0; mb1->command = READ_CHDLC_CONFIGURATION; err = sdla_exec(mb1) ? mb1->return_code : CMD_TIMEOUT; if(err != COMMAND_OK) { clear_bit(1, (void*)&card->wandev.critical); if(card->hw.type != SDLA_S514) enable_irq(card->hw.irq); chdlc_error(card, err, mb1); return -EIO; } if(card->hw.type == SDLA_S514){ card->u.c.flags = (void *)(card->hw.dpmbase + (((CHDLC_CONFIGURATION_STRUCT *)mb1->data)-> ptr_shared_mem_info_struct)); }else{ card->u.c.flags = (void *)(card->hw.dpmbase + (((CHDLC_CONFIGURATION_STRUCT *)mb1->data)-> ptr_shared_mem_info_struct % SDLA_WINDOWSIZE)); } flags = card->u.c.flags; /* This is for the ports link state */ card->wandev.state = WAN_DUALPORT; card->u.c.state = WAN_DISCONNECTED; if (!card->wandev.piggyback){ err = intr_test(card); if(err || (Intr_test_counter < MAX_INTR_TEST_COUNTER)) { printk(KERN_ERR "%s: Interrupt test failed (%i)\n", card->devname, Intr_test_counter); printk(KERN_ERR "%s: Please choose another interrupt\n", card->devname); return -EIO; } printk(KERN_INFO "%s: Interrupt test passed (%i)\n", card->devname, Intr_test_counter); } if (chdlc_set_intr_mode(card, APP_INT_ON_TIMER)){ printk (KERN_INFO "%s: Failed to set interrupt triggers!\n", card->devname); return -EIO; } /* Mask the Timer interrupt */ flags->interrupt_info_struct.interrupt_permission &= ~APP_INT_ON_TIMER; printk(KERN_INFO "\n"); return 0;}/******* WAN Device Driver Entry Points *************************************//*============================================================================ * Update device status & statistics * This procedure is called when updating the PROC file system and returns * various communications statistics. These statistics are accumulated from 3 * different locations: * 1) The 'if_stats' recorded for the device. * 2) Communication error statistics on the adapter.
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -