diff options
| author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 15:20:36 -0700 | 
|---|---|---|
| committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 15:20:36 -0700 | 
| commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
| tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/net/tokenring/smctr.c | |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/net/tokenring/smctr.c')
| -rw-r--r-- | drivers/net/tokenring/smctr.c | 5742 | 
1 files changed, 5742 insertions, 0 deletions
| diff --git a/drivers/net/tokenring/smctr.c b/drivers/net/tokenring/smctr.c new file mode 100644 index 000000000000..5c8aeacb8318 --- /dev/null +++ b/drivers/net/tokenring/smctr.c @@ -0,0 +1,5742 @@ +/* + *  smctr.c: A network driver for the SMC Token Ring Adapters. + * + *  Written by Jay Schulist <jschlst@samba.org> + * + *  This software may be used and distributed according to the terms + *  of the GNU General Public License, incorporated herein by reference. + * + *  This device driver works with the following SMC adapters: + *      - SMC TokenCard Elite   (8115T, chips 825/584) + *      - SMC TokenCard Elite/A MCA (8115T/A, chips 825/594) + * + *  Source(s): + *  	- SMC TokenCard SDK. + * + *  Maintainer(s): + *    JS        Jay Schulist <jschlst@samba.org> + * + * Changes: + *    07102000          JS      Fixed a timing problem in smctr_wait_cmd(); + *                              Also added a bit more discriptive error msgs. + *    07122000          JS      Fixed problem with detecting a card with + *				module io/irq/mem specified. + * + *  To do: + *    1. Multicast support. + * + *  Initial 2.5 cleanup Alan Cox <alan@redhat.com>  2002/10/28 + */ + +#include <linux/module.h> +#include <linux/config.h> +#include <linux/kernel.h> +#include <linux/types.h> +#include <linux/fcntl.h> +#include <linux/interrupt.h> +#include <linux/ptrace.h> +#include <linux/ioport.h> +#include <linux/in.h> +#include <linux/slab.h> +#include <linux/string.h> +#include <linux/time.h> +#include <linux/errno.h> +#include <linux/init.h> +#include <linux/pci.h> +#include <linux/mca-legacy.h> +#include <linux/delay.h> +#include <linux/netdevice.h> +#include <linux/etherdevice.h> +#include <linux/skbuff.h> +#include <linux/trdevice.h> +#include <linux/bitops.h> + +#include <asm/system.h> +#include <asm/io.h> +#include <asm/dma.h> +#include <asm/irq.h> + +#if BITS_PER_LONG == 64 +#error FIXME: driver does not support 64-bit platforms +#endif + +#include "smctr.h"               /* Our Stuff */ +#include "smctr_firmware.h"      /* SMC adapter firmware */ + +static char version[] __initdata = KERN_INFO "smctr.c: v1.4 7/12/00 by jschlst@samba.org\n"; +static const char cardname[] = "smctr"; + + +#define SMCTR_IO_EXTENT   20 + +#ifdef CONFIG_MCA_LEGACY +static unsigned int smctr_posid = 0x6ec6; +#endif + +static int ringspeed; + +/* SMC Name of the Adapter. */ +static char smctr_name[] = "SMC TokenCard"; +char *smctr_model = "Unknown"; + +/* Use 0 for production, 1 for verification, 2 for debug, and + * 3 for very verbose debug. + */ +#ifndef SMCTR_DEBUG +#define SMCTR_DEBUG 1 +#endif +static unsigned int smctr_debug = SMCTR_DEBUG; + +/* smctr.c prototypes and functions are arranged alphabeticly  + * for clearity, maintainability and pure old fashion fun.  + */ +/* A */ +static int smctr_alloc_shared_memory(struct net_device *dev); + +/* B */ +static int smctr_bypass_state(struct net_device *dev); + +/* C */ +static int smctr_checksum_firmware(struct net_device *dev); +static int __init smctr_chk_isa(struct net_device *dev); +static int smctr_chg_rx_mask(struct net_device *dev); +static int smctr_clear_int(struct net_device *dev); +static int smctr_clear_trc_reset(int ioaddr); +static int smctr_close(struct net_device *dev); + +/* D */ +static int smctr_decode_firmware(struct net_device *dev); +static int smctr_disable_16bit(struct net_device *dev); +static int smctr_disable_adapter_ctrl_store(struct net_device *dev); +static int smctr_disable_bic_int(struct net_device *dev); + +/* E */ +static int smctr_enable_16bit(struct net_device *dev); +static int smctr_enable_adapter_ctrl_store(struct net_device *dev); +static int smctr_enable_adapter_ram(struct net_device *dev); +static int smctr_enable_bic_int(struct net_device *dev); + +/* G */ +static int __init smctr_get_boardid(struct net_device *dev, int mca); +static int smctr_get_group_address(struct net_device *dev); +static int smctr_get_functional_address(struct net_device *dev); +static unsigned int smctr_get_num_rx_bdbs(struct net_device *dev); +static int smctr_get_physical_drop_number(struct net_device *dev); +static __u8 *smctr_get_rx_pointer(struct net_device *dev, short queue); +static int smctr_get_station_id(struct net_device *dev); +static struct net_device_stats *smctr_get_stats(struct net_device *dev); +static FCBlock *smctr_get_tx_fcb(struct net_device *dev, __u16 queue, +        __u16 bytes_count); +static int smctr_get_upstream_neighbor_addr(struct net_device *dev); + +/* H */ +static int smctr_hardware_send_packet(struct net_device *dev, +        struct net_local *tp); +/* I */ +static int smctr_init_acbs(struct net_device *dev); +static int smctr_init_adapter(struct net_device *dev); +static int smctr_init_card_real(struct net_device *dev); +static int smctr_init_rx_bdbs(struct net_device *dev); +static int smctr_init_rx_fcbs(struct net_device *dev); +static int smctr_init_shared_memory(struct net_device *dev); +static int smctr_init_tx_bdbs(struct net_device *dev); +static int smctr_init_tx_fcbs(struct net_device *dev); +static int smctr_internal_self_test(struct net_device *dev); +static irqreturn_t smctr_interrupt(int irq, void *dev_id, struct pt_regs *regs); +static int smctr_issue_enable_int_cmd(struct net_device *dev, +        __u16 interrupt_enable_mask); +static int smctr_issue_int_ack(struct net_device *dev, __u16 iack_code, +        __u16 ibits); +static int smctr_issue_init_timers_cmd(struct net_device *dev); +static int smctr_issue_init_txrx_cmd(struct net_device *dev); +static int smctr_issue_insert_cmd(struct net_device *dev); +static int smctr_issue_read_ring_status_cmd(struct net_device *dev); +static int smctr_issue_read_word_cmd(struct net_device *dev, __u16 aword_cnt); +static int smctr_issue_remove_cmd(struct net_device *dev); +static int smctr_issue_resume_acb_cmd(struct net_device *dev); +static int smctr_issue_resume_rx_bdb_cmd(struct net_device *dev, __u16 queue); +static int smctr_issue_resume_rx_fcb_cmd(struct net_device *dev, __u16 queue); +static int smctr_issue_resume_tx_fcb_cmd(struct net_device *dev, __u16 queue); +static int smctr_issue_test_internal_rom_cmd(struct net_device *dev); +static int smctr_issue_test_hic_cmd(struct net_device *dev); +static int smctr_issue_test_mac_reg_cmd(struct net_device *dev); +static int smctr_issue_trc_loopback_cmd(struct net_device *dev); +static int smctr_issue_tri_loopback_cmd(struct net_device *dev); +static int smctr_issue_write_byte_cmd(struct net_device *dev, +        short aword_cnt, void *byte); +static int smctr_issue_write_word_cmd(struct net_device *dev, +        short aword_cnt, void *word); + +/* J */ +static int smctr_join_complete_state(struct net_device *dev); + +/* L */ +static int smctr_link_tx_fcbs_to_bdbs(struct net_device *dev); +static int smctr_load_firmware(struct net_device *dev); +static int smctr_load_node_addr(struct net_device *dev); +static int smctr_lobe_media_test(struct net_device *dev); +static int smctr_lobe_media_test_cmd(struct net_device *dev); +static int smctr_lobe_media_test_state(struct net_device *dev); + +/* M */ +static int smctr_make_8025_hdr(struct net_device *dev, +        MAC_HEADER *rmf, MAC_HEADER *tmf, __u16 ac_fc); +static int smctr_make_access_pri(struct net_device *dev, +        MAC_SUB_VECTOR *tsv); +static int smctr_make_addr_mod(struct net_device *dev, MAC_SUB_VECTOR *tsv); +static int smctr_make_auth_funct_class(struct net_device *dev, +        MAC_SUB_VECTOR *tsv); +static int smctr_make_corr(struct net_device *dev, +        MAC_SUB_VECTOR *tsv, __u16 correlator); +static int smctr_make_funct_addr(struct net_device *dev, +        MAC_SUB_VECTOR *tsv); +static int smctr_make_group_addr(struct net_device *dev, +        MAC_SUB_VECTOR *tsv); +static int smctr_make_phy_drop_num(struct net_device *dev, +        MAC_SUB_VECTOR *tsv); +static int smctr_make_product_id(struct net_device *dev, MAC_SUB_VECTOR *tsv); +static int smctr_make_station_id(struct net_device *dev, MAC_SUB_VECTOR *tsv); +static int smctr_make_ring_station_status(struct net_device *dev, +        MAC_SUB_VECTOR *tsv); +static int smctr_make_ring_station_version(struct net_device *dev, +        MAC_SUB_VECTOR *tsv); +static int smctr_make_tx_status_code(struct net_device *dev, +        MAC_SUB_VECTOR *tsv, __u16 tx_fstatus); +static int smctr_make_upstream_neighbor_addr(struct net_device *dev, +        MAC_SUB_VECTOR *tsv); +static int smctr_make_wrap_data(struct net_device *dev, +        MAC_SUB_VECTOR *tsv); + +/* O */ +static int smctr_open(struct net_device *dev); +static int smctr_open_tr(struct net_device *dev); + +/* P */ +struct net_device *smctr_probe(int unit); +static int __init smctr_probe1(struct net_device *dev, int ioaddr); +static int smctr_process_rx_packet(MAC_HEADER *rmf, __u16 size, +        struct net_device *dev, __u16 rx_status); + +/* R */ +static int smctr_ram_memory_test(struct net_device *dev); +static int smctr_rcv_chg_param(struct net_device *dev, MAC_HEADER *rmf, +        __u16 *correlator); +static int smctr_rcv_init(struct net_device *dev, MAC_HEADER *rmf, +        __u16 *correlator); +static int smctr_rcv_tx_forward(struct net_device *dev, MAC_HEADER *rmf); +static int smctr_rcv_rq_addr_state_attch(struct net_device *dev, +        MAC_HEADER *rmf, __u16 *correlator); +static int smctr_rcv_unknown(struct net_device *dev, MAC_HEADER *rmf, +        __u16 *correlator); +static int smctr_reset_adapter(struct net_device *dev); +static int smctr_restart_tx_chain(struct net_device *dev, short queue); +static int smctr_ring_status_chg(struct net_device *dev); +static int smctr_rx_frame(struct net_device *dev); + +/* S */ +static int smctr_send_dat(struct net_device *dev); +static int smctr_send_packet(struct sk_buff *skb, struct net_device *dev); +static int smctr_send_lobe_media_test(struct net_device *dev); +static int smctr_send_rpt_addr(struct net_device *dev, MAC_HEADER *rmf, +        __u16 correlator); +static int smctr_send_rpt_attch(struct net_device *dev, MAC_HEADER *rmf, +        __u16 correlator); +static int smctr_send_rpt_state(struct net_device *dev, MAC_HEADER *rmf, +        __u16 correlator); +static int smctr_send_rpt_tx_forward(struct net_device *dev, +        MAC_HEADER *rmf, __u16 tx_fstatus); +static int smctr_send_rsp(struct net_device *dev, MAC_HEADER *rmf, +        __u16 rcode, __u16 correlator); +static int smctr_send_rq_init(struct net_device *dev); +static int smctr_send_tx_forward(struct net_device *dev, MAC_HEADER *rmf, +        __u16 *tx_fstatus); +static int smctr_set_auth_access_pri(struct net_device *dev, +        MAC_SUB_VECTOR *rsv); +static int smctr_set_auth_funct_class(struct net_device *dev, +        MAC_SUB_VECTOR *rsv); +static int smctr_set_corr(struct net_device *dev, MAC_SUB_VECTOR *rsv, +	__u16 *correlator); +static int smctr_set_error_timer_value(struct net_device *dev, +        MAC_SUB_VECTOR *rsv); +static int smctr_set_frame_forward(struct net_device *dev, +        MAC_SUB_VECTOR *rsv, __u8 dc_sc); +static int smctr_set_local_ring_num(struct net_device *dev, +        MAC_SUB_VECTOR *rsv); +static unsigned short smctr_set_ctrl_attention(struct net_device *dev); +static void smctr_set_multicast_list(struct net_device *dev); +static int smctr_set_page(struct net_device *dev, __u8 *buf); +static int smctr_set_phy_drop(struct net_device *dev, +        MAC_SUB_VECTOR *rsv); +static int smctr_set_ring_speed(struct net_device *dev); +static int smctr_set_rx_look_ahead(struct net_device *dev); +static int smctr_set_trc_reset(int ioaddr); +static int smctr_setup_single_cmd(struct net_device *dev, +        __u16 command, __u16 subcommand); +static int smctr_setup_single_cmd_w_data(struct net_device *dev, +        __u16 command, __u16 subcommand); +static char *smctr_malloc(struct net_device *dev, __u16 size); +static int smctr_status_chg(struct net_device *dev); + +/* T */ +static void smctr_timeout(struct net_device *dev); +static int smctr_trc_send_packet(struct net_device *dev, FCBlock *fcb, +        __u16 queue); +static __u16 smctr_tx_complete(struct net_device *dev, __u16 queue); +static unsigned short smctr_tx_move_frame(struct net_device *dev, +        struct sk_buff *skb, __u8 *pbuff, unsigned int bytes); + +/* U */ +static int smctr_update_err_stats(struct net_device *dev); +static int smctr_update_rx_chain(struct net_device *dev, __u16 queue); +static int smctr_update_tx_chain(struct net_device *dev, FCBlock *fcb, +        __u16 queue); + +/* W */ +static int smctr_wait_cmd(struct net_device *dev); +static int smctr_wait_while_cbusy(struct net_device *dev); + +#define TO_256_BYTE_BOUNDRY(X)  (((X + 0xff) & 0xff00) - X) +#define TO_PARAGRAPH_BOUNDRY(X) (((X + 0x0f) & 0xfff0) - X) +#define PARAGRAPH_BOUNDRY(X)    smctr_malloc(dev, TO_PARAGRAPH_BOUNDRY(X)) + +/* Allocate Adapter Shared Memory. + * IMPORTANT NOTE: Any changes to this function MUST be mirrored in the + * function "get_num_rx_bdbs" below!!! + * + * Order of memory allocation: + * + *       0. Initial System Configuration Block Pointer + *       1. System Configuration Block + *       2. System Control Block + *       3. Action Command Block + *       4. Interrupt Status Block + * + *       5. MAC TX FCB'S + *       6. NON-MAC TX FCB'S + *       7. MAC TX BDB'S + *       8. NON-MAC TX BDB'S + *       9. MAC RX FCB'S + *      10. NON-MAC RX FCB'S + *      11. MAC RX BDB'S + *      12. NON-MAC RX BDB'S + *      13. MAC TX Data Buffer( 1, 256 byte buffer) + *      14. MAC RX Data Buffer( 1, 256 byte buffer) + * + *      15. NON-MAC TX Data Buffer + *      16. NON-MAC RX Data Buffer + */ +static int smctr_alloc_shared_memory(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_alloc_shared_memory\n", dev->name); + +        /* Allocate initial System Control Block pointer. +         * This pointer is located in the last page, last offset - 4. +         */ +        tp->iscpb_ptr = (ISCPBlock *)(tp->ram_access + ((__u32)64 * 0x400) +                - (long)ISCP_BLOCK_SIZE); + +        /* Allocate System Control Blocks. */ +        tp->scgb_ptr = (SCGBlock *)smctr_malloc(dev, sizeof(SCGBlock)); +        PARAGRAPH_BOUNDRY(tp->sh_mem_used); + +        tp->sclb_ptr = (SCLBlock *)smctr_malloc(dev, sizeof(SCLBlock)); +        PARAGRAPH_BOUNDRY(tp->sh_mem_used); + +        tp->acb_head = (ACBlock *)smctr_malloc(dev, +                sizeof(ACBlock)*tp->num_acbs); +        PARAGRAPH_BOUNDRY(tp->sh_mem_used); + +        tp->isb_ptr = (ISBlock *)smctr_malloc(dev, sizeof(ISBlock)); +        PARAGRAPH_BOUNDRY(tp->sh_mem_used); + +        tp->misc_command_data = (__u16 *)smctr_malloc(dev, MISC_DATA_SIZE); +        PARAGRAPH_BOUNDRY(tp->sh_mem_used); + +        /* Allocate transmit FCBs. */ +        tp->tx_fcb_head[MAC_QUEUE] = (FCBlock *)smctr_malloc(dev, +                sizeof(FCBlock) * tp->num_tx_fcbs[MAC_QUEUE]); + +        tp->tx_fcb_head[NON_MAC_QUEUE] = (FCBlock *)smctr_malloc(dev, +                sizeof(FCBlock) * tp->num_tx_fcbs[NON_MAC_QUEUE]); + +        tp->tx_fcb_head[BUG_QUEUE] = (FCBlock *)smctr_malloc(dev, +                sizeof(FCBlock) * tp->num_tx_fcbs[BUG_QUEUE]); + +        /* Allocate transmit BDBs. */ +        tp->tx_bdb_head[MAC_QUEUE] = (BDBlock *)smctr_malloc(dev, +                sizeof(BDBlock) * tp->num_tx_bdbs[MAC_QUEUE]); + +        tp->tx_bdb_head[NON_MAC_QUEUE] = (BDBlock *)smctr_malloc(dev, +                sizeof(BDBlock) * tp->num_tx_bdbs[NON_MAC_QUEUE]); + +        tp->tx_bdb_head[BUG_QUEUE] = (BDBlock *)smctr_malloc(dev, +                sizeof(BDBlock) * tp->num_tx_bdbs[BUG_QUEUE]); + +        /* Allocate receive FCBs. */ +        tp->rx_fcb_head[MAC_QUEUE] = (FCBlock *)smctr_malloc(dev, +                sizeof(FCBlock) * tp->num_rx_fcbs[MAC_QUEUE]); + +        tp->rx_fcb_head[NON_MAC_QUEUE] = (FCBlock *)smctr_malloc(dev, +                sizeof(FCBlock) * tp->num_rx_fcbs[NON_MAC_QUEUE]); + +        /* Allocate receive BDBs. */ +        tp->rx_bdb_head[MAC_QUEUE] = (BDBlock *)smctr_malloc(dev, +                sizeof(BDBlock) * tp->num_rx_bdbs[MAC_QUEUE]); + +        tp->rx_bdb_end[MAC_QUEUE] = (BDBlock *)smctr_malloc(dev, 0); + +        tp->rx_bdb_head[NON_MAC_QUEUE] = (BDBlock *)smctr_malloc(dev, +                sizeof(BDBlock) * tp->num_rx_bdbs[NON_MAC_QUEUE]); + +        tp->rx_bdb_end[NON_MAC_QUEUE] = (BDBlock *)smctr_malloc(dev, 0); + +        /* Allocate MAC transmit buffers. +         * MAC Tx Buffers doen't have to be on an ODD Boundry. +         */ +        tp->tx_buff_head[MAC_QUEUE] +                = (__u16 *)smctr_malloc(dev, tp->tx_buff_size[MAC_QUEUE]); +        tp->tx_buff_curr[MAC_QUEUE] = tp->tx_buff_head[MAC_QUEUE]; +        tp->tx_buff_end [MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0); + +        /* Allocate BUG transmit buffers. */ +        tp->tx_buff_head[BUG_QUEUE] +                = (__u16 *)smctr_malloc(dev, tp->tx_buff_size[BUG_QUEUE]); +        tp->tx_buff_curr[BUG_QUEUE] = tp->tx_buff_head[BUG_QUEUE]; +        tp->tx_buff_end[BUG_QUEUE] = (__u16 *)smctr_malloc(dev, 0); + +        /* Allocate MAC receive data buffers. +         * MAC Rx buffer doesn't have to be on a 256 byte boundary. +         */ +        tp->rx_buff_head[MAC_QUEUE] = (__u16 *)smctr_malloc(dev, +                RX_DATA_BUFFER_SIZE * tp->num_rx_bdbs[MAC_QUEUE]); +        tp->rx_buff_end[MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0); + +        /* Allocate Non-MAC transmit buffers. +         * ?? For maximum Netware performance, put Tx Buffers on +         * ODD Boundry and then restore malloc to Even Boundrys. +         */ +        smctr_malloc(dev, 1L); +        tp->tx_buff_head[NON_MAC_QUEUE] +                = (__u16 *)smctr_malloc(dev, tp->tx_buff_size[NON_MAC_QUEUE]); +        tp->tx_buff_curr[NON_MAC_QUEUE] = tp->tx_buff_head[NON_MAC_QUEUE]; +        tp->tx_buff_end [NON_MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0); +        smctr_malloc(dev, 1L); + +        /* Allocate Non-MAC receive data buffers. +         * To guarantee a minimum of 256 contigous memory to +         * UM_Receive_Packet's lookahead pointer, before a page +         * change or ring end is encountered, place each rx buffer on +         * a 256 byte boundary. +         */ +        smctr_malloc(dev, TO_256_BYTE_BOUNDRY(tp->sh_mem_used)); +        tp->rx_buff_head[NON_MAC_QUEUE] = (__u16 *)smctr_malloc(dev, +                RX_DATA_BUFFER_SIZE * tp->num_rx_bdbs[NON_MAC_QUEUE]); +        tp->rx_buff_end[NON_MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0); + +        return (0); +} + +/* Enter Bypass state. */ +static int smctr_bypass_state(struct net_device *dev) +{ +        int err; + +	if(smctr_debug > 10) +        	printk(KERN_DEBUG "%s: smctr_bypass_state\n", dev->name); + +        err = smctr_setup_single_cmd(dev, ACB_CMD_CHANGE_JOIN_STATE, JS_BYPASS_STATE); + +        return (err); +} + +static int smctr_checksum_firmware(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        __u16 i, checksum = 0; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_checksum_firmware\n", dev->name); + +        smctr_enable_adapter_ctrl_store(dev); + +        for(i = 0; i < CS_RAM_SIZE; i += 2) +                checksum += *((__u16 *)(tp->ram_access + i)); + +        tp->microcode_version = *(__u16 *)(tp->ram_access +                + CS_RAM_VERSION_OFFSET); +        tp->microcode_version >>= 8; + +        smctr_disable_adapter_ctrl_store(dev); + +        if(checksum) +                return (checksum); + +        return (0); +} + +static int __init smctr_chk_mca(struct net_device *dev) +{ +#ifdef CONFIG_MCA_LEGACY +	struct net_local *tp = netdev_priv(dev); +	int current_slot; +	__u8 r1, r2, r3, r4, r5; + +	current_slot = mca_find_unused_adapter(smctr_posid, 0); +	if(current_slot == MCA_NOTFOUND) +		return (-ENODEV); + +	mca_set_adapter_name(current_slot, smctr_name); +	mca_mark_as_used(current_slot); +	tp->slot_num = current_slot; + +	r1 = mca_read_stored_pos(tp->slot_num, 2); +	r2 = mca_read_stored_pos(tp->slot_num, 3); + +	if(tp->slot_num) +		outb(CNFG_POS_CONTROL_REG, (__u8)((tp->slot_num - 1) | CNFG_SLOT_ENABLE_BIT)); +	else +		outb(CNFG_POS_CONTROL_REG, (__u8)((tp->slot_num) | CNFG_SLOT_ENABLE_BIT)); + +	r1 = inb(CNFG_POS_REG1); +	r2 = inb(CNFG_POS_REG0); + +	tp->bic_type = BIC_594_CHIP; + +	/* IO */ +	r2 = mca_read_stored_pos(tp->slot_num, 2); +	r2 &= 0xF0; +	dev->base_addr = ((__u16)r2 << 8) + (__u16)0x800; +	request_region(dev->base_addr, SMCTR_IO_EXTENT, smctr_name); + +	/* IRQ */ +	r5 = mca_read_stored_pos(tp->slot_num, 5); +	r5 &= 0xC; +        switch(r5) +	{ +            	case 0: +			dev->irq = 3; +               		break; + +            	case 0x4: +			dev->irq = 4; +               		break; + +            	case 0x8: +			dev->irq = 10; +               		break; + +            	default: +			dev->irq = 15; +               		break; +	} +	if (request_irq(dev->irq, smctr_interrupt, SA_SHIRQ, smctr_name, dev)) { +		release_region(dev->base_addr, SMCTR_IO_EXTENT); +		return -ENODEV; +	} + +	/* Get RAM base */ +	r3 = mca_read_stored_pos(tp->slot_num, 3); +	tp->ram_base = ((__u32)(r3 & 0x7) << 13) + 0x0C0000; +	if (r3 & 0x8) +		tp->ram_base += 0x010000; +	if (r3 & 0x80) +		tp->ram_base += 0xF00000; + +	/* Get Ram Size */ +	r3 &= 0x30; +	r3 >>= 4; + +	tp->ram_usable = (__u16)CNFG_SIZE_8KB << r3; +	tp->ram_size = (__u16)CNFG_SIZE_64KB; +	tp->board_id |= TOKEN_MEDIA; + +	r4 = mca_read_stored_pos(tp->slot_num, 4); +	tp->rom_base = ((__u32)(r4 & 0x7) << 13) + 0x0C0000; +	if (r4 & 0x8) +		tp->rom_base += 0x010000; + +	/* Get ROM size. */ +	r4 >>= 4; +	switch (r4) { +		case 0: +			tp->rom_size = CNFG_SIZE_8KB; +			break; +		case 1: +			tp->rom_size = CNFG_SIZE_16KB; +			break; +		case 2: +			tp->rom_size = CNFG_SIZE_32KB; +			break; +		default: +			tp->rom_size = ROM_DISABLE; +	} + +	/* Get Media Type. */ +	r5 = mca_read_stored_pos(tp->slot_num, 5); +	r5 &= CNFG_MEDIA_TYPE_MASK; +	switch(r5) +	{ +		case (0): +			tp->media_type = MEDIA_STP_4; +			break; + +		case (1): +			tp->media_type = MEDIA_STP_16; +			break; + +		case (3): +			tp->media_type = MEDIA_UTP_16; +			break; + +		default: +			tp->media_type = MEDIA_UTP_4; +			break; +	} +	tp->media_menu = 14; + +	r2 = mca_read_stored_pos(tp->slot_num, 2); +	if(!(r2 & 0x02)) +		tp->mode_bits |= EARLY_TOKEN_REL; + +	/* Disable slot */ +	outb(CNFG_POS_CONTROL_REG, 0); + +	tp->board_id = smctr_get_boardid(dev, 1); +	switch(tp->board_id & 0xffff) +        { +                case WD8115TA: +                        smctr_model = "8115T/A"; +                        break; + +                case WD8115T: +			if(tp->extra_info & CHIP_REV_MASK) +                                smctr_model = "8115T rev XE"; +                        else +                                smctr_model = "8115T rev XD"; +                        break; + +                default: +                        smctr_model = "Unknown"; +                        break; +        } + +	return (0); +#else +	return (-1); +#endif /* CONFIG_MCA_LEGACY */ +} + +static int smctr_chg_rx_mask(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int err = 0; + +        if(smctr_debug > 10) +		printk(KERN_DEBUG "%s: smctr_chg_rx_mask\n", dev->name); + +        smctr_enable_16bit(dev); +        smctr_set_page(dev, (__u8 *)tp->ram_access); + +        if(tp->mode_bits & LOOPING_MODE_MASK) +                tp->config_word0 |= RX_OWN_BIT; +        else +                tp->config_word0 &= ~RX_OWN_BIT; + +        if(tp->receive_mask & PROMISCUOUS_MODE) +                tp->config_word0 |= PROMISCUOUS_BIT; +        else +                tp->config_word0 &= ~PROMISCUOUS_BIT; + +        if(tp->receive_mask & ACCEPT_ERR_PACKETS) +                tp->config_word0 |= SAVBAD_BIT; +        else +                tp->config_word0 &= ~SAVBAD_BIT; + +        if(tp->receive_mask & ACCEPT_ATT_MAC_FRAMES) +                tp->config_word0 |= RXATMAC; +        else +                tp->config_word0 &= ~RXATMAC; + +        if(tp->receive_mask & ACCEPT_MULTI_PROM) +                tp->config_word1 |= MULTICAST_ADDRESS_BIT; +        else +                tp->config_word1 &= ~MULTICAST_ADDRESS_BIT; + +        if(tp->receive_mask & ACCEPT_SOURCE_ROUTING_SPANNING) +                tp->config_word1 |= SOURCE_ROUTING_SPANNING_BITS; +        else +        { +                if(tp->receive_mask & ACCEPT_SOURCE_ROUTING) +                        tp->config_word1 |= SOURCE_ROUTING_EXPLORER_BIT; +                else +                        tp->config_word1 &= ~SOURCE_ROUTING_SPANNING_BITS; +        } + +        if((err = smctr_issue_write_word_cmd(dev, RW_CONFIG_REGISTER_0, +                &tp->config_word0))) +        { +                return (err); +        } + +        if((err = smctr_issue_write_word_cmd(dev, RW_CONFIG_REGISTER_1, +                &tp->config_word1))) +        { +                return (err); +        } + +        smctr_disable_16bit(dev); + +        return (0); +} + +static int smctr_clear_int(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); + +        outb((tp->trc_mask | CSR_CLRTINT), dev->base_addr + CSR); + +        return (0); +} + +static int smctr_clear_trc_reset(int ioaddr) +{ +        __u8 r; + +        r = inb(ioaddr + MSR); +        outb(~MSR_RST & r, ioaddr + MSR); + +        return (0); +} + +/* + * The inverse routine to smctr_open(). + */ +static int smctr_close(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        struct sk_buff *skb; +        int err; + +	netif_stop_queue(dev); +	 +	tp->cleanup = 1; + +        /* Check to see if adapter is already in a closed state. */ +        if(tp->status != OPEN) +                return (0); + +        smctr_enable_16bit(dev); +        smctr_set_page(dev, (__u8 *)tp->ram_access); + +        if((err = smctr_issue_remove_cmd(dev))) +        { +                smctr_disable_16bit(dev); +                return (err); +        } + +        for(;;) +        { +                skb = skb_dequeue(&tp->SendSkbQueue); +                if(skb == NULL) +                        break; +                tp->QueueSkb++; +                dev_kfree_skb(skb); +        } + + +        return (0); +} + +static int smctr_decode_firmware(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        short bit = 0x80, shift = 12; +        DECODE_TREE_NODE *tree; +        short branch, tsize; +        __u16 buff = 0; +        long weight; +        __u8 *ucode; +        __u16 *mem; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_decode_firmware\n", dev->name); + +        weight  = *(long *)(tp->ptr_ucode + WEIGHT_OFFSET); +        tsize   = *(__u8 *)(tp->ptr_ucode + TREE_SIZE_OFFSET); +        tree    = (DECODE_TREE_NODE *)(tp->ptr_ucode + TREE_OFFSET); +        ucode   = (__u8 *)(tp->ptr_ucode + TREE_OFFSET +                        + (tsize * sizeof(DECODE_TREE_NODE))); +        mem     = (__u16 *)(tp->ram_access); + +        while(weight) +        { +                branch = ROOT; +                while((tree + branch)->tag != LEAF && weight) +                { +                        branch = *ucode & bit ? (tree + branch)->llink +                                : (tree + branch)->rlink; + +                        bit >>= 1; +                        weight--; + +                        if(bit == 0) +                        { +                                bit = 0x80; +                                ucode++; +                        } +                } + +                buff |= (tree + branch)->info << shift; +                shift -= 4; + +                if(shift < 0) +                { +                        *(mem++) = SWAP_BYTES(buff); +                        buff    = 0; +                        shift   = 12; +                } +        } + +        /* The following assumes the Control Store Memory has +         * been initialized to zero. If the last partial word +         * is zero, it will not be written. +         */ +        if(buff) +                *(mem++) = SWAP_BYTES(buff); + +        return (0); +} + +static int smctr_disable_16bit(struct net_device *dev) +{ +        return (0); +} + +/* + * On Exit, Adapter is: + * 1. TRC is in a reset state and un-initialized. + * 2. Adapter memory is enabled. + * 3. Control Store memory is out of context (-WCSS is 1). + */ +static int smctr_disable_adapter_ctrl_store(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int ioaddr = dev->base_addr; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_disable_adapter_ctrl_store\n", dev->name); + +        tp->trc_mask |= CSR_WCSS; +        outb(tp->trc_mask, ioaddr + CSR); + +        return (0); +} + +static int smctr_disable_bic_int(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int ioaddr = dev->base_addr; + +        tp->trc_mask = CSR_MSK_ALL | CSR_MSKCBUSY +	        | CSR_MSKTINT | CSR_WCSS; +        outb(tp->trc_mask, ioaddr + CSR); + +        return (0); +} + +static int smctr_enable_16bit(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        __u8    r; + +        if(tp->adapter_bus == BUS_ISA16_TYPE) +        { +                r = inb(dev->base_addr + LAAR); +                outb((r | LAAR_MEM16ENB), dev->base_addr + LAAR); +        } + +        return (0); +} + +/* + * To enable the adapter control store memory: + * 1. Adapter must be in a RESET state. + * 2. Adapter memory must be enabled. + * 3. Control Store Memory is in context (-WCSS is 0). + */ +static int smctr_enable_adapter_ctrl_store(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int ioaddr = dev->base_addr; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_enable_adapter_ctrl_store\n", dev->name); + +        smctr_set_trc_reset(ioaddr); +        smctr_enable_adapter_ram(dev); + +        tp->trc_mask &= ~CSR_WCSS; +        outb(tp->trc_mask, ioaddr + CSR); + +        return (0); +} + +static int smctr_enable_adapter_ram(struct net_device *dev) +{ +        int ioaddr = dev->base_addr; +        __u8 r; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_enable_adapter_ram\n", dev->name); + +        r = inb(ioaddr + MSR); +        outb(MSR_MEMB | r, ioaddr + MSR); + +        return (0); +} + +static int smctr_enable_bic_int(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int ioaddr = dev->base_addr; +        __u8 r; + +        switch(tp->bic_type) +        { +                case (BIC_584_CHIP): +                        tp->trc_mask = CSR_MSKCBUSY | CSR_WCSS; +                        outb(tp->trc_mask, ioaddr + CSR); +                        r = inb(ioaddr + IRR); +                        outb(r | IRR_IEN, ioaddr + IRR); +                        break; + +                case (BIC_594_CHIP): +                        tp->trc_mask = CSR_MSKCBUSY | CSR_WCSS; +                        outb(tp->trc_mask, ioaddr + CSR); +                        r = inb(ioaddr + IMCCR); +                        outb(r | IMCCR_EIL, ioaddr + IMCCR); +                        break; +        } + +        return (0); +} + +static int __init smctr_chk_isa(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int ioaddr = dev->base_addr; +        __u8 r1, r2, b, chksum = 0; +        __u16 r; +	int i; +	int err = -ENODEV; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_chk_isa %#4x\n", dev->name, ioaddr); + +	if((ioaddr & 0x1F) != 0) +                goto out; + +        /* Grab the region so that no one else tries to probe our ioports. */ +	if (!request_region(ioaddr, SMCTR_IO_EXTENT, smctr_name)) { +		err = -EBUSY; +		goto out; +	} + +        /* Checksum SMC node address */ +        for(i = 0; i < 8; i++) +        { +                b = inb(ioaddr + LAR0 + i); +                chksum += b; +        } + +        if (chksum != NODE_ADDR_CKSUM) +                goto out2; + +        b = inb(ioaddr + BDID); +	if(b != BRD_ID_8115T) +        { +                printk(KERN_ERR "%s: The adapter found is not supported\n", dev->name); +                goto out2; +        } + +        /* Check for 8115T Board ID */ +        r2 = 0; +        for(r = 0; r < 8; r++) +        { +            r1 = inb(ioaddr + 0x8 + r); +            r2 += r1; +        } + +        /* value of RegF adds up the sum to 0xFF */ +        if((r2 != 0xFF) && (r2 != 0xEE)) +                goto out2; + +        /* Get adapter ID */ +        tp->board_id = smctr_get_boardid(dev, 0); +        switch(tp->board_id & 0xffff) +        { +                case WD8115TA: +                        smctr_model = "8115T/A"; +                        break; + +                case WD8115T: +			if(tp->extra_info & CHIP_REV_MASK) +                                smctr_model = "8115T rev XE"; +                        else +                                smctr_model = "8115T rev XD"; +                        break; + +                default: +                        smctr_model = "Unknown"; +                        break; +        } + +        /* Store BIC type. */ +        tp->bic_type = BIC_584_CHIP; +        tp->nic_type = NIC_825_CHIP; + +        /* Copy Ram Size */ +        tp->ram_usable  = CNFG_SIZE_16KB; +        tp->ram_size    = CNFG_SIZE_64KB; + +        /* Get 58x Ram Base */ +        r1 = inb(ioaddr); +        r1 &= 0x3F; + +        r2 = inb(ioaddr + CNFG_LAAR_584); +        r2 &= CNFG_LAAR_MASK; +        r2 <<= 3; +        r2 |= ((r1 & 0x38) >> 3); + +        tp->ram_base = ((__u32)r2 << 16) + (((__u32)(r1 & 0x7)) << 13); + +        /* Get 584 Irq */ +        r1 = 0; +        r1 = inb(ioaddr + CNFG_ICR_583); +        r1 &= CNFG_ICR_IR2_584; + +        r2 = inb(ioaddr + CNFG_IRR_583); +        r2 &= CNFG_IRR_IRQS;     /* 0x60 */ +        r2 >>= 5; + +        switch(r2) +        { +                case 0: +                        if(r1 == 0) +                                dev->irq = 2; +                        else +                                dev->irq = 10; +                        break; + +                case 1: +                        if(r1 == 0) +                                dev->irq = 3; +                        else +                                dev->irq = 11; +                        break; + +                case 2: +                        if(r1 == 0) +                        { +                                if(tp->extra_info & ALTERNATE_IRQ_BIT) +                                        dev->irq = 5; +                                else +                                        dev->irq = 4; +                        } +                        else +                                dev->irq = 15; +                        break; + +                case 3: +                        if(r1 == 0) +                                dev->irq = 7; +                        else +                                dev->irq = 4; +                        break; + +                default: +                        printk(KERN_ERR "%s: No IRQ found aborting\n", dev->name); +                        goto out2; +         } + +        if (request_irq(dev->irq, smctr_interrupt, SA_SHIRQ, smctr_name, dev)) +                goto out2; + +        /* Get 58x Rom Base */ +        r1 = inb(ioaddr + CNFG_BIO_583); +        r1 &= 0x3E; +        r1 |= 0x40; + +        tp->rom_base = (__u32)r1 << 13; + +        /* Get 58x Rom Size */ +        r1 = inb(ioaddr + CNFG_BIO_583); +        r1 &= 0xC0; +        if(r1 == 0) +                tp->rom_size = ROM_DISABLE; +        else +        { +                r1 >>= 6; +                tp->rom_size = (__u16)CNFG_SIZE_8KB << r1; +        } + +        /* Get 58x Boot Status */ +        r1 = inb(ioaddr + CNFG_GP2); + +        tp->mode_bits &= (~BOOT_STATUS_MASK); + +        if(r1 & CNFG_GP2_BOOT_NIBBLE) +                tp->mode_bits |= BOOT_TYPE_1; + +        /* Get 58x Zero Wait State */ +        tp->mode_bits &= (~ZERO_WAIT_STATE_MASK); + +        r1 = inb(ioaddr + CNFG_IRR_583); + +        if(r1 & CNFG_IRR_ZWS) +                 tp->mode_bits |= ZERO_WAIT_STATE_8_BIT; + +        if(tp->board_id & BOARD_16BIT) +        { +                r1 = inb(ioaddr + CNFG_LAAR_584); + +                if(r1 & CNFG_LAAR_ZWS) +                        tp->mode_bits |= ZERO_WAIT_STATE_16_BIT; +        } + +        /* Get 584 Media Menu */ +        tp->media_menu = 14; +        r1 = inb(ioaddr + CNFG_IRR_583); + +        tp->mode_bits &= 0xf8ff;       /* (~CNFG_INTERFACE_TYPE_MASK) */ +        if((tp->board_id & TOKEN_MEDIA) == TOKEN_MEDIA) +        { +                /* Get Advanced Features */ +                if(((r1 & 0x6) >> 1) == 0x3) +                        tp->media_type |= MEDIA_UTP_16; +                else +                { +                        if(((r1 & 0x6) >> 1) == 0x2) +                                tp->media_type |= MEDIA_STP_16; +                        else +                        { +                                if(((r1 & 0x6) >> 1) == 0x1) +                                        tp->media_type |= MEDIA_UTP_4; + +                                else +                                        tp->media_type |= MEDIA_STP_4; +                        } +                } + +                r1 = inb(ioaddr + CNFG_GP2); +                if(!(r1 & 0x2) )           /* GP2_ETRD */ +                        tp->mode_bits |= EARLY_TOKEN_REL; + +                /* see if the chip is corrupted +                if(smctr_read_584_chksum(ioaddr)) +                { +                        printk(KERN_ERR "%s: EEPROM Checksum Failure\n", dev->name); +			free_irq(dev->irq, dev); +                        goto out2; +                } +		*/ +        } + +        return (0); + +out2: +	release_region(ioaddr, SMCTR_IO_EXTENT); +out: +	return err; +} + +static int __init smctr_get_boardid(struct net_device *dev, int mca) +{ +        struct net_local *tp = netdev_priv(dev); +        int ioaddr = dev->base_addr; +        __u8 r, r1, IdByte; +        __u16 BoardIdMask; + +        tp->board_id = BoardIdMask = 0; + +	if(mca) +	{ +		BoardIdMask |= (MICROCHANNEL+INTERFACE_CHIP+TOKEN_MEDIA+PAGED_RAM+BOARD_16BIT); +		tp->extra_info |= (INTERFACE_594_CHIP+RAM_SIZE_64K+NIC_825_BIT+ALTERNATE_IRQ_BIT+SLOT_16BIT); +	} +	else +	{ +        	BoardIdMask|=(INTERFACE_CHIP+TOKEN_MEDIA+PAGED_RAM+BOARD_16BIT); +        	tp->extra_info |= (INTERFACE_584_CHIP + RAM_SIZE_64K +        	        + NIC_825_BIT + ALTERNATE_IRQ_BIT); +	} + +	if(!mca) +	{ +        	r = inb(ioaddr + BID_REG_1); +        	r &= 0x0c; +       		outb(r, ioaddr + BID_REG_1); +        	r = inb(ioaddr + BID_REG_1); + +        	if(r & BID_SIXTEEN_BIT_BIT) +        	{ +        	        tp->extra_info |= SLOT_16BIT; +        	        tp->adapter_bus = BUS_ISA16_TYPE; +        	} +        	else +        	        tp->adapter_bus = BUS_ISA8_TYPE; +	} +	else +		tp->adapter_bus = BUS_MCA_TYPE; + +        /* Get Board Id Byte */ +        IdByte = inb(ioaddr + BID_BOARD_ID_BYTE); + +        /* if Major version > 1.0 then +         *      return; +         */ +        if(IdByte & 0xF8) +                return (-1); + +        r1 = inb(ioaddr + BID_REG_1); +        r1 &= BID_ICR_MASK; +        r1 |= BID_OTHER_BIT; + +        outb(r1, ioaddr + BID_REG_1); +        r1 = inb(ioaddr + BID_REG_3); + +        r1 &= BID_EAR_MASK; +        r1 |= BID_ENGR_PAGE; + +        outb(r1, ioaddr + BID_REG_3); +        r1 = inb(ioaddr + BID_REG_1); +        r1 &= BID_ICR_MASK; +        r1 |= (BID_RLA | BID_OTHER_BIT); + +        outb(r1, ioaddr + BID_REG_1); + +        r1 = inb(ioaddr + BID_REG_1); +        while(r1 & BID_RECALL_DONE_MASK) +                r1 = inb(ioaddr + BID_REG_1); + +        r = inb(ioaddr + BID_LAR_0 + BID_REG_6); + +        /* clear chip rev bits */ +        tp->extra_info &= ~CHIP_REV_MASK; +        tp->extra_info |= ((r & BID_EEPROM_CHIP_REV_MASK) << 6); + +        r1 = inb(ioaddr + BID_REG_1); +        r1 &= BID_ICR_MASK; +        r1 |= BID_OTHER_BIT; + +        outb(r1, ioaddr + BID_REG_1); +        r1 = inb(ioaddr + BID_REG_3); + +        r1 &= BID_EAR_MASK; +        r1 |= BID_EA6; + +        outb(r1, ioaddr + BID_REG_3); +        r1 = inb(ioaddr + BID_REG_1); + +        r1 &= BID_ICR_MASK; +        r1 |= BID_RLA; + +        outb(r1, ioaddr + BID_REG_1); +        r1 = inb(ioaddr + BID_REG_1); + +        while(r1 & BID_RECALL_DONE_MASK) +                r1 = inb(ioaddr + BID_REG_1); + +        return (BoardIdMask); +} + +static int smctr_get_group_address(struct net_device *dev) +{ +        smctr_issue_read_word_cmd(dev, RW_INDIVIDUAL_GROUP_ADDR); + +        return(smctr_wait_cmd(dev)); +} + +static int smctr_get_functional_address(struct net_device *dev) +{ +        smctr_issue_read_word_cmd(dev, RW_FUNCTIONAL_ADDR); + +        return(smctr_wait_cmd(dev)); +} + +/* Calculate number of Non-MAC receive BDB's and data buffers. + * This function must simulate allocateing shared memory exactly + * as the allocate_shared_memory function above. + */ +static unsigned int smctr_get_num_rx_bdbs(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int mem_used = 0; + +        /* Allocate System Control Blocks. */ +        mem_used += sizeof(SCGBlock); + +        mem_used += TO_PARAGRAPH_BOUNDRY(mem_used); +        mem_used += sizeof(SCLBlock); + +        mem_used += TO_PARAGRAPH_BOUNDRY(mem_used); +        mem_used += sizeof(ACBlock) * tp->num_acbs; + +        mem_used += TO_PARAGRAPH_BOUNDRY(mem_used); +        mem_used += sizeof(ISBlock); + +        mem_used += TO_PARAGRAPH_BOUNDRY(mem_used); +        mem_used += MISC_DATA_SIZE; + +        /* Allocate transmit FCB's. */ +        mem_used += TO_PARAGRAPH_BOUNDRY(mem_used); + +        mem_used += sizeof(FCBlock) * tp->num_tx_fcbs[MAC_QUEUE]; +        mem_used += sizeof(FCBlock) * tp->num_tx_fcbs[NON_MAC_QUEUE]; +        mem_used += sizeof(FCBlock) * tp->num_tx_fcbs[BUG_QUEUE]; + +        /* Allocate transmit BDBs. */ +        mem_used += sizeof(BDBlock) * tp->num_tx_bdbs[MAC_QUEUE]; +        mem_used += sizeof(BDBlock) * tp->num_tx_bdbs[NON_MAC_QUEUE]; +        mem_used += sizeof(BDBlock) * tp->num_tx_bdbs[BUG_QUEUE]; + +        /* Allocate receive FCBs. */ +        mem_used += sizeof(FCBlock) * tp->num_rx_fcbs[MAC_QUEUE]; +        mem_used += sizeof(FCBlock) * tp->num_rx_fcbs[NON_MAC_QUEUE]; + +        /* Allocate receive BDBs. */ +        mem_used += sizeof(BDBlock) * tp->num_rx_bdbs[MAC_QUEUE]; + +        /* Allocate MAC transmit buffers. +         * MAC transmit buffers don't have to be on an ODD Boundry. +         */ +        mem_used += tp->tx_buff_size[MAC_QUEUE]; + +        /* Allocate BUG transmit buffers. */ +        mem_used += tp->tx_buff_size[BUG_QUEUE]; + +        /* Allocate MAC receive data buffers. +         * MAC receive buffers don't have to be on a 256 byte boundary. +         */ +        mem_used += RX_DATA_BUFFER_SIZE * tp->num_rx_bdbs[MAC_QUEUE]; + +        /* Allocate Non-MAC transmit buffers. +         * For maximum Netware performance, put Tx Buffers on +         * ODD Boundry,and then restore malloc to Even Boundrys. +         */ +        mem_used += 1L; +        mem_used += tp->tx_buff_size[NON_MAC_QUEUE]; +        mem_used += 1L; + +        /* CALCULATE NUMBER OF NON-MAC RX BDB'S +         * AND NON-MAC RX DATA BUFFERS +         * +         * Make sure the mem_used offset at this point is the +         * same as in allocate_shared memory or the following +         * boundary adjustment will be incorrect (i.e. not allocating +         * the non-mac receive buffers above cannot change the 256 +         * byte offset). +         * +         * Since this cannot be guaranteed, adding the full 256 bytes +         * to the amount of shared memory used at this point will guaranteed +         * that the rx data buffers do not overflow shared memory. +         */ +        mem_used += 0x100; + +        return((0xffff - mem_used) / (RX_DATA_BUFFER_SIZE + sizeof(BDBlock))); +} + +static int smctr_get_physical_drop_number(struct net_device *dev) +{ +        smctr_issue_read_word_cmd(dev, RW_PHYSICAL_DROP_NUMBER); + +        return(smctr_wait_cmd(dev)); +} + +static __u8 * smctr_get_rx_pointer(struct net_device *dev, short queue) +{ +        struct net_local *tp = netdev_priv(dev); +        BDBlock *bdb; + +        bdb = (BDBlock *)((__u32)tp->ram_access +                + (__u32)(tp->rx_fcb_curr[queue]->trc_bdb_ptr)); + +        tp->rx_fcb_curr[queue]->bdb_ptr = bdb; + +        return ((__u8 *)bdb->data_block_ptr); +} + +static int smctr_get_station_id(struct net_device *dev) +{ +        smctr_issue_read_word_cmd(dev, RW_INDIVIDUAL_MAC_ADDRESS); + +        return(smctr_wait_cmd(dev)); +} + +/* + * Get the current statistics. This may be called with the card open + * or closed. + */ +static struct net_device_stats *smctr_get_stats(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); + +        return ((struct net_device_stats *)&tp->MacStat); +} + +static FCBlock *smctr_get_tx_fcb(struct net_device *dev, __u16 queue, +        __u16 bytes_count) +{ +        struct net_local *tp = netdev_priv(dev); +        FCBlock *pFCB; +        BDBlock *pbdb; +        unsigned short alloc_size; +        unsigned short *temp; + +        if(smctr_debug > 20) +                printk(KERN_DEBUG "smctr_get_tx_fcb\n"); + +        /* check if there is enough FCB blocks */ +        if(tp->num_tx_fcbs_used[queue] >= tp->num_tx_fcbs[queue]) +                return ((FCBlock *)(-1L)); + +        /* round off the input pkt size to the nearest even number */ +        alloc_size = (bytes_count + 1) & 0xfffe; + +        /* check if enough mem */ +        if((tp->tx_buff_used[queue] + alloc_size) > tp->tx_buff_size[queue]) +                return ((FCBlock *)(-1L)); + +        /* check if past the end ; +         * if exactly enough mem to end of ring, alloc from front. +         * this avoids update of curr when curr = end +         */ +        if(((unsigned long)(tp->tx_buff_curr[queue]) + alloc_size) +                >= (unsigned long)(tp->tx_buff_end[queue])) +        { +                /* check if enough memory from ring head */ +                alloc_size = alloc_size + +                        (__u16)((__u32)tp->tx_buff_end[queue] +                        - (__u32)tp->tx_buff_curr[queue]); + +                if((tp->tx_buff_used[queue] + alloc_size) +                        > tp->tx_buff_size[queue]) +                { +                        return ((FCBlock *)(-1L)); +                } + +                /* ring wrap */ +                tp->tx_buff_curr[queue] = tp->tx_buff_head[queue]; +        } + +        tp->tx_buff_used[queue] += alloc_size; +        tp->num_tx_fcbs_used[queue]++; +        tp->tx_fcb_curr[queue]->frame_length = bytes_count; +        tp->tx_fcb_curr[queue]->memory_alloc = alloc_size; +        temp = tp->tx_buff_curr[queue]; +        tp->tx_buff_curr[queue] +                = (__u16 *)((__u32)temp + (__u32)((bytes_count + 1) & 0xfffe)); + +        pbdb = tp->tx_fcb_curr[queue]->bdb_ptr; +        pbdb->buffer_length = bytes_count; +        pbdb->data_block_ptr = temp; +        pbdb->trc_data_block_ptr = TRC_POINTER(temp); + +        pFCB = tp->tx_fcb_curr[queue]; +        tp->tx_fcb_curr[queue] = tp->tx_fcb_curr[queue]->next_ptr; + +        return (pFCB); +} + +static int smctr_get_upstream_neighbor_addr(struct net_device *dev) +{ +        smctr_issue_read_word_cmd(dev, RW_UPSTREAM_NEIGHBOR_ADDRESS); + +        return(smctr_wait_cmd(dev)); +} + +static int smctr_hardware_send_packet(struct net_device *dev, +        struct net_local *tp) +{ +        struct tr_statistics *tstat = &tp->MacStat; +        struct sk_buff *skb; +        FCBlock *fcb; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG"%s: smctr_hardware_send_packet\n", dev->name); + +        if(tp->status != OPEN) +                return (-1); + +        if(tp->monitor_state_ready != 1) +                return (-1); + +        for(;;) +        { +                /* Send first buffer from queue */ +                skb = skb_dequeue(&tp->SendSkbQueue); +                if(skb == NULL) +                        return (-1); + +                tp->QueueSkb++; + +                if(skb->len < SMC_HEADER_SIZE || skb->len > tp->max_packet_size)                        return (-1); + +                smctr_enable_16bit(dev); +                smctr_set_page(dev, (__u8 *)tp->ram_access); + +                if((fcb = smctr_get_tx_fcb(dev, NON_MAC_QUEUE, skb->len)) +                        == (FCBlock *)(-1L)) +                { +                        smctr_disable_16bit(dev); +                        return (-1); +                } + +                smctr_tx_move_frame(dev, skb, +                        (__u8 *)fcb->bdb_ptr->data_block_ptr, skb->len); + +                smctr_set_page(dev, (__u8 *)fcb); + +                smctr_trc_send_packet(dev, fcb, NON_MAC_QUEUE); +                dev_kfree_skb(skb); + +                tstat->tx_packets++; + +                smctr_disable_16bit(dev); +        } + +        return (0); +} + +static int smctr_init_acbs(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i; +        ACBlock *acb; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_init_acbs\n", dev->name); + +        acb                     = tp->acb_head; +        acb->cmd_done_status    = (ACB_COMMAND_DONE | ACB_COMMAND_SUCCESSFUL); +        acb->cmd_info           = ACB_CHAIN_END; +        acb->cmd                = 0; +        acb->subcmd             = 0; +        acb->data_offset_lo     = 0; +        acb->data_offset_hi     = 0; +        acb->next_ptr +                = (ACBlock *)(((char *)acb) + sizeof(ACBlock)); +        acb->trc_next_ptr       = TRC_POINTER(acb->next_ptr); + +        for(i = 1; i < tp->num_acbs; i++) +        { +                acb             = acb->next_ptr; +                acb->cmd_done_status +                        = (ACB_COMMAND_DONE | ACB_COMMAND_SUCCESSFUL); +                acb->cmd_info = ACB_CHAIN_END; +                acb->cmd        = 0; +                acb->subcmd     = 0; +                acb->data_offset_lo = 0; +                acb->data_offset_hi = 0; +                acb->next_ptr +                        = (ACBlock *)(((char *)acb) + sizeof(ACBlock)); +                acb->trc_next_ptr = TRC_POINTER(acb->next_ptr); +        } + +        acb->next_ptr           = tp->acb_head; +        acb->trc_next_ptr       = TRC_POINTER(tp->acb_head); +        tp->acb_next            = tp->acb_head->next_ptr; +        tp->acb_curr            = tp->acb_head->next_ptr; +        tp->num_acbs_used       = 0; + +        return (0); +} + +static int smctr_init_adapter(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int err; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_init_adapter\n", dev->name); + +        tp->status              = CLOSED; +        tp->page_offset_mask    = (tp->ram_usable * 1024) - 1; +        skb_queue_head_init(&tp->SendSkbQueue); +        tp->QueueSkb = MAX_TX_QUEUE; + +        if(!(tp->group_address_0 & 0x0080)) +                tp->group_address_0 |= 0x00C0; + +        if(!(tp->functional_address_0 & 0x00C0)) +                tp->functional_address_0 |= 0x00C0; + +        tp->functional_address[0] &= 0xFF7F; + +        if(tp->authorized_function_classes == 0) +                tp->authorized_function_classes = 0x7FFF; + +        if(tp->authorized_access_priority == 0) +                tp->authorized_access_priority = 0x06; + +        smctr_disable_bic_int(dev); +        smctr_set_trc_reset(dev->base_addr); + +        smctr_enable_16bit(dev); +        smctr_set_page(dev, (__u8 *)tp->ram_access); + +        if(smctr_checksum_firmware(dev)) +	{ +                printk(KERN_ERR "%s: Previously loaded firmware is missing\n",dev->name);                return (-ENOENT); +        } + +        if((err = smctr_ram_memory_test(dev))) +	{ +                printk(KERN_ERR "%s: RAM memory test failed.\n", dev->name); +                return (-EIO); +        } + +	smctr_set_rx_look_ahead(dev); +        smctr_load_node_addr(dev); + +        /* Initialize adapter for Internal Self Test. */ +        smctr_reset_adapter(dev); +        if((err = smctr_init_card_real(dev))) +	{ +                printk(KERN_ERR "%s: Initialization of card failed (%d)\n", +                        dev->name, err); +                return (-EINVAL); +        } + +        /* This routine clobbers the TRC's internal registers. */ +        if((err = smctr_internal_self_test(dev))) +	{ +                printk(KERN_ERR "%s: Card failed internal self test (%d)\n", +                        dev->name, err); +                return (-EINVAL); +        } + +        /* Re-Initialize adapter's internal registers */ +        smctr_reset_adapter(dev); +        if((err = smctr_init_card_real(dev))) +	{ +                printk(KERN_ERR "%s: Initialization of card failed (%d)\n", +                        dev->name, err); +                return (-EINVAL); +        } + +        smctr_enable_bic_int(dev); + +        if((err = smctr_issue_enable_int_cmd(dev, TRC_INTERRUPT_ENABLE_MASK))) +                return (err); + +        smctr_disable_16bit(dev); + +        return (0); +} + +static int smctr_init_card_real(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int err = 0; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_init_card_real\n", dev->name); + +        tp->sh_mem_used = 0; +        tp->num_acbs    = NUM_OF_ACBS; + +        /* Range Check Max Packet Size */ +        if(tp->max_packet_size < 256) +                tp->max_packet_size = 256; +        else +        { +                if(tp->max_packet_size > NON_MAC_TX_BUFFER_MEMORY) +                        tp->max_packet_size = NON_MAC_TX_BUFFER_MEMORY; +        } + +        tp->num_of_tx_buffs = (NON_MAC_TX_BUFFER_MEMORY +                / tp->max_packet_size) - 1; + +        if(tp->num_of_tx_buffs > NUM_NON_MAC_TX_FCBS) +                tp->num_of_tx_buffs = NUM_NON_MAC_TX_FCBS; +        else +        { +                if(tp->num_of_tx_buffs == 0) +                        tp->num_of_tx_buffs = 1; +        } + +        /* Tx queue constants */ +        tp->num_tx_fcbs        [BUG_QUEUE]     = NUM_BUG_TX_FCBS; +        tp->num_tx_bdbs        [BUG_QUEUE]     = NUM_BUG_TX_BDBS; +        tp->tx_buff_size       [BUG_QUEUE]     = BUG_TX_BUFFER_MEMORY; +        tp->tx_buff_used       [BUG_QUEUE]     = 0; +        tp->tx_queue_status    [BUG_QUEUE]     = NOT_TRANSMITING; + +        tp->num_tx_fcbs        [MAC_QUEUE]     = NUM_MAC_TX_FCBS; +        tp->num_tx_bdbs        [MAC_QUEUE]     = NUM_MAC_TX_BDBS; +        tp->tx_buff_size       [MAC_QUEUE]     = MAC_TX_BUFFER_MEMORY; +        tp->tx_buff_used       [MAC_QUEUE]     = 0; +        tp->tx_queue_status    [MAC_QUEUE]     = NOT_TRANSMITING; + +        tp->num_tx_fcbs        [NON_MAC_QUEUE] = NUM_NON_MAC_TX_FCBS; +        tp->num_tx_bdbs        [NON_MAC_QUEUE] = NUM_NON_MAC_TX_BDBS; +        tp->tx_buff_size       [NON_MAC_QUEUE] = NON_MAC_TX_BUFFER_MEMORY; +        tp->tx_buff_used       [NON_MAC_QUEUE] = 0; +        tp->tx_queue_status    [NON_MAC_QUEUE] = NOT_TRANSMITING; + +        /* Receive Queue Constants */ +        tp->num_rx_fcbs[MAC_QUEUE] = NUM_MAC_RX_FCBS; +        tp->num_rx_bdbs[MAC_QUEUE] = NUM_MAC_RX_BDBS; + +        if(tp->extra_info & CHIP_REV_MASK) +                tp->num_rx_fcbs[NON_MAC_QUEUE] = 78;    /* 825 Rev. XE */ +        else +                tp->num_rx_fcbs[NON_MAC_QUEUE] = 7;     /* 825 Rev. XD */ + +        tp->num_rx_bdbs[NON_MAC_QUEUE] = smctr_get_num_rx_bdbs(dev); + +        smctr_alloc_shared_memory(dev); +        smctr_init_shared_memory(dev); + +        if((err = smctr_issue_init_timers_cmd(dev))) +                return (err); + +        if((err = smctr_issue_init_txrx_cmd(dev))) +	{ +                printk(KERN_ERR "%s: Hardware failure\n", dev->name); +                return (err); +        } + +        return (0); +} + +static int smctr_init_rx_bdbs(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i, j; +        BDBlock *bdb; +        __u16 *buf; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_init_rx_bdbs\n", dev->name); + +        for(i = 0; i < NUM_RX_QS_USED; i++) +        { +                bdb = tp->rx_bdb_head[i]; +                buf = tp->rx_buff_head[i]; +                bdb->info = (BDB_CHAIN_END | BDB_NO_WARNING); +                bdb->buffer_length = RX_DATA_BUFFER_SIZE; +                bdb->next_ptr = (BDBlock *)(((char *)bdb) + sizeof(BDBlock)); +                bdb->data_block_ptr = buf; +                bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr); + +                if(i == NON_MAC_QUEUE) +                        bdb->trc_data_block_ptr = RX_BUFF_TRC_POINTER(buf); +                else +                        bdb->trc_data_block_ptr = TRC_POINTER(buf); + +                for(j = 1; j < tp->num_rx_bdbs[i]; j++) +                { +                        bdb->next_ptr->back_ptr = bdb; +                        bdb = bdb->next_ptr; +                        buf = (__u16 *)((char *)buf + RX_DATA_BUFFER_SIZE); +                        bdb->info = (BDB_NOT_CHAIN_END | BDB_NO_WARNING); +                        bdb->buffer_length = RX_DATA_BUFFER_SIZE; +                        bdb->next_ptr = (BDBlock *)(((char *)bdb) + sizeof(BDBlock)); +                        bdb->data_block_ptr = buf; +                        bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr); + +                        if(i == NON_MAC_QUEUE) +                                bdb->trc_data_block_ptr = RX_BUFF_TRC_POINTER(buf); +                        else +                                bdb->trc_data_block_ptr = TRC_POINTER(buf); +                } + +                bdb->next_ptr           = tp->rx_bdb_head[i]; +                bdb->trc_next_ptr       = TRC_POINTER(tp->rx_bdb_head[i]); + +                tp->rx_bdb_head[i]->back_ptr    = bdb; +                tp->rx_bdb_curr[i]              = tp->rx_bdb_head[i]->next_ptr; +        } + +        return (0); +} + +static int smctr_init_rx_fcbs(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i, j; +        FCBlock *fcb; + +        for(i = 0; i < NUM_RX_QS_USED; i++) +        { +                fcb               = tp->rx_fcb_head[i]; +                fcb->frame_status = 0; +                fcb->frame_length = 0; +                fcb->info         = FCB_CHAIN_END; +                fcb->next_ptr     = (FCBlock *)(((char*)fcb) + sizeof(FCBlock)); +                if(i == NON_MAC_QUEUE) +                        fcb->trc_next_ptr = RX_FCB_TRC_POINTER(fcb->next_ptr); +                else +                        fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr); + +                for(j = 1; j < tp->num_rx_fcbs[i]; j++) +                { +                        fcb->next_ptr->back_ptr = fcb; +                        fcb                     = fcb->next_ptr; +                        fcb->frame_status       = 0; +                        fcb->frame_length       = 0; +                        fcb->info               = FCB_WARNING; +                        fcb->next_ptr +                                = (FCBlock *)(((char *)fcb) + sizeof(FCBlock)); + +                        if(i == NON_MAC_QUEUE) +                                fcb->trc_next_ptr +                                        = RX_FCB_TRC_POINTER(fcb->next_ptr); +                        else +                                fcb->trc_next_ptr +                                        = TRC_POINTER(fcb->next_ptr); +                } + +                fcb->next_ptr = tp->rx_fcb_head[i]; + +                if(i == NON_MAC_QUEUE) +                        fcb->trc_next_ptr = RX_FCB_TRC_POINTER(fcb->next_ptr); +                else +                        fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr); + +                tp->rx_fcb_head[i]->back_ptr    = fcb; +                tp->rx_fcb_curr[i]              = tp->rx_fcb_head[i]->next_ptr; +        } + +        return(0); +} + +static int smctr_init_shared_memory(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i; +        __u32 *iscpb; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_init_shared_memory\n", dev->name); + +        smctr_set_page(dev, (__u8 *)(unsigned int)tp->iscpb_ptr); + +        /* Initialize Initial System Configuration Point. (ISCP) */ +        iscpb = (__u32 *)PAGE_POINTER(&tp->iscpb_ptr->trc_scgb_ptr); +        *iscpb = (__u32)(SWAP_WORDS(TRC_POINTER(tp->scgb_ptr))); + +        smctr_set_page(dev, (__u8 *)tp->ram_access); + +        /* Initialize System Configuration Pointers. (SCP) */ +        tp->scgb_ptr->config = (SCGB_ADDRESS_POINTER_FORMAT +                | SCGB_MULTI_WORD_CONTROL | SCGB_DATA_FORMAT +                | SCGB_BURST_LENGTH); + +        tp->scgb_ptr->trc_sclb_ptr      = TRC_POINTER(tp->sclb_ptr); +        tp->scgb_ptr->trc_acb_ptr       = TRC_POINTER(tp->acb_head); +        tp->scgb_ptr->trc_isb_ptr       = TRC_POINTER(tp->isb_ptr); +        tp->scgb_ptr->isbsiz            = (sizeof(ISBlock)) - 2; + +        /* Initialize System Control Block. (SCB) */ +        tp->sclb_ptr->valid_command    = SCLB_VALID | SCLB_CMD_NOP; +        tp->sclb_ptr->iack_code        = 0; +        tp->sclb_ptr->resume_control   = 0; +        tp->sclb_ptr->int_mask_control = 0; +        tp->sclb_ptr->int_mask_state   = 0; + +        /* Initialize Interrupt Status Block. (ISB) */ +        for(i = 0; i < NUM_OF_INTERRUPTS; i++) +        { +                tp->isb_ptr->IStatus[i].IType = 0xf0; +                tp->isb_ptr->IStatus[i].ISubtype = 0; +        } + +        tp->current_isb_index = 0; + +        /* Initialize Action Command Block. (ACB) */ +        smctr_init_acbs(dev); + +        /* Initialize transmit FCB's and BDB's. */ +        smctr_link_tx_fcbs_to_bdbs(dev); +        smctr_init_tx_bdbs(dev); +        smctr_init_tx_fcbs(dev); + +        /* Initialize receive FCB's and BDB's. */ +        smctr_init_rx_bdbs(dev); +        smctr_init_rx_fcbs(dev); + +        return (0); +} + +static int smctr_init_tx_bdbs(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i, j; +        BDBlock *bdb; + +        for(i = 0; i < NUM_TX_QS_USED; i++) +        { +                bdb = tp->tx_bdb_head[i]; +                bdb->info = (BDB_NOT_CHAIN_END | BDB_NO_WARNING); +                bdb->next_ptr = (BDBlock *)(((char *)bdb) + sizeof(BDBlock)); +                bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr); + +                for(j = 1; j < tp->num_tx_bdbs[i]; j++) +                { +                        bdb->next_ptr->back_ptr = bdb; +                        bdb = bdb->next_ptr; +                        bdb->info = (BDB_NOT_CHAIN_END | BDB_NO_WARNING); +                        bdb->next_ptr +                                = (BDBlock *)(((char *)bdb) + sizeof( BDBlock));                        bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr); +                } + +                bdb->next_ptr = tp->tx_bdb_head[i]; +                bdb->trc_next_ptr = TRC_POINTER(tp->tx_bdb_head[i]); +                tp->tx_bdb_head[i]->back_ptr = bdb; +        } + +        return (0); +} + +static int smctr_init_tx_fcbs(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i, j; +        FCBlock *fcb; + +        for(i = 0; i < NUM_TX_QS_USED; i++) +        { +                fcb               = tp->tx_fcb_head[i]; +                fcb->frame_status = 0; +                fcb->frame_length = 0; +                fcb->info         = FCB_CHAIN_END; +                fcb->next_ptr = (FCBlock *)(((char *)fcb) + sizeof(FCBlock)); +                fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr); + +                for(j = 1; j < tp->num_tx_fcbs[i]; j++) +                { +                        fcb->next_ptr->back_ptr = fcb; +                        fcb                     = fcb->next_ptr; +                        fcb->frame_status       = 0; +                        fcb->frame_length       = 0; +                        fcb->info               = FCB_CHAIN_END; +                        fcb->next_ptr +                                = (FCBlock *)(((char *)fcb) + sizeof(FCBlock)); +                        fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr); +                } + +                fcb->next_ptr           = tp->tx_fcb_head[i]; +                fcb->trc_next_ptr       = TRC_POINTER(tp->tx_fcb_head[i]); + +                tp->tx_fcb_head[i]->back_ptr    = fcb; +                tp->tx_fcb_end[i]               = tp->tx_fcb_head[i]->next_ptr; +                tp->tx_fcb_curr[i]              = tp->tx_fcb_head[i]->next_ptr; +                tp->num_tx_fcbs_used[i]         = 0; +        } + +        return (0); +} + +static int smctr_internal_self_test(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int err; + +        if((err = smctr_issue_test_internal_rom_cmd(dev))) +                return (err); + +        if((err = smctr_wait_cmd(dev))) +                return (err); + +        if(tp->acb_head->cmd_done_status & 0xff) +                return (-1); + +        if((err = smctr_issue_test_hic_cmd(dev))) +                return (err); + +        if((err = smctr_wait_cmd(dev))) +                return (err); + +        if(tp->acb_head->cmd_done_status & 0xff) +                return (-1); + +        if((err = smctr_issue_test_mac_reg_cmd(dev))) +                return (err); + +        if((err = smctr_wait_cmd(dev))) +                return (err); + +        if(tp->acb_head->cmd_done_status & 0xff) +                return (-1); + +        return (0); +} + +/* + * The typical workload of the driver: Handle the network interface interrupts. + */ +static irqreturn_t smctr_interrupt(int irq, void *dev_id, struct pt_regs *regs) +{ +        struct net_device *dev = dev_id; +        struct net_local *tp; +        int ioaddr; +        __u16 interrupt_unmask_bits = 0, interrupt_ack_code = 0xff00; +        __u16 err1, err = NOT_MY_INTERRUPT; +        __u8 isb_type, isb_subtype; +        __u16 isb_index; + +        if(dev == NULL) +        { +                printk(KERN_CRIT "%s: irq %d for unknown device.\n", dev->name, irq); +                return IRQ_NONE; +        } + +        ioaddr = dev->base_addr; +        tp = netdev_priv(dev); +         + +        if(tp->status == NOT_INITIALIZED) +                return IRQ_NONE; + +        spin_lock(&tp->lock); +         +        smctr_disable_bic_int(dev); +        smctr_enable_16bit(dev); + +        smctr_clear_int(dev); + +        /* First read the LSB */ +        while((tp->isb_ptr->IStatus[tp->current_isb_index].IType & 0xf0) == 0) +        { +                isb_index       = tp->current_isb_index; +                isb_type        = tp->isb_ptr->IStatus[isb_index].IType; +                isb_subtype     = tp->isb_ptr->IStatus[isb_index].ISubtype; + +                (tp->current_isb_index)++; +                if(tp->current_isb_index == NUM_OF_INTERRUPTS) +                        tp->current_isb_index = 0; + +                if(isb_type >= 0x10) +                { +                        smctr_disable_16bit(dev); +		        spin_unlock(&tp->lock); +                        return IRQ_HANDLED; +                } + +                err = HARDWARE_FAILED; +                interrupt_ack_code = isb_index; +                tp->isb_ptr->IStatus[isb_index].IType |= 0xf0; + +                interrupt_unmask_bits |= (1 << (__u16)isb_type); + +                switch(isb_type) +                { +                        case ISB_IMC_MAC_TYPE_3: +                                smctr_disable_16bit(dev); + +                                switch(isb_subtype) +                                { +                                        case 0: +                                                tp->monitor_state = MS_MONITOR_FSM_INACTIVE; +                                               break; + +                                        case 1: +                                                tp->monitor_state = MS_REPEAT_BEACON_STATE; +                                                break; + +                                        case 2: +                                                tp->monitor_state = MS_REPEAT_CLAIM_TOKEN_STATE; +                                                break; + +                                        case 3: +                                                tp->monitor_state = MS_TRANSMIT_CLAIM_TOKEN_STATE;                                                break; + +                                        case 4: +                                                tp->monitor_state = MS_STANDBY_MONITOR_STATE; +                                                break; + +                                        case 5: +                                                tp->monitor_state = MS_TRANSMIT_BEACON_STATE; +                                                break; + +                                        case 6: +                                                tp->monitor_state = MS_ACTIVE_MONITOR_STATE; +                                                break; + +                                        case 7: +                                                tp->monitor_state = MS_TRANSMIT_RING_PURGE_STATE; +                                                break; + +                                        case 8:   /* diagnostic state */ +                                                break; + +                                        case 9: +                                                tp->monitor_state = MS_BEACON_TEST_STATE; +                                                if(smctr_lobe_media_test(dev)) +                                                { +                                                        tp->ring_status_flags = RING_STATUS_CHANGED; +                                                        tp->ring_status = AUTO_REMOVAL_ERROR; +                                                        smctr_ring_status_chg(dev); +                                                        smctr_bypass_state(dev); +                                                } +                                                else +                                                        smctr_issue_insert_cmd(dev); +                                                break; + +                                        /* case 0x0a-0xff, illegal states */ +                                        default: +                                                break; +                                } + +                                tp->ring_status_flags = MONITOR_STATE_CHANGED; +                                err = smctr_ring_status_chg(dev); + +                                smctr_enable_16bit(dev); +                                break; + +                        /* Type 0x02 - MAC Error Counters Interrupt +                         * One or more MAC Error Counter is half full +                         *      MAC Error Counters +                         *      Lost_FR_Error_Counter +                         *      RCV_Congestion_Counter +                         *      FR_copied_Error_Counter +                         *      FREQ_Error_Counter +                         *      Token_Error_Counter +                         *      Line_Error_Counter +                         *      Internal_Error_Count +                         */ +                        case ISB_IMC_MAC_ERROR_COUNTERS: +                                /* Read 802.5 Error Counters */ +                                err = smctr_issue_read_ring_status_cmd(dev); +                                break; + +                        /* Type 0x04 - MAC Type 2 Interrupt +                         * HOST needs to enqueue MAC Frame for transmission +                         * SubType Bit 15 - RQ_INIT_PDU( Request Initialization)                         * Changed from RQ_INIT_PDU to +                         * TRC_Status_Changed_Indicate +                         */ +                        case ISB_IMC_MAC_TYPE_2: +                                err = smctr_issue_read_ring_status_cmd(dev); +                                break; + + +                        /* Type 0x05 - TX Frame Interrupt (FI). */ +                        case ISB_IMC_TX_FRAME: +                                /* BUG QUEUE for TRC stuck receive BUG */ +                                if(isb_subtype & TX_PENDING_PRIORITY_2) +                                { +                                        if((err = smctr_tx_complete(dev, BUG_QUEUE)) != SUCCESS) +                                                break; +                                } + +                                /* NON-MAC frames only */ +                                if(isb_subtype & TX_PENDING_PRIORITY_1) +                                { +                                        if((err = smctr_tx_complete(dev, NON_MAC_QUEUE)) != SUCCESS) +                                                break; +                                } + +                                /* MAC frames only */ +                                if(isb_subtype & TX_PENDING_PRIORITY_0) +                                        err = smctr_tx_complete(dev, MAC_QUEUE);                                break; + +                        /* Type 0x06 - TX END OF QUEUE (FE) */ +                        case ISB_IMC_END_OF_TX_QUEUE: +                                /* BUG queue */ +                                if(isb_subtype & TX_PENDING_PRIORITY_2) +                                { +                                        /* ok to clear Receive FIFO overrun +                                         * imask send_BUG now completes. +                                         */ +                                        interrupt_unmask_bits |= 0x800; + +                                        tp->tx_queue_status[BUG_QUEUE] = NOT_TRANSMITING; +                                        if((err = smctr_tx_complete(dev, BUG_QUEUE)) != SUCCESS) +                                                break; +                                        if((err = smctr_restart_tx_chain(dev, BUG_QUEUE)) != SUCCESS) +                                                break; +                                } + +                                /* NON-MAC queue only */ +                                if(isb_subtype & TX_PENDING_PRIORITY_1) +                                { +                                        tp->tx_queue_status[NON_MAC_QUEUE] = NOT_TRANSMITING; +                                        if((err = smctr_tx_complete(dev, NON_MAC_QUEUE)) != SUCCESS) +                                                break; +                                        if((err = smctr_restart_tx_chain(dev, NON_MAC_QUEUE)) != SUCCESS) +                                                break; +                                } + +                                /* MAC queue only */ +                                if(isb_subtype & TX_PENDING_PRIORITY_0) +                                { +                                        tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING; +                                        if((err = smctr_tx_complete(dev, MAC_QUEUE)) != SUCCESS) +                                                break; + +                                        err = smctr_restart_tx_chain(dev, MAC_QUEUE); +                                } +                                break; + +                        /* Type 0x07 - NON-MAC RX Resource Interrupt +                         *   Subtype bit 12 - (BW) BDB warning +                         *   Subtype bit 13 - (FW) FCB warning +                         *   Subtype bit 14 - (BE) BDB End of chain +                         *   Subtype bit 15 - (FE) FCB End of chain +                         */ +                        case ISB_IMC_NON_MAC_RX_RESOURCE: +                                tp->rx_fifo_overrun_count = 0; +                                tp->receive_queue_number = NON_MAC_QUEUE; +                                err1 = smctr_rx_frame(dev); + +                                if(isb_subtype & NON_MAC_RX_RESOURCE_FE) +                                { +                                        if((err = smctr_issue_resume_rx_fcb_cmd(                                                dev, NON_MAC_QUEUE)) != SUCCESS)                                                break; + +                                        if(tp->ptr_rx_fcb_overruns) +                                                (*tp->ptr_rx_fcb_overruns)++; +                                } + +                                if(isb_subtype & NON_MAC_RX_RESOURCE_BE) +                                { +                                        if((err = smctr_issue_resume_rx_bdb_cmd(                                                dev, NON_MAC_QUEUE)) != SUCCESS)                                                break; + +                                        if(tp->ptr_rx_bdb_overruns) +                                                (*tp->ptr_rx_bdb_overruns)++; +                                } +                                err = err1; +                                break; + +                        /* Type 0x08 - MAC RX Resource Interrupt +                         *   Subtype bit 12 - (BW) BDB warning +                         *   Subtype bit 13 - (FW) FCB warning +                         *   Subtype bit 14 - (BE) BDB End of chain +                         *   Subtype bit 15 - (FE) FCB End of chain +                         */ +                        case ISB_IMC_MAC_RX_RESOURCE: +                                tp->receive_queue_number = MAC_QUEUE; +                                err1 = smctr_rx_frame(dev); + +                                if(isb_subtype & MAC_RX_RESOURCE_FE) +                                { +                                        if((err = smctr_issue_resume_rx_fcb_cmd(                                                dev, MAC_QUEUE)) != SUCCESS) +                                                break; + +                                        if(tp->ptr_rx_fcb_overruns) +                                                (*tp->ptr_rx_fcb_overruns)++; +                                } + +                                if(isb_subtype & MAC_RX_RESOURCE_BE) +                                { +                                        if((err = smctr_issue_resume_rx_bdb_cmd(                                                dev, MAC_QUEUE)) != SUCCESS) +                                                break; + +                                        if(tp->ptr_rx_bdb_overruns) +                                                (*tp->ptr_rx_bdb_overruns)++; +                                } +                                err = err1; +                                break; + +                        /* Type 0x09 - NON_MAC RX Frame Interrupt */ +                        case ISB_IMC_NON_MAC_RX_FRAME: +                                tp->rx_fifo_overrun_count = 0; +                                tp->receive_queue_number = NON_MAC_QUEUE; +                                err = smctr_rx_frame(dev); +                                break; + +                        /* Type 0x0A - MAC RX Frame Interrupt */ +                        case ISB_IMC_MAC_RX_FRAME: +                                tp->receive_queue_number = MAC_QUEUE; +                                err = smctr_rx_frame(dev); +                                break; + +                        /* Type 0x0B - TRC status +                         * TRC has encountered an error condition +                         * subtype bit 14 - transmit FIFO underrun +                         * subtype bit 15 - receive FIFO overrun +                         */ +                        case ISB_IMC_TRC_FIFO_STATUS: +                                if(isb_subtype & TRC_FIFO_STATUS_TX_UNDERRUN) +                                { +                                        if(tp->ptr_tx_fifo_underruns) +                                                (*tp->ptr_tx_fifo_underruns)++; +                                } + +                                if(isb_subtype & TRC_FIFO_STATUS_RX_OVERRUN) +                                { +                                        /* update overrun stuck receive counter +                                         * if >= 3, has to clear it by sending +                                         * back to back frames. We pick +                                         * DAT(duplicate address MAC frame) +                                         */ +                                        tp->rx_fifo_overrun_count++; + +                                        if(tp->rx_fifo_overrun_count >= 3) +                                        { +                                                tp->rx_fifo_overrun_count = 0; + +                                                /* delay clearing fifo overrun +                                                 * imask till send_BUG tx +                                                 * complete posted +                                                 */ +                                                interrupt_unmask_bits &= (~0x800); +                                                printk(KERN_CRIT "Jay please send bug\n");//                                              smctr_send_bug(dev); +                                        } + +                                        if(tp->ptr_rx_fifo_overruns) +                                                (*tp->ptr_rx_fifo_overruns)++; +                                } + +                                err = SUCCESS; +                                break; + +                        /* Type 0x0C - Action Command Status Interrupt +                         * Subtype bit 14 - CB end of command chain (CE) +                         * Subtype bit 15 - CB command interrupt (CI) +                         */ +                        case ISB_IMC_COMMAND_STATUS: +                                err = SUCCESS; +                                if(tp->acb_head->cmd == ACB_CMD_HIC_NOP) +                                { +                                        printk(KERN_ERR "i1\n"); +                                        smctr_disable_16bit(dev); + +                                        /* XXXXXXXXXXXXXXXXX */ +                                /*      err = UM_Interrupt(dev); */ + +                                        smctr_enable_16bit(dev); +                                } +                                else +                                { +                                        if((tp->acb_head->cmd +                                                == ACB_CMD_READ_TRC_STATUS) +                                                && (tp->acb_head->subcmd +                                                == RW_TRC_STATUS_BLOCK)) +                                        { +                                                if(tp->ptr_bcn_type != 0) +                                                { +                                                        *(tp->ptr_bcn_type) +                                                                = (__u32)((SBlock *)tp->misc_command_data)->BCN_Type; +                                                } + +                                                if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & ERROR_COUNTERS_CHANGED) +                                                { +                                                        smctr_update_err_stats(dev); +                                                } + +                                                if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & TI_NDIS_RING_STATUS_CHANGED) +                                                { +                                                        tp->ring_status +                                                                = ((SBlock*)tp->misc_command_data)->TI_NDIS_Ring_Status; +                                                        smctr_disable_16bit(dev); +                                                        err = smctr_ring_status_chg(dev); +                                                        smctr_enable_16bit(dev); +                                                        if((tp->ring_status & REMOVE_RECEIVED) +                                                                && (tp->config_word0 & NO_AUTOREMOVE)) +                                                        { +                                                                smctr_issue_remove_cmd(dev); +                                                        } + +                                                        if(err != SUCCESS) +                                                        { +                                                                tp->acb_pending = 0; +                                                                break; +                                                        } +                                                } + +                                                if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & UNA_CHANGED) +                                                { +                                                        if(tp->ptr_una) +                                                        { +                                                                tp->ptr_una[0] = SWAP_BYTES(((SBlock *)tp->misc_command_data)->UNA[0]); +                                                                tp->ptr_una[1] = SWAP_BYTES(((SBlock *)tp->misc_command_data)->UNA[1]); +                                                                tp->ptr_una[2] = SWAP_BYTES(((SBlock *)tp->misc_command_data)->UNA[2]); +                                                        } + +                                                } + +                                                if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & READY_TO_SEND_RQ_INIT)                                                { +                                                        err = smctr_send_rq_init(dev); +                                                } +                                        } +                                } + +                                tp->acb_pending = 0; +                                break; + +                        /* Type 0x0D - MAC Type 1 interrupt +                         * Subtype -- 00 FR_BCN received at S12 +                         *            01 FR_BCN received at S21 +                         *            02 FR_DAT(DA=MA, A<>0) received at S21 +                         *            03 TSM_EXP at S21 +                         *            04 FR_REMOVE received at S42 +                         *            05 TBR_EXP, BR_FLAG_SET at S42 +                         *            06 TBT_EXP at S53 +                         */ +                        case ISB_IMC_MAC_TYPE_1: +                                if(isb_subtype > 8) +                                { +                                        err = HARDWARE_FAILED; +                                        break; +                                } + +                                err = SUCCESS; +                                switch(isb_subtype) +                                { +                                        case 0: +                                                tp->join_state = JS_BYPASS_STATE; +                                                if(tp->status != CLOSED) +                                                { +                                                        tp->status = CLOSED; +                                                        err = smctr_status_chg(dev); +                                                } +                                                break; + +                                        case 1: +                                                tp->join_state = JS_LOBE_TEST_STATE; +                                                break; + +                                        case 2: +                                                tp->join_state = JS_DETECT_MONITOR_PRESENT_STATE; +                                                break; + +                                        case 3: +                                                tp->join_state = JS_AWAIT_NEW_MONITOR_STATE; +                                                break; + +                                        case 4: +                                                tp->join_state = JS_DUPLICATE_ADDRESS_TEST_STATE; +                                                break; + +                                        case 5: +                                                tp->join_state = JS_NEIGHBOR_NOTIFICATION_STATE; +                                                break; + +                                        case 6: +                                                tp->join_state = JS_REQUEST_INITIALIZATION_STATE; +                                                break; + +                                        case 7: +                                                tp->join_state = JS_JOIN_COMPLETE_STATE; +                                                tp->status = OPEN; +                                                err = smctr_status_chg(dev); +                                                break; + +                                        case 8: +                                                tp->join_state = JS_BYPASS_WAIT_STATE; +                                                break; +                                } +                                break ; + +                        /* Type 0x0E - TRC Initialization Sequence Interrupt +                         * Subtype -- 00-FF Initializatin sequence complete +                         */ +                        case ISB_IMC_TRC_INTRNL_TST_STATUS: +                                tp->status = INITIALIZED; +                                smctr_disable_16bit(dev); +                                err = smctr_status_chg(dev); +                                smctr_enable_16bit(dev); +                                break; + +                        /* other interrupt types, illegal */ +                        default: +                                break; +                } + +                if(err != SUCCESS) +                        break; +        } + +        /* Checking the ack code instead of the unmask bits here is because : +         * while fixing the stuck receive, DAT frame are sent and mask off +         * FIFO overrun interrupt temporarily (interrupt_unmask_bits = 0) +         * but we still want to issue ack to ISB +         */ +        if(!(interrupt_ack_code & 0xff00)) +                smctr_issue_int_ack(dev, interrupt_ack_code, interrupt_unmask_bits); + +        smctr_disable_16bit(dev); +        smctr_enable_bic_int(dev); +        spin_unlock(&tp->lock); + +        return IRQ_HANDLED; +} + +static int smctr_issue_enable_int_cmd(struct net_device *dev, +        __u16 interrupt_enable_mask) +{ +        struct net_local *tp = netdev_priv(dev); +        int err; + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        tp->sclb_ptr->int_mask_control  = interrupt_enable_mask; +        tp->sclb_ptr->valid_command     = SCLB_VALID | SCLB_CMD_CLEAR_INTERRUPT_MASK; + +        smctr_set_ctrl_attention(dev); + +        return (0); +} + +static int smctr_issue_int_ack(struct net_device *dev, __u16 iack_code, __u16 ibits) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(smctr_wait_while_cbusy(dev)) +                return (-1); + +        tp->sclb_ptr->int_mask_control = ibits; +        tp->sclb_ptr->iack_code = iack_code << 1; /* use the offset from base */        tp->sclb_ptr->resume_control = 0; +        tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_IACK_CODE_VALID | SCLB_CMD_CLEAR_INTERRUPT_MASK; + +        smctr_set_ctrl_attention(dev); + +        return (0); +} + +static int smctr_issue_init_timers_cmd(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i; +        int err; +        __u16 *pTimer_Struc = (__u16 *)tp->misc_command_data; + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        if((err = smctr_wait_cmd(dev))) +                return (err); + +        tp->config_word0 = THDREN | DMA_TRIGGER | USETPT | NO_AUTOREMOVE; +        tp->config_word1 = 0; + +        if((tp->media_type == MEDIA_STP_16) +                || (tp->media_type == MEDIA_UTP_16) +                || (tp->media_type == MEDIA_STP_16_UTP_16)) +        { +                tp->config_word0 |= FREQ_16MB_BIT; +        } + +        if(tp->mode_bits & EARLY_TOKEN_REL) +                tp->config_word0 |= ETREN; + +        if(tp->mode_bits & LOOPING_MODE_MASK) +                tp->config_word0 |= RX_OWN_BIT; +        else +                tp->config_word0 &= ~RX_OWN_BIT; + +        if(tp->receive_mask & PROMISCUOUS_MODE) +                tp->config_word0 |= PROMISCUOUS_BIT; +        else +                tp->config_word0 &= ~PROMISCUOUS_BIT; + +        if(tp->receive_mask & ACCEPT_ERR_PACKETS) +                tp->config_word0 |= SAVBAD_BIT; +        else +                tp->config_word0 &= ~SAVBAD_BIT; + +        if(tp->receive_mask & ACCEPT_ATT_MAC_FRAMES) +                tp->config_word0 |= RXATMAC; +        else +                tp->config_word0 &= ~RXATMAC; + +        if(tp->receive_mask & ACCEPT_MULTI_PROM) +                tp->config_word1 |= MULTICAST_ADDRESS_BIT; +        else +                tp->config_word1 &= ~MULTICAST_ADDRESS_BIT; + +        if(tp->receive_mask & ACCEPT_SOURCE_ROUTING_SPANNING) +                tp->config_word1 |= SOURCE_ROUTING_SPANNING_BITS; +        else +        { +                if(tp->receive_mask & ACCEPT_SOURCE_ROUTING) +                        tp->config_word1 |= SOURCE_ROUTING_EXPLORER_BIT; +                else +                        tp->config_word1 &= ~SOURCE_ROUTING_SPANNING_BITS; +        } + +        if((tp->media_type == MEDIA_STP_16) +                || (tp->media_type == MEDIA_UTP_16) +                || (tp->media_type == MEDIA_STP_16_UTP_16)) +        { +                tp->config_word1 |= INTERFRAME_SPACING_16; +        } +        else +                tp->config_word1 |= INTERFRAME_SPACING_4; + +        *pTimer_Struc++ = tp->config_word0; +        *pTimer_Struc++ = tp->config_word1; + +        if((tp->media_type == MEDIA_STP_4) +                || (tp->media_type == MEDIA_UTP_4) +                || (tp->media_type == MEDIA_STP_4_UTP_4)) +        { +                *pTimer_Struc++ = 0x00FA;       /* prescale */ +                *pTimer_Struc++ = 0x2710;       /* TPT_limit */ +                *pTimer_Struc++ = 0x2710;       /* TQP_limit */ +                *pTimer_Struc++ = 0x0A28;       /* TNT_limit */ +                *pTimer_Struc++ = 0x3E80;       /* TBT_limit */ +                *pTimer_Struc++ = 0x3A98;       /* TSM_limit */ +                *pTimer_Struc++ = 0x1B58;       /* TAM_limit */ +                *pTimer_Struc++ = 0x00C8;       /* TBR_limit */ +                *pTimer_Struc++ = 0x07D0;       /* TER_limit */ +                *pTimer_Struc++ = 0x000A;       /* TGT_limit */ +                *pTimer_Struc++ = 0x1162;       /* THT_limit */ +                *pTimer_Struc++ = 0x07D0;       /* TRR_limit */ +                *pTimer_Struc++ = 0x1388;       /* TVX_limit */ +                *pTimer_Struc++ = 0x0000;       /* reserved */ +        } +        else +        { +                *pTimer_Struc++ = 0x03E8;       /* prescale */ +                *pTimer_Struc++ = 0x9C40;       /* TPT_limit */ +                *pTimer_Struc++ = 0x9C40;       /* TQP_limit */ +                *pTimer_Struc++ = 0x0A28;       /* TNT_limit */ +                *pTimer_Struc++ = 0x3E80;       /* TBT_limit */ +                *pTimer_Struc++ = 0x3A98;       /* TSM_limit */ +                *pTimer_Struc++ = 0x1B58;       /* TAM_limit */ +                *pTimer_Struc++ = 0x00C8;       /* TBR_limit */ +                *pTimer_Struc++ = 0x07D0;       /* TER_limit */ +                *pTimer_Struc++ = 0x000A;       /* TGT_limit */ +                *pTimer_Struc++ = 0x4588;       /* THT_limit */ +                *pTimer_Struc++ = 0x1F40;       /* TRR_limit */ +                *pTimer_Struc++ = 0x4E20;       /* TVX_limit */ +                *pTimer_Struc++ = 0x0000;       /* reserved */ +        } + +        /* Set node address. */ +        *pTimer_Struc++ = dev->dev_addr[0] << 8 +                | (dev->dev_addr[1] & 0xFF); +        *pTimer_Struc++ = dev->dev_addr[2] << 8 +                | (dev->dev_addr[3] & 0xFF); +        *pTimer_Struc++ = dev->dev_addr[4] << 8 +                | (dev->dev_addr[5] & 0xFF); + +        /* Set group address. */ +        *pTimer_Struc++ = tp->group_address_0 << 8 +                | tp->group_address_0 >> 8; +        *pTimer_Struc++ = tp->group_address[0] << 8 +                | tp->group_address[0] >> 8; +        *pTimer_Struc++ = tp->group_address[1] << 8 +                | tp->group_address[1] >> 8; + +        /* Set functional address. */ +        *pTimer_Struc++ = tp->functional_address_0 << 8 +                | tp->functional_address_0 >> 8; +        *pTimer_Struc++ = tp->functional_address[0] << 8 +                | tp->functional_address[0] >> 8; +        *pTimer_Struc++ = tp->functional_address[1] << 8 +                | tp->functional_address[1] >> 8; + +        /* Set Bit-Wise group address. */ +        *pTimer_Struc++ = tp->bitwise_group_address[0] << 8 +                | tp->bitwise_group_address[0] >> 8; +        *pTimer_Struc++ = tp->bitwise_group_address[1] << 8 +                | tp->bitwise_group_address[1] >> 8; + +        /* Set ring number address. */ +        *pTimer_Struc++ = tp->source_ring_number; +        *pTimer_Struc++ = tp->target_ring_number; + +        /* Physical drop number. */ +        *pTimer_Struc++ = (unsigned short)0; +        *pTimer_Struc++ = (unsigned short)0; + +        /* Product instance ID. */ +        for(i = 0; i < 9; i++) +                *pTimer_Struc++ = (unsigned short)0; + +        err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_INIT_TRC_TIMERS, 0); + +        return (err); +} + +static int smctr_issue_init_txrx_cmd(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i; +        int err; +        void **txrx_ptrs = (void *)tp->misc_command_data; + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        if((err = smctr_wait_cmd(dev))) +	{ +                printk(KERN_ERR "%s: Hardware failure\n", dev->name); +                return (err); +        } + +        /* Initialize Transmit Queue Pointers that are used, to point to +         * a single FCB. +         */ +        for(i = 0; i < NUM_TX_QS_USED; i++) +                *txrx_ptrs++ = (void *)TRC_POINTER(tp->tx_fcb_head[i]); + +        /* Initialize Transmit Queue Pointers that are NOT used to ZERO. */ +        for(; i < MAX_TX_QS; i++) +                *txrx_ptrs++ = (void *)0; + +        /* Initialize Receive Queue Pointers (MAC and Non-MAC) that are +         * used, to point to a single FCB and a BDB chain of buffers. +         */ +        for(i = 0; i < NUM_RX_QS_USED; i++) +        { +                *txrx_ptrs++ = (void *)TRC_POINTER(tp->rx_fcb_head[i]); +                *txrx_ptrs++ = (void *)TRC_POINTER(tp->rx_bdb_head[i]); +        } + +        /* Initialize Receive Queue Pointers that are NOT used to ZERO. */ +        for(; i < MAX_RX_QS; i++) +        { +                *txrx_ptrs++ = (void *)0; +                *txrx_ptrs++ = (void *)0; +        } + +        err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_INIT_TX_RX, 0); + +        return (err); +} + +static int smctr_issue_insert_cmd(struct net_device *dev) +{ +        int err; + +        err = smctr_setup_single_cmd(dev, ACB_CMD_INSERT, ACB_SUB_CMD_NOP); + +        return (err); +} + +static int smctr_issue_read_ring_status_cmd(struct net_device *dev) +{ +        int err; + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        if((err = smctr_wait_cmd(dev))) +                return (err); + +        err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_READ_TRC_STATUS, +                RW_TRC_STATUS_BLOCK); + +        return (err); +} + +static int smctr_issue_read_word_cmd(struct net_device *dev, __u16 aword_cnt) +{ +        int err; + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        if((err = smctr_wait_cmd(dev))) +                return (err); + +        err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_MCT_READ_VALUE, +                aword_cnt); + +        return (err); +} + +static int smctr_issue_remove_cmd(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int err; + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        tp->sclb_ptr->resume_control    = 0; +        tp->sclb_ptr->valid_command     = SCLB_VALID | SCLB_CMD_REMOVE; + +        smctr_set_ctrl_attention(dev); + +        return (0); +} + +static int smctr_issue_resume_acb_cmd(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int err; + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        tp->sclb_ptr->resume_control = SCLB_RC_ACB; +        tp->sclb_ptr->valid_command  = SCLB_VALID | SCLB_RESUME_CONTROL_VALID; + +        tp->acb_pending = 1; + +        smctr_set_ctrl_attention(dev); + +        return (0); +} + +static int smctr_issue_resume_rx_bdb_cmd(struct net_device *dev, __u16 queue) +{ +        struct net_local *tp = netdev_priv(dev); +        int err; + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        if(queue == MAC_QUEUE) +                tp->sclb_ptr->resume_control = SCLB_RC_RX_MAC_BDB; +        else +                tp->sclb_ptr->resume_control = SCLB_RC_RX_NON_MAC_BDB; + +        tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_RESUME_CONTROL_VALID; + +        smctr_set_ctrl_attention(dev); + +        return (0); +} + +static int smctr_issue_resume_rx_fcb_cmd(struct net_device *dev, __u16 queue) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_issue_resume_rx_fcb_cmd\n", dev->name); + +        if(smctr_wait_while_cbusy(dev)) +                return (-1); + +        if(queue == MAC_QUEUE) +                tp->sclb_ptr->resume_control = SCLB_RC_RX_MAC_FCB; +        else +                tp->sclb_ptr->resume_control = SCLB_RC_RX_NON_MAC_FCB; + +        tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_RESUME_CONTROL_VALID; + +        smctr_set_ctrl_attention(dev); + +        return (0); +} + +static int smctr_issue_resume_tx_fcb_cmd(struct net_device *dev, __u16 queue) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_issue_resume_tx_fcb_cmd\n", dev->name); + +        if(smctr_wait_while_cbusy(dev)) +                return (-1); + +        tp->sclb_ptr->resume_control = (SCLB_RC_TFCB0 << queue); +        tp->sclb_ptr->valid_command = SCLB_RESUME_CONTROL_VALID | SCLB_VALID; + +        smctr_set_ctrl_attention(dev); + +        return (0); +} + +static int smctr_issue_test_internal_rom_cmd(struct net_device *dev) +{ +        int err; + +        err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST, +                TRC_INTERNAL_ROM_TEST); + +        return (err); +} + +static int smctr_issue_test_hic_cmd(struct net_device *dev) +{ +        int err; + +        err = smctr_setup_single_cmd(dev, ACB_CMD_HIC_TEST, +                TRC_HOST_INTERFACE_REG_TEST); + +        return (err); +} + +static int smctr_issue_test_mac_reg_cmd(struct net_device *dev) +{ +        int err; + +        err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST, +                TRC_MAC_REGISTERS_TEST); + +        return (err); +} + +static int smctr_issue_trc_loopback_cmd(struct net_device *dev) +{ +        int err; + +        err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST, +                TRC_INTERNAL_LOOPBACK); + +        return (err); +} + +static int smctr_issue_tri_loopback_cmd(struct net_device *dev) +{ +        int err; + +        err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST, +                TRC_TRI_LOOPBACK); + +        return (err); +} + +static int smctr_issue_write_byte_cmd(struct net_device *dev, +        short aword_cnt, void *byte) +{ +	struct net_local *tp = netdev_priv(dev); +        unsigned int iword, ibyte; +	int err; + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        if((err = smctr_wait_cmd(dev))) +                return (err); + +        for(iword = 0, ibyte = 0; iword < (unsigned int)(aword_cnt & 0xff); +        	iword++, ibyte += 2) +        { +                tp->misc_command_data[iword] = (*((__u8 *)byte + ibyte) << 8) +			| (*((__u8 *)byte + ibyte + 1)); +        } + +        return (smctr_setup_single_cmd_w_data(dev, ACB_CMD_MCT_WRITE_VALUE,  +		aword_cnt)); +} + +static int smctr_issue_write_word_cmd(struct net_device *dev, +        short aword_cnt, void *word) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i, err; + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        if((err = smctr_wait_cmd(dev))) +                return (err); + +        for(i = 0; i < (unsigned int)(aword_cnt & 0xff); i++) +                tp->misc_command_data[i] = *((__u16 *)word + i); + +        err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_MCT_WRITE_VALUE, +                aword_cnt); + +        return (err); +} + +static int smctr_join_complete_state(struct net_device *dev) +{ +        int err; + +        err = smctr_setup_single_cmd(dev, ACB_CMD_CHANGE_JOIN_STATE, +                JS_JOIN_COMPLETE_STATE); + +        return (err); +} + +static int smctr_link_tx_fcbs_to_bdbs(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i, j; +        FCBlock *fcb; +        BDBlock *bdb; + +        for(i = 0; i < NUM_TX_QS_USED; i++) +        { +                fcb = tp->tx_fcb_head[i]; +                bdb = tp->tx_bdb_head[i]; + +                for(j = 0; j < tp->num_tx_fcbs[i]; j++) +                { +                        fcb->bdb_ptr            = bdb; +                        fcb->trc_bdb_ptr        = TRC_POINTER(bdb); +                        fcb = (FCBlock *)((char *)fcb + sizeof(FCBlock)); +                        bdb = (BDBlock *)((char *)bdb + sizeof(BDBlock)); +                } +        } + +        return (0); +} + +static int smctr_load_firmware(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        __u16 i, checksum = 0; +        int err = 0; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_load_firmware\n", dev->name); + +        tp->ptr_ucode           = smctr_code; +        tp->num_of_tx_buffs     = 4; +        tp->mode_bits          |= UMAC; +        tp->receive_mask        = 0; +        tp->max_packet_size     = 4177; + +        /* Can only upload the firmware once per adapter reset. */ +        if(tp->microcode_version != 0) +                return (UCODE_PRESENT); + +        /* Verify the firmware exists and is there in the right amount. */ +        if((tp->ptr_ucode == 0L) +                || (*(tp->ptr_ucode + UCODE_VERSION_OFFSET) < UCODE_VERSION)) +        { +                return (UCODE_NOT_PRESENT); +        } + +        /* UCODE_SIZE is not included in Checksum. */ +        for(i = 0; i < *((__u16 *)(tp->ptr_ucode + UCODE_SIZE_OFFSET)); i += 2) +                checksum += *((__u16 *)(tp->ptr_ucode + 2 + i)); +        if(checksum) +                return (UCODE_NOT_PRESENT); + +        /* At this point we have a valid firmware image, lets kick it on up. */ +        smctr_enable_adapter_ram(dev); +        smctr_enable_16bit(dev); +        smctr_set_page(dev, (__u8 *)tp->ram_access); + +        if((smctr_checksum_firmware(dev)) +                || (*(tp->ptr_ucode + UCODE_VERSION_OFFSET) +                > tp->microcode_version)) +        { +                smctr_enable_adapter_ctrl_store(dev); + +                /* Zero out ram space for firmware. */ +                for(i = 0; i < CS_RAM_SIZE; i += 2) +                        *((__u16 *)(tp->ram_access + i)) = 0; + +                smctr_decode_firmware(dev); + +                tp->microcode_version = *(tp->ptr_ucode + UCODE_VERSION_OFFSET);                *((__u16 *)(tp->ram_access + CS_RAM_VERSION_OFFSET)) +                        = (tp->microcode_version << 8); +                *((__u16 *)(tp->ram_access + CS_RAM_CHECKSUM_OFFSET)) +                        = ~(tp->microcode_version << 8) + 1; + +                smctr_disable_adapter_ctrl_store(dev); + +                if(smctr_checksum_firmware(dev)) +                        err = HARDWARE_FAILED; +        } +        else +                err = UCODE_PRESENT; + +        smctr_disable_16bit(dev); + +        return (err); +} + +static int smctr_load_node_addr(struct net_device *dev) +{ +        int ioaddr = dev->base_addr; +        unsigned int i; +        __u8 r; + +        for(i = 0; i < 6; i++) +        { +                r = inb(ioaddr + LAR0 + i); +                dev->dev_addr[i] = (char)r; +        } +        dev->addr_len = 6; + +        return (0); +} + +/* Lobe Media Test. + * During the transmission of the initial 1500 lobe media MAC frames, + * the phase lock loop in the 805 chip may lock, and then un-lock, causing + * the 825 to go into a PURGE state. When performing a PURGE, the MCT + * microcode will not transmit any frames given to it by the host, and + * will consequently cause a timeout. + * + * NOTE 1: If the monitor_state is MS_BEACON_TEST_STATE, all transmit + * queues other then the one used for the lobe_media_test should be + * disabled.!? + * + * NOTE 2: If the monitor_state is MS_BEACON_TEST_STATE and the receive_mask + * has any multi-cast or promiscous bits set, the receive_mask needs to + * be changed to clear the multi-cast or promiscous mode bits, the lobe_test + * run, and then the receive mask set back to its original value if the test + * is successful. + */ +static int smctr_lobe_media_test(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i, perror = 0; +        unsigned short saved_rcv_mask; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_lobe_media_test\n", dev->name); + +        /* Clear receive mask for lobe test. */ +        saved_rcv_mask          = tp->receive_mask; +        tp->receive_mask        = 0; + +        smctr_chg_rx_mask(dev); + +        /* Setup the lobe media test. */ +        smctr_lobe_media_test_cmd(dev); +        if(smctr_wait_cmd(dev)) +        { +                smctr_reset_adapter(dev); +                tp->status = CLOSED; +                return (LOBE_MEDIA_TEST_FAILED); +        } + +        /* Tx lobe media test frames. */ +        for(i = 0; i < 1500; ++i) +        { +                if(smctr_send_lobe_media_test(dev)) +                { +                        if(perror) +                        { +                                smctr_reset_adapter(dev); +                                tp->state = CLOSED; +                                return (LOBE_MEDIA_TEST_FAILED); +                        } +                        else +                        { +                                perror = 1; +                                if(smctr_lobe_media_test_cmd(dev)) +                                { +                                        smctr_reset_adapter(dev); +                                        tp->state = CLOSED; +                                        return (LOBE_MEDIA_TEST_FAILED); +                                } +                        } +                } +        } + +        if(smctr_send_dat(dev)) +        { +                if(smctr_send_dat(dev)) +                { +                        smctr_reset_adapter(dev); +                        tp->state = CLOSED; +                        return (LOBE_MEDIA_TEST_FAILED); +                } +        } + +        /* Check if any frames received during test. */ +        if((tp->rx_fcb_curr[MAC_QUEUE]->frame_status) +                || (tp->rx_fcb_curr[NON_MAC_QUEUE]->frame_status)) +        { +                smctr_reset_adapter(dev); +                tp->state = CLOSED; +                return (LOBE_MEDIA_TEST_FAILED); +        } + +        /* Set receive mask to "Promisc" mode. */ +        tp->receive_mask = saved_rcv_mask; + +        smctr_chg_rx_mask(dev); + +        return (0); +} + +static int smctr_lobe_media_test_cmd(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int err; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_lobe_media_test_cmd\n", dev->name); + +        /* Change to lobe media test state. */ +        if(tp->monitor_state != MS_BEACON_TEST_STATE) +        { +                smctr_lobe_media_test_state(dev); +                if(smctr_wait_cmd(dev)) +                { +                        printk(KERN_ERR "Lobe Failed test state\n"); +                        return (LOBE_MEDIA_TEST_FAILED); +                } +        } + +        err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST, +                TRC_LOBE_MEDIA_TEST); + +        return (err); +} + +static int smctr_lobe_media_test_state(struct net_device *dev) +{ +        int err; + +        err = smctr_setup_single_cmd(dev, ACB_CMD_CHANGE_JOIN_STATE, +                JS_LOBE_TEST_STATE); + +        return (err); +} + +static int smctr_make_8025_hdr(struct net_device *dev, +        MAC_HEADER *rmf, MAC_HEADER *tmf, __u16 ac_fc) +{ +        tmf->ac = MSB(ac_fc);                 /* msb is access control */ +        tmf->fc = LSB(ac_fc);                 /* lsb is frame control */ + +        tmf->sa[0] = dev->dev_addr[0]; +        tmf->sa[1] = dev->dev_addr[1]; +        tmf->sa[2] = dev->dev_addr[2]; +        tmf->sa[3] = dev->dev_addr[3]; +        tmf->sa[4] = dev->dev_addr[4]; +        tmf->sa[5] = dev->dev_addr[5]; + +        switch(tmf->vc) +        { +		/* Send RQ_INIT to RPS */ +                case RQ_INIT: +                        tmf->da[0] = 0xc0; +                        tmf->da[1] = 0x00; +                        tmf->da[2] = 0x00; +                        tmf->da[3] = 0x00; +                        tmf->da[4] = 0x00; +                        tmf->da[5] = 0x02; +                        break; + +		/* Send RPT_TX_FORWARD to CRS */ +                case RPT_TX_FORWARD: +                        tmf->da[0] = 0xc0; +                        tmf->da[1] = 0x00; +                        tmf->da[2] = 0x00; +                        tmf->da[3] = 0x00; +                        tmf->da[4] = 0x00; +                        tmf->da[5] = 0x10; +                        break; + +		/* Everything else goes to sender */ +                default: +                        tmf->da[0] = rmf->sa[0]; +                        tmf->da[1] = rmf->sa[1]; +                        tmf->da[2] = rmf->sa[2]; +                        tmf->da[3] = rmf->sa[3]; +                        tmf->da[4] = rmf->sa[4]; +                        tmf->da[5] = rmf->sa[5]; +                        break; +        } + +        return (0); +} + +static int smctr_make_access_pri(struct net_device *dev, MAC_SUB_VECTOR *tsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        tsv->svi = AUTHORIZED_ACCESS_PRIORITY; +        tsv->svl = S_AUTHORIZED_ACCESS_PRIORITY; + +        tsv->svv[0] = MSB(tp->authorized_access_priority); +        tsv->svv[1] = LSB(tp->authorized_access_priority); + +	return (0); +} + +static int smctr_make_addr_mod(struct net_device *dev, MAC_SUB_VECTOR *tsv) +{ +        tsv->svi = ADDRESS_MODIFER; +        tsv->svl = S_ADDRESS_MODIFER; + +        tsv->svv[0] = 0; +        tsv->svv[1] = 0; + +        return (0); +} + +static int smctr_make_auth_funct_class(struct net_device *dev, +        MAC_SUB_VECTOR *tsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        tsv->svi = AUTHORIZED_FUNCTION_CLASS; +        tsv->svl = S_AUTHORIZED_FUNCTION_CLASS; + +        tsv->svv[0] = MSB(tp->authorized_function_classes); +        tsv->svv[1] = LSB(tp->authorized_function_classes); + +        return (0); +} + +static int smctr_make_corr(struct net_device *dev, +        MAC_SUB_VECTOR *tsv, __u16 correlator) +{ +        tsv->svi = CORRELATOR; +        tsv->svl = S_CORRELATOR; + +        tsv->svv[0] = MSB(correlator); +        tsv->svv[1] = LSB(correlator); + +        return (0); +} + +static int smctr_make_funct_addr(struct net_device *dev, MAC_SUB_VECTOR *tsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        smctr_get_functional_address(dev); + +        tsv->svi = FUNCTIONAL_ADDRESS; +        tsv->svl = S_FUNCTIONAL_ADDRESS; + +        tsv->svv[0] = MSB(tp->misc_command_data[0]); +        tsv->svv[1] = LSB(tp->misc_command_data[0]); + +        tsv->svv[2] = MSB(tp->misc_command_data[1]); +        tsv->svv[3] = LSB(tp->misc_command_data[1]); + +        return (0); +} + +static int smctr_make_group_addr(struct net_device *dev, MAC_SUB_VECTOR *tsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        smctr_get_group_address(dev); + +        tsv->svi = GROUP_ADDRESS; +        tsv->svl = S_GROUP_ADDRESS; + +        tsv->svv[0] = MSB(tp->misc_command_data[0]); +        tsv->svv[1] = LSB(tp->misc_command_data[0]); + +        tsv->svv[2] = MSB(tp->misc_command_data[1]); +        tsv->svv[3] = LSB(tp->misc_command_data[1]); + +        /* Set Group Address Sub-vector to all zeros if only the +         * Group Address/Functional Address Indicator is set. +         */ +        if(tsv->svv[0] == 0x80 && tsv->svv[1] == 0x00 +        	&& tsv->svv[2] == 0x00 && tsv->svv[3] == 0x00) +                tsv->svv[0] = 0x00; + +        return (0); +} + +static int smctr_make_phy_drop_num(struct net_device *dev, +        MAC_SUB_VECTOR *tsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        smctr_get_physical_drop_number(dev); + +        tsv->svi = PHYSICAL_DROP; +        tsv->svl = S_PHYSICAL_DROP; + +        tsv->svv[0] = MSB(tp->misc_command_data[0]); +        tsv->svv[1] = LSB(tp->misc_command_data[0]); + +        tsv->svv[2] = MSB(tp->misc_command_data[1]); +        tsv->svv[3] = LSB(tp->misc_command_data[1]); + +        return (0); +} + +static int smctr_make_product_id(struct net_device *dev, MAC_SUB_VECTOR *tsv) +{ +        int i; + +        tsv->svi = PRODUCT_INSTANCE_ID; +        tsv->svl = S_PRODUCT_INSTANCE_ID; + +        for(i = 0; i < 18; i++) +                tsv->svv[i] = 0xF0; + +        return (0); +} + +static int smctr_make_station_id(struct net_device *dev, MAC_SUB_VECTOR *tsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        smctr_get_station_id(dev); + +        tsv->svi = STATION_IDENTIFER; +        tsv->svl = S_STATION_IDENTIFER; + +        tsv->svv[0] = MSB(tp->misc_command_data[0]); +        tsv->svv[1] = LSB(tp->misc_command_data[0]); + +        tsv->svv[2] = MSB(tp->misc_command_data[1]); +        tsv->svv[3] = LSB(tp->misc_command_data[1]); + +        tsv->svv[4] = MSB(tp->misc_command_data[2]); +        tsv->svv[5] = LSB(tp->misc_command_data[2]); + +        return (0); +} + +static int smctr_make_ring_station_status(struct net_device *dev, +        MAC_SUB_VECTOR * tsv) +{ +        tsv->svi = RING_STATION_STATUS; +        tsv->svl = S_RING_STATION_STATUS; + +        tsv->svv[0] = 0; +        tsv->svv[1] = 0; +        tsv->svv[2] = 0; +        tsv->svv[3] = 0; +        tsv->svv[4] = 0; +        tsv->svv[5] = 0; + +        return (0); +} + +static int smctr_make_ring_station_version(struct net_device *dev, +        MAC_SUB_VECTOR *tsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        tsv->svi = RING_STATION_VERSION_NUMBER; +        tsv->svl = S_RING_STATION_VERSION_NUMBER; + +        tsv->svv[0] = 0xe2;            /* EBCDIC - S */ +        tsv->svv[1] = 0xd4;            /* EBCDIC - M */ +        tsv->svv[2] = 0xc3;            /* EBCDIC - C */ +        tsv->svv[3] = 0x40;            /* EBCDIC -   */ +        tsv->svv[4] = 0xe5;            /* EBCDIC - V */ +        tsv->svv[5] = 0xF0 + (tp->microcode_version >> 4); +        tsv->svv[6] = 0xF0 + (tp->microcode_version & 0x0f); +        tsv->svv[7] = 0x40;            /* EBCDIC -   */ +        tsv->svv[8] = 0xe7;            /* EBCDIC - X */ + +        if(tp->extra_info & CHIP_REV_MASK) +                tsv->svv[9] = 0xc5;    /* EBCDIC - E */ +        else +                tsv->svv[9] = 0xc4;    /* EBCDIC - D */ + +        return (0); +} + +static int smctr_make_tx_status_code(struct net_device *dev, +        MAC_SUB_VECTOR *tsv, __u16 tx_fstatus) +{ +        tsv->svi = TRANSMIT_STATUS_CODE; +        tsv->svl = S_TRANSMIT_STATUS_CODE; + +        tsv->svv[0] = ((tx_fstatus & 0x0100 >> 6) || IBM_PASS_SOURCE_ADDR); + +        /* Stripped frame status of Transmitted Frame */ +        tsv->svv[1] = tx_fstatus & 0xff; + +        return (0); +} + +static int smctr_make_upstream_neighbor_addr(struct net_device *dev, +        MAC_SUB_VECTOR *tsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        smctr_get_upstream_neighbor_addr(dev); + +        tsv->svi = UPSTREAM_NEIGHBOR_ADDRESS; +        tsv->svl = S_UPSTREAM_NEIGHBOR_ADDRESS; + +        tsv->svv[0] = MSB(tp->misc_command_data[0]); +        tsv->svv[1] = LSB(tp->misc_command_data[0]); + +        tsv->svv[2] = MSB(tp->misc_command_data[1]); +        tsv->svv[3] = LSB(tp->misc_command_data[1]); + +        tsv->svv[4] = MSB(tp->misc_command_data[2]); +        tsv->svv[5] = LSB(tp->misc_command_data[2]); + +        return (0); +} + +static int smctr_make_wrap_data(struct net_device *dev, MAC_SUB_VECTOR *tsv) +{ +        tsv->svi = WRAP_DATA; +        tsv->svl = S_WRAP_DATA; + +        return (0); +} + +/* + * Open/initialize the board. This is called sometime after + * booting when the 'ifconfig' program is run. + * + * This routine should set everything up anew at each open, even + * registers that "should" only need to be set once at boot, so that + * there is non-reboot way to recover if something goes wrong. + */ +static int smctr_open(struct net_device *dev) +{ +        int err; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_open\n", dev->name); + +        err = smctr_init_adapter(dev); +        if(err < 0) +                return (err); + +        return (err); +} + +/* Interrupt driven open of Token card. */ +static int smctr_open_tr(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned long flags; +        int err; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_open_tr\n", dev->name); + +        /* Now we can actually open the adapter. */ +        if(tp->status == OPEN) +                return (0); +        if(tp->status != INITIALIZED) +                return (-1); + +	/* FIXME: it would work a lot better if we masked the irq sources +	   on the card here, then we could skip the locking and poll nicely */ +	spin_lock_irqsave(&tp->lock, flags); +	 +        smctr_set_page(dev, (__u8 *)tp->ram_access); + +        if((err = smctr_issue_resume_rx_fcb_cmd(dev, (short)MAC_QUEUE))) +                goto out; + +        if((err = smctr_issue_resume_rx_bdb_cmd(dev, (short)MAC_QUEUE))) +                goto out; + +        if((err = smctr_issue_resume_rx_fcb_cmd(dev, (short)NON_MAC_QUEUE))) +                goto out; + +        if((err = smctr_issue_resume_rx_bdb_cmd(dev, (short)NON_MAC_QUEUE))) +                goto out; + +        tp->status = CLOSED; + +        /* Insert into the Ring or Enter Loopback Mode. */ +        if((tp->mode_bits & LOOPING_MODE_MASK) == LOOPBACK_MODE_1) +        { +                tp->status = CLOSED; + +                if(!(err = smctr_issue_trc_loopback_cmd(dev))) +                { +                        if(!(err = smctr_wait_cmd(dev))) +                                tp->status = OPEN; +                } + +                smctr_status_chg(dev); +        } +        else +        { +                if((tp->mode_bits & LOOPING_MODE_MASK) == LOOPBACK_MODE_2) +                { +                        tp->status = CLOSED; +                        if(!(err = smctr_issue_tri_loopback_cmd(dev))) +                        { +                                if(!(err = smctr_wait_cmd(dev))) +                                        tp->status = OPEN; +                        } + +                        smctr_status_chg(dev); +                } +                else +                { +                        if((tp->mode_bits & LOOPING_MODE_MASK) +                                == LOOPBACK_MODE_3) +                        { +                                tp->status = CLOSED; +                                if(!(err = smctr_lobe_media_test_cmd(dev))) +                                { +                                        if(!(err = smctr_wait_cmd(dev))) +                                                tp->status = OPEN; +                                } +                                smctr_status_chg(dev); +                        } +                        else +                        { +                                if(!(err = smctr_lobe_media_test(dev))) +                                        err = smctr_issue_insert_cmd(dev); +				else +                                { +                                        if(err == LOBE_MEDIA_TEST_FAILED) +                                                printk(KERN_WARNING "%s: Lobe Media Test Failure - Check cable?\n", dev->name); +                                } +                        } +                } +        } + +out: +        spin_unlock_irqrestore(&tp->lock, flags); + +        return (err); +} + +/* Check for a network adapter of this type,  + * and return device structure if one exists. + */ +struct net_device __init *smctr_probe(int unit) +{ +	struct net_device *dev = alloc_trdev(sizeof(struct net_local)); +	static const unsigned ports[] = { +		0x200, 0x220, 0x240, 0x260, 0x280, 0x2A0, 0x2C0, 0x2E0, 0x300, +		0x320, 0x340, 0x360, 0x380, 0 +	}; +	const unsigned *port; +        int err = 0; + +	if (!dev) +		return ERR_PTR(-ENOMEM); + +	SET_MODULE_OWNER(dev); + +	if (unit >= 0) { +		sprintf(dev->name, "tr%d", unit); +		netdev_boot_setup_check(dev); +	} + +        if (dev->base_addr > 0x1ff)    /* Check a single specified location. */ +		err = smctr_probe1(dev, dev->base_addr); +        else if(dev->base_addr != 0)  /* Don't probe at all. */ +                err =-ENXIO; +	else { +		for (port = ports; *port; port++) { +			err = smctr_probe1(dev, *port); +			if (!err) +				break; +		} +	} +	if (err) +		goto out; +	err = register_netdev(dev); +	if (err) +		goto out1; +	return dev; +out1: +#ifdef CONFIG_MCA_LEGACY +	{ struct net_local *tp = netdev_priv(dev); +	  if (tp->slot_num) +		mca_mark_as_unused(tp->slot_num); +	} +#endif +	release_region(dev->base_addr, SMCTR_IO_EXTENT); +	free_irq(dev->irq, dev); +out: +	free_netdev(dev); +	return ERR_PTR(err); +} + + +static int __init smctr_probe1(struct net_device *dev, int ioaddr) +{ +        static unsigned version_printed; +        struct net_local *tp = netdev_priv(dev); +        int err; +        __u32 *ram; + +        if(smctr_debug && version_printed++ == 0) +                printk(version); + +        spin_lock_init(&tp->lock); +        dev->base_addr = ioaddr; + +	/* Actually detect an adapter now. */ +        err = smctr_chk_isa(dev); +        if(err < 0) +        { +		if ((err = smctr_chk_mca(dev)) < 0) { +			err = -ENODEV; +			goto out; +		} +        } + +        tp = netdev_priv(dev); +        dev->mem_start = tp->ram_base; +        dev->mem_end = dev->mem_start + 0x10000; +        ram = (__u32 *)phys_to_virt(dev->mem_start); +        tp->ram_access = *(__u32 *)&ram; +	tp->status = NOT_INITIALIZED; + +        err = smctr_load_firmware(dev); +        if(err != UCODE_PRESENT && err != SUCCESS) +        { +                printk(KERN_ERR "%s: Firmware load failed (%d)\n", dev->name, err); +		err = -EIO; +		goto out; +        } + +	/* Allow user to specify ring speed on module insert. */ +	if(ringspeed == 4) +		tp->media_type = MEDIA_UTP_4; +	else +		tp->media_type = MEDIA_UTP_16; + +        printk(KERN_INFO "%s: %s %s at Io %#4x, Irq %d, Rom %#4x, Ram %#4x.\n", +                dev->name, smctr_name, smctr_model, +                (unsigned int)dev->base_addr, +                dev->irq, tp->rom_base, tp->ram_base); + +        dev->open               = smctr_open; +        dev->stop               = smctr_close; +        dev->hard_start_xmit    = smctr_send_packet; +        dev->tx_timeout		= smctr_timeout; +        dev->watchdog_timeo	= HZ; +        dev->get_stats          = smctr_get_stats; +        dev->set_multicast_list = &smctr_set_multicast_list; +        return (0); + +out: +	return err; +} + +static int smctr_process_rx_packet(MAC_HEADER *rmf, __u16 size, +        struct net_device *dev, __u16 rx_status) +{ +        struct net_local *tp = netdev_priv(dev); +        struct sk_buff *skb; +        __u16 rcode, correlator; +        int err = 0; +        __u8 xframe = 1; +        __u16 tx_fstatus; + +        rmf->vl = SWAP_BYTES(rmf->vl); +        if(rx_status & FCB_RX_STATUS_DA_MATCHED) +        { +                switch(rmf->vc) +                { +                        /* Received MAC Frames Processed by RS. */ +                        case INIT: +                                if((rcode = smctr_rcv_init(dev, rmf, &correlator)) == HARDWARE_FAILED) +                                { +                                        return (rcode); +                                } + +                                if((err = smctr_send_rsp(dev, rmf, rcode, +                                        correlator))) +                                { +                                        return (err); +                                } +                                break; + +                        case CHG_PARM: +                                if((rcode = smctr_rcv_chg_param(dev, rmf, +                                        &correlator)) ==HARDWARE_FAILED) +                                { +                                        return (rcode); +                                } + +                                if((err = smctr_send_rsp(dev, rmf, rcode, +                                        correlator))) +                                { +                                        return (err); +                                } +                                break; + +                        case RQ_ADDR: +                                if((rcode = smctr_rcv_rq_addr_state_attch(dev, +                                        rmf, &correlator)) != POSITIVE_ACK) +                                { +                                        if(rcode == HARDWARE_FAILED) +                                                return (rcode); +                                        else +                                                return (smctr_send_rsp(dev, rmf, +                                                        rcode, correlator)); +                                } + +                                if((err = smctr_send_rpt_addr(dev, rmf, +                                        correlator))) +                                { +                                        return (err); +                                } +                                break; + +                        case RQ_ATTCH: +                                if((rcode = smctr_rcv_rq_addr_state_attch(dev, +                                        rmf, &correlator)) != POSITIVE_ACK) +                                { +                                        if(rcode == HARDWARE_FAILED) +                                                return (rcode); +                                        else +                                                return (smctr_send_rsp(dev, rmf, +                                                        rcode, +                                                        correlator)); +                                } + +                                if((err = smctr_send_rpt_attch(dev, rmf, +                                        correlator))) +                                { +                                        return (err); +                                } +                                break; + +                        case RQ_STATE: +                                if((rcode = smctr_rcv_rq_addr_state_attch(dev, +                                        rmf, &correlator)) != POSITIVE_ACK) +                                { +                                        if(rcode == HARDWARE_FAILED) +                                                return (rcode); +                                        else +                                                return (smctr_send_rsp(dev, rmf, +                                                        rcode, +                                                        correlator)); +                                } + +                                if((err = smctr_send_rpt_state(dev, rmf, +                                        correlator))) +                                { +                                        return (err); +                                } +                                break; + +                        case TX_FORWARD: +                                if((rcode = smctr_rcv_tx_forward(dev, rmf)) +                                        != POSITIVE_ACK) +                                { +                                        if(rcode == HARDWARE_FAILED) +                                                return (rcode); +                                        else +                                                return (smctr_send_rsp(dev, rmf, +                                                        rcode, +                                                        correlator)); +                                } + +                                if((err = smctr_send_tx_forward(dev, rmf, +                                        &tx_fstatus)) == HARDWARE_FAILED) +                                { +                                        return (err); +                                } + +                                if(err == A_FRAME_WAS_FORWARDED) +                                { +                                        if((err = smctr_send_rpt_tx_forward(dev, +						rmf, tx_fstatus)) +                                                == HARDWARE_FAILED) +                                        { +                                                return (err); +                                        } +                                } +                                break; + +                        /* Received MAC Frames Processed by CRS/REM/RPS. */ +                        case RSP: +                        case RQ_INIT: +                        case RPT_NEW_MON: +                        case RPT_SUA_CHG: +                        case RPT_ACTIVE_ERR: +                        case RPT_NN_INCMP: +                        case RPT_ERROR: +                        case RPT_ATTCH: +                        case RPT_STATE: +                        case RPT_ADDR: +                                break; + +                        /* Rcvd Att. MAC Frame (if RXATMAC set) or UNKNOWN */ +                        default: +                                xframe = 0; +                                if(!(tp->receive_mask & ACCEPT_ATT_MAC_FRAMES)) +                                { +                                        rcode = smctr_rcv_unknown(dev, rmf, +                                                &correlator); +                                        if((err = smctr_send_rsp(dev, rmf,rcode, +                                                correlator))) +                                        { +                                                return (err); +                                        } +                                } + +                                break; +                } +        } +        else +        { +                /* 1. DA doesn't match (Promiscuous Mode). +                 * 2. Parse for Extended MAC Frame Type. +                 */ +                switch(rmf->vc) +                { +                        case RSP: +                        case INIT: +                        case RQ_INIT: +                        case RQ_ADDR: +                        case RQ_ATTCH: +                        case RQ_STATE: +                        case CHG_PARM: +                        case RPT_ADDR: +                        case RPT_ERROR: +                        case RPT_ATTCH: +                        case RPT_STATE: +                        case RPT_NEW_MON: +                        case RPT_SUA_CHG: +                        case RPT_NN_INCMP: +                        case RPT_ACTIVE_ERR: +                                break; + +                        default: +                                xframe = 0; +                                break; +                } +        } + +        /* NOTE: UNKNOWN MAC frames will NOT be passed up unless +         * ACCEPT_ATT_MAC_FRAMES is set. +         */ +        if(((tp->receive_mask & ACCEPT_ATT_MAC_FRAMES) +                && (xframe == (__u8)0)) +                || ((tp->receive_mask & ACCEPT_EXT_MAC_FRAMES) +                && (xframe == (__u8)1))) +        { +                rmf->vl = SWAP_BYTES(rmf->vl); + +                if (!(skb = dev_alloc_skb(size))) +			return -ENOMEM; +                skb->len = size; + +                /* Slide data into a sleek skb. */ +                skb_put(skb, skb->len); +                memcpy(skb->data, rmf, skb->len); + +                /* Update Counters */ +                tp->MacStat.rx_packets++; +                tp->MacStat.rx_bytes += skb->len; + +                /* Kick the packet on up. */ +                skb->dev = dev; +                skb->protocol = tr_type_trans(skb, dev); +                netif_rx(skb); +		dev->last_rx = jiffies; +                err = 0; +        } + +        return (err); +} + +/* Adapter RAM test. Incremental word ODD boundary data test. */ +static int smctr_ram_memory_test(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        __u16 page, pages_of_ram, start_pattern = 0, word_pattern = 0, +                word_read = 0, err_word = 0, err_pattern = 0; +        unsigned int err_offset; +        __u32 j, pword; +        __u8 err = 0; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_ram_memory_test\n", dev->name); + +        start_pattern   = 0x0001; +        pages_of_ram    = tp->ram_size / tp->ram_usable; +        pword           = tp->ram_access; + +        /* Incremental word ODD boundary test. */ +        for(page = 0; (page < pages_of_ram) && (~err); +                page++, start_pattern += 0x8000) +        { +                smctr_set_page(dev, (__u8 *)(tp->ram_access +                        + (page * tp->ram_usable * 1024) + 1)); +                word_pattern = start_pattern; + +                for(j = 1; j < (__u32)(tp->ram_usable * 1024) - 1; j += 2) +                        *(__u16 *)(pword + j) = word_pattern++; + +                word_pattern = start_pattern; + +                for(j = 1; j < (__u32)(tp->ram_usable * 1024) - 1 +                        && (~err); j += 2, word_pattern++) +                { +                        word_read = *(__u16 *)(pword + j); +                        if(word_read != word_pattern) +                        { +                                err             = (__u8)1; +                                err_offset      = j; +                                err_word        = word_read; +                                err_pattern     = word_pattern; +                                return (RAM_TEST_FAILED); +                        } +                } +        } + +        /* Zero out memory. */ +        for(page = 0; page < pages_of_ram && (~err); page++) +        { +                smctr_set_page(dev, (__u8 *)(tp->ram_access +                        + (page * tp->ram_usable * 1024))); +                word_pattern = 0; + +                for(j = 0; j < (__u32)tp->ram_usable * 1024; j +=2) +                        *(__u16 *)(pword + j) = word_pattern; + +                for(j =0; j < (__u32)tp->ram_usable * 1024 +                        && (~err); j += 2) +                { +                        word_read = *(__u16 *)(pword + j); +                        if(word_read != word_pattern) +                        { +                                err             = (__u8)1; +                                err_offset      = j; +                                err_word        = word_read; +                                err_pattern     = word_pattern; +                                return (RAM_TEST_FAILED); +                        } +                } +        } + +        smctr_set_page(dev, (__u8 *)tp->ram_access); + +        return (0); +} + +static int smctr_rcv_chg_param(struct net_device *dev, MAC_HEADER *rmf, +        __u16 *correlator) +{ +        MAC_SUB_VECTOR *rsv; +        signed short vlen; +        __u16 rcode = POSITIVE_ACK; +        unsigned int svectors = F_NO_SUB_VECTORS_FOUND; + +        /* This Frame can only come from a CRS */ +        if((rmf->dc_sc & SC_MASK) != SC_CRS) +                return(E_INAPPROPRIATE_SOURCE_CLASS); + +        /* Remove MVID Length from total length. */ +        vlen = (signed short)rmf->vl - 4; + +        /* Point to First SVID */ +        rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER)); + +        /* Search for Appropriate SVID's. */ +        while((vlen > 0) && (rcode == POSITIVE_ACK)) +        { +                switch(rsv->svi) +                { +                        case CORRELATOR: +                                svectors |= F_CORRELATOR; +                                rcode = smctr_set_corr(dev, rsv, correlator); +                                break; + +                        case LOCAL_RING_NUMBER: +                                svectors |= F_LOCAL_RING_NUMBER; +                                rcode = smctr_set_local_ring_num(dev, rsv); +                                break; + +                        case ASSIGN_PHYSICAL_DROP: +                                svectors |= F_ASSIGN_PHYSICAL_DROP; +                                rcode = smctr_set_phy_drop(dev, rsv); +                                break; + +                        case ERROR_TIMER_VALUE: +                                svectors |= F_ERROR_TIMER_VALUE; +                                rcode = smctr_set_error_timer_value(dev, rsv); +                                break; + +                        case AUTHORIZED_FUNCTION_CLASS: +                                svectors |= F_AUTHORIZED_FUNCTION_CLASS; +                                rcode = smctr_set_auth_funct_class(dev, rsv); +                                break; + +                        case AUTHORIZED_ACCESS_PRIORITY: +                                svectors |= F_AUTHORIZED_ACCESS_PRIORITY; +                                rcode = smctr_set_auth_access_pri(dev, rsv); +                                break; + +                        default: +                                rcode = E_SUB_VECTOR_UNKNOWN; +                                break; +                } + +                /* Let Sender Know if SUM of SV length's is +                 * larger then length in MVID length field +                 */ +                if((vlen -= rsv->svl) < 0) +                        rcode = E_VECTOR_LENGTH_ERROR; + +                rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl); +        } + +        if(rcode == POSITIVE_ACK) +        { +                /* Let Sender Know if MVID length field +                 * is larger then SUM of SV length's +                 */ +                if(vlen != 0) +                        rcode = E_VECTOR_LENGTH_ERROR; +                else +		{ +                	/* Let Sender Know if Expected SVID Missing */ +                	if((svectors & R_CHG_PARM) ^ R_CHG_PARM) +                        	rcode = E_MISSING_SUB_VECTOR; +		} +        } + +        return (rcode); +} + +static int smctr_rcv_init(struct net_device *dev, MAC_HEADER *rmf, +        __u16 *correlator) +{ +        MAC_SUB_VECTOR *rsv; +        signed short vlen; +        __u16 rcode = POSITIVE_ACK; +        unsigned int svectors = F_NO_SUB_VECTORS_FOUND; + +        /* This Frame can only come from a RPS */ +        if((rmf->dc_sc & SC_MASK) != SC_RPS) +                return (E_INAPPROPRIATE_SOURCE_CLASS); + +        /* Remove MVID Length from total length. */ +        vlen = (signed short)rmf->vl - 4; + +        /* Point to First SVID */ +        rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER)); + +        /* Search for Appropriate SVID's */ +        while((vlen > 0) && (rcode == POSITIVE_ACK)) +        { +                switch(rsv->svi) +                { +                        case CORRELATOR: +                                svectors |= F_CORRELATOR; +                                rcode = smctr_set_corr(dev, rsv, correlator); +                                break; + +                        case LOCAL_RING_NUMBER: +                                svectors |= F_LOCAL_RING_NUMBER; +                                rcode = smctr_set_local_ring_num(dev, rsv); +                                break; + +                        case ASSIGN_PHYSICAL_DROP: +                                svectors |= F_ASSIGN_PHYSICAL_DROP; +                                rcode = smctr_set_phy_drop(dev, rsv); +                                break; + +                        case ERROR_TIMER_VALUE: +                                svectors |= F_ERROR_TIMER_VALUE; +                                rcode = smctr_set_error_timer_value(dev, rsv); +                                break; + +                        default: +                                rcode = E_SUB_VECTOR_UNKNOWN; +                                break; +                } + +                /* Let Sender Know if SUM of SV length's is +                 * larger then length in MVID length field +		 */ +                if((vlen -= rsv->svl) < 0) +                        rcode = E_VECTOR_LENGTH_ERROR; + +                rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl); +        } + +        if(rcode == POSITIVE_ACK) +        { +                /* Let Sender Know if MVID length field +                 * is larger then SUM of SV length's +                 */ +                if(vlen != 0) +                        rcode = E_VECTOR_LENGTH_ERROR; +                else +		{ +                	/* Let Sender Know if Expected SV Missing */ +                	if((svectors & R_INIT) ^ R_INIT) +                        	rcode = E_MISSING_SUB_VECTOR; +		} +        } + +        return (rcode); +} + +static int smctr_rcv_tx_forward(struct net_device *dev, MAC_HEADER *rmf) +{ +        MAC_SUB_VECTOR *rsv; +        signed short vlen; +        __u16 rcode = POSITIVE_ACK; +        unsigned int svectors = F_NO_SUB_VECTORS_FOUND; + +        /* This Frame can only come from a CRS */ +        if((rmf->dc_sc & SC_MASK) != SC_CRS) +                return (E_INAPPROPRIATE_SOURCE_CLASS); + +        /* Remove MVID Length from total length */ +        vlen = (signed short)rmf->vl - 4; + +        /* Point to First SVID */ +        rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER)); + +        /* Search for Appropriate SVID's */ +        while((vlen > 0) && (rcode == POSITIVE_ACK)) +        { +                switch(rsv->svi) +                { +                        case FRAME_FORWARD: +                                svectors |= F_FRAME_FORWARD; +                                rcode = smctr_set_frame_forward(dev, rsv,  +					rmf->dc_sc); +                                break; + +                        default: +                                rcode = E_SUB_VECTOR_UNKNOWN; +                                break; +                } + +                /* Let Sender Know if SUM of SV length's is +                 * larger then length in MVID length field +		 */ +                if((vlen -= rsv->svl) < 0) +                        rcode = E_VECTOR_LENGTH_ERROR; + +                rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl); +        } + +        if(rcode == POSITIVE_ACK) +        { +                /* Let Sender Know if MVID length field +                 * is larger then SUM of SV length's +                 */ +                if(vlen != 0) +                        rcode = E_VECTOR_LENGTH_ERROR; +                else +		{ +                	/* Let Sender Know if Expected SV Missing */ +                	if((svectors & R_TX_FORWARD) ^ R_TX_FORWARD) +                        	rcode = E_MISSING_SUB_VECTOR; +		} +        } + +        return (rcode); +} + +static int smctr_rcv_rq_addr_state_attch(struct net_device *dev, +        MAC_HEADER *rmf, __u16 *correlator) +{ +        MAC_SUB_VECTOR *rsv; +        signed short vlen; +        __u16 rcode = POSITIVE_ACK; +        unsigned int svectors = F_NO_SUB_VECTORS_FOUND; + +        /* Remove MVID Length from total length */ +        vlen = (signed short)rmf->vl - 4; + +        /* Point to First SVID */ +        rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER)); + +        /* Search for Appropriate SVID's */ +        while((vlen > 0) && (rcode == POSITIVE_ACK)) +        { +                switch(rsv->svi) +                { +                        case CORRELATOR: +                                svectors |= F_CORRELATOR; +                                rcode = smctr_set_corr(dev, rsv, correlator); +                                break; + +                        default: +                                rcode = E_SUB_VECTOR_UNKNOWN; +                                break; +                } + +                /* Let Sender Know if SUM of SV length's is +                 * larger then length in MVID length field +                 */ +                if((vlen -= rsv->svl) < 0) +                        rcode = E_VECTOR_LENGTH_ERROR; + +                rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl); +        } + +        if(rcode == POSITIVE_ACK) +        { +                /* Let Sender Know if MVID length field +                 * is larger then SUM of SV length's +                 */ +                if(vlen != 0) +                        rcode = E_VECTOR_LENGTH_ERROR; +                else +		{ +                	/* Let Sender Know if Expected SVID Missing */ +                	if((svectors & R_RQ_ATTCH_STATE_ADDR)  +				^ R_RQ_ATTCH_STATE_ADDR) +                        	rcode = E_MISSING_SUB_VECTOR; +			} +        } + +        return (rcode); +} + +static int smctr_rcv_unknown(struct net_device *dev, MAC_HEADER *rmf, +        __u16 *correlator) +{ +        MAC_SUB_VECTOR *rsv; +        signed short vlen; + +        *correlator = 0; + +        /* Remove MVID Length from total length */ +        vlen = (signed short)rmf->vl - 4; + +        /* Point to First SVID */ +        rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER)); + +        /* Search for CORRELATOR for RSP to UNKNOWN */ +        while((vlen > 0) && (*correlator == 0)) +        { +                switch(rsv->svi) +                { +                        case CORRELATOR: +                                smctr_set_corr(dev, rsv, correlator); +                                break; + +                        default: +                                break; +                } + +                vlen -= rsv->svl; +                rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl); +        } + +        return (E_UNRECOGNIZED_VECTOR_ID); +} + +/* + * Reset the 825 NIC and exit w: + * 1. The NIC reset cleared (non-reset state), halted and un-initialized. + * 2. TINT masked. + * 3. CBUSY masked. + * 4. TINT clear. + * 5. CBUSY clear. + */ +static int smctr_reset_adapter(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int ioaddr = dev->base_addr; + +        /* Reseting the NIC will put it in a halted and un-initialized state. */        smctr_set_trc_reset(ioaddr); +        mdelay(200); /* ~2 ms */ + +        smctr_clear_trc_reset(ioaddr); +        mdelay(200); /* ~2 ms */ + +        /* Remove any latched interrupts that occurred prior to reseting the +         * adapter or possibily caused by line glitches due to the reset. +         */ +        outb(tp->trc_mask | CSR_CLRTINT | CSR_CLRCBUSY, ioaddr + CSR); + +        return (0); +} + +static int smctr_restart_tx_chain(struct net_device *dev, short queue) +{ +        struct net_local *tp = netdev_priv(dev); +        int err = 0; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_restart_tx_chain\n", dev->name); + +        if(tp->num_tx_fcbs_used[queue] != 0 +                && tp->tx_queue_status[queue] == NOT_TRANSMITING) +        { +                tp->tx_queue_status[queue] = TRANSMITING; +                err = smctr_issue_resume_tx_fcb_cmd(dev, queue); +        } + +        return (err); +} + +static int smctr_ring_status_chg(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_ring_status_chg\n", dev->name); + +        /* Check for ring_status_flag: whenever MONITOR_STATE_BIT +         * Bit is set, check value of monitor_state, only then we +         * enable and start transmit/receive timeout (if and only +         * if it is MS_ACTIVE_MONITOR_STATE or MS_STANDBY_MONITOR_STATE) +         */ +        if(tp->ring_status_flags == MONITOR_STATE_CHANGED) +        { +                if((tp->monitor_state == MS_ACTIVE_MONITOR_STATE) +                        || (tp->monitor_state == MS_STANDBY_MONITOR_STATE)) +                { +                        tp->monitor_state_ready = 1; +                } +                else +                { +                        /* if adapter is NOT in either active monitor +                         * or standby monitor state => Disable +                         * transmit/receive timeout. +                         */ +                        tp->monitor_state_ready = 0; + +			/* Ring speed problem, switching to auto mode. */ +			if(tp->monitor_state == MS_MONITOR_FSM_INACTIVE +				&& !tp->cleanup) +			{ +				printk(KERN_INFO "%s: Incorrect ring speed switching.\n", +					dev->name); +				smctr_set_ring_speed(dev); +			} +                } +        } + +        if(!(tp->ring_status_flags & RING_STATUS_CHANGED)) +                return (0); + +        switch(tp->ring_status) +        { +                case RING_RECOVERY: +                        printk(KERN_INFO "%s: Ring Recovery\n", dev->name); +                        tp->current_ring_status |= RING_RECOVERY; +                        break; + +                case SINGLE_STATION: +                        printk(KERN_INFO "%s: Single Statinon\n", dev->name); +                        tp->current_ring_status |= SINGLE_STATION; +                        break; + +                case COUNTER_OVERFLOW: +                        printk(KERN_INFO "%s: Counter Overflow\n", dev->name); +                        tp->current_ring_status |= COUNTER_OVERFLOW; +                        break; + +                case REMOVE_RECEIVED: +                        printk(KERN_INFO "%s: Remove Received\n", dev->name); +                        tp->current_ring_status |= REMOVE_RECEIVED; +                        break; + +                case AUTO_REMOVAL_ERROR: +                        printk(KERN_INFO "%s: Auto Remove Error\n", dev->name); +                        tp->current_ring_status |= AUTO_REMOVAL_ERROR; +                        break; + +                case LOBE_WIRE_FAULT: +                        printk(KERN_INFO "%s: Lobe Wire Fault\n", dev->name); +                        tp->current_ring_status |= LOBE_WIRE_FAULT; +                        break; + +                case TRANSMIT_BEACON: +                        printk(KERN_INFO "%s: Transmit Beacon\n", dev->name); +                        tp->current_ring_status |= TRANSMIT_BEACON; +                        break; + +                case SOFT_ERROR: +                        printk(KERN_INFO "%s: Soft Error\n", dev->name); +                        tp->current_ring_status |= SOFT_ERROR; +                        break; + +                case HARD_ERROR: +                        printk(KERN_INFO "%s: Hard Error\n", dev->name); +                        tp->current_ring_status |= HARD_ERROR; +                        break; + +                case SIGNAL_LOSS: +                        printk(KERN_INFO "%s: Signal Loss\n", dev->name); +                        tp->current_ring_status |= SIGNAL_LOSS; +                        break; + +                default: +			printk(KERN_INFO "%s: Unknown ring status change\n", +				dev->name); +                        break; +        } + +        return (0); +} + +static int smctr_rx_frame(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        __u16 queue, status, rx_size, err = 0; +        __u8 *pbuff; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_rx_frame\n", dev->name); + +        queue = tp->receive_queue_number; + +        while((status = tp->rx_fcb_curr[queue]->frame_status) != SUCCESS) +        { +                err = HARDWARE_FAILED; + +                if(((status & 0x007f) == 0) +                        || ((tp->receive_mask & ACCEPT_ERR_PACKETS) != 0)) +                { +                        /* frame length less the CRC (4 bytes) + FS (1 byte) */ +                        rx_size = tp->rx_fcb_curr[queue]->frame_length - 5; + +                        pbuff = smctr_get_rx_pointer(dev, queue); + +                        smctr_set_page(dev, pbuff); +                        smctr_disable_16bit(dev); + +                        /* pbuff points to addr within one page */ +                        pbuff = (__u8 *)PAGE_POINTER(pbuff); + +                        if(queue == NON_MAC_QUEUE) +                        { +                                struct sk_buff *skb; + +                                skb = dev_alloc_skb(rx_size); +				if (skb) { +                                	skb_put(skb, rx_size); + +                                	memcpy(skb->data, pbuff, rx_size); + +                                	/* Update Counters */ +                                	tp->MacStat.rx_packets++; +                                	tp->MacStat.rx_bytes += skb->len; + +                                	/* Kick the packet on up. */ +                                	skb->dev = dev; +                                	skb->protocol = tr_type_trans(skb, dev); +                                	netif_rx(skb); +					dev->last_rx = jiffies; +				} else { +				} +                        } +                        else +                                smctr_process_rx_packet((MAC_HEADER *)pbuff, +                                        rx_size, dev, status); +                } + +                smctr_enable_16bit(dev); +                smctr_set_page(dev, (__u8 *)tp->ram_access); +                smctr_update_rx_chain(dev, queue); + +                if(err != SUCCESS) +                        break; +        } + +        return (err); +} + +static int smctr_send_dat(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int i, err; +        MAC_HEADER *tmf; +        FCBlock *fcb; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_send_dat\n", dev->name); + +        if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, +                sizeof(MAC_HEADER))) == (FCBlock *)(-1L)) +        { +                return (OUT_OF_RESOURCES); +        } + +        /* Initialize DAT Data Fields. */ +        tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr; +        tmf->ac = MSB(AC_FC_DAT); +        tmf->fc = LSB(AC_FC_DAT); + +        for(i = 0; i < 6; i++) +        { +                tmf->sa[i] = dev->dev_addr[i]; +                tmf->da[i] = dev->dev_addr[i]; + +        } + +        tmf->vc        = DAT; +        tmf->dc_sc     = DC_RS | SC_RS; +        tmf->vl        = 4; +        tmf->vl        = SWAP_BYTES(tmf->vl); + +        /* Start Transmit. */ +        if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE))) +                return (err); + +        /* Wait for Transmit to Complete */ +        for(i = 0; i < 10000; i++) +        { +                if(fcb->frame_status & FCB_COMMAND_DONE) +                        break; +                mdelay(1); +        } + +        /* Check if GOOD frame Tx'ed. */ +        if(!(fcb->frame_status &  FCB_COMMAND_DONE) +                || fcb->frame_status & (FCB_TX_STATUS_E | FCB_TX_AC_BITS)) +        { +                return (INITIALIZE_FAILED); +        } + +        /* De-allocated Tx FCB and Frame Buffer +         * The FCB must be de-allocated manually if executing with +         * interrupts disabled, other wise the ISR (LM_Service_Events) +         * will de-allocate it when the interrupt occurs. +         */ +        tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING; +        smctr_update_tx_chain(dev, fcb, MAC_QUEUE); + +        return (0); +} + +static void smctr_timeout(struct net_device *dev) +{ +	/* +         * If we get here, some higher level has decided we are broken. +         * There should really be a "kick me" function call instead. +         * +         * Resetting the token ring adapter takes a long time so just +         * fake transmission time and go on trying. Our own timeout +         * routine is in sktr_timer_chk() +         */ +        dev->trans_start = jiffies; +        netif_wake_queue(dev); +} + +/* + * Gets skb from system, queues it and checks if it can be sent + */ +static int smctr_send_packet(struct sk_buff *skb, struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_send_packet\n", dev->name); + +        /* +         * Block a transmit overlap +         */ +          +        netif_stop_queue(dev); + +        if(tp->QueueSkb == 0) +                return (1);     /* Return with tbusy set: queue full */ + +        tp->QueueSkb--; +        skb_queue_tail(&tp->SendSkbQueue, skb); +        smctr_hardware_send_packet(dev, tp); +        if(tp->QueueSkb > 0) +		netif_wake_queue(dev); +		 +        return (0); +} + +static int smctr_send_lobe_media_test(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +	MAC_SUB_VECTOR *tsv; +	MAC_HEADER *tmf; +        FCBlock *fcb; +	__u32 i; +	int err; + +        if(smctr_debug > 15) +                printk(KERN_DEBUG "%s: smctr_send_lobe_media_test\n", dev->name); + +        if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(struct trh_hdr) +                + S_WRAP_DATA + S_WRAP_DATA)) == (FCBlock *)(-1L)) +        { +                return (OUT_OF_RESOURCES); +        } + +        /* Initialize DAT Data Fields. */ +        tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr; +        tmf->ac = MSB(AC_FC_LOBE_MEDIA_TEST); +        tmf->fc = LSB(AC_FC_LOBE_MEDIA_TEST); + +        for(i = 0; i < 6; i++) +        { +                tmf->da[i] = 0; +                tmf->sa[i] = dev->dev_addr[i]; +        } + +        tmf->vc        = LOBE_MEDIA_TEST; +        tmf->dc_sc     = DC_RS | SC_RS; +        tmf->vl        = 4; + +        tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER)); +        smctr_make_wrap_data(dev, tsv); +        tmf->vl += tsv->svl; + +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_wrap_data(dev, tsv); +        tmf->vl += tsv->svl; + +        /* Start Transmit. */ +        tmf->vl = SWAP_BYTES(tmf->vl); +        if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE))) +                return (err); + +        /* Wait for Transmit to Complete. (10 ms). */ +        for(i=0; i < 10000; i++) +        { +                if(fcb->frame_status & FCB_COMMAND_DONE) +                        break; +                mdelay(1); +        } + +        /* Check if GOOD frame Tx'ed */ +        if(!(fcb->frame_status & FCB_COMMAND_DONE) +                || fcb->frame_status & (FCB_TX_STATUS_E | FCB_TX_AC_BITS)) +        { +                return (LOBE_MEDIA_TEST_FAILED); +        } + +        /* De-allocated Tx FCB and Frame Buffer +         * The FCB must be de-allocated manually if executing with +         * interrupts disabled, other wise the ISR (LM_Service_Events) +         * will de-allocate it when the interrupt occurs. +         */ +        tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING; +        smctr_update_tx_chain(dev, fcb, MAC_QUEUE); + +        return (0); +} + +static int smctr_send_rpt_addr(struct net_device *dev, MAC_HEADER *rmf, +        __u16 correlator) +{ +        MAC_HEADER *tmf; +        MAC_SUB_VECTOR *tsv; +        FCBlock *fcb; + +        if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER) +		+ S_CORRELATOR + S_PHYSICAL_DROP + S_UPSTREAM_NEIGHBOR_ADDRESS +		+ S_ADDRESS_MODIFER + S_GROUP_ADDRESS + S_FUNCTIONAL_ADDRESS)) +		== (FCBlock *)(-1L)) +        { +                return (0); +        } + +        tmf 		= (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr; +        tmf->vc    	= RPT_ADDR; +        tmf->dc_sc 	= (rmf->dc_sc & SC_MASK) << 4; +        tmf->vl    	= 4; + +        smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_ADDR); + +        tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER)); +        smctr_make_corr(dev, tsv, correlator); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_phy_drop_num(dev, tsv); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_upstream_neighbor_addr(dev, tsv); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_addr_mod(dev, tsv); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_group_addr(dev, tsv); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_funct_addr(dev, tsv); + +        tmf->vl += tsv->svl; + +        /* Subtract out MVID and MVL which is +         * include in both vl and MAC_HEADER +         */ +/*      fcb->frame_length           = tmf->vl + sizeof(MAC_HEADER) - 4; +        fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4; +*/ +        tmf->vl = SWAP_BYTES(tmf->vl); + +        return (smctr_trc_send_packet(dev, fcb, MAC_QUEUE)); +} + +static int smctr_send_rpt_attch(struct net_device *dev, MAC_HEADER *rmf, +        __u16 correlator) +{ +        MAC_HEADER *tmf; +        MAC_SUB_VECTOR *tsv; +        FCBlock *fcb; + +        if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER) +		+ S_CORRELATOR + S_PRODUCT_INSTANCE_ID + S_FUNCTIONAL_ADDRESS +		+ S_AUTHORIZED_FUNCTION_CLASS + S_AUTHORIZED_ACCESS_PRIORITY)) +		== (FCBlock *)(-1L)) +        { +                return (0); +        } + +        tmf 	   = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr; +        tmf->vc    = RPT_ATTCH; +        tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4; +        tmf->vl    = 4; + +        smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_ATTCH); + +        tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER)); +        smctr_make_corr(dev, tsv, correlator); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_product_id(dev, tsv); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_funct_addr(dev, tsv); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_auth_funct_class(dev, tsv); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_access_pri(dev, tsv); + +        tmf->vl += tsv->svl; + +        /* Subtract out MVID and MVL which is +         * include in both vl and MAC_HEADER +         */ +/*      fcb->frame_length           = tmf->vl + sizeof(MAC_HEADER) - 4; +        fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4; +*/ +        tmf->vl = SWAP_BYTES(tmf->vl); + +        return (smctr_trc_send_packet(dev, fcb, MAC_QUEUE)); +} + +static int smctr_send_rpt_state(struct net_device *dev, MAC_HEADER *rmf, +        __u16 correlator) +{ +        MAC_HEADER *tmf; +        MAC_SUB_VECTOR *tsv; +        FCBlock *fcb; + +        if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER) +		+ S_CORRELATOR + S_RING_STATION_VERSION_NUMBER +		+ S_RING_STATION_STATUS + S_STATION_IDENTIFER)) +		== (FCBlock *)(-1L)) +        { +                return (0); +        } + +        tmf 	   = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr; +        tmf->vc    = RPT_STATE; +        tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4; +        tmf->vl    = 4; + +        smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_STATE); + +        tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER)); +        smctr_make_corr(dev, tsv, correlator); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_ring_station_version(dev, tsv); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_ring_station_status(dev, tsv); + +        tmf->vl += tsv->svl; +        tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +        smctr_make_station_id(dev, tsv); + +        tmf->vl += tsv->svl; + +        /* Subtract out MVID and MVL which is +         * include in both vl and MAC_HEADER +         */ +/*      fcb->frame_length           = tmf->vl + sizeof(MAC_HEADER) - 4; +        fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4; +*/ +        tmf->vl = SWAP_BYTES(tmf->vl); + +        return (smctr_trc_send_packet(dev, fcb, MAC_QUEUE)); +} + +static int smctr_send_rpt_tx_forward(struct net_device *dev, +        MAC_HEADER *rmf, __u16 tx_fstatus) +{ +        MAC_HEADER *tmf; +        MAC_SUB_VECTOR *tsv; +        FCBlock *fcb; + +        if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER) +		+ S_TRANSMIT_STATUS_CODE)) == (FCBlock *)(-1L)) +        { +                return (0); +        } + +        tmf 	   = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr; +        tmf->vc    = RPT_TX_FORWARD; +        tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4; +        tmf->vl    = 4; + +        smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_TX_FORWARD); + +        tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER)); +        smctr_make_tx_status_code(dev, tsv, tx_fstatus); + +        tmf->vl += tsv->svl; + +        /* Subtract out MVID and MVL which is +         * include in both vl and MAC_HEADER +         */ +/*      fcb->frame_length           = tmf->vl + sizeof(MAC_HEADER) - 4; +        fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4; +*/ +        tmf->vl = SWAP_BYTES(tmf->vl); + +        return(smctr_trc_send_packet(dev, fcb, MAC_QUEUE)); +} + +static int smctr_send_rsp(struct net_device *dev, MAC_HEADER *rmf, +        __u16 rcode, __u16 correlator) +{ +        MAC_HEADER *tmf; +        MAC_SUB_VECTOR *tsv; +        FCBlock *fcb; + +        if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER) +		+ S_CORRELATOR + S_RESPONSE_CODE)) == (FCBlock *)(-1L)) +        { +                return (0); +        } + +        tmf 	   = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr; +        tmf->vc    = RSP; +        tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4; +        tmf->vl    = 4; + +        smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RSP); + +        tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER)); +        smctr_make_corr(dev, tsv, correlator); + +        return (0); +} + +static int smctr_send_rq_init(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        MAC_HEADER *tmf; +        MAC_SUB_VECTOR *tsv; +        FCBlock *fcb; +	unsigned int i, count = 0; +	__u16 fstatus; +	int err; + +        do { +        	if(((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER) +			+ S_PRODUCT_INSTANCE_ID + S_UPSTREAM_NEIGHBOR_ADDRESS +			+ S_RING_STATION_VERSION_NUMBER + S_ADDRESS_MODIFER)) +			== (FCBlock *)(-1L))) +                { +                        return (0); +                } + +                tmf 	   = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr; +                tmf->vc    = RQ_INIT; +                tmf->dc_sc = DC_RPS | SC_RS; +                tmf->vl    = 4; + +                smctr_make_8025_hdr(dev, NULL, tmf, AC_FC_RQ_INIT); + +                tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER)); +                smctr_make_product_id(dev, tsv); + +                tmf->vl += tsv->svl; +                tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +                smctr_make_upstream_neighbor_addr(dev, tsv); + +                tmf->vl += tsv->svl; +                tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +                smctr_make_ring_station_version(dev, tsv); + +                tmf->vl += tsv->svl; +                tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl); +                smctr_make_addr_mod(dev, tsv); + +                tmf->vl += tsv->svl; + +                /* Subtract out MVID and MVL which is +                 * include in both vl and MAC_HEADER +                 */ +/*              fcb->frame_length           = tmf->vl + sizeof(MAC_HEADER) - 4; +                fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4; +*/ +                tmf->vl = SWAP_BYTES(tmf->vl); + +                if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE))) +                        return (err); + +                /* Wait for Transmit to Complete */ +      		for(i = 0; i < 10000; i++)  +		{ +          		if(fcb->frame_status & FCB_COMMAND_DONE) +              			break; +          		mdelay(1); +      		} + +                /* Check if GOOD frame Tx'ed */ +                fstatus = fcb->frame_status; + +                if(!(fstatus & FCB_COMMAND_DONE)) +                        return (HARDWARE_FAILED); + +                if(!(fstatus & FCB_TX_STATUS_E)) +                        count++; + +                /* De-allocated Tx FCB and Frame Buffer +                 * The FCB must be de-allocated manually if executing with +                 * interrupts disabled, other wise the ISR (LM_Service_Events) +                 * will de-allocate it when the interrupt occurs. +                 */ +                tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING; +                smctr_update_tx_chain(dev, fcb, MAC_QUEUE); +        } while(count < 4 && ((fstatus & FCB_TX_AC_BITS) ^ FCB_TX_AC_BITS)); + +	return (smctr_join_complete_state(dev)); +} + +static int smctr_send_tx_forward(struct net_device *dev, MAC_HEADER *rmf, +        __u16 *tx_fstatus) +{ +        struct net_local *tp = netdev_priv(dev); +        FCBlock *fcb; +        unsigned int i; +	int err; + +        /* Check if this is the END POINT of the Transmit Forward Chain. */ +        if(rmf->vl <= 18) +                return (0); + +        /* Allocate Transmit FCB only by requesting 0 bytes +         * of data buffer. +         */ +        if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, 0)) == (FCBlock *)(-1L)) +                return (0); + +        /* Set pointer to Transmit Frame Buffer to the data +         * portion of the received TX Forward frame, making +         * sure to skip over the Vector Code (vc) and Vector +         * length (vl). +         */ +        fcb->bdb_ptr->trc_data_block_ptr = TRC_POINTER((__u32)rmf  +		+ sizeof(MAC_HEADER) + 2); +        fcb->bdb_ptr->data_block_ptr     = (__u16 *)((__u32)rmf  +		+ sizeof(MAC_HEADER) + 2); + +        fcb->frame_length                = rmf->vl - 4 - 2; +        fcb->bdb_ptr->buffer_length      = rmf->vl - 4 - 2; + +        if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE))) +                return (err); + +        /* Wait for Transmit to Complete */ +   	for(i = 0; i < 10000; i++)  +	{ +       		if(fcb->frame_status & FCB_COMMAND_DONE) +           		break; +        	mdelay(1); +   	} + +        /* Check if GOOD frame Tx'ed */ +        if(!(fcb->frame_status & FCB_COMMAND_DONE)) +        { +                if((err = smctr_issue_resume_tx_fcb_cmd(dev, MAC_QUEUE))) +                        return (err); + +      		for(i = 0; i < 10000; i++)  +		{ +          		if(fcb->frame_status & FCB_COMMAND_DONE) +              			break; +        		mdelay(1); +      		} + +                if(!(fcb->frame_status & FCB_COMMAND_DONE)) +                        return (HARDWARE_FAILED); +        } + +        *tx_fstatus = fcb->frame_status; + +        return (A_FRAME_WAS_FORWARDED); +} + +static int smctr_set_auth_access_pri(struct net_device *dev, +        MAC_SUB_VECTOR *rsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(rsv->svl != S_AUTHORIZED_ACCESS_PRIORITY) +                return (E_SUB_VECTOR_LENGTH_ERROR); + +        tp->authorized_access_priority = (rsv->svv[0] << 8 | rsv->svv[1]); + +        return (POSITIVE_ACK); +} + +static int smctr_set_auth_funct_class(struct net_device *dev, +        MAC_SUB_VECTOR *rsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(rsv->svl != S_AUTHORIZED_FUNCTION_CLASS) +                return (E_SUB_VECTOR_LENGTH_ERROR); + +        tp->authorized_function_classes = (rsv->svv[0] << 8 | rsv->svv[1]); + +        return (POSITIVE_ACK); +} + +static int smctr_set_corr(struct net_device *dev, MAC_SUB_VECTOR *rsv, +        __u16 *correlator) +{ +        if(rsv->svl != S_CORRELATOR) +                return (E_SUB_VECTOR_LENGTH_ERROR); + +        *correlator = (rsv->svv[0] << 8 | rsv->svv[1]); + +        return (POSITIVE_ACK); +} + +static int smctr_set_error_timer_value(struct net_device *dev, +        MAC_SUB_VECTOR *rsv) +{ +	__u16 err_tval; +	int err; + +        if(rsv->svl != S_ERROR_TIMER_VALUE) +                return (E_SUB_VECTOR_LENGTH_ERROR); + +        err_tval = (rsv->svv[0] << 8 | rsv->svv[1])*10; + +        smctr_issue_write_word_cmd(dev, RW_TER_THRESHOLD, &err_tval); + +        if((err = smctr_wait_cmd(dev))) +                return (err); + +        return (POSITIVE_ACK); +} + +static int smctr_set_frame_forward(struct net_device *dev, +        MAC_SUB_VECTOR *rsv, __u8 dc_sc) +{ +        if((rsv->svl < 2) || (rsv->svl > S_FRAME_FORWARD)) +                return (E_SUB_VECTOR_LENGTH_ERROR); + +        if((dc_sc & DC_MASK) != DC_CRS) +        { +                if(rsv->svl >= 2 && rsv->svl < 20) +                	return (E_TRANSMIT_FORWARD_INVALID); + +                if((rsv->svv[0] != 0) || (rsv->svv[1] != 0)) +                        return (E_TRANSMIT_FORWARD_INVALID); +        } + +        return (POSITIVE_ACK); +} + +static int smctr_set_local_ring_num(struct net_device *dev, +        MAC_SUB_VECTOR *rsv) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(rsv->svl != S_LOCAL_RING_NUMBER) +                return (E_SUB_VECTOR_LENGTH_ERROR); + +        if(tp->ptr_local_ring_num) +                *(__u16 *)(tp->ptr_local_ring_num)  +			= (rsv->svv[0] << 8 | rsv->svv[1]); + +        return (POSITIVE_ACK); +} + +static unsigned short smctr_set_ctrl_attention(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        int ioaddr = dev->base_addr; + +        if(tp->bic_type == BIC_585_CHIP) +                outb((tp->trc_mask | HWR_CA), ioaddr + HWR); +        else +        { +                outb((tp->trc_mask | CSR_CA), ioaddr + CSR); +                outb(tp->trc_mask, ioaddr + CSR); +        } + +        return (0); +} + +static void smctr_set_multicast_list(struct net_device *dev) +{ +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_set_multicast_list\n", dev->name); + +        return; +} + +static int smctr_set_page(struct net_device *dev, __u8 *buf) +{ +        struct net_local *tp = netdev_priv(dev); +        __u8 amask; +        __u32 tptr; + +        tptr = (__u32)buf - (__u32)tp->ram_access; +        amask = (__u8)((tptr & PR_PAGE_MASK) >> 8); +        outb(amask, dev->base_addr + PR); + +        return (0); +} + +static int smctr_set_phy_drop(struct net_device *dev, MAC_SUB_VECTOR *rsv) +{ +	int err; + +        if(rsv->svl != S_PHYSICAL_DROP) +                return (E_SUB_VECTOR_LENGTH_ERROR); + +        smctr_issue_write_byte_cmd(dev, RW_PHYSICAL_DROP_NUMBER, &rsv->svv[0]); +        if((err = smctr_wait_cmd(dev))) +                return (err); + +        return (POSITIVE_ACK); +} + +/* Reset the ring speed to the opposite of what it was. This auto-pilot + * mode requires a complete reset and re-init of the adapter. + */ +static int smctr_set_ring_speed(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +	int err; + +        if(tp->media_type == MEDIA_UTP_16) +                tp->media_type = MEDIA_UTP_4; +        else +                tp->media_type = MEDIA_UTP_16; + +        smctr_enable_16bit(dev); + +        /* Re-Initialize adapter's internal registers */ +        smctr_reset_adapter(dev); + +        if((err = smctr_init_card_real(dev))) +                return (err); + +        smctr_enable_bic_int(dev); + +        if((err = smctr_issue_enable_int_cmd(dev, TRC_INTERRUPT_ENABLE_MASK))) +                return (err); + +        smctr_disable_16bit(dev); + +	return (0); +} + +static int smctr_set_rx_look_ahead(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        __u16 sword, rword; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_set_rx_look_ahead_flag\n", dev->name); + +        tp->adapter_flags &= ~(FORCED_16BIT_MODE); +        tp->adapter_flags |= RX_VALID_LOOKAHEAD; + +        if(tp->adapter_bus == BUS_ISA16_TYPE) +        { +                sword = *((__u16 *)(tp->ram_access)); +                *((__u16 *)(tp->ram_access)) = 0x1234; + +                smctr_disable_16bit(dev); +                rword = *((__u16 *)(tp->ram_access)); +                smctr_enable_16bit(dev); + +                if(rword != 0x1234) +                        tp->adapter_flags |= FORCED_16BIT_MODE; + +                *((__u16 *)(tp->ram_access)) = sword; +        } + +        return (0); +} + +static int smctr_set_trc_reset(int ioaddr) +{ +        __u8 r; + +        r = inb(ioaddr + MSR); +        outb(MSR_RST | r, ioaddr + MSR); + +        return (0); +} + +/* + * This function can be called if the adapter is busy or not. + */ +static int smctr_setup_single_cmd(struct net_device *dev, +        __u16 command, __u16 subcommand) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int err; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_setup_single_cmd\n", dev->name); + +        if((err = smctr_wait_while_cbusy(dev))) +                return (err); + +        if((err = (unsigned int)smctr_wait_cmd(dev))) +                return (err); + +        tp->acb_head->cmd_done_status   = 0; +        tp->acb_head->cmd               = command; +        tp->acb_head->subcmd            = subcommand; + +        err = smctr_issue_resume_acb_cmd(dev); + +        return (err); +} + +/* + * This function can not be called with the adapter busy. + */ +static int smctr_setup_single_cmd_w_data(struct net_device *dev, +        __u16 command, __u16 subcommand) +{ +        struct net_local *tp = netdev_priv(dev); + +        tp->acb_head->cmd_done_status   = ACB_COMMAND_NOT_DONE; +        tp->acb_head->cmd               = command; +        tp->acb_head->subcmd            = subcommand; +        tp->acb_head->data_offset_lo +                = (__u16)TRC_POINTER(tp->misc_command_data); + +        return(smctr_issue_resume_acb_cmd(dev)); +} + +static char *smctr_malloc(struct net_device *dev, __u16 size) +{ +        struct net_local *tp = netdev_priv(dev); +        char *m; + +        m = (char *)(tp->ram_access + tp->sh_mem_used); +        tp->sh_mem_used += (__u32)size; + +        return (m); +} + +static int smctr_status_chg(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_status_chg\n", dev->name); + +        switch(tp->status) +        { +                case OPEN: +                        break; + +                case CLOSED: +                        break; + +                /* Interrupt driven open() completion. XXX */ +                case INITIALIZED: +                        tp->group_address_0 = 0; +                        tp->group_address[0] = 0; +                        tp->group_address[1] = 0; +                        tp->functional_address_0 = 0; +                        tp->functional_address[0] = 0; +                        tp->functional_address[1] = 0; +                        smctr_open_tr(dev); +                        break; + +                default: +                        printk(KERN_INFO "%s: status change unknown %x\n", +                                dev->name, tp->status); +                        break; +        } + +        return (0); +} + +static int smctr_trc_send_packet(struct net_device *dev, FCBlock *fcb, +        __u16 queue) +{ +        struct net_local *tp = netdev_priv(dev); +        int err = 0; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_trc_send_packet\n", dev->name); + +        fcb->info = FCB_CHAIN_END | FCB_ENABLE_TFS; +        if(tp->num_tx_fcbs[queue] != 1) +                fcb->back_ptr->info = FCB_INTERRUPT_ENABLE | FCB_ENABLE_TFS; + +        if(tp->tx_queue_status[queue] == NOT_TRANSMITING) +        { +                tp->tx_queue_status[queue] = TRANSMITING; +                err = smctr_issue_resume_tx_fcb_cmd(dev, queue); +        } + +        return (err); +} + +static __u16 smctr_tx_complete(struct net_device *dev, __u16 queue) +{ +        struct net_local *tp = netdev_priv(dev); +        __u16 status, err = 0; +        int cstatus; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_tx_complete\n", dev->name); + +        while((status = tp->tx_fcb_end[queue]->frame_status) != SUCCESS) +        { +                if(status & 0x7e00 ) +                { +                        err = HARDWARE_FAILED; +                        break; +                } + +                if((err = smctr_update_tx_chain(dev, tp->tx_fcb_end[queue], +                        queue)) != SUCCESS) +                        break; + +                smctr_disable_16bit(dev); + +                if(tp->mode_bits & UMAC) +                { +                        if(!(status & (FCB_TX_STATUS_AR1 | FCB_TX_STATUS_AR2))) +                                cstatus = NO_SUCH_DESTINATION; +                        else +                        { +                                if(!(status & (FCB_TX_STATUS_CR1 | FCB_TX_STATUS_CR2))) +                                        cstatus = DEST_OUT_OF_RESOURCES; +                                else +                                { +                                        if(status & FCB_TX_STATUS_E) +                                                cstatus = MAX_COLLISIONS; +                                        else +                                                cstatus = SUCCESS; +                                } +                        } +                } +                else +                        cstatus = SUCCESS; + +                if(queue == BUG_QUEUE) +                        err = SUCCESS; + +                smctr_enable_16bit(dev); +                if(err != SUCCESS) +                        break; +        } + +        return (err); +} + +static unsigned short smctr_tx_move_frame(struct net_device *dev, +        struct sk_buff *skb, __u8 *pbuff, unsigned int bytes) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int ram_usable; +        __u32 flen, len, offset = 0; +        __u8 *frag, *page; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_tx_move_frame\n", dev->name); + +        ram_usable = ((unsigned int)tp->ram_usable) << 10; +        frag       = skb->data; +        flen       = skb->len; + +        while(flen > 0 && bytes > 0) +        { +                smctr_set_page(dev, pbuff); + +                offset = SMC_PAGE_OFFSET(pbuff); + +                if(offset + flen > ram_usable) +                        len = ram_usable - offset; +                else +                        len = flen; + +                if(len > bytes) +                        len = bytes; + +                page = (char *) (offset + tp->ram_access); +                memcpy(page, frag, len); + +                flen -=len; +                bytes -= len; +                frag += len; +                pbuff += len; +        } + +        return (0); +} + +/* Update the error statistic counters for this adapter. */ +static int smctr_update_err_stats(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        struct tr_statistics *tstat = &tp->MacStat; + +        if(tstat->internal_errors) +                tstat->internal_errors +                        += *(tp->misc_command_data + 0) & 0x00ff; + +        if(tstat->line_errors) +                tstat->line_errors += *(tp->misc_command_data + 0) >> 8; + +        if(tstat->A_C_errors) +                tstat->A_C_errors += *(tp->misc_command_data + 1) & 0x00ff; + +        if(tstat->burst_errors) +                tstat->burst_errors += *(tp->misc_command_data + 1) >> 8; + +        if(tstat->abort_delimiters) +                tstat->abort_delimiters += *(tp->misc_command_data + 2) >> 8; + +        if(tstat->recv_congest_count) +                tstat->recv_congest_count +                        += *(tp->misc_command_data + 3) & 0x00ff; + +        if(tstat->lost_frames) +                tstat->lost_frames +                        += *(tp->misc_command_data + 3) >> 8; + +        if(tstat->frequency_errors) +                tstat->frequency_errors += *(tp->misc_command_data + 4) & 0x00ff; + +        if(tstat->frame_copied_errors) +                 tstat->frame_copied_errors +                        += *(tp->misc_command_data + 4) >> 8; + +        if(tstat->token_errors) +                tstat->token_errors += *(tp->misc_command_data + 5) >> 8; + +        return (0); +} + +static int smctr_update_rx_chain(struct net_device *dev, __u16 queue) +{ +        struct net_local *tp = netdev_priv(dev); +        FCBlock *fcb; +        BDBlock *bdb; +        __u16 size, len; + +        fcb = tp->rx_fcb_curr[queue]; +        len = fcb->frame_length; + +        fcb->frame_status = 0; +        fcb->info = FCB_CHAIN_END; +        fcb->back_ptr->info = FCB_WARNING; + +        tp->rx_fcb_curr[queue] = tp->rx_fcb_curr[queue]->next_ptr; + +        /* update RX BDBs */ +        size = (len >> RX_BDB_SIZE_SHIFT); +        if(len & RX_DATA_BUFFER_SIZE_MASK) +                size += sizeof(BDBlock); +        size &= (~RX_BDB_SIZE_MASK); + +        /* check if wrap around */ +        bdb = (BDBlock *)((__u32)(tp->rx_bdb_curr[queue]) + (__u32)(size)); +        if((__u32)bdb >= (__u32)tp->rx_bdb_end[queue]) +        { +                bdb = (BDBlock *)((__u32)(tp->rx_bdb_head[queue]) +                        + (__u32)(bdb) - (__u32)(tp->rx_bdb_end[queue])); +        } + +        bdb->back_ptr->info = BDB_CHAIN_END; +        tp->rx_bdb_curr[queue]->back_ptr->info = BDB_NOT_CHAIN_END; +        tp->rx_bdb_curr[queue] = bdb; + +        return (0); +} + +static int smctr_update_tx_chain(struct net_device *dev, FCBlock *fcb, +        __u16 queue) +{ +        struct net_local *tp = netdev_priv(dev); + +        if(smctr_debug > 20) +                printk(KERN_DEBUG "smctr_update_tx_chain\n"); + +        if(tp->num_tx_fcbs_used[queue] <= 0) +                return (HARDWARE_FAILED); +        else +        { +                if(tp->tx_buff_used[queue] < fcb->memory_alloc) +                { +                        tp->tx_buff_used[queue] = 0; +                        return (HARDWARE_FAILED); +                } + +                tp->tx_buff_used[queue] -= fcb->memory_alloc; + +                /* if all transmit buffer are cleared +                 * need to set the tx_buff_curr[] to tx_buff_head[] +                 * otherwise, tx buffer will be segregate and cannot +                 * accommodate and buffer greater than (curr - head) and +                 * (end - curr) since we do not allow wrap around allocation. +                 */ +                if(tp->tx_buff_used[queue] == 0) +                        tp->tx_buff_curr[queue] = tp->tx_buff_head[queue]; + +                tp->num_tx_fcbs_used[queue]--; +                fcb->frame_status = 0; +                tp->tx_fcb_end[queue] = fcb->next_ptr; +		netif_wake_queue(dev); +                return (0); +        } +} + +static int smctr_wait_cmd(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int loop_count = 0x20000; + +        if(smctr_debug > 10) +                printk(KERN_DEBUG "%s: smctr_wait_cmd\n", dev->name); + +        while(loop_count) +        { +                if(tp->acb_head->cmd_done_status & ACB_COMMAND_DONE) +                        break; +		udelay(1); +                loop_count--; +        } + +        if(loop_count == 0) +                return(HARDWARE_FAILED); + +        if(tp->acb_head->cmd_done_status & 0xff) +                return(HARDWARE_FAILED); + +        return (0); +} + +static int smctr_wait_while_cbusy(struct net_device *dev) +{ +        struct net_local *tp = netdev_priv(dev); +        unsigned int timeout = 0x20000; +        int ioaddr = dev->base_addr; +        __u8 r; + +        if(tp->bic_type == BIC_585_CHIP) +        { +                while(timeout) +                { +                        r = inb(ioaddr + HWR); +                        if((r & HWR_CBUSY) == 0) +                                break; +                        timeout--; +                } +        } +        else +        { +                while(timeout) +                { +                        r = inb(ioaddr + CSR); +                        if((r & CSR_CBUSY) == 0) +                                break; +                        timeout--; +                } +        } + +        if(timeout) +                return (0); +        else +                return (HARDWARE_FAILED); +} + +#ifdef MODULE + +static struct net_device* dev_smctr[SMCTR_MAX_ADAPTERS]; +static int io[SMCTR_MAX_ADAPTERS]; +static int irq[SMCTR_MAX_ADAPTERS]; + +MODULE_LICENSE("GPL"); + +module_param_array(io, int, NULL, 0); +module_param_array(irq, int, NULL, 0); +module_param(ringspeed, int, 0); + +static struct net_device *setup_card(int n) +{ +	struct net_device *dev = alloc_trdev(sizeof(struct net_local)); +	int err; +	 +	if (!dev) +		return ERR_PTR(-ENOMEM); + +	dev->irq = irq[n]; +	err = smctr_probe1(dev, io[n]); +	if (err)  +		goto out; +		 +	err = register_netdev(dev); +	if (err) +		goto out1; +	return dev; + out1: +#ifdef CONFIG_MCA_LEGACY +	{ struct net_local *tp = netdev_priv(dev); +	  if (tp->slot_num) +		mca_mark_as_unused(tp->slot_num); +	} +#endif +	release_region(dev->base_addr, SMCTR_IO_EXTENT); +	free_irq(dev->irq, dev); +out: +	free_netdev(dev); +	return ERR_PTR(err); +} +			 + +int init_module(void) +{ +        int i, found = 0; +	struct net_device *dev; + +        for(i = 0; i < SMCTR_MAX_ADAPTERS; i++) { +		dev = io[0]? setup_card(i) : smctr_probe(-1); +		if (!IS_ERR(dev)) { +			++found; +			dev_smctr[i] = dev; +		} +        } + +        return found ? 0 : -ENODEV; +} + +void cleanup_module(void) +{ +        int i; + +        for(i = 0; i < SMCTR_MAX_ADAPTERS; i++) { +		struct net_device *dev = dev_smctr[i]; + +		if (dev) { + +			unregister_netdev(dev); +#ifdef CONFIG_MCA_LEGACY +			{ struct net_local *tp = netdev_priv(dev); +			if (tp->slot_num) +				mca_mark_as_unused(tp->slot_num); +			} +#endif +			release_region(dev->base_addr, SMCTR_IO_EXTENT); +			if (dev->irq) +				free_irq(dev->irq, dev); + +			free_netdev(dev); +		} +        } +} +#endif /* MODULE */ | 
