patch-2.1.91 linux/drivers/net/sdla_fr.c
Next file: linux/drivers/net/sdla_ppp.c
Previous file: linux/drivers/net/hamradio/soundmodem/gentbl.c
Back to the patch index
Back to the overall index
- Lines: 3742
- Date:
Sat Mar 21 10:56:27 1998
- Orig file:
v2.1.90/linux/drivers/net/sdla_fr.c
- Orig date:
Thu Feb 12 20:56:09 1998
diff -u --recursive --new-file v2.1.90/linux/drivers/net/sdla_fr.c linux/drivers/net/sdla_fr.c
@@ -1,4 +1,4 @@
-/****************************************************************************
+/*****************************************************************************
* sdla_fr.c WANPIPE(tm) Multiprotocol WAN Link Driver. Frame relay module.
*
* Author(s): Gene Kozin
@@ -83,85 +83,83 @@
* Jan 02, 1997 Gene Kozin Initial version.
*****************************************************************************/
-#if !defined(__KERNEL__) || !defined(MODULE)
-#error This code MUST be compiled as a kernel module!
-#endif
-
#include <linux/config.h> /* OS configuration options */
#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/malloc.h> /* kmalloc(), kfree() */
-#include <linux/init.h> /* __initfunc */
#include <linux/wanrouter.h> /* WAN router definitions */
#include <linux/wanpipe.h> /* WANPIPE common user API definitions */
#include <linux/if_arp.h> /* ARPHRD_* defines */
#include <asm/byteorder.h> /* htons(), etc. */
#include <asm/io.h> /* for inb(), outb(), etc. */
-#include <asm/uaccess.h>
-#include <linux/time.h> /* for do_gettimeofday */
-
+#include <linux/time.h> /* for do_gettimeofday */
#define _GNUC_
#include <linux/sdla_fr.h> /* frame relay firmware API definitions */
-/****** Defines & Macros ****************************************************/
+#include <asm/uaccess.h>
-#define MAX_CMD_RETRY 10 /* max number of firmware retries */
+/****** Defines & Macros ****************************************************/
-#define FR_HEADER_LEN 8 /* max encapsulation header size */
-#define FR_CHANNEL_MTU 1500 /* unfragmented logical channel MTU */
+#define MAX_CMD_RETRY 10 /* max number of firmware retries */
+#define FR_HEADER_LEN 8 /* max encapsulation header size */
+#define FR_CHANNEL_MTU 1500 /* unfragmented logical channel MTU */
/* Q.922 frame types */
-#define Q922_UI 0x03 /* Unnumbered Info frame */
-#define Q922_XID 0xAF /* ??? */
+
+#define Q922_UI 0x03 /* Unnumbered Info frame */
+#define Q922_XID 0xAF /* ??? */
/* DLCI configured or not */
+
#define DLCI_NOT_CONFIGURED 0x00
#define DLCI_CONFIG_PENDING 0x01
#define DLCI_CONFIGURED 0x02
/* CIR enabled or not */
+
#define CIR_ENABLED 0x00
#define CIR_DISABLED 0x01
/* Interrupt mode for DLCI = 0 */
+
#define BUFFER_INTR_MODE 0x00
#define DLCI_LIST_INTR_MODE 0x01
/* Transmit Interrupt Status */
+
#define DISABLED 0x00
#define WAITING_TO_BE_ENABLED 0x01
/* For handle_IPXWAN() */
+
#define CVHexToAscii(b) (((unsigned char)(b) > (unsigned char)9) ? ((unsigned char)'A' + ((unsigned char)(b) - (unsigned char)10)) : ((unsigned char)'0' + (unsigned char)(b)))
-
+
/****** Data Structures *****************************************************/
/* This is an extention of the 'struct device' we create for each network
* interface to keep the rest of channel-specific data.
*/
-typedef struct fr_channel
-{
- char name[WAN_IFNAME_SZ+1]; /* interface name, ASCIIZ */
- unsigned dlci_configured ; /* check whether configured or not */
- unsigned cir_status; /* check whether CIR enabled or not */
- unsigned dlci; /* logical channel number */
- unsigned cir; /* committed information rate */
- unsigned bc; /* committed burst size */
- unsigned be; /* excess burst size */
- unsigned mc; /* multicast support on or off */
- unsigned tx_int_status; /* Transmit Interrupt Status */
+typedef struct fr_channel {
+ char name[WAN_IFNAME_SZ + 1]; /* interface name, ASCIIZ */
+ unsigned dlci_configured; /* check whether configured or not */
+ unsigned cir_status; /* check whether CIR enabled or not */
+ unsigned dlci; /* logical channel number */
+ unsigned cir; /* committed information rate */
+ unsigned bc; /* committed burst size */
+ unsigned be; /* excess burst size */
+ unsigned mc; /* multicast support on or off */
+ unsigned tx_int_status; /* Transmit Interrupt Status */
unsigned short pkt_length; /* Packet Length */
- unsigned long router_start_time;/* Router start time in seconds */
+ unsigned long router_start_time; /* Router start time in seconds */
unsigned long tick_counter; /* counter for transmit time out */
char dev_pending_devtint; /* interface pending dev_tint() */
- char state; /* channel state */
- void* dlci_int_interface; /* pointer to the DLCI Interface */
- unsigned long IB_addr; /* physical address of Interface Byte */
+ char state; /* channel state */
+ void *dlci_int_interface; /* pointer to the DLCI Interface */
+ unsigned long IB_addr; /* physical address of Interface Byte */
unsigned long state_tick; /* time of the last state change */
- sdla_t* card; /* -> owner */
- struct enet_statistics ifstats; /* interface statistics */
-
+ sdla_t *card; /* -> owner */
+ struct enet_statistics ifstats; /* interface statistics */
unsigned long if_send_entry;
unsigned long if_send_skb_null;
unsigned long if_send_broadcast;
@@ -177,14 +175,12 @@
unsigned long if_send_no_bfrs;
unsigned long if_send_adptr_bfrs_full;
unsigned long if_send_bfrs_passed_to_adptr;
-
unsigned long rx_intr_no_socket;
unsigned long rx_intr_dev_not_started;
unsigned long rx_intr_FPIPE_request;
unsigned long rx_intr_DRVSTATS_request;
unsigned long rx_intr_bfr_not_passed_to_stack;
unsigned long rx_intr_bfr_passed_to_stack;
-
unsigned long UDP_FPIPE_mgmt_kmalloc_err;
unsigned long UDP_FPIPE_mgmt_direction_err;
unsigned long UDP_FPIPE_mgmt_adptr_type_err;
@@ -206,37 +202,32 @@
unsigned long router_up_time;
} fr_channel_t;
-typedef struct dlci_status
-{
- unsigned short dlci PACKED;
- unsigned char state PACKED;
+typedef struct dlci_status {
+ unsigned short dlci PACKED;
+ unsigned char state PACKED;
} dlci_status_t;
-typedef struct dlci_IB_mapping
-{
- unsigned short dlci PACKED;
- unsigned long addr_value PACKED;
+typedef struct dlci_IB_mapping {
+ unsigned short dlci PACKED;
+ unsigned long addr_value PACKED;
} dlci_IB_mapping_t;
/* This structure is used for DLCI list Tx interrupt mode. It is used to
enable interrupt bit and set the packet length for transmission
*/
-typedef struct fr_dlci_interface
-{
- unsigned char gen_interrupt PACKED;
- unsigned short packet_length PACKED;
- unsigned char reserved PACKED;
-} fr_dlci_interface_t;
+
+typedef struct fr_dlci_interface {
+ unsigned char gen_interrupt PACKED;
+ unsigned short packet_length PACKED;
+ unsigned char reserved PACKED;
+} fr_dlci_interface_t;
static unsigned short num_frames;
static unsigned long curr_trace_addr;
static unsigned long start_trace_addr;
static unsigned short available_buffer_space;
-static char TracingEnabled;
-
-/* variable for keeping track of enabling/disabling FT1 monitor status */
+static char TracingEnabled; /* variable for keeping track of enabling/disabling FT1 monitor status */
static int rCount = 0;
-
extern void disable_irq(unsigned int);
extern void enable_irq(unsigned int);
@@ -248,73 +239,63 @@
/****** Function Prototypes *************************************************/
/* WAN link driver entry points. These are called by the WAN router module. */
-static int update (wan_device_t* wandev);
-static int new_if (wan_device_t* wandev, struct device* dev,
- wanif_conf_t* conf);
-static int del_if (wan_device_t* wandev, struct device* dev);
-
+static int update(wan_device_t * wandev);
+static int new_if(wan_device_t * wandev, struct device *dev,
+ wanif_conf_t * conf);
+static int del_if(wan_device_t * wandev, struct device *dev);
/* WANPIPE-specific entry points */
-static int wpf_exec (struct sdla* card, void* u_cmd, void* u_data);
-
+static int wpf_exec(struct sdla *card, void *u_cmd, void *u_data);
/* Network device interface */
-static int if_init (struct device* dev);
-static int if_open (struct device* dev);
-static int if_close (struct device* dev);
-static int if_header (struct sk_buff* skb, struct device* dev,
- unsigned short type, void* daddr, void* saddr, unsigned len);
-static int if_rebuild_hdr (struct sk_buff* skb);
-static int if_send (struct sk_buff* skb, struct device* dev);
-static struct enet_statistics* if_stats (struct device* dev);
-
+static int if_init(struct device *dev);
+static int if_open(struct device *dev);
+static int if_close(struct device *dev);
+static int if_header(struct sk_buff *skb, struct device *dev,
+ unsigned short type, void *daddr, void *saddr, unsigned len);
+static int if_rebuild_hdr(struct sk_buff *skb);
+static int if_send(struct sk_buff *skb, struct device *dev);
+static struct enet_statistics *if_stats(struct device *dev);
/* Interrupt handlers */
-static void fr502_isr (sdla_t* card);
-static void fr508_isr (sdla_t* card);
-static void fr502_rx_intr (sdla_t* card);
-static void fr508_rx_intr (sdla_t* card);
-static void tx_intr (sdla_t* card);
-static void spur_intr (sdla_t* card);
-
+static void fr502_isr(sdla_t * card);
+static void fr508_isr(sdla_t * card);
+static void fr502_rx_intr(sdla_t * card);
+static void fr508_rx_intr(sdla_t * card);
+static void tx_intr(sdla_t * card);
+static void spur_intr(sdla_t * card);
/* Background polling routines */
-static void wpf_poll (sdla_t* card);
-
+static void wpf_poll(sdla_t * card);
/* Frame relay firmware interface functions */
-static int fr_read_version (sdla_t* card, char* str);
-static int fr_configure (sdla_t* card, fr_conf_t *conf);
-static int fr_dlci_configure (sdla_t* card, fr_dlc_conf_t *conf, unsigned dlci);
-static int fr_set_intr_mode (sdla_t* card, unsigned mode, unsigned mtu);
-static int fr_comm_enable (sdla_t* card);
-static int fr_comm_disable (sdla_t* card);
-static int fr_get_err_stats (sdla_t* card);
-static int fr_get_stats (sdla_t* card);
-static int fr_add_dlci (sdla_t* card, int dlci, int num);
-static int fr_activate_dlci (sdla_t* card, int dlci, int num);
-static int fr_issue_isf (sdla_t* card, int isf);
-static int fr502_send (sdla_t* card, int dlci, int attr, int len, void *buf);
-static int fr508_send (sdla_t* card, int dlci, int attr, int len, void *buf);
-
+static int fr_read_version(sdla_t * card, char *str);
+static int fr_configure(sdla_t * card, fr_conf_t * conf);
+static int fr_dlci_configure(sdla_t * card, fr_dlc_conf_t * conf, unsigned dlci);
+static int fr_set_intr_mode(sdla_t * card, unsigned mode, unsigned mtu);
+static int fr_comm_enable(sdla_t * card);
+static int fr_comm_disable(sdla_t * card);
+static int fr_get_err_stats(sdla_t * card);
+static int fr_get_stats(sdla_t * card);
+static int fr_add_dlci(sdla_t * card, int dlci, int num);
+static int fr_activate_dlci(sdla_t * card, int dlci, int num);
+static int fr_issue_isf(sdla_t * card, int isf);
+static int fr502_send(sdla_t * card, int dlci, int attr, int len, void *buf);
+static int fr508_send(sdla_t * card, int dlci, int attr, int len, void *buf);
/* Firmware asynchronous event handlers */
-static int fr_event (sdla_t* card, int event, fr_mbox_t* mbox);
-static int fr_modem_failure (sdla_t *card, fr_mbox_t* mbox);
-static int fr_dlci_change (sdla_t *card, fr_mbox_t* mbox);
-
+static int fr_event(sdla_t * card, int event, fr_mbox_t * mbox);
+static int fr_modem_failure(sdla_t * card, fr_mbox_t * mbox);
+static int fr_dlci_change(sdla_t * card, fr_mbox_t * mbox);
/* Miscellaneous functions */
-static int update_chan_state (struct device* dev);
-static void set_chan_state (struct device* dev, int state);
-static struct device* find_channel (sdla_t* card, unsigned dlci);
-static int is_tx_ready (sdla_t* card, fr_channel_t* chan);
-static unsigned int dec_to_uint (unsigned char* str, int len);
-static int reply_udp( unsigned char *data, unsigned int mbox_len );
-
-static int intr_test( sdla_t* card );
-static void init_chan_statistics( fr_channel_t* chan );
-static void init_global_statistics( sdla_t* card );
-static void read_DLCI_IB_mapping( sdla_t* card, fr_channel_t* chan );
-
+static int update_chan_state(struct device *dev);
+static void set_chan_state(struct device *dev, int state);
+static struct device *find_channel(sdla_t * card, unsigned dlci);
+static int is_tx_ready(sdla_t * card, fr_channel_t * chan);
+static unsigned int dec_to_uint(unsigned char *str, int len);
+static int reply_udp(unsigned char *data, unsigned int mbox_len);
+static int intr_test(sdla_t * card);
+static void init_chan_statistics(fr_channel_t * chan);
+static void init_global_statistics(sdla_t * card);
+static void read_DLCI_IB_mapping(sdla_t * card, fr_channel_t * chan);
/* Udp management functions */
-static int process_udp_mgmt_pkt(char udp_pkt_src, sdla_t* card, struct sk_buff *skb, struct device* dev, int dlci, fr_channel_t* chan);
-static int process_udp_driver_call(char udp_pkt_src, sdla_t* card, struct sk_buff *skb, struct device* dev, int dlci, fr_channel_t* chan);
-static int udp_pkt_type( struct sk_buff *skb, sdla_t* card );
-
+static int process_udp_mgmt_pkt(char udp_pkt_src, sdla_t * card, struct sk_buff *skb, struct device *dev, int dlci, fr_channel_t * chan);
+static int process_udp_driver_call(char udp_pkt_src, sdla_t * card, struct sk_buff *skb, struct device *dev, int dlci, fr_channel_t * chan);
+static int udp_pkt_type(struct sk_buff *skb, sdla_t * card);
/* IPX functions */
static void switch_net_numbers(unsigned char *sendpacket, unsigned long network_number, unsigned char incoming);
static int handle_IPXWAN(unsigned char *sendpacket, char *devname, unsigned char enable_IPX, unsigned long network_number);
@@ -333,15 +314,16 @@
* Return: 0 o.k.
* < 0 failure.
*/
-__initfunc(int wpf_init(sdla_t * card, wandev_conf_t * conf))
+int wpf_init(sdla_t * card, wandev_conf_t * conf)
{
union {
char str[80];
fr_conf_t cfg;
} u;
-
+ int i;
/* Verify configuration ID */
- if (conf->config_id != WANCONFIG_FR) {
+ if (conf->config_id != WANCONFIG_FR)
+ {
printk(KERN_INFO "%s: invalid configuration ID %u!\n",
card->devname, conf->config_id);
return -EINVAL;
@@ -355,45 +337,41 @@
card->flags = (void *) (card->hw.dpmbase + FR502_FLAG_OFFS);
card->isr = &fr502_isr;
break;
-
case SFID_FR508:
card->mbox = (void *) (card->hw.dpmbase + FR508_MBOX_OFFS);
card->flags = (void *) (card->hw.dpmbase + FR508_FLAG_OFFS);
card->isr = &fr508_isr;
break;
-
default:
return -EINVAL;
}
-
/* 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 (fr_read_version(card, NULL) || fr_read_version(card, u.str))
- return -EIO
- ;
+ return -EIO;
printk(KERN_INFO "%s: running frame relay firmware v%s\n",
card->devname, u.str);
-
/* Adjust configuration */
conf->mtu = max(min(conf->mtu, 4080), FR_CHANNEL_MTU + FR_HEADER_LEN);
conf->bps = min(conf->bps, 2048000);
-
/* Configure adapter firmware */
memset(&u.cfg, 0, sizeof(u.cfg));
u.cfg.mtu = conf->mtu;
- u.cfg.t391 = 10;
- u.cfg.t392 = 15;
- u.cfg.n391 = 6;
- u.cfg.n392 = 3;
- u.cfg.n393 = 4;
u.cfg.kbps = conf->bps / 1000;
- u.cfg.cir_fwd = 16;
- u.cfg.cir_bwd = u.cfg.bc_fwd = u.cfg.bc_bwd = u.cfg.cir_fwd;
- u.cfg.options = 0x0081; /* direct Rx, no CIR check */
-
+ u.cfg.cir_fwd = u.cfg.cir_bwd = 16;
+ u.cfg.bc_fwd = u.cfg.bc_bwd = 16;
+ if (conf->station == WANOPT_CPE)
+ {
+ u.cfg.options = 0x0080;
+ printk(KERN_INFO "%s: Global CIR enabled by Default\n", card->devname);
+ }
+ else
+ {
+ u.cfg.options = 0x0081;
+ }
switch (conf->u.fr.signalling)
{
case WANOPT_FR_Q933:
@@ -403,54 +381,59 @@
u.cfg.options |= 0x0400;
break;
}
-
if (conf->station == WANOPT_CPE)
{
u.cfg.options |= 0x8000; /* auto config DLCI */
+ card->u.f.dlci_num = 0;
}
else
{
u.cfg.station = 1; /* switch emulation mode */
- card->u.f.node_dlci = conf->u.fr.dlci ? conf->u.fr.dlci : 16;
+ /* For switch emulation we have to create a list of dlci(s)
+ * that will be sent to be global SET_DLCI_CONFIGURATION
+ * command in fr_configure() routine.
+ */
card->u.f.dlci_num = min(max(conf->u.fr.dlci_num, 1), 100);
+ for (i = 0; i < card->u.f.dlci_num; i++)
+ {
+ card->u.f.node_dlci[i] = (unsigned short)
+ conf->u.fr.dlci[i] ? conf->u.fr.dlci[i] : 16;
+ }
}
-
if (conf->clocking == WANOPT_INTERNAL)
- u.cfg.port |= 0x0001
- ;
+ u.cfg.port |= 0x0001;
if (conf->interface == WANOPT_RS232)
- u.cfg.port |= 0x0002
- ;
+ u.cfg.port |= 0x0002;
if (conf->u.fr.t391)
u.cfg.t391 = min(conf->u.fr.t391, 30);
+ else
+ u.cfg.t391 = 5;
if (conf->u.fr.t392)
u.cfg.t392 = min(conf->u.fr.t392, 30);
+ else
+ u.cfg.t392 = 15;
if (conf->u.fr.n391)
u.cfg.n391 = min(conf->u.fr.n391, 255);
+ else
+ u.cfg.n391 = 2;
if (conf->u.fr.n392)
u.cfg.n392 = min(conf->u.fr.n392, 10);
+ else
+ u.cfg.n392 = 3;
if (conf->u.fr.n393)
u.cfg.n393 = min(conf->u.fr.n393, 10);
-
+ else
+ u.cfg.n393 = 4;
if (fr_configure(card, &u.cfg))
- return -EIO
- ;
-
+ return -EIO;
if (card->hw.fwid == SFID_FR508)
{
fr_buf_info_t *buf_info =
(void *) (card->hw.dpmbase + FR508_RXBC_OFFS);
-
- card->rxmb =
- (void *) (buf_info->rse_next -
- FR_MB_VECTOR + card->hw.dpmbase);
- card->u.f.rxmb_base =
- (void *) (buf_info->rse_base -
- FR_MB_VECTOR + card->hw.dpmbase);
- card->u.f.rxmb_last =
- (void *) (buf_info->rse_base +
- (buf_info->rse_num - 1) * sizeof(fr_buf_ctl_t) -
- FR_MB_VECTOR + card->hw.dpmbase);
+ card->rxmb = (void *) (buf_info->rse_next - FR_MB_VECTOR + card->hw.dpmbase);
+ card->u.f.rxmb_base = (void *) (buf_info->rse_base - FR_MB_VECTOR + card->hw.dpmbase);
+ card->u.f.rxmb_last = (void *) (buf_info->rse_base + (buf_info->rse_num - 1) *
+ sizeof(fr_buf_ctl_t) - FR_MB_VECTOR + card->hw.dpmbase);
card->u.f.rx_base = buf_info->buf_base;
card->u.f.rx_top = buf_info->buf_top;
}
@@ -465,8 +448,19 @@
card->wandev.new_if = &new_if;
card->wandev.del_if = &del_if;
card->wandev.state = WAN_DISCONNECTED;
+ card->wandev.ttl = conf->ttl;
card->wandev.udp_port = conf->udp_port;
- TracingEnabled = '0';
+ card->wandev.enable_tx_int = 0;
+ card->irq_dis_if_send_count = 0;
+ card->irq_dis_poll_count = 0;
+ card->wandev.enable_IPX = conf->enable_IPX;
+ if (conf->network_number)
+ card->wandev.network_number = conf->network_number;
+ else
+ card->wandev.network_number = 0xDEADBEEF;
+ /* Intialize global statistics for a card */
+ init_global_statistics(card);
+ TracingEnabled = 0;
return 0;
}
@@ -475,20 +469,17 @@
/*============================================================================
* Update device status & statistics.
*/
+
static int update(wan_device_t * wandev)
{
sdla_t *card;
-
/* sanity checks */
if ((wandev == NULL) || (wandev->private == NULL))
- return -EFAULT
- ;
+ return -EFAULT;
if (wandev->state == WAN_UNCONFIGURED)
- return -ENODEV
- ;
+ return -ENODEV;
if (test_and_set_bit(0, (void *) &wandev->critical))
- return -EAGAIN
- ;
+ return -EAGAIN;
card = wandev->private;
fr_get_err_stats(card);
fr_get_stats(card);
@@ -508,13 +499,14 @@
* Return: 0 o.k.
* < 0 failure (channel will not be created)
*/
+
static int new_if(wan_device_t * wandev, struct device *dev, wanif_conf_t * conf)
{
sdla_t *card = wandev->private;
fr_channel_t *chan;
int err = 0;
-
- if ((conf->name[0] == '\0') || (strlen(conf->name) > WAN_IFNAME_SZ)) {
+ if ((conf->name[0] == '\0') || (strlen(conf->name) > WAN_IFNAME_SZ))
+ {
printk(KERN_INFO "%s: invalid interface name!\n",
card->devname);
return -EINVAL;
@@ -522,73 +514,67 @@
/* allocate and initialize private data */
chan = kmalloc(sizeof(fr_channel_t), GFP_KERNEL);
if (chan == NULL)
- return -ENOMEM
- ;
+ return -ENOMEM;
memset(chan, 0, sizeof(fr_channel_t));
strcpy(chan->name, conf->name);
chan->card = card;
-
/* verify media address */
- if (is_digit(conf->addr[0])) {
+ if (is_digit(conf->addr[0]))
+ {
int dlci = dec_to_uint(conf->addr, 0);
-
- if (dlci && (dlci <= 4095)) {
+ if (dlci && (dlci <= 4095))
+ {
chan->dlci = dlci;
- } else {
- printk(KERN_ERR
- "%s: invalid DLCI %u on interface %s!\n",
+ }
+ else
+ {
+ printk(KERN_ERR "%s: invalid DLCI %u on interface %s!\n",
wandev->name, dlci, chan->name);
err = -EINVAL;
}
- } else {
- printk(KERN_ERR
- "%s: invalid media address on interface %s!\n",
+ }
+ else
+ {
+ printk(KERN_ERR "%s: invalid media address on interface %s!\n",
wandev->name, chan->name);
err = -EINVAL;
}
- if (err) {
+ if (err)
+ {
kfree(chan);
return err;
}
-
/* place cir,be,bc and other channel specific information into the
* chan structure
- */
+ */
if (conf->cir)
{
- chan->cir = max( 1, min( conf->cir, 512 ) );
- chan->cir_status = CIR_ENABLED;
-
+ chan->cir = max(1, min(conf->cir, 512));
+ chan->cir_status = CIR_ENABLED;
if (conf->bc)
- chan->bc = max( 1, min( conf->bc, 512 ) );
+ chan->bc = max(1, min(conf->bc, 512));
if (conf->be)
- chan->be = max( 0, min( conf->be, 511) );
-
+ chan->be = max(0, min(conf->be, 511));
}
else
chan->cir_status = CIR_DISABLED;
-
chan->mc = conf->mc;
-
- chan->dlci_configured = DLCI_NOT_CONFIGURED;
-
- chan->tx_int_status = DISABLED;
-
- init_chan_statistics( chan );
-
+ chan->dlci_configured = DLCI_NOT_CONFIGURED;
+ chan->tx_int_status = DISABLED;
+ init_chan_statistics(chan);
/* prepare network device data space for registration */
dev->name = chan->name;
dev->init = &if_init;
dev->priv = chan;
return 0;
}
-
/*============================================================================
* Delete logical channel.
*/
static int del_if(wan_device_t * wandev, struct device *dev)
{
- if (dev->priv) {
+ if (dev->priv)
+ {
kfree(dev->priv);
dev->priv = NULL;
}
@@ -606,24 +592,27 @@
int retry = MAX_CMD_RETRY;
int err, len;
fr_cmd_t cmd;
-
- if (copy_from_user((void *) &cmd, u_cmd, sizeof(cmd)))
- return -EFAULT;
+ if(copy_from_user((void *) &cmd, u_cmd, sizeof(cmd)))
+ return -EFAULT;
/* execute command */
- do {
+ do
+ {
memcpy(&mbox->cmd, &cmd, sizeof(cmd));
if (cmd.length)
- if (copy_from_user((void *) &mbox->data, u_data, cmd.length))
+ {
+ if(copy_from_user((void *) &mbox->data, u_data, cmd.length))
return -EFAULT;
+ }
if (sdla_exec(mbox))
err = mbox->cmd.result;
else
return -EIO;
- }
+ }
while (err && retry-- && fr_event(card, err, mbox));
/* return result */
- if (copy_to_user(u_cmd, (void *) &mbox->cmd, sizeof(fr_cmd_t)))
+
+ if(copy_to_user(u_cmd, (void *) &mbox->cmd, sizeof(fr_cmd_t)))
return -EFAULT;
len = mbox->cmd.length;
if (len && u_data && copy_to_user(u_data, (void *) &mbox->data, len))
@@ -632,7 +621,6 @@
}
/****** Network Device Interface ********************************************/
-
/*============================================================================
* Initialize Linux network interface.
*
@@ -645,7 +633,6 @@
fr_channel_t *chan = dev->priv;
sdla_t *card = chan->card;
wan_device_t *wandev = &card->wandev;
- int i;
/* Initialize device driver entry points */
dev->open = &if_open;
@@ -654,27 +641,22 @@
dev->rebuild_header = &if_rebuild_hdr;
dev->hard_start_xmit = &if_send;
dev->get_stats = &if_stats;
-
/* Initialize media-specific parameters */
- dev->family = AF_INET; /* address family */
- dev->type = ARPHRD_DLCI; /* ARP h/w type */
+ dev->type = ARPHRD_DLCI; /* ARP h/w type */
dev->mtu = FR_CHANNEL_MTU;
- dev->hard_header_len = FR_HEADER_LEN; /* media header length */
- dev->addr_len = 2; /* hardware address length */
+ dev->hard_header_len = FR_HEADER_LEN; /* media header length */
+ dev->addr_len = 2; /* hardware address length */
*(unsigned short *) dev->dev_addr = htons(chan->dlci);
-
/* Initialize hardware parameters (just for reference) */
dev->irq = wandev->irq;
dev->dma = wandev->dma;
dev->base_addr = wandev->ioport;
dev->mem_start = wandev->maddr;
dev->mem_end = wandev->maddr + wandev->msize - 1;
-
/* Set transmit buffer queue length */
- dev->tx_queue_len = 30;
-
+ dev->tx_queue_len = 10;
+ /* Initialize socket buffers */
dev_init_buffers(dev);
-
set_chan_state(dev, WAN_DISCONNECTED);
return 0;
}
@@ -695,124 +677,93 @@
int err = 0;
fr508_flags_t *flags = card->flags;
struct timeval tv;
-
if (dev->start)
return -EBUSY; /* only one open is allowed */
-
if (test_and_set_bit(0, (void *) &card->wandev.critical))
return -EAGAIN;
-
if (!card->open_cnt)
{
Intr_test_counter = 0;
card->intr_mode = INTR_TEST_MODE;
- err = intr_test( card );
-
- if ((err) || (Intr_test_counter !=(MAX_INTR_TEST_COUNTER +1))) {
- printk(KERN_INFO
- "%s: Interrupt Test Failed, Counter: %i\n",
- card->devname, Intr_test_counter);
+ err = intr_test(card);
+ if ((err) || (Intr_test_counter != (MAX_INTR_TEST_COUNTER + 1))) {
+ printk(KERN_INFO
+ "%s: Interrupt Test Failed, Counter: %i\n",
+ card->devname, Intr_test_counter);
err = -EIO;
card->wandev.critical = 0;
return err;
}
-
printk(KERN_INFO "%s: Interrupt Test Passed, Counter: %i\n"
- ,card->devname, Intr_test_counter);
-
+ ,card->devname, Intr_test_counter);
/* The following allocates and intializes a circular
* link list of interfaces per card.
*/
-
card->devs_struct = kmalloc(sizeof(load_sharing_t), GFP_KERNEL);
if (card->devs_struct == NULL)
- return -ENOMEM;
+ return -ENOMEM;
card->dev_to_devtint_next = card->devs_struct;
-
for (dev2 = card->wandev.dev; dev2; dev2 = dev2->slave) {
(card->devs_struct)->dev_ptr = dev2;
- if(dev2->slave == NULL)
+ if (dev2->slave == NULL)
(card->devs_struct)->next = card->dev_to_devtint_next;
else {
(card->devs_struct)->next = kmalloc(
- sizeof(load_sharing_t), GFP_KERNEL);
+ sizeof(load_sharing_t), GFP_KERNEL);
if ((card->devs_struct)->next == NULL)
- return -ENOMEM;
+ return -ENOMEM;
card->devs_struct = (card->devs_struct)->next;
- }
+ }
}
-
card->devs_struct = card->dev_to_devtint_next;
-
- card->intr_mode = BUFFER_INTR_MODE;
-
+ card->intr_mode = BUFFER_INTR_MODE;
/*
- check all the interfaces for the device to see if CIR has
- been enabled for any DLCI(s). If so then use the DLCI list
- Interrupt mode for fr_set_intr_mode(), otherwise use the default global interrupt mode
- */
-
+ check all the interfaces for the device to see if CIR has
+ been enabled for any DLCI(s). If so then use the DLCI list
+ Interrupt mode for fr_set_intr_mode(), otherwise use the default global interrupt mode
+ */
for (dev2 = card->wandev.dev; dev2; dev2 = dev2->slave) {
-
- if( ((fr_channel_t *)dev2->priv)->cir_status
- == CIR_ENABLED) {
+ if (((fr_channel_t *) dev2->priv)->cir_status
+ == CIR_ENABLED) {
card->intr_mode = DLCI_LIST_INTR_MODE;
break;
}
}
-
/*
- * If you enable comms and then set ints, you get a Tx int as you
- * perform the SET_INT_TRIGGERS command. So, we only set int
- * triggers and then adjust the interrupt mask (to disable Tx ints) before enabling comms.
+ If you enable comms and then set ints, you get a Tx int as you
+ perform the SET_INT_TRIGGERS command. So, we only set int
+ triggers and then adjust the interrupt mask (to disable Tx ints) before enabling comms.
*/
- if (card->intr_mode == BUFFER_INTR_MODE)
- {
- if (fr_set_intr_mode(card, 0x03, card->wandev.mtu))
- {
+ if (card->intr_mode == BUFFER_INTR_MODE) {
+ if (fr_set_intr_mode(card, 0x03, card->wandev.mtu)) {
err = -EIO;
card->wandev.critical = 0;
return err;
}
-
- printk( KERN_INFO
- "%s: Global Buffering Tx Interrupt Mode\n"
- , card->devname);
-
- }
- else if (card->intr_mode == DLCI_LIST_INTR_MODE)
- {
- if (fr_set_intr_mode(card, 0x83, card->wandev.mtu))
- {
+ printk(KERN_INFO
+ "%s: Global Buffering Tx Interrupt Mode\n"
+ ,card->devname);
+ } else if (card->intr_mode == DLCI_LIST_INTR_MODE) {
+ if (fr_set_intr_mode(card, 0x83, card->wandev.mtu)) {
err = -EIO;
card->wandev.critical = 0;
return err;
}
-
- printk( KERN_INFO "%s: DLCI list Tx Interrupt Mode\n",
- card->devname);
-
+ printk(KERN_INFO
+ "%s: DLCI list Tx Interrupt Mode\n",
+ card->devname);
}
-
flags->imask &= ~0x02;
-
- if (fr_comm_enable(card))
- {
+ if (fr_comm_enable(card)) {
err = -EIO;
card->wandev.critical = 0;
return err;
- }
-
+ }
wanpipe_set_state(card, WAN_CONNECTED);
-
- if (card->wandev.station == WANOPT_CPE)
- {
+ if (card->wandev.station == WANOPT_CPE) {
/* CPE: issue full status enquiry */
fr_issue_isf(card, FR_ISF_FSE);
- }
- else
- { /* FR switch: activate DLCI(s) */
-
+ } else { /* FR switch: activate DLCI(s) */
/* For Switch emulation we have to ADD and ACTIVATE
* the DLCI(s) that were configured with the SET_DLCI_
* CONFIGURATION command. Add and Activate will fail if
@@ -820,12 +771,13 @@
*
* Also If_open is called once for each interface. But
* it does not get in here for all the interface. So
- * we have to pass the entire list of DLCI(s) to add
+ * we have to pass the entire list of DLCI(s) to add
* activate routines.
- */
-
- fr_add_dlci(card, card->u.f.node_dlci[0], card->u.f.dlci_num);
- fr_activate_dlci(card, card->u.f.node_dlci, card->u.f.dlci_num);
+ */
+ fr_add_dlci(card,
+ card->u.f.node_dlci[0], card->u.f.dlci_num);
+ fr_activate_dlci(card,
+ card->u.f.node_dlci[0], card->u.f.dlci_num);
}
}
dev->mtu = min(dev->mtu, card->wandev.mtu - FR_HEADER_LEN);
@@ -834,8 +786,7 @@
dev->start = 1;
wanpipe_open(card);
update_chan_state(dev);
-
- do_gettimeofday( &tv );
+ do_gettimeofday(&tv);
chan->router_start_time = tv.tv_sec;
card->wandev.critical = 0;
return err;
@@ -846,17 +797,17 @@
* o if this is the last open, then disable communications and interrupts.
* o reset flags.
*/
+
static int if_close(struct device *dev)
{
fr_channel_t *chan = dev->priv;
sdla_t *card = chan->card;
-
if (test_and_set_bit(0, (void *) &card->wandev.critical))
return -EAGAIN;
- ;
dev->start = 0;
wanpipe_close(card);
- if (!card->open_cnt) {
+ if (!card->open_cnt)
+ {
wanpipe_set_state(card, WAN_DISCONNECTED);
fr_set_intr_mode(card, 0, 0);
fr_comm_disable(card);
@@ -875,14 +826,15 @@
*
* Return: media header length.
*/
+
static int if_header(struct sk_buff *skb, struct device *dev,
unsigned short type, void *daddr, void *saddr, unsigned len)
{
int hdr_len = 0;
-
skb->protocol = type;
hdr_len = wan_encapsulate(skb, dev);
- if (hdr_len < 0) {
+ if (hdr_len < 0)
+ {
hdr_len = 0;
skb->protocol = 0;
}
@@ -898,13 +850,14 @@
* Return: 1 physical address resolved.
* 0 physical address not resolved
*/
+
static int if_rebuild_hdr(struct sk_buff *skb)
{
- fr_channel_t *chan = skb->dev->priv;
+ struct device *dev=skb->dev;
+ fr_channel_t *chan = dev->priv;
sdla_t *card = chan->card;
-
printk(KERN_INFO "%s: rebuild_header() called for interface %s!\n",
- card->devname, skb->dev->name);
+ card->devname, dev->name);
return 1;
}
@@ -926,80 +879,101 @@
* 2. Setting tbusy flag will inhibit further transmit requests from the
* protocol stack and can be used for flow control with protocol layer.
*/
+
static int if_send(struct sk_buff *skb, struct device *dev)
{
fr_channel_t *chan = dev->priv;
sdla_t *card = chan->card;
int retry = 0, err;
+ unsigned char *sendpacket;
struct device *dev2;
- fr508_flags_t* adptr_flags = card->flags;
- fr_dlci_interface_t* dlci_interface = chan->dlci_int_interface;
+ unsigned long check_braddr, check_mcaddr;
+ fr508_flags_t *adptr_flags = card->flags;
+ int udp_type, send_data;
+ fr_dlci_interface_t *dlci_interface = chan->dlci_int_interface;
unsigned long host_cpu_flags;
- int send_data = 0;
- ++chan->if_send_entry;
+ ++chan->if_send_entry;
- if (dev->tbusy)
- {
+ if (dev->tbusy)
+ {
/* If our device stays busy for at least 5 seconds then we will
- * kick start the device by making dev->tbusy = 0. We expect
- * that our device never stays busy more than 5 seconds. So this * is only used as a last resort.
- */
-
+ * kick start the device by making dev->tbusy = 0. We expect
+ * that our device never stays busy more than 5 seconds. So this * is only used as a last resort.
+ */
++chan->if_send_busy;
++chan->ifstats.collisions;
-
- if ((jiffies - chan->tick_counter) < (5*HZ))
+ if ((jiffies - chan->tick_counter) < (5 * HZ))
return 1;
printk(KERN_INFO "%s: Transmit timed out\n", chan->name);
-
++chan->if_send_busy_timeout;
-
/* unbusy all the interfaces on the card */
- for (dev2 = card->wandev.dev; dev2; dev2 = dev2->slave)
+ for (dev2 = card->wandev.dev; dev2; dev2 = dev2->slave)
dev2->tbusy = 0;
- }
-
- if (test_and_set_bit(0, (void *) &card->wandev.critical)) {
-#ifdef _DEBUG_
- printk(KERN_INFO "%s: if_send() hit critical section!\n",
- card->devname);
-#endif
+ }
+ sendpacket = skb->data;
+ udp_type = udp_pkt_type(skb, card);
+ if (udp_type == UDP_DRVSTATS_TYPE)
+ {
+ ++chan->if_send_DRVSTATS_request;
+ process_udp_driver_call(UDP_PKT_FRM_STACK, card, skb, dev, 0,
+ chan);
+ dev_kfree_skb(skb);
+ return 0;
+ }
+ else if (udp_type == UDP_FPIPE_TYPE)
+ ++chan->if_send_FPIPE_request;
+ /* retreive source address in two forms: broadcast & multicast */
+ check_braddr = sendpacket[17];
+ check_mcaddr = sendpacket[14];
+ check_braddr = check_braddr << 8;
+ check_mcaddr = check_mcaddr << 8;
+ check_braddr |= sendpacket[16];
+ check_mcaddr |= sendpacket[15];
+ check_braddr = check_braddr << 8;
+ check_mcaddr = check_mcaddr << 8;
+ check_braddr |= sendpacket[15];
+ check_mcaddr |= sendpacket[16];
+ check_braddr = check_braddr << 8;
+ check_mcaddr = check_mcaddr << 8;
+ check_braddr |= sendpacket[14];
+ check_mcaddr |= sendpacket[17];
+ /* if the Source Address is a Multicast address */
+ if ((chan->mc == WANOPT_NO) && (check_mcaddr >= 0xE0000001) &&
+ (check_mcaddr <= 0xFFFFFFFE))
+ {
+ printk(KERN_INFO "%s: Multicast Src. Addr. silently discarded\n"
+ ,card->devname);
dev_kfree_skb(skb);
+ ++chan->ifstats.tx_dropped;
+ ++chan->if_send_multicast;
return 0;
}
- disable_irq(card->hw.irq);
+ disable_irq(card->hw.irq);
++card->irq_dis_if_send_count;
-
- if (test_and_set_bit(0, (void*)&card->wandev.critical))
+ if (test_and_set_bit(0, (void *) &card->wandev.critical))
{
if (card->wandev.critical == CRITICAL_IN_ISR)
- {
+ {
++chan->if_send_critical_ISR;
-
- if (card->intr_mode == DLCI_LIST_INTR_MODE)
+ if (card->intr_mode == DLCI_LIST_INTR_MODE)
{
/* The enable_tx_int flag is set here so that if
- * the critical flag is set due to an interrupt
+ * the critical flag is set due to an interrupt
* then we want to enable transmit interrupts
* again.
- */
-
+ */
card->wandev.enable_tx_int = 1;
-
/* Setting this flag to WAITING_TO_BE_ENABLED
* specifies that interrupt bit has to be
* enabled for that particular interface.
* (delayed interrupt)
- */
-
+ */
chan->tx_int_status = WAITING_TO_BE_ENABLED;
-
/* This is used for enabling dynamic calculation
* of CIRs relative to the packet length.
- */
-
- chan->pkt_length = skb->len;
+ */
+ chan->pkt_length = skb->len;
dev->tbusy = 1;
chan->tick_counter = jiffies;
}
@@ -1011,34 +985,36 @@
}
save_flags(host_cpu_flags);
cli();
- if ((!(--card->irq_dis_if_send_count)) &&
- (!card->irq_dis_poll_count))
+ if ((!(--card->irq_dis_if_send_count)) &&
+ (!card->irq_dis_poll_count))
enable_irq(card->hw.irq);
restore_flags(host_cpu_flags);
return 1;
}
-
++chan->if_send_critical_non_ISR;
++chan->ifstats.tx_dropped;
dev_kfree_skb(skb);
save_flags(host_cpu_flags);
cli();
- if ((!(--card->irq_dis_if_send_count)) &&
- (!card->irq_dis_poll_count))
- enable_irq(card->hw.irq);
+ if ((!(--card->irq_dis_if_send_count)) &&
+ (!card->irq_dis_poll_count))
+ enable_irq(card->hw.irq);
restore_flags(host_cpu_flags);
return 0;
}
-
card->wandev.critical = 0x21;
-
- if (card->wandev.state != WAN_CONNECTED)
+ if (udp_type == UDP_FPIPE_TYPE)
+ {
+ err = process_udp_mgmt_pkt(UDP_PKT_FRM_STACK, card, skb,
+ dev, 0, chan);
+ }
+ else if (card->wandev.state != WAN_CONNECTED)
{
++chan->if_send_wan_disconnected;
++chan->ifstats.tx_dropped;
++card->wandev.stats.tx_dropped;
}
- else if (chan->state != WAN_CONNECTED)
+ else if (chan->state != WAN_CONNECTED)
{
++chan->if_send_dlci_disconnected;
update_chan_state(dev);
@@ -1047,313 +1023,361 @@
}
else if (!is_tx_ready(card, chan))
{
- if (card->intr_mode == DLCI_LIST_INTR_MODE )
+ if (card->intr_mode == DLCI_LIST_INTR_MODE)
{
dlci_interface->gen_interrupt |= 0x40;
- dlci_interface->packet_length = skb->len;
- }
- dev->tbusy = 1;
+ dlci_interface->packet_length = skb->len;
+ }
+ dev->tbusy = 1;
chan->tick_counter = jiffies;
-
adptr_flags->imask |= 0x02;
-
- ++ chan->if_send_no_bfrs;
+ ++chan->if_send_no_bfrs;
retry = 1;
}
- else
+ else
{
send_data = 1;
/* If it's an IPX packet */
- if( sendpacket[1] == 0x00 &&
+ if (sendpacket[1] == 0x00 &&
sendpacket[2] == 0x80 &&
sendpacket[6] == 0x81 &&
sendpacket[7] == 0x37)
{
- if( card->wandev.enable_IPX )
+ if (card->wandev.enable_IPX)
{
- switch_net_numbers(sendpacket,
- card->wandev.network_number, 0);
- }
- else
+ switch_net_numbers(sendpacket,
+ card->wandev.network_number, 0);
+ }
+ else
{
/* increment some statistic here! */
send_data = 0;
}
}
-
- if (send_data)
+ if (send_data)
{
- err = (card->hw.fwid == SFID_FR508) ?
- fr508_send(card, chan->dlci, 0, skb->len, skb->data) :
- fr502_send(card, chan->dlci, 0, skb->len, skb->data);
-
+ err = (card->hw.fwid == SFID_FR508) ?
+ fr508_send(card, chan->dlci, 0, skb->len, skb->data) :
+ fr502_send(card, chan->dlci, 0, skb->len, skb->data);
if (err)
{
if (card->intr_mode == DLCI_LIST_INTR_MODE)
{
dlci_interface->gen_interrupt |= 0x40;
- dlci_interface->packet_length = skb->len;
- }
- dev->tbusy = 1;
+ dlci_interface->packet_length = skb->len;
+ }
+ dev->tbusy = 1;
chan->tick_counter = jiffies;
- adptr_flags->imask |= 0x02;
+ adptr_flags->imask |= 0x02;
retry = 1;
- ++ chan->if_send_adptr_bfrs_full;
- ++ chan->ifstats.tx_errors;
- ++ card->wandev.stats.tx_errors;
- }
- else
+ ++chan->if_send_adptr_bfrs_full;
+ ++chan->ifstats.tx_errors;
+ ++card->wandev.stats.tx_errors;
+ }
+ else
{
- ++ chan->if_send_bfrs_passed_to_adptr;
+ ++chan->if_send_bfrs_passed_to_adptr;
++chan->ifstats.tx_packets;
++card->wandev.stats.tx_packets;
}
}
}
-
if (!retry)
dev_kfree_skb(skb);
card->wandev.critical = 0;
save_flags(host_cpu_flags);
cli();
- if ((!(--card->irq_dis_if_send_count)) && (!card->irq_dis_poll_count))
- enable_irq(card->hw.irq);
+ if ((!(--card->irq_dis_if_send_count)) && (!card->irq_dis_poll_count))
+ enable_irq(card->hw.irq);
restore_flags(host_cpu_flags);
return retry;
}
+/*============================================================================
+ * Reply to UDP Management system.
+ * Return nothing.
+ */
+
+static int reply_udp(unsigned char *data, unsigned int mbox_len)
+{
+ unsigned short len, udp_length, temp, i, ip_length;
+ unsigned long sum;
+ /* Set length of packet */
+ len = mbox_len + 62;
+ /* fill in UDP reply */
+ data[38] = 0x02;
+ /* fill in UDP length */
+ udp_length = mbox_len + 40;
+ /* put it on an even boundary */
+ if (udp_length & 0x0001)
+ {
+ udp_length += 1;
+ len += 1;
+ }
+ temp = (udp_length << 8) | (udp_length >> 8);
+ memcpy(&data[26], &temp, 2);
+ /* swap UDP ports */
+ memcpy(&temp, &data[22], 2);
+ memcpy(&data[22], &data[24], 2);
+ memcpy(&data[24], &temp, 2);
+ /* add UDP pseudo header */
+ temp = 0x1100;
+ memcpy(&data[udp_length + 22], &temp, 2);
+ temp = (udp_length << 8) | (udp_length >> 8);
+ memcpy(&data[udp_length + 24], &temp, 2);
+ /* calculate UDP checksum */
+ data[28] = data[29] = 0;
+ sum = 0;
+ for (i = 0; i < udp_length + 12; i += 2)
+ {
+ memcpy(&temp, &data[14 + i], 2);
+ sum += (unsigned long) temp;
+ }
+ while (sum >> 16)
+ sum = (sum & 0xffffUL) + (sum >> 16);
+
+ temp = (unsigned short) sum;
+ temp = ~temp;
+ if (temp == 0)
+ temp = 0xffff;
+ memcpy(&data[28], &temp, 2);
+ /* fill in IP length */
+ ip_length = udp_length + 20;
+ temp = (ip_length << 8) | (ip_length >> 8);
+ memcpy(&data[4], &temp, 2);
+ /* swap IP addresses */
+ memcpy(&temp, &data[14], 2);
+ memcpy(&data[14], &data[18], 2);
+ memcpy(&data[18], &temp, 2);
+ memcpy(&temp, &data[16], 2);
+ memcpy(&data[16], &data[20], 2);
+ memcpy(&data[20], &temp, 2);
+ /* fill in IP checksum */
+ data[12] = data[13] = 0;
+ sum = 0;
+ for (i = 0; i < 20; i += 2)
+ {
+ memcpy(&temp, &data[2 + i], 2);
+ sum += (unsigned long) temp;
+ }
+ while (sum >> 16)
+ sum = (sum & 0xffffUL) + (sum >> 16);
+ temp = (unsigned short) sum;
+ temp = ~temp;
+ if (temp == 0)
+ temp = 0xffff;
+ memcpy(&data[12], &temp, 2);
+ return len;
+} /* reply_udp */
/*
- * If incoming is 0 (outgoing)- if the net numbers is ours make it 0
- * if incoming is 1 - if the net number is 0 make it ours
- *
+ If incoming is 0 (outgoing)- if the net numbers is ours make it 0
+ if incoming is 1 - if the net number is 0 make it ours
*/
-
+
static void switch_net_numbers(unsigned char *sendpacket, unsigned long network_number, unsigned char incoming)
{
unsigned long pnetwork_number;
-
- pnetwork_number = (unsigned long)((sendpacket[14] << 24) +
- (sendpacket[15] << 16) + (sendpacket[16] << 8) +
- sendpacket[17]);
-
+ pnetwork_number = (unsigned long) ((sendpacket[14] << 24) +
+ (sendpacket[15] << 16) + (sendpacket[16] << 8) +
+ sendpacket[17]);
if (!incoming) {
- if( pnetwork_number == network_number) {
- sendpacket[14] = sendpacket[15] = sendpacket[16] =
- sendpacket[17] = 0x00;
+ /* If the destination network number is ours, make it 0 */
+ if (pnetwork_number == network_number) {
+ sendpacket[14] = sendpacket[15] = sendpacket[16] =
+ sendpacket[17] = 0x00;
}
} else {
- if( pnetwork_number == 0) {
- sendpacket[14] = (unsigned char)(network_number >> 24);
- sendpacket[15] = (unsigned char)((network_number &
- 0x00FF0000) >> 16);
- sendpacket[16] = (unsigned char)((network_number &
- 0x0000FF00) >> 8);
- sendpacket[17] = (unsigned char)(network_number &
- 0x000000FF);
+ /* If the incoming network is 0, make it ours */
+ if (pnetwork_number == 0)
+ {
+ sendpacket[14] = (unsigned char) (network_number >> 24);
+ sendpacket[15] = (unsigned char) ((network_number &
+ 0x00FF0000) >> 16);
+ sendpacket[16] = (unsigned char) ((network_number &
+ 0x0000FF00) >> 8);
+ sendpacket[17] = (unsigned char) (network_number &
+ 0x000000FF);
}
}
-
-
- pnetwork_number = (unsigned long)((sendpacket[26] << 24) +
- (sendpacket[27] << 16) + (sendpacket[28] << 8) +
- sendpacket[29]);
-
- if( !incoming ) {
- if( pnetwork_number == network_number) {
- sendpacket[26] = sendpacket[27] = sendpacket[28] =
- sendpacket[29] = 0x00;
+ pnetwork_number = (unsigned long) ((sendpacket[26] << 24) +
+ (sendpacket[27] << 16) + (sendpacket[28] << 8) +
+ sendpacket[29]);
+ if (!incoming) {
+ /* If the source network is ours, make it 0 */
+ if (pnetwork_number == network_number)
+ {
+ sendpacket[26] = sendpacket[27] = sendpacket[28] =
+ sendpacket[29] = 0x00;
}
} else {
- if( pnetwork_number == 0 ) {
- sendpacket[26] = (unsigned char)(network_number >> 24);
- sendpacket[27] = (unsigned char)((network_number &
- 0x00FF0000) >> 16);
- sendpacket[28] = (unsigned char)((network_number &
- 0x0000FF00) >> 8);
- sendpacket[29] = (unsigned char)(network_number &
- 0x000000FF);
+ /* If the source network is 0, make it ours */
+ if (pnetwork_number == 0) {
+ sendpacket[26] = (unsigned char) (network_number >> 24);
+ sendpacket[27] = (unsigned char) ((network_number &
+ 0x00FF0000) >> 16);
+ sendpacket[28] = (unsigned char) ((network_number &
+ 0x0000FF00) >> 8);
+ sendpacket[29] = (unsigned char) (network_number &
+ 0x000000FF);
}
}
-} /* switch_net_numbers */
-
+} /* switch_net_numbers */
/*============================================================================
* Get ethernet-style interface statistics.
* Return a pointer to struct enet_statistics.
*/
+
static struct net_device_stats *if_stats(struct device *dev)
{
fr_channel_t *chan = dev->priv;
-
return &chan->ifstats;
}
/****** Interrupt Handlers **************************************************/
-
/*============================================================================
* S502 frame relay interrupt service routine.
*/
+
static void fr502_isr(sdla_t * card)
{
fr502_flags_t *flags = card->flags;
-
switch (flags->iflag)
{
case 0x01: /* receive interrupt */
fr502_rx_intr(card);
break;
-
case 0x02: /* transmit interrupt */
flags->imask &= ~0x02;
tx_intr(card);
break;
-
default:
spur_intr(card);
}
flags->iflag = 0;
}
-
/*============================================================================
* S508 frame relay interrupt service routine.
*/
+
static void fr508_isr(sdla_t * card)
{
fr508_flags_t *flags = card->flags;
fr_buf_ctl_t *bctl;
char *ptr = &flags->iflag;
- struct device* dev = card->wandev.dev;
- struct device* dev2;
+ struct device *dev = card->wandev.dev;
+ struct device *dev2;
int i;
unsigned long host_cpu_flags;
- unsigned disable_tx_intr =1;
- fr_channel_t* chan;
- fr_dlci_interface_t* dlci_interface;
-
+ unsigned disable_tx_intr = 1;
+ fr_channel_t *chan;
+ fr_dlci_interface_t *dlci_interface;
/* This flag prevents nesting of interrupts. See sdla_isr() routine
- * in sdlamain.c.
+ * in sdlamain.c.
*/
card->in_isr = 1;
-
++card->statistics.isr_entry;
-
- if (test_and_set_bit(0, (void*)&card->wandev.critical))
+ if (test_and_set_bit(0, (void *) &card->wandev.critical))
{
- printk(KERN_INFO "fr508_isr: %s, wandev.critical set to 0x%02X, int type = 0x%02X\n", card->devname, card->wandev.critical, flags->iflag);
+ printk(KERN_INFO "fr508_isr: %s, wandev.critical set to 0x%02X, int type = 0x%02X\n", card->devname, card->wandev.critical, flags->iflag);
++card->statistics.isr_already_critical;
card->in_isr = 0;
return;
}
- int_occur = 1;
-
/* For all interrupts set the critical flag to CRITICAL_RX_INTR.
- * If the if_send routine is called with this flag set it will set
- * the enable transmit flag to 1. (for a delayed interrupt)
- */
+ * If the if_send routine is called with this flag set it will set
+ * the enable transmit flag to 1. (for a delayed interrupt)
+ */
card->wandev.critical = CRITICAL_IN_ISR;
-
card->dlci_int_mode_unbusy = 0;
- card->buff_int_mode_unbusy = 0;
-
- switch (flags->iflag) {
- case 0x01: /* receive interrupt */
- ++card->statistics.isr_rx;
- fr508_rx_intr(card);
- break;
-
- case 0x02: /* transmit interrupt */
- ++card->statistics.isr_tx;
- bctl = (void*)(flags->tse_offs - FR_MB_VECTOR +
- card->hw.dpmbase);
+ card->buff_int_mode_unbusy = 0;
+ switch (flags->iflag)
+ {
+ case 0x01: /* receive interrupt */
+ ++card->statistics.isr_rx;
+ fr508_rx_intr(card);
+ break;
+ case 0x02: /* transmit interrupt */
+ ++card->statistics.isr_tx;
+ bctl = (void *) (flags->tse_offs - FR_MB_VECTOR +
+ card->hw.dpmbase);
bctl->flag = 0xA0;
-
- if (card->intr_mode == DLCI_LIST_INTR_MODE )
+ if (card->intr_mode == DLCI_LIST_INTR_MODE)
{
/* Find the structure and make it unbusy */
- dev = find_channel( card, flags->dlci);
+ dev = find_channel(card, flags->dlci);
dev->tbusy = 0;
-
/* This is used to perform devtint at the
* end of the isr
*/
card->dlci_int_mode_unbusy = 1;
-
/* check to see if any other interfaces are
* busy. If so then do not disable the tx
* interrupts
- */
- for (dev2 = card->wandev.dev; dev2;
- dev2 = dev2->slave)
+ */
+ for (dev2 = card->wandev.dev; dev2;
+ dev2 = dev2->slave)
{
- if ( dev2->tbusy == 1)
+ if (dev2->tbusy == 1)
{
disable_tx_intr = 0;
break;
- }
+ }
}
if (disable_tx_intr)
flags->imask &= ~0x02;
-
- }
+ }
else if (card->intr_mode == BUFFER_INTR_MODE)
{
- for (dev2 = card->wandev.dev; dev2;
- dev2 = dev2->slave)
+ for (dev2 = card->wandev.dev; dev2;
+ dev2 = dev2->slave)
{
- if ( !dev2 || !dev2->start )
+ if (!dev2 || !dev2->start)
{
- ++card->statistics.
- tx_intr_dev_not_started;
+ ++card->statistics.tx_intr_dev_not_started;
continue;
}
- if(dev2->tbusy)
+ if (dev2->tbusy)
{
card->buff_int_mode_unbusy = 1;
- ((fr_channel_t*)dev2->priv)->dev_pending_devtint = 1;
+ ((fr_channel_t *) dev2->priv)->dev_pending_devtint = 1;
dev2->tbusy = 0;
- } else
- ((fr_channel_t*)dev2->priv)->dev_pending_devtint = 0;
+ }
+ else
+ ((fr_channel_t *) dev2->priv)->dev_pending_devtint = 0;
}
- flags->imask &= ~0x02;
+ flags->imask &= ~0x02;
}
- break;
-
+ break;
case 0x08:
- Intr_test_counter++;
+ Intr_test_counter++;
++card->statistics.isr_intr_test;
- break;
-
+ break;
default:
- ++card->statistics.isr_spurious;
- spur_intr(card);
- printk(KERN_INFO "%s: Interrupt Type 0x%02X!\n",
- card->devname, flags->iflag);
-
- printk(KERN_INFO "%s: ID Bytes = ",card->devname);
- for(i = 0; i < 8; i ++)
+ ++card->statistics.isr_spurious;
+ spur_intr(card);
+ printk(KERN_INFO "%s: Interrupt Type 0x%02X!\n",
+ card->devname, flags->iflag);
+ printk(KERN_INFO "%s: ID Bytes = ", card->devname);
+ for (i = 0; i < 8; i++)
printk(KERN_INFO "0x%02X ", *(ptr + 0x28 + i));
- printk(KERN_INFO "\n");
-
+ printk(KERN_INFO "\n");
break;
- }
-
+ }
card->wandev.critical = CRITICAL_INTR_HANDLED;
if (card->wandev.enable_tx_int)
{
- if( card->intr_mode == DLCI_LIST_INTR_MODE )
- {
- for (dev2 = card->wandev.dev; dev2; dev2 = dev2->slave)
- {
- chan = dev2->priv;
- if ( chan->tx_int_status ==
- WAITING_TO_BE_ENABLED )
+ if (card->intr_mode == DLCI_LIST_INTR_MODE)
+ {
+ for (dev2 = card->wandev.dev; dev2; dev2 = dev2->slave)
+ {
+ chan = dev2->priv;
+ if (chan->tx_int_status == WAITING_TO_BE_ENABLED)
{
- dlci_interface =
- chan->dlci_int_interface;
+ dlci_interface = chan->dlci_int_interface;
dlci_interface->gen_interrupt |= 0x40;
- dlci_interface->packet_length =
- chan->pkt_length;
+ dlci_interface->packet_length = chan->pkt_length;
chan->tx_int_status = DISABLED;
}
}
@@ -1361,7 +1385,7 @@
card->wandev.enable_tx_int = 0;
flags->imask |= 0x02;
++card->statistics.isr_enable_tx_int;
- }
+ }
save_flags(host_cpu_flags);
cli();
card->in_isr = 0;
@@ -1369,35 +1393,30 @@
flags->iflag = 0;
card->wandev.critical = 0;
restore_flags(host_cpu_flags);
-
- /*
- * Device is now ready to send. The instant this is executed the If_Send
- * routine is called. That is why this is put at the bottom of the ISR
- * to prevent a endless loop condition caused by repeated Interrupts and
- * enable_tx_int flag.
+ /* Device is now ready to send. The instant this is executed the If_Send
+ routine is called. That is why this is put at the bottom of the ISR
+ to prevent a endless loop condition caused by repeated Interrupts and
+ enable_tx_int flag.
*/
-
- if(card->dlci_int_mode_unbusy)
- dev_tint(dev);
-
- if(card->buff_int_mode_unbusy)
+ if (card->dlci_int_mode_unbusy)
+ mark_bh(NET_BH);
+ if (card->buff_int_mode_unbusy)
{
for (;;)
{
- if (((fr_channel_t*)((card->devs_struct)->dev_ptr)->priv)->dev_pending_devtint == 1){
-
- ((fr_channel_t*)((card->devs_struct)->dev_ptr)->priv)->dev_pending_devtint=0;
- dev_tint((card->devs_struct)->dev_ptr);
+ if (((fr_channel_t *) ((card->devs_struct)->dev_ptr)->priv)->dev_pending_devtint == 1)
+ {
+ ((fr_channel_t *) ((card->devs_struct)->dev_ptr)->priv)->dev_pending_devtint = 0;
+ mark_bh(NET_BH);
}
if ((card->devs_struct)->next == card->dev_to_devtint_next)
break;
card->devs_struct = (card->devs_struct)->next;
}
card->devs_struct = (card->dev_to_devtint_next)->next;
- card->dev_to_devtint_next = card->devs_struct;
+ card->dev_to_devtint_next = card->devs_struct;
}
}
-
/*============================================================================
* Receive interrupt handler.
*/
@@ -1410,28 +1429,31 @@
fr_channel_t *chan;
unsigned dlci, len;
void *buf;
-
+ unsigned char *sendpacket;
+ unsigned char buf2[3];
+ int udp_type;
sdla_mapmem(&card->hw, FR502_RX_VECTOR);
-
dlci = mbox->cmd.dlci;
len = mbox->cmd.length;
-
/* Find network interface for this packet */
dev = find_channel(card, dlci);
- if (dev == NULL) {
+ if (dev == NULL)
+ {
/* Invalid channel, discard packet */
printk(KERN_INFO "%s: receiving on orphaned DLCI %d!\n",
card->devname, dlci);
sdla_mapmem(&card->hw, FR_MB_VECTOR);
}
chan = dev->priv;
- if (!dev->start) {
+ if (!dev->start)
+ {
++chan->ifstats.rx_dropped;
sdla_mapmem(&card->hw, FR_MB_VECTOR);
}
/* Allocate socket buffer */
skb = dev_alloc_skb(len);
- if (skb == NULL) {
+ if (skb == NULL)
+ {
printk(KERN_INFO "%s: no socket buffers available!\n",
card->devname);
++chan->ifstats.rx_dropped;
@@ -1441,26 +1463,50 @@
buf = skb_put(skb, len);
memcpy(buf, mbox->data, len);
sdla_mapmem(&card->hw, FR_MB_VECTOR);
-
- /* Decapsulate packet and pass it up the protocol stack */
- skb->dev = dev;
- buf = skb_pull(skb, 1); /* remove hardware header */
- if (!wan_type_trans(skb, dev)) {
- /* can't decapsulate packet */
- dev_kfree_skb(skb);
- ++chan->ifstats.rx_errors;
- ++card->wandev.stats.rx_errors;
- } else {
- netif_rx(skb);
- ++chan->ifstats.rx_packets;
- ++card->wandev.stats.rx_packets;
+ /* Check if it's a UDP management packet */
+ sendpacket = skb->data;
+ memcpy(&buf2, &card->wandev.udp_port, 2);
+ udp_type = udp_pkt_type(skb, card);
+ if ((udp_type == UDP_FPIPE_TYPE) || (udp_type == UDP_DRVSTATS_TYPE))
+ {
+ if (udp_type == UDP_DRVSTATS_TYPE)
+ {
+ ++chan->rx_intr_DRVSTATS_request;
+ process_udp_driver_call(UDP_PKT_FRM_NETWORK, card, skb,
+ dev, dlci, chan);
+ }
+ else
+ {
+ ++chan->rx_intr_FPIPE_request;
+ process_udp_mgmt_pkt(UDP_PKT_FRM_NETWORK, card, skb,
+ dev, dlci, chan);
+ }
+ }
+ else
+ {
+ /* Decapsulate packet and pass it up the protocol stack */
+ skb->dev = dev;
+ buf = skb_pull(skb, 1); /* remove hardware header */
+ if (!wan_type_trans(skb, dev))
+ {
+ /* can't decapsulate packet */
+ dev_kfree_skb(skb);
+ ++chan->ifstats.rx_errors;
+ ++card->wandev.stats.rx_errors;
+ }
+ else
+ {
+ netif_rx(skb);
+ ++chan->ifstats.rx_packets;
+ ++card->wandev.stats.rx_packets;
+ }
}
sdla_mapmem(&card->hw, FR_MB_VECTOR);
}
-
/*============================================================================
* Receive interrupt handler.
*/
+
static void fr508_rx_intr(sdla_t * card)
{
fr_buf_ctl_t *frbuf = card->rxmb;
@@ -1470,134 +1516,127 @@
unsigned dlci, len, offs;
void *buf;
unsigned rx_count = 0;
- fr508_flags_t* flags = card->flags;
+ fr508_flags_t *flags = card->flags;
char *ptr = &flags->iflag;
- int i, err;
-
- if (frbuf->flag != 0x01) {
- printk(KERN_INFO "%s: corrupted Rx buffer @ 0x%X!\n",
- card->devname, (unsigned) frbuf);
- printk(KERN_INFO "%s: ID Bytes = ",card->devname);
- for(i = 0; i < 8; i ++)
+ int i, err, udp_type;
+ if (frbuf->flag != 0x01)
+ {
+ printk(KERN_INFO
+ "%s: corrupted Rx buffer @ 0x%X, flag = 0x%02X!\n",
+ card->devname, (unsigned) frbuf, frbuf->flag);
+ printk(KERN_INFO "%s: ID Bytes = ", card->devname);
+ for (i = 0; i < 8; i++)
printk(KERN_INFO "0x%02X ", *(ptr + 0x28 + i));
printk(KERN_INFO "\n");
-
++card->statistics.rx_intr_corrupt_rx_bfr;
return;
}
-
- do
+
+ do
{
- len = frbuf->length;
+ len = frbuf->length;
dlci = frbuf->dlci;
offs = frbuf->offset;
-
/* Find network interface for this packet */
dev = find_channel(card, dlci);
chan = dev->priv;
-
if (dev == NULL)
{
/* Invalid channel, discard packet */
printk(KERN_INFO "%s: receiving on orphaned DLCI %d!\n"
- , card->devname, dlci);
- ++card->statistics.rx_intr_on_orphaned_DLCI;
- }
+ ,card->devname, dlci);
+ ++card->statistics.rx_intr_on_orphaned_DLCI;
+ }
else
{
- skb = dev_alloc_skb(len);
- if (!dev->start || (skb == NULL))
- {
+ skb = dev_alloc_skb(len);
+ if (!dev->start || (skb == NULL))
+ {
++chan->ifstats.rx_dropped;
- if(dev->start)
+ if (dev->start)
{
- printk(KERN_INFO
- "%s: no socket buffers available!\n",
- card->devname);
- ++chan->rx_intr_no_socket;
-
- }
- else
- ++ chan->rx_intr_dev_not_started;
- }
+ printk(KERN_INFO
+ "%s: no socket buffers available!\n",
+ card->devname);
+ ++chan->rx_intr_no_socket;
+ } else
+ ++chan->rx_intr_dev_not_started;
+ }
else
{
/* Copy data to the socket buffer */
if ((offs + len) > card->u.f.rx_top + 1)
{
- unsigned tmp = card->u.f.rx_top -
- offs + 1;
-
+ unsigned tmp = card->u.f.rx_top - offs + 1;
buf = skb_put(skb, tmp);
sdla_peek(&card->hw, offs, buf, tmp);
offs = card->u.f.rx_base;
- len -= tmp;
- }
-
+ len -= tmp;
+ }
buf = skb_put(skb, len);
sdla_peek(&card->hw, offs, buf, len);
-#ifdef CONFIG_SANGOMA_MANAGER
- if (management_check(skb,card))
+ udp_type = udp_pkt_type(skb, card);
+ if (udp_type == UDP_DRVSTATS_TYPE)
{
++chan->rx_intr_DRVSTATS_request;
- }
- else
-#endif
- if (handle_IPXWAN(skb->data,card->devname, card->wandev.enable_IPX, card->wandev.network_number))
+ process_udp_driver_call(
+ UDP_PKT_FRM_NETWORK, card, skb,
+ dev, dlci, chan);
+ }
+ else if (udp_type == UDP_FPIPE_TYPE)
+ {
+ ++chan->rx_intr_FPIPE_request;
+ err = process_udp_mgmt_pkt(
+ UDP_PKT_FRM_NETWORK, card,
+ skb, dev, dlci, chan);
+ }
+ else if (handle_IPXWAN(skb->data, card->devname, card->wandev.enable_IPX, card->wandev.network_number))
{
if (card->wandev.enable_IPX)
- {
fr508_send(card, dlci, 0, skb->len, skb->data);
- } else {
- /* increment some statistic! */
- }
- }
- else
+ }
+ else
{
- /* Decapsulate packet and pass it up the
- protocol stack */
+ /* Decapsulate packet and pass it up the
+ protocol stack */
skb->dev = dev;
-
/* remove hardware header */
- buf = skb_pull(skb, 1);
-
+ buf = skb_pull(skb, 1);
if (!wan_type_trans(skb, dev))
{
/* can't decapsulate packet */
dev_kfree_skb(skb);
- ++chan->rx_intr_bfr_not_passed_to_stack;
- ++chan->ifstats.rx_errors;
- ++card->wandev.stats.rx_errors;
+ ++chan->
+ rx_intr_bfr_not_passed_to_stack;
+ ++chan->
+ ifstats.rx_errors;
+ ++card->
+ wandev.stats.rx_errors;
}
else
{
netif_rx(skb);
- ++ chan->rx_intr_bfr_passed_to_stack;
- ++ chan->ifstats.rx_packets;
- ++ card->wandev.stats.rx_packets;
+ ++chan->rx_intr_bfr_passed_to_stack;
+ ++chan->ifstats.rx_packets;
+ ++card->wandev.stats.rx_packets;
}
- }
- }
- }
-
- /* Release buffer element and calculate a pointer to the next
+ }
+ }
+ }
+ /* Release buffer element and calculate a pointer to the next
one */
- frbuf->flag = 0;
+ frbuf->flag = 0;
card->rxmb = ++frbuf;
-
- if ((void*)frbuf > card->u.f.rxmb_last)
+ if ((void *) frbuf > card->u.f.rxmb_last)
card->rxmb = card->u.f.rxmb_base;
-
/* The loop put in is temporary, that is why the break is
- * placed here. (?????)
+ * placed here. (?????)
*/
break;
-
- frbuf = card->rxmb;
-
- } while (frbuf->flag && ((++ rx_count) < 4));
+ frbuf = card->rxmb;
+ }
+ while (frbuf->flag && ((++rx_count) < 4));
}
-
/*============================================================================
* Transmit interrupt handler.
* o print a warning
@@ -1607,25 +1646,23 @@
static void tx_intr(sdla_t * card)
{
struct device *dev = card->wandev.dev;
-
if (card->intr_mode == BUFFER_INTR_MODE)
- {
+ {
for (; dev; dev = dev->slave)
{
- if ( !dev || !dev->start )
- {
- ++ card->statistics.tx_intr_dev_not_started;
+ if (!dev || !dev->start)
+ {
+ ++card->statistics.tx_intr_dev_not_started;
continue;
}
-
dev->tbusy = 0;
- dev_tint(dev);
+ mark_bh(NET_BH);
}
}
else
{
dev->tbusy = 0;
- dev_tint(dev);
+ mark_bh(NET_BH);
}
}
@@ -1635,70 +1672,75 @@
* o
* If number of spurious interrupts exceeded some limit, then ???
*/
+
static void spur_intr(sdla_t * card)
{
printk(KERN_INFO "%s: spurious interrupt!\n", card->devname);
}
/*
- Return 0 for non-IPXWAN packet
- 1 for IPXWAN packet or IPX is not enabled!
-
-*/
+ Return 0 for non-IPXWAN packet
+ 1 for IPXWAN packet or IPX is not enabled!
+ */
static int handle_IPXWAN(unsigned char *sendpacket, char *devname, unsigned char enable_IPX, unsigned long network_number)
{
int i;
-
- if( sendpacket[1] == 0x00 &&
+ if (sendpacket[1] == 0x00 &&
sendpacket[2] == 0x80 &&
sendpacket[6] == 0x81 &&
- sendpacket[7] == 0x37) {
-
- if(!enable_IPX) {
+ sendpacket[7] == 0x37)
+ {
+ /* It's an IPX packet */
+ if (!enable_IPX) {
+ /* Return 1 so we don't pass it up the stack. */
return 1;
}
- } else {
+ }
+ else
+ {
+ /* It's not IPX so return and pass it up the stack. */
return 0;
}
-
- if( sendpacket[24] == 0x90 &&
- sendpacket[25] == 0x04)
+ if (sendpacket[24] == 0x90 &&
+ sendpacket[25] == 0x04)
{
- if( sendpacket[10] == 0x02 &&
- sendpacket[42] == 0x00)
+ /* It's IPXWAN */
+ if (sendpacket[10] == 0x02 &&
+ sendpacket[42] == 0x00)
{
- printk(KERN_INFO "%s: Received IPXWAN Timer Request packet\n",devname);
-
- for(i = 49; sendpacket[i] == 0x00; i += 5)
+ /* It's a timer request packet */
+ printk(KERN_INFO "%s: Received IPXWAN Timer Request packet\n", devname);
+ /* Go through the routing options and answer no to every */
+ /* option except Unnumbered RIP/SAP */
+ for (i = 49; sendpacket[i] == 0x00; i += 5)
{
- if( sendpacket[i + 4] != 0x02)
+ /* 0x02 is the option for Unnumbered RIP/SAP */
+ if (sendpacket[i + 4] != 0x02)
{
sendpacket[i + 1] = 0;
}
}
-
- if( sendpacket[i] == 0x04 )
- {
+ /* Skip over the extended Node ID option */
+ if (sendpacket[i] == 0x04)
i += 8;
- }
-
- for(; sendpacket[i] == 0x80 ;)
+ /* We also want to turn off all header compression opt. */
+ for (; sendpacket[i] == 0x80;)
{
sendpacket[i + 1] = 0;
i += (sendpacket[i + 2] << 8) + (sendpacket[i + 3]) + 4;
}
-
+ /* Set the packet type to timer response */
sendpacket[42] = 0x01;
-
- printk(KERN_INFO "%s: Sending IPXWAN Timer Response\n",devname);
+ printk(KERN_INFO "%s: Sending IPXWAN Timer Response\n", devname);
}
- else if( sendpacket[42] == 0x02 )
+ else if (sendpacket[42] == 0x02)
{
- printk(KERN_INFO "%s: Received IPXWAN Information Request packet\n",devname);
-
+ /* This is an information request packet */
+ printk(KERN_INFO "%s: Received IPXWAN Information Request packet\n", devname);
+ /* Set the packet type to information response */
sendpacket[42] = 0x03;
-
+ /* Set the router name */
sendpacket[59] = 'F';
sendpacket[60] = 'P';
sendpacket[61] = 'I';
@@ -1706,39 +1748,35 @@
sendpacket[63] = 'E';
sendpacket[64] = '-';
sendpacket[65] = CVHexToAscii(network_number >> 28);
- sendpacket[66] = CVHexToAscii((network_number & 0x0F000000)>> 24);
- sendpacket[67] = CVHexToAscii((network_number & 0x00F00000)>> 20);
- sendpacket[68] = CVHexToAscii((network_number & 0x000F0000)>> 16);
- sendpacket[69] = CVHexToAscii((network_number & 0x0000F000)>> 12);
- sendpacket[70] = CVHexToAscii((network_number & 0x00000F00)>> 8);
- sendpacket[71] = CVHexToAscii((network_number & 0x000000F0)>> 4);
+ sendpacket[66] = CVHexToAscii((network_number & 0x0F000000) >> 24);
+ sendpacket[67] = CVHexToAscii((network_number & 0x00F00000) >> 20);
+ sendpacket[68] = CVHexToAscii((network_number & 0x000F0000) >> 16);
+ sendpacket[69] = CVHexToAscii((network_number & 0x0000F000) >> 12);
+ sendpacket[70] = CVHexToAscii((network_number & 0x00000F00) >> 8);
+ sendpacket[71] = CVHexToAscii((network_number & 0x000000F0) >> 4);
sendpacket[72] = CVHexToAscii(network_number & 0x0000000F);
- for(i = 73; i < 107; i+= 1)
- {
+ for (i = 73; i < 107; i += 1)
sendpacket[i] = 0;
- }
-
- printk(KERN_INFO "%s: Sending IPXWAN Information Response packet\n",devname);
+ printk(KERN_INFO "%s: Sending IPXWAN Information Response packet\n", devname);
}
else
{
- printk(KERN_INFO "%s: Unknown IPXWAN packet!\n",devname);
+ printk(KERN_INFO "%s: Unknown IPXWAN packet!\n", devname);
return 0;
}
-
- sendpacket[43] = (unsigned char)(network_number >> 24);
- sendpacket[44] = (unsigned char)((network_number & 0x00FF0000) >> 16);
- sendpacket[45] = (unsigned char)((network_number & 0x0000FF00) >> 8);
- sendpacket[46] = (unsigned char)(network_number & 0x000000FF);
-
+ /* Set the WNodeID to our network address */
+ sendpacket[43] = (unsigned char) (network_number >> 24);
+ sendpacket[44] = (unsigned char) ((network_number & 0x00FF0000) >> 16);
+ sendpacket[45] = (unsigned char) ((network_number & 0x0000FF00) >> 8);
+ sendpacket[46] = (unsigned char) (network_number & 0x000000FF);
return 1;
}
-
- switch_net_numbers(sendpacket, network_number ,1);
+ /* If we get here, its an IPX-data packet so it'll get passed up the stack. */
+ /* switch the network numbers */
+ switch_net_numbers(sendpacket, network_number, 1);
return 0;
}
-
/****** Background Polling Routines ****************************************/
/*============================================================================
@@ -1755,136 +1793,127 @@
static void wpf_poll(sdla_t * card)
{
- fr508_flags_t *flags;
+/* struct device* dev = card->wandev.dev; */
+ fr508_flags_t *flags = card->flags;
unsigned long host_cpu_flags;
-
++card->statistics.poll_entry;
-
- if (((jiffies - card->state_tick) < HZ) ||
- (card->intr_mode == INTR_TEST_MODE))
+ if (((jiffies - card->state_tick) < HZ) ||
+ (card->intr_mode == INTR_TEST_MODE))
return;
-
disable_irq(card->hw.irq);
++card->irq_dis_poll_count;
-
- if (test_and_set_bit(0, (void *)&card->wandev.critical))
+ if (test_and_set_bit(0, (void *) &card->wandev.critical))
{
- ++ card->statistics.poll_already_critical;
+ ++card->statistics.poll_already_critical;
save_flags(host_cpu_flags);
cli();
if ((!card->irq_dis_if_send_count) &&
- (!(--card->irq_dis_poll_count)))
- enable_irq(card->hw.irq);
+ (!(--card->irq_dis_poll_count)))
+ enable_irq(card->hw.irq);
restore_flags(host_cpu_flags);
-
return;
}
-
card->wandev.critical = 0x11;
-
- ++ card->statistics.poll_processed;
-
- if (flags->event) {
- fr_mbox_t* mbox = card->mbox;
+ ++card->statistics.poll_processed;
+ /* This is to be changed later ??? */
+ /*
+ if( dev && dev->tbusy && !(flags->imask & 0x02) ) {
+ printk(KERN_INFO "%s: Wpf_Poll: tbusy = 0x01, imask = 0x%02X\n", card->devname, flags->imask);
+ }
+ */
+ if (flags->event)
+ {
+ fr_mbox_t *mbox = card->mbox;
int err;
-
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
mbox->cmd.command = FR_READ_STATUS;
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
if (err)
fr_event(card, err, mbox);
}
-
card->wandev.critical = 0;
-
save_flags(host_cpu_flags);
cli();
- if ((!card->irq_dis_if_send_count) && (!(--card->irq_dis_poll_count)))
+ if ((!card->irq_dis_if_send_count) && (!(--card->irq_dis_poll_count)))
enable_irq(card->hw.irq);
restore_flags(host_cpu_flags);
-
card->state_tick = jiffies;
}
-
/****** Frame Relay Firmware-Specific Functions *****************************/
/*============================================================================
* Read firmware code version.
* o fill string str with firmware version info.
*/
+
static int fr_read_version(sdla_t * card, char *str)
{
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err;
-
- do {
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
mbox->cmd.command = FR_READ_CODE_VERSION;
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
- }
- while (err && retry-- && fr_event(card, err, mbox));
- if (!err && str) {
+ } while (err && retry-- && fr_event(card, err, mbox));
+
+ if (!err && str)
+ {
int len = mbox->cmd.length;
-
memcpy(str, mbox->data, len);
str[len] = '\0';
}
return err;
}
-
/*============================================================================
* Set global configuration.
*/
+
static int fr_configure(sdla_t * card, fr_conf_t * conf)
{
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int dlci_num = card->u.f.dlci_num;
int err, i;
-
- do {
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
memcpy(mbox->data, conf, sizeof(fr_conf_t));
-
- if (dlci_num) for (i = 0; i < dlci_num; ++i)
- ((fr_conf_t*)mbox->data)->dlci[i] =
- card->u.f.node_dlci[i];
-
+ if (dlci_num)
+ for (i = 0; i < dlci_num; ++i)
+ ((fr_conf_t *) mbox->data)->dlci[i] =
+ card->u.f.node_dlci[i];
mbox->cmd.command = FR_SET_CONFIG;
mbox->cmd.length =
sizeof(fr_conf_t) + dlci_num * sizeof(short);
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
+
return err;
}
-
/*============================================================================
* Set DLCI configuration.
*/
-static int fr_dlci_configure (sdla_t* card, fr_dlc_conf_t *conf, unsigned dlci)
+static int fr_dlci_configure(sdla_t * card, fr_dlc_conf_t * conf, unsigned dlci)
{
- fr_mbox_t* mbox = card->mbox;
+ fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err;
-
do
{
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
memcpy(mbox->data, conf, sizeof(fr_dlc_conf_t));
- mbox->cmd.dlci = (unsigned short) dlci;
+ mbox->cmd.dlci = (unsigned short) dlci;
mbox->cmd.command = FR_SET_CONFIG;
mbox->cmd.length = 0x0E;
-
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
-
- } while (err && retry--);
-
+ }
+ while (err && retry--);
return err;
}
-
/*============================================================================
* Set interrupt mode.
*/
@@ -1893,19 +1922,20 @@
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err;
-
- do {
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
- if (card->hw.fwid == SFID_FR502) {
+ if (card->hw.fwid == SFID_FR502)
+ {
fr502_intr_ctl_t *ictl = (void *) mbox->data;
-
memset(ictl, 0, sizeof(fr502_intr_ctl_t));
ictl->mode = mode;
ictl->tx_len = mtu;
mbox->cmd.length = sizeof(fr502_intr_ctl_t);
- } else {
+ }
+ else
+ {
fr508_intr_ctl_t *ictl = (void *) mbox->data;
-
memset(ictl, 0, sizeof(fr508_intr_ctl_t));
ictl->mode = mode;
ictl->tx_len = mtu;
@@ -1916,9 +1946,9 @@
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
+
return err;
}
-
/*============================================================================
* Enable communications.
*/
@@ -1927,16 +1957,16 @@
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err;
-
- do {
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
mbox->cmd.command = FR_COMM_ENABLE;
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
+
return err;
}
-
/*============================================================================
* Disable communications.
*/
@@ -1945,16 +1975,16 @@
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err;
-
- do {
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
mbox->cmd.command = FR_COMM_DISABLE;
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
+
return err;
}
-
/*============================================================================
* Get communications error statistics.
*/
@@ -1963,26 +1993,26 @@
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err;
-
- do {
+
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
mbox->cmd.command = FR_READ_ERROR_STATS;
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
-
- if (!err) {
- fr_comm_stat_t* stats = (void*)mbox->data;
-
- card->wandev.stats.rx_over_errors = stats->rx_overruns;
- card->wandev.stats.rx_crc_errors = stats->rx_bad_crc;
- card->wandev.stats.rx_missed_errors = stats->rx_aborts;
- card->wandev.stats.rx_length_errors = stats->rx_too_long;
+
+ if (!err)
+ {
+ fr_comm_stat_t *stats = (void *) mbox->data;
+ card->wandev.stats.rx_over_errors = stats->rx_overruns;
+ card->wandev.stats.rx_crc_errors = stats->rx_bad_crc;
+ card->wandev.stats.rx_missed_errors = stats->rx_aborts;
+ card->wandev.stats.rx_length_errors = stats->rx_too_long;
card->wandev.stats.tx_aborted_errors = stats->tx_aborts;
}
return err;
}
-
/*============================================================================
* Get statistics.
*/
@@ -1991,74 +2021,68 @@
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err;
-
- do {
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
mbox->cmd.command = FR_READ_STATISTICS;
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
-
- if (!err) {
+
+ if (!err)
+ {
fr_link_stat_t *stats = (void *) mbox->data;
-
card->wandev.stats.rx_frame_errors = stats->rx_bad_format;
- card->wandev.stats.rx_dropped =
- stats->rx_dropped + stats->rx_dropped2
- ;
+ card->wandev.stats.rx_dropped = stats->rx_dropped + stats->rx_dropped2;
}
return err;
}
-
/*============================================================================
- * Add DLCI(s) (Access Node only!).
+ * Add DLCI(s) (Access Node only!).
+ * This routine will perform the ADD_DLCIs command for the specified DLCI.
*/
-
static int fr_add_dlci(sdla_t * card, int dlci, int num)
{
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err, i;
-
- do {
+ do
+ {
unsigned short *dlci_list = (void *) mbox->data;
-
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
for (i = 0; i < num; ++i)
dlci_list[i] = card->u.f.node_dlci[i];
-
mbox->cmd.length = num * sizeof(short);
mbox->cmd.command = FR_ADD_DLCI;
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
+
return err;
}
-
/*============================================================================
* Activate DLCI(s) (Access Node only!).
+ * This routine will perform the ACTIVATE_DLCIs command with a list of DLCIs.
*/
static int fr_activate_dlci(sdla_t * card, int dlci, int num)
{
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err, i;
-
- do {
+ do
+ {
unsigned short *dlci_list = (void *) mbox->data;
-
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
for (i = 0; i < num; ++i)
dlci_list[i] = card->u.f.node_dlci[i];
-
mbox->cmd.length = num * sizeof(short);
mbox->cmd.command = FR_ACTIVATE_DLCI;
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
+
return err;
}
-
/*============================================================================
* Issue in-channel signalling frame.
*/
@@ -2067,8 +2091,8 @@
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err;
-
- do {
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
mbox->data[0] = isf;
mbox->cmd.length = 1;
@@ -2076,9 +2100,9 @@
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
+
return err;
}
-
/*============================================================================
* Send a frame (S502 version).
*/
@@ -2087,8 +2111,9 @@
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err;
-
- do {
+
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
memcpy(mbox->data, buf, len);
mbox->cmd.dlci = dlci;
@@ -2098,9 +2123,9 @@
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
+
return err;
}
-
/*============================================================================
* Send a frame (S508 version).
*/
@@ -2109,8 +2134,9 @@
fr_mbox_t *mbox = card->mbox;
int retry = MAX_CMD_RETRY;
int err;
-
- do {
+
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
mbox->cmd.dlci = dlci;
mbox->cmd.attr = attr;
@@ -2119,8 +2145,9 @@
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
-
- if (!err) {
+
+ if (!err)
+ {
fr_buf_ctl_t *frbuf = (void *) (*(unsigned long *) mbox->data -
FR_MB_VECTOR + card->hw.dpmbase);
sdla_poke(&card->hw, frbuf->offset, buf, len);
@@ -2138,53 +2165,47 @@
*
* Return zero if previous command has to be cancelled.
*/
+
static int fr_event(sdla_t * card, int event, fr_mbox_t * mbox)
{
- fr508_flags_t* flags = card->flags;
+ fr508_flags_t *flags = card->flags;
char *ptr = &flags->iflag;
int i;
-
switch (event)
{
case FRRES_MODEM_FAILURE:
return fr_modem_failure(card, mbox);
-
case FRRES_CHANNEL_DOWN:
wanpipe_set_state(card, WAN_DISCONNECTED);
return 1;
-
case FRRES_CHANNEL_UP:
wanpipe_set_state(card, WAN_CONNECTED);
return 1;
-
case FRRES_DLCI_CHANGE:
return fr_dlci_change(card, mbox);
-
case FRRES_DLCI_MISMATCH:
- printk(KERN_INFO "%s: DLCI list mismatch!\n", card->devname);
+ printk(KERN_INFO "%s: DLCI list mismatch!\n",
+ card->devname);
return 1;
-
case CMD_TIMEOUT:
printk(KERN_ERR "%s: command 0x%02X timed out!\n",
card->devname, mbox->cmd.command);
- printk(KERN_INFO "%s: ID Bytes = ",card->devname);
- for(i = 0; i < 8; i ++)
+ printk(KERN_INFO "%s: ID Bytes = ", card->devname);
+ for (i = 0; i < 8; i++)
printk(KERN_INFO "0x%02X ", *(ptr + 0x28 + i));
- printk(KERN_INFO "\n");
- break;
-
+ printk(KERN_INFO "\n");
+ break;
case FRRES_DLCI_INACTIVE:
- printk(KERN_ERR "%s: DLCI %u is inactive!\n",
- card->devname, mbox->cmd.dlci);
+ printk(KERN_ERR "%s: DLCI %u is inactive!\n",
+ card->devname, mbox->cmd.dlci);
break;
-
case FRRES_CIR_OVERFLOW:
break;
case FRRES_BUFFER_OVERFLOW:
- break;
+ break;
default:
- printk(KERN_INFO "%s: command 0x%02X returned 0x%02X!\n",
- card->devname, mbox->cmd.command, event);
+ printk(KERN_INFO "%s: command 0x%02X returned 0x%02X!\n"
+ ,card->devname, mbox->cmd.command, event);
}
return 0;
}
@@ -2206,7 +2227,6 @@
}
return 1;
}
-
/*============================================================================
* Handle DLCI status change.
*
@@ -2218,18 +2238,18 @@
int cnt = mbox->cmd.length / sizeof(dlci_status_t);
fr_dlc_conf_t cfg;
fr_channel_t *chan;
- struct device* dev2;
-
- for (; cnt; --cnt, ++status) {
+ struct device *dev2;
+ for (; cnt; --cnt, ++status)
+ {
unsigned short dlci = status->dlci;
struct device *dev = find_channel(card, dlci);
-
- if (dev == NULL)
+ if (dev == NULL)
{
- printk(KERN_INFO "%s: CPE contains unconfigured DLCI= %d\n",
- card->devname, dlci);
+ printk(KERN_INFO
+ "%s: CPE contains unconfigured DLCI= %d\n",
+ card->devname, dlci);
}
- else
+ else
{
if (status->state & 0x01)
{
@@ -2242,68 +2262,56 @@
else if (status->state & 0x02)
{
printk(KERN_INFO
- "%s: DLCI %u becomes active!\n",
- card->devname, dlci);
+ "%s: DLCI %u becomes active!\n",
+ card->devname, dlci);
chan = dev->priv;
/* This flag is used for configuring specific
DLCI(s) when they become active.
- */
+ */
chan->dlci_configured = DLCI_CONFIG_PENDING;
-
if (dev && dev->start)
set_chan_state(dev, WAN_CONNECTED);
}
}
}
-
- for (dev2 =card->wandev.dev; dev2; dev2 = dev2->slave)
- {
+ for (dev2 = card->wandev.dev; dev2; dev2 = dev2->slave)
+ {
chan = dev2->priv;
-
- if (chan->dlci_configured == DLCI_CONFIG_PENDING)
+ if (chan->dlci_configured == DLCI_CONFIG_PENDING)
{
memset(&cfg, 0, sizeof(cfg));
-
- if ( chan->cir_status == CIR_DISABLED)
+ if (chan->cir_status == CIR_DISABLED)
{
- cfg.cir_fwd = cfg.cir_bwd = 16;
+ cfg.cir_fwd = cfg.cir_bwd = 16;
cfg.bc_fwd = cfg.bc_bwd = 16;
- cfg.conf_flags = 0x0001;
- printk(KERN_INFO "%s: CIR Disabled for %s\n",
- card->devname, chan->name);
- }
- else if (chan->cir_status == CIR_ENABLED)
- {
+ cfg.conf_flags = 0x0001;
+ printk(KERN_INFO "%s: CIR Disabled for %s\n",
+ card->devname, chan->name);
+ } else if (chan->cir_status == CIR_ENABLED) {
cfg.cir_fwd = cfg.cir_bwd = chan->cir;
- cfg.bc_fwd = cfg.bc_bwd = chan->bc;
- cfg.be_fwd = cfg.be_bwd = chan->be;
+ cfg.bc_fwd = cfg.bc_bwd = chan->bc;
+ cfg.be_fwd = cfg.be_bwd = chan->be;
cfg.conf_flags = 0x0000;
printk(KERN_INFO "%s: CIR Enabled for %s\n",
- card->devname, chan->name);
-
+ card->devname, chan->name);
}
-
- if (fr_dlci_configure( card, &cfg , chan->dlci))
+ if (fr_dlci_configure(card, &cfg, chan->dlci))
{
- printk(KERN_INFO
- "%s: DLCI Configure failed for %d\n",
- card->devname, chan->dlci);
- return 1;
+ printk(KERN_INFO
+ "%s: DLCI Configure failed for %d\n",
+ card->devname, chan->dlci);
+ return 1;
}
-
chan->dlci_configured = DLCI_CONFIGURED;
-
- /*
- * Read the interface byte mapping into the channel
- * structure.
+ /* Read the interface byte mapping into the channel
+ structure.
*/
if (card->intr_mode == DLCI_LIST_INTR_MODE)
- read_DLCI_IB_mapping( card, chan );
- }
+ read_DLCI_IB_mapping(card, chan);
+ }
}
return 1;
}
-
/******* Miscellaneous ******************************************************/
/*============================================================================
@@ -2318,17 +2326,18 @@
int err;
int dlci_found = 0;
- do {
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
mbox->cmd.command = FR_LIST_ACTIVE_DLCI;
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
}
while (err && retry-- && fr_event(card, err, mbox));
- if (!err) {
+ if (!err)
+ {
unsigned short *list = (void *) mbox->data;
int cnt = mbox->cmd.length / sizeof(short);
-
for (; cnt; --cnt, ++list)
{
if (*list == chan->dlci)
@@ -2338,14 +2347,13 @@
break;
}
}
-
- if(!dlci_found)
- printk(KERN_INFO "%s: DLCI %u is inactive\n",
- card->devname, chan->dlci);
+ if (!dlci_found)
+ printk(KERN_INFO "%s: DLCI %u is inactive\n",
+ card->devname, chan->dlci);
}
+
return err;
}
-
/*============================================================================
* Set channel state.
*/
@@ -2354,27 +2362,27 @@
fr_channel_t *chan = dev->priv;
sdla_t *card = chan->card;
unsigned long flags;
-
+
save_flags(flags);
cli();
-
+
if (chan->state != state)
{
switch (state)
{
case WAN_CONNECTED:
printk(KERN_INFO "%s: interface %s connected!\n"
- , card->devname, dev->name);
+ ,card->devname, dev->name);
break;
case WAN_CONNECTING:
- printk(KERN_INFO
- "%s: interface %s connecting...\n",
- card->devname, dev->name);
+ printk(KERN_INFO
+ "%s: interface %s connecting...\n",
+ card->devname, dev->name);
break;
case WAN_DISCONNECTED:
- printk (KERN_INFO
- "%s: interface %s disconnected!\n",
- card->devname, dev->name);
+ printk(KERN_INFO
+ "%s: interface %s disconnected!\n",
+ card->devname, dev->name);
break;
}
chan->state = state;
@@ -2389,14 +2397,11 @@
static struct device *find_channel(sdla_t * card, unsigned dlci)
{
struct device *dev;
-
for (dev = card->wandev.dev; dev; dev = dev->slave)
if (((fr_channel_t *) dev->priv)->dlci == dlci)
- break
- ;
+ break;
return dev;
}
-
/*============================================================================
* Check to see if a frame can be sent. If no transmit buffers available,
* enable transmit interrupts.
@@ -2405,18 +2410,18 @@
* 0 - no buffers available
*/
-static int is_tx_ready(sdla_t * card)
+static int is_tx_ready(sdla_t * card, fr_channel_t * chan)
{
if (card->hw.fwid == SFID_FR508)
{
unsigned char sb = inb(card->hw.port);
-
if (sb & 0x02)
return 1;
- } else {
- fr502_flags_t* flags = card->flags;
-
- if (flags->tx_ready)
+ }
+ else
+ {
+ fr502_flags_t *flags = card->flags;
+ if (flags->tx_ready)
return 1;
flags->imask |= 0x02;
}
@@ -2430,7 +2435,6 @@
static unsigned int dec_to_uint(unsigned char *str, int len)
{
unsigned val;
-
if (!len)
len = strlen(str);
for (val = 0; len && is_digit(*str); ++str, --len)
@@ -2439,109 +2443,677 @@
}
/*==============================================================================
+ * Process UDP call of type FPIPE8ND
+ */
+
+static int process_udp_mgmt_pkt(char udp_pkt_src, sdla_t * card, struct sk_buff *skb, struct device *dev, int dlci, fr_channel_t * chan)
+{
+ int c_retry = MAX_CMD_RETRY;
+ unsigned char *data;
+ unsigned char *buf;
+ unsigned char buf2[5];
+ unsigned int loops, frames, len;
+ unsigned long data_ptr;
+ unsigned short real_len, buffer_length;
+ struct sk_buff *new_skb;
+ unsigned char *sendpacket;
+ fr_mbox_t *mbox = card->mbox;
+ int err;
+ struct timeval tv;
+ int udp_mgmt_req_valid = 1;
+ sendpacket = skb->data;
+ memcpy(&buf2, &card->wandev.udp_port, 2);
+ if ((data = kmalloc(2000, GFP_ATOMIC)) == NULL)
+ {
+ printk(KERN_INFO
+ "%s: Error allocating memory for UDP management cmnd 0x%02X",
+ card->devname, data[47]);
+ ++chan->UDP_FPIPE_mgmt_kmalloc_err;
+ return 1;
+ }
+ memcpy(data, sendpacket, skb->len);
+ switch (data[47])
+ {
+ /* FPIPE_ENABLE_TRACE */
+ case 0x41:
+ /* FPIPE_DISABLE_TRACE */
+ case 0x42:
+ /* FPIPE_GET_TRACE_INFO */
+ case 0x43:
+ /* SET FT1 MODE */
+ case 0x81:
+ if (udp_pkt_src == UDP_PKT_FRM_NETWORK)
+ {
+ ++chan->UDP_FPIPE_mgmt_direction_err;
+ udp_mgmt_req_valid = 0;
+ break;
+ }
+ /* FPIPE_FT1_READ_STATUS */
+ case 0x44:
+ /* FT1 MONITOR STATUS */
+ case 0x80:
+ if (card->hw.fwid != SFID_FR508)
+ {
+ ++chan->UDP_FPIPE_mgmt_adptr_type_err;
+ udp_mgmt_req_valid = 0;
+ }
+ break;
+ default:
+ break;
+ }
+ if (!udp_mgmt_req_valid)
+ {
+ /* set length to 0 */
+ data[48] = data[49] = 0;
+ /* set return code */
+ data[50] = (card->hw.fwid != SFID_FR508) ? 0x1F : 0xCD;
+ }
+ else
+ {
+ switch (data[47])
+ {
+ /* FPIPE_ENABLE_TRACE */
+ case 0x41:
+ if (!TracingEnabled)
+ {
+ do
+ {
+ /* SET_TRACE_CONFIGURATION */
+ mbox->cmd.command = 0x60;
+ mbox->cmd.length = 1;
+ mbox->cmd.dlci = 0x00;
+ mbox->data[0] = 0x37;
+ err = sdla_exec(mbox) ?
+ mbox->cmd.result : CMD_TIMEOUT;
+ }
+ while (err && c_retry-- && fr_event(card, err, mbox));
+
+ if (err)
+ {
+ TracingEnabled = 0;
+ /* set the return code */
+ data[50] = mbox->cmd.result;
+ mbox->cmd.length = 0;
+ break;
+ }
+ /* get num_frames */
+ sdla_peek(&card->hw, 0x9000, &num_frames, 2);
+ sdla_peek(&card->hw, 0x9002, &curr_trace_addr,4);
+ start_trace_addr = curr_trace_addr;
+ /* MAX_SEND_BUFFER_SIZE -
+ * sizeof(UDP_MGMT_PACKET) - 41 */
+ available_buffer_space = 1926;
+ /* set return code */
+ data[50] = 0;
+ }
+ else
+ {
+ /* set return code to line trace already
+ enabled */
+ data[50] = 1;
+ }
+ mbox->cmd.length = 0;
+ TracingEnabled = 1;
+ break;
+ /* FPIPE_DISABLE_TRACE */
+ case 0x42:
+ if (TracingEnabled)
+ {
+ do
+ {
+ /* SET_TRACE_CONFIGURATION */
+ mbox->cmd.command = 0x60;
+ mbox->cmd.length = 1;
+ mbox->cmd.dlci = 0x00;
+ mbox->data[0] = 0x36;
+ err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
+ }
+ while (err && c_retry-- && fr_event(card, err, mbox));
+ }
+ /* set return code */
+ data[50] = 0;
+ mbox->cmd.length = 0;
+ TracingEnabled = 0;
+ break;
+ /* FPIPE_GET_TRACE_INFO */
+ case 0x43:
+ /* Line trace cannot be performed on the 502 */
+ if (!TracingEnabled)
+ {
+ /* set return code */
+ data[50] = 1;
+ mbox->cmd.length = 0;
+ break;
+ }
+ buffer_length = 0;
+ loops = (num_frames < 20) ? num_frames : 20;
+ for (frames = 0; frames < loops; frames += 1)
+ {
+ sdla_peek(&card->hw, curr_trace_addr, &buf2, 1);
+ /* no data on board so exit */
+ if (buf2[0] == 0x00)
+ break;
+ /* 1+sizeof(FRAME_DATA) = 9 */
+ if ((available_buffer_space - buffer_length) < 9)
+ {
+ /* indicate we have more frames on board
+ and exit */
+ data[62] |= 0x02;
+ break;
+ }
+ /* get frame status */
+ sdla_peek(&card->hw, curr_trace_addr + 0x05, &data[62 + buffer_length], 1);
+ /* get time stamp */
+ sdla_peek(&card->hw, curr_trace_addr + 0x06, &data[66 + buffer_length], 2);
+ /* get frame length */
+ sdla_peek(&card->hw, curr_trace_addr + 0x01, &data[64 + buffer_length], 2);
+ /* get pointer to real data */
+ sdla_peek(&card->hw, curr_trace_addr + 0x0C,&data_ptr, 4);
+ /* see if we can fit the frame into the user buffer */
+ memcpy(&real_len, &data[64 + buffer_length], 2);
+ if (data_ptr == 0 || real_len + 8 > available_buffer_space)
+ {
+ data[63 + buffer_length] = 0x00;
+ }
+ else
+ {
+ /* we can take it next time */
+ if (available_buffer_space - buffer_length < real_len + 8)
+ {
+ data[62] |= 0x02;
+ break;
+ }
+ /* ok, get the frame */
+ data[63 + buffer_length] = 0x01;
+ /* get the data */
+ sdla_peek(&card->hw, data_ptr, &data[68 + buffer_length], real_len);
+ /* zero the opp flag to show we got the frame */
+ buf2[0] = 0x00;
+ sdla_poke(&card->hw, curr_trace_addr, &buf2, 1);
+ /* now move onto the next frame */
+ curr_trace_addr += 16;
+ /* check if we passed the last address */
+ if (curr_trace_addr >= (start_trace_addr + num_frames * 16))
+ curr_trace_addr = start_trace_addr;
+ /* update buffer length and make sure
+ its even */
+ if (data[63 + buffer_length] == 0x01)
+ buffer_length += real_len - 1;
+ /* for the header */
+ buffer_length += 8;
+ if (buffer_length & 0x0001)
+ buffer_length += 1;
+ }
+ }
+ /* ok now set the total number of frames passed in the
+ high 5 bits */
+ data[62] = (frames << 3) | data[62];
+ /* set the data length */
+ mbox->cmd.length = buffer_length;
+ memcpy(&data[48], &buffer_length, 2);
+ data[50] = 0;
+ break;
+ /* FPIPE_FT1_READ_STATUS */
+ case 0x44:
+ sdla_peek(&card->hw, 0xF020, &data[62], 2);
+ data[48] = 2;
+ data[49] = 0;
+ data[50] = 0;
+ mbox->cmd.length = 2;
+ break;
+ /* FPIPE_FLUSH_DRIVER_STATS */
+ case 0x48:
+ init_chan_statistics(chan);
+ init_global_statistics(card);
+ mbox->cmd.length = 0;
+ break;
+ case 0x49:
+ do_gettimeofday(&tv);
+ chan->router_up_time = tv.tv_sec - chan->router_start_time;
+ *(unsigned long *) &data[62] = chan->router_up_time;
+ mbox->cmd.length = 4;
+ break;
+ /* FPIPE_KILL_BOARD */
+ case 0x50:
+ break;
+ /* FT1 MONITOR STATUS */
+ case 0x80:
+ if (data[62] == 1)
+ {
+ if (rCount++ != 0)
+ {
+ data[50] = 0;
+ mbox->cmd.length = 1;
+ break;
+ }
+ }
+ /* Disable FT1 MONITOR STATUS */
+ if (data[62] == 0)
+ {
+ if (--rCount != 0)
+ {
+ data[50] = 0;
+ mbox->cmd.length = 1;
+ break;
+ }
+ }
+ default:
+ do
+ {
+ memcpy(&mbox->cmd, &sendpacket[47], sizeof(fr_cmd_t));
+ if (mbox->cmd.length)
+ memcpy(&mbox->data, &sendpacket[62],mbox->cmd.length);
+ err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
+ }
+ while (err && c_retry-- && fr_event(card, err, mbox));
+
+ if (!err)
+ {
+ ++chan->UDP_FPIPE_mgmt_adptr_cmnd_OK;
+ memcpy(data, sendpacket, skb->len);
+ memcpy(&data[47], &mbox->cmd, sizeof(fr_cmd_t));
+ if (mbox->cmd.length)
+ {
+ memcpy(&data[62], &mbox->data,mbox->cmd.length);
+ }
+ }
+ else
+ {
+ ++chan->UDP_FPIPE_mgmt_adptr_cmnd_timeout;
+ }
+ }
+ }
+ /* Fill UDP TTL */
+ data[10] = card->wandev.ttl;
+ len = reply_udp(data, mbox->cmd.length);
+ if (udp_pkt_src == UDP_PKT_FRM_NETWORK)
+ {
+ err = fr508_send(card, dlci, 0, len, data);
+ if (err)
+ ++chan->UDP_FPIPE_mgmt_adptr_send_passed;
+ else
+ ++chan->UDP_FPIPE_mgmt_adptr_send_failed;
+ dev_kfree_skb(skb);
+ }
+ else
+ {
+ /* Allocate socket buffer */
+ if ((new_skb = dev_alloc_skb(len)) != NULL)
+ {
+ /* copy data into new_skb */
+ buf = skb_put(new_skb, len);
+ memcpy(buf, data, len);
+ /* Decapsulate packet and pass it up the protocol
+ stack */
+ new_skb->dev = dev;
+ buf = skb_pull(new_skb, 1); /* remove hardware header */
+ if (!wan_type_trans(new_skb, dev))
+ {
+ ++chan->UDP_FPIPE_mgmt_not_passed_to_stack;
+ /* can't decapsulate packet */
+ dev_kfree_skb(new_skb);
+ }
+ else
+ {
+ ++chan->UDP_FPIPE_mgmt_passed_to_stack;
+ netif_rx(new_skb);
+ }
+ }
+ else
+ {
+ ++chan->UDP_FPIPE_mgmt_no_socket;
+ printk(KERN_INFO
+ "%s: UDP mgmt cmnd, no socket buffers available!\n",
+ card->devname);
+ }
+ }
+ kfree(data);
+ return 0;
+}
+/*==============================================================================
* Perform the Interrupt Test by running the READ_CODE_VERSION command MAX_INTR_
* TEST_COUNTER times.
*/
-static int intr_test( sdla_t* card )
+
+static int intr_test(sdla_t * card)
{
- fr_mbox_t* mb = card->mbox;
- int err,i;
-
- /*
- * The critical flag is unset here because we want to get into the
- * ISR without the flag already set. The If_open sets the flag.
+ fr_mbox_t *mb = card->mbox;
+ int err, i;
+ /* The critical flag is unset here because we want to get into the
+ ISR without the flag already set. The If_open sets the flag.
*/
-
card->wandev.critical = 0;
-
- err = fr_set_intr_mode( card, 0x08, card->wandev.mtu );
-
+ err = fr_set_intr_mode(card, 0x08, card->wandev.mtu);
if (err == CMD_OK)
{
- for ( i = 0; i < MAX_INTR_TEST_COUNTER; i++ )
+ for (i = 0; i < MAX_INTR_TEST_COUNTER; i++)
{
- /* Run command READ_CODE_VERSION */
+ /* Run command READ_CODE_VERSION */
memset(&mb->cmd, 0, sizeof(fr_cmd_t));
- mb->cmd.length = 0;
+ mb->cmd.length = 0;
mb->cmd.command = 0x40;
err = sdla_exec(mb) ? mb->cmd.result : CMD_TIMEOUT;
-
- if (err != CMD_OK)
+ if (err != CMD_OK)
fr_event(card, err, mb);
}
+ }
+ else
+ {
+ return err;
}
- else
- return err;
-
- err = fr_set_intr_mode( card, 0, card->wandev.mtu );
-
- if( err != CMD_OK )
+ err = fr_set_intr_mode(card, 0, card->wandev.mtu);
+ if (err != CMD_OK)
return err;
-
card->wandev.critical = 1;
return 0;
}
+/*============================================================================
+ * Process UDP call of type DRVSTATS.
+ */
+static int process_udp_driver_call(char udp_pkt_src, sdla_t * card, struct sk_buff *skb, struct device *dev, int dlci, fr_channel_t * chan)
+{
+ int c_retry = MAX_CMD_RETRY;
+ unsigned char *sendpacket;
+ unsigned char buf2[5];
+ unsigned char *data;
+ unsigned char *buf;
+ unsigned int len;
+ fr_mbox_t *mbox = card->mbox;
+ struct sk_buff *new_skb;
+ int err;
+ sendpacket = skb->data;
+ memcpy(&buf2, &card->wandev.udp_port, 2);
+ if ((data = kmalloc(2000, GFP_ATOMIC)) == NULL)
+ {
+ printk(KERN_INFO
+ "%s: Error allocating memory for UDP DRIVER STATS cmnd0x%02X"
+ ,card->devname, data[45]);
+ ++chan->UDP_DRVSTATS_mgmt_kmalloc_err;
+ return 1;
+ }
+ memcpy(data, sendpacket, skb->len);
+ switch (data[47])
+ {
+ case 0x45:
+ *(unsigned long *) &data[62] = chan->if_send_entry;
+ *(unsigned long *) &data[66] = chan->if_send_skb_null;
+ *(unsigned long *) &data[70] = chan->if_send_broadcast;
+ *(unsigned long *) &data[74] = chan->if_send_multicast;
+ *(unsigned long *) &data[78] = chan->if_send_critical_ISR;
+ *(unsigned long *) &data[82] = chan->if_send_critical_non_ISR;
+ *(unsigned long *) &data[86] = chan->if_send_busy;
+ *(unsigned long *) &data[90] = chan->if_send_busy_timeout;
+ *(unsigned long *) &data[94] = chan->if_send_DRVSTATS_request;
+ *(unsigned long *) &data[98] = chan->if_send_FPIPE_request;
+ *(unsigned long *) &data[102] = chan->if_send_wan_disconnected;
+ *(unsigned long *) &data[106] = chan->if_send_dlci_disconnected;
+ *(unsigned long *) &data[110] = chan->if_send_no_bfrs;
+ *(unsigned long *) &data[114] = chan->if_send_adptr_bfrs_full;
+ *(unsigned long *) &data[118] = chan->if_send_bfrs_passed_to_adptr;
+ *(unsigned long *) &data[120] = card->irq_dis_if_send_count;
+ mbox->cmd.length = 62;
+ break;
+ case 0x46:
+ *(unsigned long *) &data[62] = card->statistics.isr_entry;
+ *(unsigned long *) &data[66] = card->statistics.isr_already_critical;
+ *(unsigned long *) &data[70] = card->statistics.isr_rx;
+ *(unsigned long *) &data[74] = card->statistics.isr_tx;
+ *(unsigned long *) &data[78] = card->statistics.isr_intr_test;
+ *(unsigned long *) &data[82] = card->statistics.isr_spurious;
+ *(unsigned long *) &data[86] = card->statistics.isr_enable_tx_int;
+ *(unsigned long *) &data[90] = card->statistics.tx_intr_dev_not_started;
+ *(unsigned long *) &data[94] = card->statistics.rx_intr_corrupt_rx_bfr;
+ *(unsigned long *) &data[98] = card->statistics.rx_intr_on_orphaned_DLCI;
+ *(unsigned long *) &data[102] = chan->rx_intr_no_socket;
+ *(unsigned long *) &data[106] = chan->rx_intr_dev_not_started;
+ *(unsigned long *) &data[110] = chan->rx_intr_DRVSTATS_request;
+ *(unsigned long *) &data[114] = chan->rx_intr_FPIPE_request;
+ *(unsigned long *) &data[118] = chan->rx_intr_bfr_not_passed_to_stack;
+ *(unsigned long *) &data[122] = chan->rx_intr_bfr_passed_to_stack;
+ mbox->cmd.length = 64;
+ break;
+ case 0x47:
+ *(unsigned long *) &data[62] = chan->UDP_FPIPE_mgmt_kmalloc_err;
+ *(unsigned long *) &data[66] = chan->UDP_FPIPE_mgmt_adptr_type_err;
+ *(unsigned long *) &data[70] = chan->UDP_FPIPE_mgmt_direction_err;
+ *(unsigned long *) &data[74] = chan->UDP_FPIPE_mgmt_adptr_cmnd_timeout;
+ *(unsigned long *) &data[78] = chan->UDP_FPIPE_mgmt_adptr_cmnd_OK;
+ *(unsigned long *) &data[82] = chan->UDP_FPIPE_mgmt_adptr_send_passed;
+ *(unsigned long *) &data[86] = chan->UDP_FPIPE_mgmt_adptr_send_failed;
+ *(unsigned long *) &data[90] = chan->UDP_FPIPE_mgmt_no_socket;
+ *(unsigned long *) &data[94] = chan->UDP_FPIPE_mgmt_not_passed_to_stack;
+ *(unsigned long *) &data[98] = chan->UDP_FPIPE_mgmt_passed_to_stack;
+ *(unsigned long *) &data[102] = chan->UDP_DRVSTATS_mgmt_kmalloc_err;
+ *(unsigned long *) &data[106] = chan->UDP_DRVSTATS_mgmt_adptr_cmnd_timeout;
+ *(unsigned long *) &data[110] = chan->UDP_DRVSTATS_mgmt_adptr_cmnd_OK;
+ *(unsigned long *) &data[114] = chan->UDP_DRVSTATS_mgmt_adptr_send_passed;
+ *(unsigned long *) &data[118] = chan->UDP_DRVSTATS_mgmt_adptr_send_failed;
+ *(unsigned long *) &data[122] = chan->UDP_DRVSTATS_mgmt_no_socket;
+ *(unsigned long *) &data[126] = chan->UDP_DRVSTATS_mgmt_not_passed_to_stack;
+ *(unsigned long *) &data[130] = chan->UDP_DRVSTATS_mgmt_passed_to_stack;
+ *(unsigned long *) &data[134] = card->statistics.poll_entry;
+ *(unsigned long *) &data[138] = card->statistics.poll_already_critical;
+ *(unsigned long *) &data[142] = card->statistics.poll_processed;
+ *(unsigned long *) &data[144] = card->irq_dis_poll_count;
+ mbox->cmd.length = 86;
+ break;
+ default:
+ do
+ {
+ memcpy(&mbox->cmd, &sendpacket[47], sizeof(fr_cmd_t));
+ if (mbox->cmd.length)
+ memcpy(&mbox->data, &sendpacket[62], mbox->cmd.length);
+ err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
+ }
+ while (err && c_retry-- && fr_event(card, err, mbox));
+
+ if (!err)
+ {
+ ++chan->UDP_DRVSTATS_mgmt_adptr_cmnd_OK;
+ memcpy(data, sendpacket, skb->len);
+ memcpy(&data[47], &mbox->cmd, sizeof(fr_cmd_t));
+ if (mbox->cmd.length)
+ memcpy(&data[62], &mbox->data, mbox->cmd.length);
+ }
+ else
+ {
+ ++chan->UDP_DRVSTATS_mgmt_adptr_cmnd_timeout;
+ }
+ }
+ /* Fill UDP TTL */
+ data[10] = card->wandev.ttl;
+ len = reply_udp(data, mbox->cmd.length);
+ if (udp_pkt_src == UDP_PKT_FRM_NETWORK)
+ {
+ err = fr508_send(card, dlci, 0, len, data);
+ if (err)
+ ++chan->UDP_DRVSTATS_mgmt_adptr_send_failed;
+ else
+ ++chan->UDP_DRVSTATS_mgmt_adptr_send_passed;
+ dev_kfree_skb(skb);
+ }
+ else
+ {
+ /* Allocate socket buffer */
+ if ((new_skb = dev_alloc_skb(len)) != NULL)
+ {
+ /* copy data into new_skb */
+ buf = skb_put(new_skb, len);
+ memcpy(buf, data, len);
+ /* Decapsulate packet and pass it up the
+ protocol stack */
+ new_skb->dev = dev;
+ /* remove hardware header */
+ buf = skb_pull(new_skb, 1);
+ if (!wan_type_trans(new_skb, dev))
+ {
+ /* can't decapsulate packet */
+ ++chan->UDP_DRVSTATS_mgmt_not_passed_to_stack;
+ dev_kfree_skb(new_skb);
+ }
+ else
+ {
+ ++chan->UDP_DRVSTATS_mgmt_passed_to_stack;
+ netif_rx(new_skb);
+ }
+ }
+ else
+ {
+ ++chan->UDP_DRVSTATS_mgmt_no_socket;
+ printk(KERN_INFO "%s: UDP mgmt cmnd, no socket buffers available!\n", card->devname);
+ }
+ }
+ kfree(data);
+ return 0;
+}
+
+/*==============================================================================
+ * Determine what type of UDP call it is. DRVSTATS or FPIPE8ND ?
+ */
+static int udp_pkt_type(struct sk_buff *skb, sdla_t * card)
+{
+ unsigned char *sendpacket;
+ unsigned char buf2[5];
+ sendpacket = skb->data;
+ memcpy(&buf2, &card->wandev.udp_port, 2);
+ if (sendpacket[2] == 0x45 && /* IP packet */
+ sendpacket[11] == 0x11 && /* UDP packet */
+ sendpacket[24] == buf2[1] && /* UDP Port */
+ sendpacket[25] == buf2[0] &&
+ sendpacket[38] == 0x01)
+ {
+ if (sendpacket[30] == 0x46 && /* FPIPE8ND: Signature */
+ sendpacket[31] == 0x50 &&
+ sendpacket[32] == 0x49 &&
+ sendpacket[33] == 0x50 &&
+ sendpacket[34] == 0x45 &&
+ sendpacket[35] == 0x38 &&
+ sendpacket[36] == 0x4E &&
+ sendpacket[37] == 0x44)
+ {
+ return UDP_FPIPE_TYPE;
+ } else if (sendpacket[30] == 0x44 && /* DRVSTATS: Signature */
+ sendpacket[31] == 0x52 &&
+ sendpacket[32] == 0x56 &&
+ sendpacket[33] == 0x53 &&
+ sendpacket[34] == 0x54 &&
+ sendpacket[35] == 0x41 &&
+ sendpacket[36] == 0x54 &&
+ sendpacket[37] == 0x53)
+ {
+ return UDP_DRVSTATS_TYPE;
+ }
+ else
+ return UDP_INVALID_TYPE;
+ }
+ else
+ return UDP_INVALID_TYPE;
+}
+/*==============================================================================
+ * Initializes the Statistics values in the fr_channel structure.
+ */
+
+void init_chan_statistics(fr_channel_t * chan)
+{
+ chan->if_send_entry = 0;
+ chan->if_send_skb_null = 0;
+ chan->if_send_broadcast = 0;
+ chan->if_send_multicast = 0;
+ chan->if_send_critical_ISR = 0;
+ chan->if_send_critical_non_ISR = 0;
+ chan->if_send_busy = 0;
+ chan->if_send_busy_timeout = 0;
+ chan->if_send_FPIPE_request = 0;
+ chan->if_send_DRVSTATS_request = 0;
+ chan->if_send_wan_disconnected = 0;
+ chan->if_send_dlci_disconnected = 0;
+ chan->if_send_no_bfrs = 0;
+ chan->if_send_adptr_bfrs_full = 0;
+ chan->if_send_bfrs_passed_to_adptr = 0;
+ chan->rx_intr_no_socket = 0;
+ chan->rx_intr_dev_not_started = 0;
+ chan->rx_intr_FPIPE_request = 0;
+ chan->rx_intr_DRVSTATS_request = 0;
+ chan->rx_intr_bfr_not_passed_to_stack = 0;
+ chan->rx_intr_bfr_passed_to_stack = 0;
+ chan->UDP_FPIPE_mgmt_kmalloc_err = 0;
+ chan->UDP_FPIPE_mgmt_direction_err = 0;
+ chan->UDP_FPIPE_mgmt_adptr_type_err = 0;
+ chan->UDP_FPIPE_mgmt_adptr_cmnd_OK = 0;
+ chan->UDP_FPIPE_mgmt_adptr_cmnd_timeout = 0;
+ chan->UDP_FPIPE_mgmt_adptr_send_passed = 0;
+ chan->UDP_FPIPE_mgmt_adptr_send_failed = 0;
+ chan->UDP_FPIPE_mgmt_not_passed_to_stack = 0;
+ chan->UDP_FPIPE_mgmt_passed_to_stack = 0;
+ chan->UDP_FPIPE_mgmt_no_socket = 0;
+ chan->UDP_DRVSTATS_mgmt_kmalloc_err = 0;
+ chan->UDP_DRVSTATS_mgmt_adptr_cmnd_OK = 0;
+ chan->UDP_DRVSTATS_mgmt_adptr_cmnd_timeout = 0;
+ chan->UDP_DRVSTATS_mgmt_adptr_send_passed = 0;
+ chan->UDP_DRVSTATS_mgmt_adptr_send_failed = 0;
+ chan->UDP_DRVSTATS_mgmt_not_passed_to_stack = 0;
+ chan->UDP_DRVSTATS_mgmt_passed_to_stack = 0;
+ chan->UDP_DRVSTATS_mgmt_no_socket = 0;
+}
/*==============================================================================
* Initializes the Statistics values in the Sdla_t structure.
*/
-void init_global_statistics( sdla_t* card )
+void init_global_statistics(sdla_t * card)
{
/* Intialize global statistics for a card */
- card->statistics.isr_entry = 0;
- card->statistics.isr_already_critical = 0;
- card->statistics.isr_rx = 0;
- card->statistics.isr_tx = 0;
- card->statistics.isr_intr_test = 0;
- card->statistics.isr_spurious = 0;
- card->statistics.isr_enable_tx_int = 0;
- card->statistics.rx_intr_corrupt_rx_bfr = 0;
+ card->statistics.isr_entry = 0;
+ card->statistics.isr_already_critical = 0;
+ card->statistics.isr_rx = 0;
+ card->statistics.isr_tx = 0;
+ card->statistics.isr_intr_test = 0;
+ card->statistics.isr_spurious = 0;
+ card->statistics.isr_enable_tx_int = 0;
+ card->statistics.rx_intr_corrupt_rx_bfr = 0;
card->statistics.rx_intr_on_orphaned_DLCI = 0;
- card->statistics.tx_intr_dev_not_started = 0;
- card->statistics.poll_entry = 0;
- card->statistics.poll_already_critical = 0;
- card->statistics.poll_processed = 0;
+ card->statistics.tx_intr_dev_not_started = 0;
+ card->statistics.poll_entry = 0;
+ card->statistics.poll_already_critical = 0;
+ card->statistics.poll_processed = 0;
}
-static void read_DLCI_IB_mapping( sdla_t* card, fr_channel_t* chan )
+static void read_DLCI_IB_mapping(sdla_t * card, fr_channel_t * chan)
{
- fr_mbox_t* mbox = card->mbox;
- int retry = MAX_CMD_RETRY;
- dlci_IB_mapping_t* result;
- int err, counter, found;
-
- do {
+ fr_mbox_t *mbox = card->mbox;
+ int retry = MAX_CMD_RETRY;
+ dlci_IB_mapping_t *result;
+ int err, counter, found;
+ do
+ {
memset(&mbox->cmd, 0, sizeof(fr_cmd_t));
mbox->cmd.command = FR_READ_DLCI_IB_MAPPING;
-
err = sdla_exec(mbox) ? mbox->cmd.result : CMD_TIMEOUT;
+ }
+ while (err && retry-- && fr_event(card, err, mbox));
- } while (err && retry-- && fr_event(card, err, mbox));
-
- if( mbox->cmd.result != 0)
- printk(KERN_INFO "%s: Read DLCI IB Mapping failed\n",
- chan->name);
+ if (mbox->cmd.result != 0)
+ printk(KERN_INFO "%s: Read DLCI IB Mapping failed\n", chan->name);
counter = mbox->cmd.length / sizeof(dlci_IB_mapping_t);
- result = (void *)mbox->data;
-
+ result = (void *) mbox->data;
found = 0;
- for (; counter; --counter, ++result) {
- if ( result->dlci == chan->dlci ) {
- printk( KERN_INFO "%s: DLCI= %d, IB addr = %lx for %s\n"
- ,card->devname,result->dlci, result->addr_value
- ,chan->name);
+ for (; counter; --counter, ++result)
+ {
+ if (result->dlci == chan->dlci)
+ {
+ printk(KERN_INFO "%s: DLCI= %d, IB addr = %lx for %s\n"
+ ,card->devname, result->dlci, result->addr_value ,chan->name);
chan->IB_addr = result->addr_value;
- chan->dlci_int_interface = (void*)(card->hw.dpmbase +
- ( chan->IB_addr & 0x00001FFF));
+ chan->dlci_int_interface = (void *) (card->hw.dpmbase +
+ (chan->IB_addr & 0x00001FFF));
found = 1;
- break;
- }
+ break;
+ }
}
if (!found)
- printk( KERN_INFO "%s: DLCI %d not found by IB MAPPING cmd\n",
- card->devname, chan->dlci);
+ printk(KERN_INFO "%s: DLCI %d not found by IB MAPPING cmd\n",
+ card->devname, chan->dlci);
}
/****** End *****************************************************************/
FUNET's LINUX-ADM group, linux-adm@nic.funet.fi
TCL-scripts by Sam Shen, slshen@lbl.gov