SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/net/tokenring/smctr.c

   1 /*
   2  *  smctr.c: A network driver for the SMC Token Ring Adapters.
   3  *
   4  *  Written by Jay Schulist <jschlst@samba.org>
   5  *
   6  *  This software may be used and distributed according to the terms
   7  *  of the GNU General Public License, incorporated herein by reference.
   8  *
   9  *  This device driver works with the following SMC adapters:
  10  *      - SMC TokenCard Elite   (8115T, chips 825/584)
  11  *      - SMC TokenCard Elite/A MCA (8115T/A, chips 825/594)
  12  *
  13  *  Source(s):
  14  *      - SMC TokenCard SDK.
  15  *
  16  *  Maintainer(s):
  17  *    JS        Jay Schulist <jschlst@samba.org>
  18  *
  19  * Changes:
  20  *    07102000          JS      Fixed a timing problem in smctr_wait_cmd();
  21  *                              Also added a bit more discriptive error msgs.
  22  *    07122000          JS      Fixed problem with detecting a card with
  23  *                              module io/irq/mem specified.
  24  *
  25  *  To do:
  26  *    1. Multicast support.
  27  *
  28  *  Initial 2.5 cleanup Alan Cox <alan@lxorguk.ukuu.org.uk>  2002/10/28
  29  */
  30
  31 #include <linux/module.h>
  32 #include <linux/kernel.h>
  33 #include <linux/types.h>
  34 #include <linux/fcntl.h>
  35 #include <linux/interrupt.h>
  36 #include <linux/ptrace.h>
  37 #include <linux/ioport.h>
  38 #include <linux/in.h>
  39 #include <linux/string.h>
  40 #include <linux/time.h>
  41 #include <linux/errno.h>
  42 #include <linux/init.h>
  43 #include <linux/mca-legacy.h>
  44 #include <linux/delay.h>
  45 #include <linux/netdevice.h>
  46 #include <linux/etherdevice.h>
  47 #include <linux/skbuff.h>
  48 #include <linux/trdevice.h>
  49 #include <linux/bitops.h>
  50 #include <linux/firmware.h>
  51
  52 #include <asm/system.h>
  53 #include <asm/io.h>
  54 #include <asm/dma.h>
  55 #include <asm/irq.h>
  56
  57 #if BITS_PER_LONG == 64
  58 #error FIXME: driver does not support 64-bit platforms
  59 #endif
  60
  61 #include "smctr.h"               /* Our Stuff */
  62
  63 static const char version[] __initdata =
  64         KERN_INFO "smctr.c: v1.4 7/12/00 by jschlst@samba.org\n";
  65 static const char cardname[] = "smctr";
  66
  67
  68 #define SMCTR_IO_EXTENT   20
  69
  70 #ifdef CONFIG_MCA_LEGACY
  71 static unsigned int smctr_posid = 0x6ec6;
  72 #endif
  73
  74 static int ringspeed;
  75
  76 /* SMC Name of the Adapter. */
  77 static char smctr_name[] = "SMC TokenCard";
  78 static char *smctr_model = "Unknown";
  79
  80 /* Use 0 for production, 1 for verification, 2 for debug, and
  81  * 3 for very verbose debug.
  82  */
  83 #ifndef SMCTR_DEBUG
  84 #define SMCTR_DEBUG 1
  85 #endif
  86 static unsigned int smctr_debug = SMCTR_DEBUG;
  87
  88 /* smctr.c prototypes and functions are arranged alphabeticly
  89  * for clearity, maintainability and pure old fashion fun.
  90  */
  91 /* A */
  92 static int smctr_alloc_shared_memory(struct net_device *dev);
  93
  94 /* B */
  95 static int smctr_bypass_state(struct net_device *dev);
  96
  97 /* C */
  98 static int smctr_checksum_firmware(struct net_device *dev);
  99 static int __init smctr_chk_isa(struct net_device *dev);
 100 static int smctr_chg_rx_mask(struct net_device *dev);
 101 static int smctr_clear_int(struct net_device *dev);
 102 static int smctr_clear_trc_reset(int ioaddr);
 103 static int smctr_close(struct net_device *dev);
 104
 105 /* D */
 106 static int smctr_decode_firmware(struct net_device *dev,
 107                                  const struct firmware *fw);
 108 static int smctr_disable_16bit(struct net_device *dev);
 109 static int smctr_disable_adapter_ctrl_store(struct net_device *dev);
 110 static int smctr_disable_bic_int(struct net_device *dev);
 111
 112 /* E */
 113 static int smctr_enable_16bit(struct net_device *dev);
 114 static int smctr_enable_adapter_ctrl_store(struct net_device *dev);
 115 static int smctr_enable_adapter_ram(struct net_device *dev);
 116 static int smctr_enable_bic_int(struct net_device *dev);
 117
 118 /* G */
 119 static int __init smctr_get_boardid(struct net_device *dev, int mca);
 120 static int smctr_get_group_address(struct net_device *dev);
 121 static int smctr_get_functional_address(struct net_device *dev);
 122 static unsigned int smctr_get_num_rx_bdbs(struct net_device *dev);
 123 static int smctr_get_physical_drop_number(struct net_device *dev);
 124 static __u8 *smctr_get_rx_pointer(struct net_device *dev, short queue);
 125 static int smctr_get_station_id(struct net_device *dev);
 126 static FCBlock *smctr_get_tx_fcb(struct net_device *dev, __u16 queue,
 127         __u16 bytes_count);
 128 static int smctr_get_upstream_neighbor_addr(struct net_device *dev);
 129
 130 /* H */
 131 static int smctr_hardware_send_packet(struct net_device *dev,
 132         struct net_local *tp);
 133 /* I */
 134 static int smctr_init_acbs(struct net_device *dev);
 135 static int smctr_init_adapter(struct net_device *dev);
 136 static int smctr_init_card_real(struct net_device *dev);
 137 static int smctr_init_rx_bdbs(struct net_device *dev);
 138 static int smctr_init_rx_fcbs(struct net_device *dev);
 139 static int smctr_init_shared_memory(struct net_device *dev);
 140 static int smctr_init_tx_bdbs(struct net_device *dev);
 141 static int smctr_init_tx_fcbs(struct net_device *dev);
 142 static int smctr_internal_self_test(struct net_device *dev);
 143 static irqreturn_t smctr_interrupt(int irq, void *dev_id);
 144 static int smctr_issue_enable_int_cmd(struct net_device *dev,
 145         __u16 interrupt_enable_mask);
 146 static int smctr_issue_int_ack(struct net_device *dev, __u16 iack_code,
 147         __u16 ibits);
 148 static int smctr_issue_init_timers_cmd(struct net_device *dev);
 149 static int smctr_issue_init_txrx_cmd(struct net_device *dev);
 150 static int smctr_issue_insert_cmd(struct net_device *dev);
 151 static int smctr_issue_read_ring_status_cmd(struct net_device *dev);
 152 static int smctr_issue_read_word_cmd(struct net_device *dev, __u16 aword_cnt);
 153 static int smctr_issue_remove_cmd(struct net_device *dev);
 154 static int smctr_issue_resume_acb_cmd(struct net_device *dev);
 155 static int smctr_issue_resume_rx_bdb_cmd(struct net_device *dev, __u16 queue);
 156 static int smctr_issue_resume_rx_fcb_cmd(struct net_device *dev, __u16 queue);
 157 static int smctr_issue_resume_tx_fcb_cmd(struct net_device *dev, __u16 queue);
 158 static int smctr_issue_test_internal_rom_cmd(struct net_device *dev);
 159 static int smctr_issue_test_hic_cmd(struct net_device *dev);
 160 static int smctr_issue_test_mac_reg_cmd(struct net_device *dev);
 161 static int smctr_issue_trc_loopback_cmd(struct net_device *dev);
 162 static int smctr_issue_tri_loopback_cmd(struct net_device *dev);
 163 static int smctr_issue_write_byte_cmd(struct net_device *dev,
 164         short aword_cnt, void *byte);
 165 static int smctr_issue_write_word_cmd(struct net_device *dev,
 166         short aword_cnt, void *word);
 167
 168 /* J */
 169 static int smctr_join_complete_state(struct net_device *dev);
 170
 171 /* L */
 172 static int smctr_link_tx_fcbs_to_bdbs(struct net_device *dev);
 173 static int smctr_load_firmware(struct net_device *dev);
 174 static int smctr_load_node_addr(struct net_device *dev);
 175 static int smctr_lobe_media_test(struct net_device *dev);
 176 static int smctr_lobe_media_test_cmd(struct net_device *dev);
 177 static int smctr_lobe_media_test_state(struct net_device *dev);
 178
 179 /* M */
 180 static int smctr_make_8025_hdr(struct net_device *dev,
 181         MAC_HEADER *rmf, MAC_HEADER *tmf, __u16 ac_fc);
 182 static int smctr_make_access_pri(struct net_device *dev,
 183         MAC_SUB_VECTOR *tsv);
 184 static int smctr_make_addr_mod(struct net_device *dev, MAC_SUB_VECTOR *tsv);
 185 static int smctr_make_auth_funct_class(struct net_device *dev,
 186         MAC_SUB_VECTOR *tsv);
 187 static int smctr_make_corr(struct net_device *dev,
 188         MAC_SUB_VECTOR *tsv, __u16 correlator);
 189 static int smctr_make_funct_addr(struct net_device *dev,
 190         MAC_SUB_VECTOR *tsv);
 191 static int smctr_make_group_addr(struct net_device *dev,
 192         MAC_SUB_VECTOR *tsv);
 193 static int smctr_make_phy_drop_num(struct net_device *dev,
 194         MAC_SUB_VECTOR *tsv);
 195 static int smctr_make_product_id(struct net_device *dev, MAC_SUB_VECTOR *tsv);
 196 static int smctr_make_station_id(struct net_device *dev, MAC_SUB_VECTOR *tsv);
 197 static int smctr_make_ring_station_status(struct net_device *dev,
 198         MAC_SUB_VECTOR *tsv);
 199 static int smctr_make_ring_station_version(struct net_device *dev,
 200         MAC_SUB_VECTOR *tsv);
 201 static int smctr_make_tx_status_code(struct net_device *dev,
 202         MAC_SUB_VECTOR *tsv, __u16 tx_fstatus);
 203 static int smctr_make_upstream_neighbor_addr(struct net_device *dev,
 204         MAC_SUB_VECTOR *tsv);
 205 static int smctr_make_wrap_data(struct net_device *dev,
 206         MAC_SUB_VECTOR *tsv);
 207
 208 /* O */
 209 static int smctr_open(struct net_device *dev);
 210 static int smctr_open_tr(struct net_device *dev);
 211
 212 /* P */
 213 struct net_device *smctr_probe(int unit);
 214 static int __init smctr_probe1(struct net_device *dev, int ioaddr);
 215 static int smctr_process_rx_packet(MAC_HEADER *rmf, __u16 size,
 216         struct net_device *dev, __u16 rx_status);
 217
 218 /* R */
 219 static int smctr_ram_memory_test(struct net_device *dev);
 220 static int smctr_rcv_chg_param(struct net_device *dev, MAC_HEADER *rmf,
 221         __u16 *correlator);
 222 static int smctr_rcv_init(struct net_device *dev, MAC_HEADER *rmf,
 223         __u16 *correlator);
 224 static int smctr_rcv_tx_forward(struct net_device *dev, MAC_HEADER *rmf);
 225 static int smctr_rcv_rq_addr_state_attch(struct net_device *dev,
 226         MAC_HEADER *rmf, __u16 *correlator);
 227 static int smctr_rcv_unknown(struct net_device *dev, MAC_HEADER *rmf,
 228         __u16 *correlator);
 229 static int smctr_reset_adapter(struct net_device *dev);
 230 static int smctr_restart_tx_chain(struct net_device *dev, short queue);
 231 static int smctr_ring_status_chg(struct net_device *dev);
 232 static int smctr_rx_frame(struct net_device *dev);
 233
 234 /* S */
 235 static int smctr_send_dat(struct net_device *dev);
 236 static netdev_tx_t smctr_send_packet(struct sk_buff *skb,
 237                                            struct net_device *dev);
 238 static int smctr_send_lobe_media_test(struct net_device *dev);
 239 static int smctr_send_rpt_addr(struct net_device *dev, MAC_HEADER *rmf,
 240         __u16 correlator);
 241 static int smctr_send_rpt_attch(struct net_device *dev, MAC_HEADER *rmf,
 242         __u16 correlator);
 243 static int smctr_send_rpt_state(struct net_device *dev, MAC_HEADER *rmf,
 244         __u16 correlator);
 245 static int smctr_send_rpt_tx_forward(struct net_device *dev,
 246         MAC_HEADER *rmf, __u16 tx_fstatus);
 247 static int smctr_send_rsp(struct net_device *dev, MAC_HEADER *rmf,
 248         __u16 rcode, __u16 correlator);
 249 static int smctr_send_rq_init(struct net_device *dev);
 250 static int smctr_send_tx_forward(struct net_device *dev, MAC_HEADER *rmf,
 251         __u16 *tx_fstatus);
 252 static int smctr_set_auth_access_pri(struct net_device *dev,
 253         MAC_SUB_VECTOR *rsv);
 254 static int smctr_set_auth_funct_class(struct net_device *dev,
 255         MAC_SUB_VECTOR *rsv);
 256 static int smctr_set_corr(struct net_device *dev, MAC_SUB_VECTOR *rsv,
 257         __u16 *correlator);
 258 static int smctr_set_error_timer_value(struct net_device *dev,
 259         MAC_SUB_VECTOR *rsv);
 260 static int smctr_set_frame_forward(struct net_device *dev,
 261         MAC_SUB_VECTOR *rsv, __u8 dc_sc);
 262 static int smctr_set_local_ring_num(struct net_device *dev,
 263         MAC_SUB_VECTOR *rsv);
 264 static unsigned short smctr_set_ctrl_attention(struct net_device *dev);
 265 static void smctr_set_multicast_list(struct net_device *dev);
 266 static int smctr_set_page(struct net_device *dev, __u8 *buf);
 267 static int smctr_set_phy_drop(struct net_device *dev,
 268         MAC_SUB_VECTOR *rsv);
 269 static int smctr_set_ring_speed(struct net_device *dev);
 270 static int smctr_set_rx_look_ahead(struct net_device *dev);
 271 static int smctr_set_trc_reset(int ioaddr);
 272 static int smctr_setup_single_cmd(struct net_device *dev,
 273         __u16 command, __u16 subcommand);
 274 static int smctr_setup_single_cmd_w_data(struct net_device *dev,
 275         __u16 command, __u16 subcommand);
 276 static char *smctr_malloc(struct net_device *dev, __u16 size);
 277 static int smctr_status_chg(struct net_device *dev);
 278
 279 /* T */
 280 static void smctr_timeout(struct net_device *dev);
 281 static int smctr_trc_send_packet(struct net_device *dev, FCBlock *fcb,
 282         __u16 queue);
 283 static __u16 smctr_tx_complete(struct net_device *dev, __u16 queue);
 284 static unsigned short smctr_tx_move_frame(struct net_device *dev,
 285         struct sk_buff *skb, __u8 *pbuff, unsigned int bytes);
 286
 287 /* U */
 288 static int smctr_update_err_stats(struct net_device *dev);
 289 static int smctr_update_rx_chain(struct net_device *dev, __u16 queue);
 290 static int smctr_update_tx_chain(struct net_device *dev, FCBlock *fcb,
 291         __u16 queue);
 292
 293 /* W */
 294 static int smctr_wait_cmd(struct net_device *dev);
 295 static int smctr_wait_while_cbusy(struct net_device *dev);
 296
 297 #define TO_256_BYTE_BOUNDRY(X)  (((X + 0xff) & 0xff00) - X)
 298 #define TO_PARAGRAPH_BOUNDRY(X) (((X + 0x0f) & 0xfff0) - X)
 299 #define PARAGRAPH_BOUNDRY(X)    smctr_malloc(dev, TO_PARAGRAPH_BOUNDRY(X))
 300
 301 /* Allocate Adapter Shared Memory.
 302  * IMPORTANT NOTE: Any changes to this function MUST be mirrored in the
 303  * function "get_num_rx_bdbs" below!!!
 304  *
 305  * Order of memory allocation:
 306  *
 307  *       0. Initial System Configuration Block Pointer
 308  *       1. System Configuration Block
 309  *       2. System Control Block
 310  *       3. Action Command Block
 311  *       4. Interrupt Status Block
 312  *
 313  *       5. MAC TX FCB'S
 314  *       6. NON-MAC TX FCB'S
 315  *       7. MAC TX BDB'S
 316  *       8. NON-MAC TX BDB'S
 317  *       9. MAC RX FCB'S
 318  *      10. NON-MAC RX FCB'S
 319  *      11. MAC RX BDB'S
 320  *      12. NON-MAC RX BDB'S
 321  *      13. MAC TX Data Buffer( 1, 256 byte buffer)
 322  *      14. MAC RX Data Buffer( 1, 256 byte buffer)
 323  *
 324  *      15. NON-MAC TX Data Buffer
 325  *      16. NON-MAC RX Data Buffer
 326  */
 327 static int smctr_alloc_shared_memory(struct net_device *dev)
 328 {
 329         struct net_local *tp = netdev_priv(dev);
 330
 331         if(smctr_debug > 10)
 332                 printk(KERN_DEBUG "%s: smctr_alloc_shared_memory\n", dev->name);
 333
 334         /* Allocate initial System Control Block pointer.
 335          * This pointer is located in the last page, last offset - 4.
 336          */
 337         tp->iscpb_ptr = (ISCPBlock *)(tp->ram_access + ((__u32)64 * 0x400)
 338                 - (long)ISCP_BLOCK_SIZE);
 339
 340         /* Allocate System Control Blocks. */
 341         tp->scgb_ptr = (SCGBlock *)smctr_malloc(dev, sizeof(SCGBlock));
 342         PARAGRAPH_BOUNDRY(tp->sh_mem_used);
 343
 344         tp->sclb_ptr = (SCLBlock *)smctr_malloc(dev, sizeof(SCLBlock));
 345         PARAGRAPH_BOUNDRY(tp->sh_mem_used);
 346
 347         tp->acb_head = (ACBlock *)smctr_malloc(dev,
 348                 sizeof(ACBlock)*tp->num_acbs);
 349         PARAGRAPH_BOUNDRY(tp->sh_mem_used);
 350
 351         tp->isb_ptr = (ISBlock *)smctr_malloc(dev, sizeof(ISBlock));
 352         PARAGRAPH_BOUNDRY(tp->sh_mem_used);
 353
 354         tp->misc_command_data = (__u16 *)smctr_malloc(dev, MISC_DATA_SIZE);
 355         PARAGRAPH_BOUNDRY(tp->sh_mem_used);
 356
 357         /* Allocate transmit FCBs. */
 358         tp->tx_fcb_head[MAC_QUEUE] = (FCBlock *)smctr_malloc(dev,
 359                 sizeof(FCBlock) * tp->num_tx_fcbs[MAC_QUEUE]);
 360
 361         tp->tx_fcb_head[NON_MAC_QUEUE] = (FCBlock *)smctr_malloc(dev,
 362                 sizeof(FCBlock) * tp->num_tx_fcbs[NON_MAC_QUEUE]);
 363
 364         tp->tx_fcb_head[BUG_QUEUE] = (FCBlock *)smctr_malloc(dev,
 365                 sizeof(FCBlock) * tp->num_tx_fcbs[BUG_QUEUE]);
 366
 367         /* Allocate transmit BDBs. */
 368         tp->tx_bdb_head[MAC_QUEUE] = (BDBlock *)smctr_malloc(dev,
 369                 sizeof(BDBlock) * tp->num_tx_bdbs[MAC_QUEUE]);
 370
 371         tp->tx_bdb_head[NON_MAC_QUEUE] = (BDBlock *)smctr_malloc(dev,
 372                 sizeof(BDBlock) * tp->num_tx_bdbs[NON_MAC_QUEUE]);
 373
 374         tp->tx_bdb_head[BUG_QUEUE] = (BDBlock *)smctr_malloc(dev,
 375                 sizeof(BDBlock) * tp->num_tx_bdbs[BUG_QUEUE]);
 376
 377         /* Allocate receive FCBs. */
 378         tp->rx_fcb_head[MAC_QUEUE] = (FCBlock *)smctr_malloc(dev,
 379                 sizeof(FCBlock) * tp->num_rx_fcbs[MAC_QUEUE]);
 380
 381         tp->rx_fcb_head[NON_MAC_QUEUE] = (FCBlock *)smctr_malloc(dev,
 382                 sizeof(FCBlock) * tp->num_rx_fcbs[NON_MAC_QUEUE]);
 383
 384         /* Allocate receive BDBs. */
 385         tp->rx_bdb_head[MAC_QUEUE] = (BDBlock *)smctr_malloc(dev,
 386                 sizeof(BDBlock) * tp->num_rx_bdbs[MAC_QUEUE]);
 387
 388         tp->rx_bdb_end[MAC_QUEUE] = (BDBlock *)smctr_malloc(dev, 0);
 389
 390         tp->rx_bdb_head[NON_MAC_QUEUE] = (BDBlock *)smctr_malloc(dev,
 391                 sizeof(BDBlock) * tp->num_rx_bdbs[NON_MAC_QUEUE]);
 392
 393         tp->rx_bdb_end[NON_MAC_QUEUE] = (BDBlock *)smctr_malloc(dev, 0);
 394
 395         /* Allocate MAC transmit buffers.
 396          * MAC Tx Buffers doen't have to be on an ODD Boundry.
 397          */
 398         tp->tx_buff_head[MAC_QUEUE]
 399                 = (__u16 *)smctr_malloc(dev, tp->tx_buff_size[MAC_QUEUE]);
 400         tp->tx_buff_curr[MAC_QUEUE] = tp->tx_buff_head[MAC_QUEUE];
 401         tp->tx_buff_end [MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0);
 402
 403         /* Allocate BUG transmit buffers. */
 404         tp->tx_buff_head[BUG_QUEUE]
 405                 = (__u16 *)smctr_malloc(dev, tp->tx_buff_size[BUG_QUEUE]);
 406         tp->tx_buff_curr[BUG_QUEUE] = tp->tx_buff_head[BUG_QUEUE];
 407         tp->tx_buff_end[BUG_QUEUE] = (__u16 *)smctr_malloc(dev, 0);
 408
 409         /* Allocate MAC receive data buffers.
 410          * MAC Rx buffer doesn't have to be on a 256 byte boundary.
 411          */
 412         tp->rx_buff_head[MAC_QUEUE] = (__u16 *)smctr_malloc(dev,
 413                 RX_DATA_BUFFER_SIZE * tp->num_rx_bdbs[MAC_QUEUE]);
 414         tp->rx_buff_end[MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0);
 415
 416         /* Allocate Non-MAC transmit buffers.
 417          * ?? For maximum Netware performance, put Tx Buffers on
 418          * ODD Boundry and then restore malloc to Even Boundrys.
 419          */
 420         smctr_malloc(dev, 1L);
 421         tp->tx_buff_head[NON_MAC_QUEUE]
 422                 = (__u16 *)smctr_malloc(dev, tp->tx_buff_size[NON_MAC_QUEUE]);
 423         tp->tx_buff_curr[NON_MAC_QUEUE] = tp->tx_buff_head[NON_MAC_QUEUE];
 424         tp->tx_buff_end [NON_MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0);
 425         smctr_malloc(dev, 1L);
 426
 427         /* Allocate Non-MAC receive data buffers.
 428          * To guarantee a minimum of 256 contiguous memory to
 429          * UM_Receive_Packet's lookahead pointer, before a page
 430          * change or ring end is encountered, place each rx buffer on
 431          * a 256 byte boundary.
 432          */
 433         smctr_malloc(dev, TO_256_BYTE_BOUNDRY(tp->sh_mem_used));
 434         tp->rx_buff_head[NON_MAC_QUEUE] = (__u16 *)smctr_malloc(dev,
 435                 RX_DATA_BUFFER_SIZE * tp->num_rx_bdbs[NON_MAC_QUEUE]);
 436         tp->rx_buff_end[NON_MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0);
 437
 438         return (0);
 439 }
 440
 441 /* Enter Bypass state. */
 442 static int smctr_bypass_state(struct net_device *dev)
 443 {
 444         int err;
 445
 446         if(smctr_debug > 10)
 447                 printk(KERN_DEBUG "%s: smctr_bypass_state\n", dev->name);
 448
 449         err = smctr_setup_single_cmd(dev, ACB_CMD_CHANGE_JOIN_STATE, JS_BYPASS_STATE);
 450
 451         return (err);
 452 }
 453
 454 static int smctr_checksum_firmware(struct net_device *dev)
 455 {
 456         struct net_local *tp = netdev_priv(dev);
 457         __u16 i, checksum = 0;
 458
 459         if(smctr_debug > 10)
 460                 printk(KERN_DEBUG "%s: smctr_checksum_firmware\n", dev->name);
 461
 462         smctr_enable_adapter_ctrl_store(dev);
 463
 464         for(i = 0; i < CS_RAM_SIZE; i += 2)
 465                 checksum += *((__u16 *)(tp->ram_access + i));
 466
 467         tp->microcode_version = *(__u16 *)(tp->ram_access
 468                 + CS_RAM_VERSION_OFFSET);
 469         tp->microcode_version >>= 8;
 470
 471         smctr_disable_adapter_ctrl_store(dev);
 472
 473         if(checksum)
 474                 return (checksum);
 475
 476         return (0);
 477 }
 478
 479 static int __init smctr_chk_mca(struct net_device *dev)
 480 {
 481 #ifdef CONFIG_MCA_LEGACY
 482         struct net_local *tp = netdev_priv(dev);
 483         int current_slot;
 484         __u8 r1, r2, r3, r4, r5;
 485
 486         current_slot = mca_find_unused_adapter(smctr_posid, 0);
 487         if(current_slot == MCA_NOTFOUND)
 488                 return (-ENODEV);
 489
 490         mca_set_adapter_name(current_slot, smctr_name);
 491         mca_mark_as_used(current_slot);
 492         tp->slot_num = current_slot;
 493
 494         r1 = mca_read_stored_pos(tp->slot_num, 2);
 495         r2 = mca_read_stored_pos(tp->slot_num, 3);
 496
 497         if(tp->slot_num)
 498                 outb(CNFG_POS_CONTROL_REG, (__u8)((tp->slot_num - 1) | CNFG_SLOT_ENABLE_BIT));
 499         else
 500                 outb(CNFG_POS_CONTROL_REG, (__u8)((tp->slot_num) | CNFG_SLOT_ENABLE_BIT));
 501
 502         r1 = inb(CNFG_POS_REG1);
 503         r2 = inb(CNFG_POS_REG0);
 504
 505         tp->bic_type = BIC_594_CHIP;
 506
 507         /* IO */
 508         r2 = mca_read_stored_pos(tp->slot_num, 2);
 509         r2 &= 0xF0;
 510         dev->base_addr = ((__u16)r2 << 8) + (__u16)0x800;
 511         request_region(dev->base_addr, SMCTR_IO_EXTENT, smctr_name);
 512
 513         /* IRQ */
 514         r5 = mca_read_stored_pos(tp->slot_num, 5);
 515         r5 &= 0xC;
 516         switch(r5)
 517         {
 518                 case 0:
 519                         dev->irq = 3;
 520                         break;
 521
 522                 case 0x4:
 523                         dev->irq = 4;
 524                         break;
 525
 526                 case 0x8:
 527                         dev->irq = 10;
 528                         break;
 529
 530                 default:
 531                         dev->irq = 15;
 532                         break;
 533         }
 534         if (request_irq(dev->irq, smctr_interrupt, IRQF_SHARED, smctr_name, dev)) {
 535                 release_region(dev->base_addr, SMCTR_IO_EXTENT);
 536                 return -ENODEV;
 537         }
 538
 539         /* Get RAM base */
 540         r3 = mca_read_stored_pos(tp->slot_num, 3);
 541         tp->ram_base = ((__u32)(r3 & 0x7) << 13) + 0x0C0000;
 542         if (r3 & 0x8)
 543                 tp->ram_base += 0x010000;
 544         if (r3 & 0x80)
 545                 tp->ram_base += 0xF00000;
 546
 547         /* Get Ram Size */
 548         r3 &= 0x30;
 549         r3 >>= 4;
 550
 551         tp->ram_usable = (__u16)CNFG_SIZE_8KB << r3;
 552         tp->ram_size = (__u16)CNFG_SIZE_64KB;
 553         tp->board_id |= TOKEN_MEDIA;
 554
 555         r4 = mca_read_stored_pos(tp->slot_num, 4);
 556         tp->rom_base = ((__u32)(r4 & 0x7) << 13) + 0x0C0000;
 557         if (r4 & 0x8)
 558                 tp->rom_base += 0x010000;
 559
 560         /* Get ROM size. */
 561         r4 >>= 4;
 562         switch (r4) {
 563                 case 0:
 564                         tp->rom_size = CNFG_SIZE_8KB;
 565                         break;
 566                 case 1:
 567                         tp->rom_size = CNFG_SIZE_16KB;
 568                         break;
 569                 case 2:
 570                         tp->rom_size = CNFG_SIZE_32KB;
 571                         break;
 572                 default:
 573                         tp->rom_size = ROM_DISABLE;
 574         }
 575
 576         /* Get Media Type. */
 577         r5 = mca_read_stored_pos(tp->slot_num, 5);
 578         r5 &= CNFG_MEDIA_TYPE_MASK;
 579         switch(r5)
 580         {
 581                 case (0):
 582                         tp->media_type = MEDIA_STP_4;
 583                         break;
 584
 585                 case (1):
 586                         tp->media_type = MEDIA_STP_16;
 587                         break;
 588
 589                 case (3):
 590                         tp->media_type = MEDIA_UTP_16;
 591                         break;
 592
 593                 default:
 594                         tp->media_type = MEDIA_UTP_4;
 595                         break;
 596         }
 597         tp->media_menu = 14;
 598
 599         r2 = mca_read_stored_pos(tp->slot_num, 2);
 600         if(!(r2 & 0x02))
 601                 tp->mode_bits |= EARLY_TOKEN_REL;
 602
 603         /* Disable slot */
 604         outb(CNFG_POS_CONTROL_REG, 0);
 605
 606         tp->board_id = smctr_get_boardid(dev, 1);
 607         switch(tp->board_id & 0xffff)
 608         {
 609                 case WD8115TA:
 610                         smctr_model = "8115T/A";
 611                         break;
 612
 613                 case WD8115T:
 614                         if(tp->extra_info & CHIP_REV_MASK)
 615                                 smctr_model = "8115T rev XE";
 616                         else
 617                                 smctr_model = "8115T rev XD";
 618                         break;
 619
 620                 default:
 621                         smctr_model = "Unknown";
 622                         break;
 623         }
 624
 625         return (0);
 626 #else
 627         return (-1);
 628 #endif /* CONFIG_MCA_LEGACY */
 629 }
 630
 631 static int smctr_chg_rx_mask(struct net_device *dev)
 632 {
 633         struct net_local *tp = netdev_priv(dev);
 634         int err = 0;
 635
 636         if(smctr_debug > 10)
 637                 printk(KERN_DEBUG "%s: smctr_chg_rx_mask\n", dev->name);
 638
 639         smctr_enable_16bit(dev);
 640         smctr_set_page(dev, (__u8 *)tp->ram_access);
 641
 642         if(tp->mode_bits & LOOPING_MODE_MASK)
 643                 tp->config_word0 |= RX_OWN_BIT;
 644         else
 645                 tp->config_word0 &= ~RX_OWN_BIT;
 646
 647         if(tp->receive_mask & PROMISCUOUS_MODE)
 648                 tp->config_word0 |= PROMISCUOUS_BIT;
 649         else
 650                 tp->config_word0 &= ~PROMISCUOUS_BIT;
 651
 652         if(tp->receive_mask & ACCEPT_ERR_PACKETS)
 653                 tp->config_word0 |= SAVBAD_BIT;
 654         else
 655                 tp->config_word0 &= ~SAVBAD_BIT;
 656
 657         if(tp->receive_mask & ACCEPT_ATT_MAC_FRAMES)
 658                 tp->config_word0 |= RXATMAC;
 659         else
 660                 tp->config_word0 &= ~RXATMAC;
 661
 662         if(tp->receive_mask & ACCEPT_MULTI_PROM)
 663                 tp->config_word1 |= MULTICAST_ADDRESS_BIT;
 664         else
 665                 tp->config_word1 &= ~MULTICAST_ADDRESS_BIT;
 666
 667         if(tp->receive_mask & ACCEPT_SOURCE_ROUTING_SPANNING)
 668                 tp->config_word1 |= SOURCE_ROUTING_SPANNING_BITS;
 669         else
 670         {
 671                 if(tp->receive_mask & ACCEPT_SOURCE_ROUTING)
 672                         tp->config_word1 |= SOURCE_ROUTING_EXPLORER_BIT;
 673                 else
 674                         tp->config_word1 &= ~SOURCE_ROUTING_SPANNING_BITS;
 675         }
 676
 677         if((err = smctr_issue_write_word_cmd(dev, RW_CONFIG_REGISTER_0,
 678                 &tp->config_word0)))
 679         {
 680                 return (err);
 681         }
 682
 683         if((err = smctr_issue_write_word_cmd(dev, RW_CONFIG_REGISTER_1,
 684                 &tp->config_word1)))
 685         {
 686                 return (err);
 687         }
 688
 689         smctr_disable_16bit(dev);
 690
 691         return (0);
 692 }
 693
 694 static int smctr_clear_int(struct net_device *dev)
 695 {
 696         struct net_local *tp = netdev_priv(dev);
 697
 698         outb((tp->trc_mask | CSR_CLRTINT), dev->base_addr + CSR);
 699
 700         return (0);
 701 }
 702
 703 static int smctr_clear_trc_reset(int ioaddr)
 704 {
 705         __u8 r;
 706
 707         r = inb(ioaddr + MSR);
 708         outb(~MSR_RST & r, ioaddr + MSR);
 709
 710         return (0);
 711 }
 712
 713 /*
 714  * The inverse routine to smctr_open().
 715  */
 716 static int smctr_close(struct net_device *dev)
 717 {
 718         struct net_local *tp = netdev_priv(dev);
 719         struct sk_buff *skb;
 720         int err;
 721
 722         netif_stop_queue(dev);
 723
 724         tp->cleanup = 1;
 725
 726         /* Check to see if adapter is already in a closed state. */
 727         if(tp->status != OPEN)
 728                 return (0);
 729
 730         smctr_enable_16bit(dev);
 731         smctr_set_page(dev, (__u8 *)tp->ram_access);
 732
 733         if((err = smctr_issue_remove_cmd(dev)))
 734         {
 735                 smctr_disable_16bit(dev);
 736                 return (err);
 737         }
 738
 739         for(;;)
 740         {
 741                 skb = skb_dequeue(&tp->SendSkbQueue);
 742                 if(skb == NULL)
 743                         break;
 744                 tp->QueueSkb++;
 745                 dev_kfree_skb(skb);
 746         }
 747
 748
 749         return (0);
 750 }
 751
 752 static int smctr_decode_firmware(struct net_device *dev,
 753                                  const struct firmware *fw)
 754 {
 755         struct net_local *tp = netdev_priv(dev);
 756         short bit = 0x80, shift = 12;
 757         DECODE_TREE_NODE *tree;
 758         short branch, tsize;
 759         __u16 buff = 0;
 760         long weight;
 761         __u8 *ucode;
 762         __u16 *mem;
 763
 764         if(smctr_debug > 10)
 765                 printk(KERN_DEBUG "%s: smctr_decode_firmware\n", dev->name);
 766
 767         weight  = *(long *)(fw->data + WEIGHT_OFFSET);
 768         tsize   = *(__u8 *)(fw->data + TREE_SIZE_OFFSET);
 769         tree    = (DECODE_TREE_NODE *)(fw->data + TREE_OFFSET);
 770         ucode   = (__u8 *)(fw->data + TREE_OFFSET
 771                         + (tsize * sizeof(DECODE_TREE_NODE)));
 772         mem     = (__u16 *)(tp->ram_access);
 773
 774         while(weight)
 775         {
 776                 branch = ROOT;
 777                 while((tree + branch)->tag != LEAF && weight)
 778                 {
 779                         branch = *ucode & bit ? (tree + branch)->llink
 780                                 : (tree + branch)->rlink;
 781
 782                         bit >>= 1;
 783                         weight--;
 784
 785                         if(bit == 0)
 786                         {
 787                                 bit = 0x80;
 788                                 ucode++;
 789                         }
 790                 }
 791
 792                 buff |= (tree + branch)->info << shift;
 793                 shift -= 4;
 794
 795                 if(shift < 0)
 796                 {
 797                         *(mem++) = SWAP_BYTES(buff);
 798                         buff    = 0;
 799                         shift   = 12;
 800                 }
 801         }
 802
 803         /* The following assumes the Control Store Memory has
 804          * been initialized to zero. If the last partial word
 805          * is zero, it will not be written.
 806          */
 807         if(buff)
 808                 *(mem++) = SWAP_BYTES(buff);
 809
 810         return (0);
 811 }
 812
 813 static int smctr_disable_16bit(struct net_device *dev)
 814 {
 815         return (0);
 816 }
 817
 818 /*
 819  * On Exit, Adapter is:
 820  * 1. TRC is in a reset state and un-initialized.
 821  * 2. Adapter memory is enabled.
 822  * 3. Control Store memory is out of context (-WCSS is 1).
 823  */
 824 static int smctr_disable_adapter_ctrl_store(struct net_device *dev)
 825 {
 826         struct net_local *tp = netdev_priv(dev);
 827         int ioaddr = dev->base_addr;
 828
 829         if(smctr_debug > 10)
 830                 printk(KERN_DEBUG "%s: smctr_disable_adapter_ctrl_store\n", dev->name);
 831
 832         tp->trc_mask |= CSR_WCSS;
 833         outb(tp->trc_mask, ioaddr + CSR);
 834
 835         return (0);
 836 }
 837
 838 static int smctr_disable_bic_int(struct net_device *dev)
 839 {
 840         struct net_local *tp = netdev_priv(dev);
 841         int ioaddr = dev->base_addr;
 842
 843         tp->trc_mask = CSR_MSK_ALL | CSR_MSKCBUSY
 844                 | CSR_MSKTINT | CSR_WCSS;
 845         outb(tp->trc_mask, ioaddr + CSR);
 846
 847         return (0);
 848 }
 849
 850 static int smctr_enable_16bit(struct net_device *dev)
 851 {
 852         struct net_local *tp = netdev_priv(dev);
 853         __u8    r;
 854
 855         if(tp->adapter_bus == BUS_ISA16_TYPE)
 856         {
 857                 r = inb(dev->base_addr + LAAR);
 858                 outb((r | LAAR_MEM16ENB), dev->base_addr + LAAR);
 859         }
 860
 861         return (0);
 862 }
 863
 864 /*
 865  * To enable the adapter control store memory:
 866  * 1. Adapter must be in a RESET state.
 867  * 2. Adapter memory must be enabled.
 868  * 3. Control Store Memory is in context (-WCSS is 0).
 869  */
 870 static int smctr_enable_adapter_ctrl_store(struct net_device *dev)
 871 {
 872         struct net_local *tp = netdev_priv(dev);
 873         int ioaddr = dev->base_addr;
 874
 875         if(smctr_debug > 10)
 876                 printk(KERN_DEBUG "%s: smctr_enable_adapter_ctrl_store\n", dev->name);
 877
 878         smctr_set_trc_reset(ioaddr);
 879         smctr_enable_adapter_ram(dev);
 880
 881         tp->trc_mask &= ~CSR_WCSS;
 882         outb(tp->trc_mask, ioaddr + CSR);
 883
 884         return (0);
 885 }
 886
 887 static int smctr_enable_adapter_ram(struct net_device *dev)
 888 {
 889         int ioaddr = dev->base_addr;
 890         __u8 r;
 891
 892         if(smctr_debug > 10)
 893                 printk(KERN_DEBUG "%s: smctr_enable_adapter_ram\n", dev->name);
 894
 895         r = inb(ioaddr + MSR);
 896         outb(MSR_MEMB | r, ioaddr + MSR);
 897
 898         return (0);
 899 }
 900
 901 static int smctr_enable_bic_int(struct net_device *dev)
 902 {
 903         struct net_local *tp = netdev_priv(dev);
 904         int ioaddr = dev->base_addr;
 905         __u8 r;
 906
 907         switch(tp->bic_type)
 908         {
 909                 case (BIC_584_CHIP):
 910                         tp->trc_mask = CSR_MSKCBUSY | CSR_WCSS;
 911                         outb(tp->trc_mask, ioaddr + CSR);
 912                         r = inb(ioaddr + IRR);
 913                         outb(r | IRR_IEN, ioaddr + IRR);
 914                         break;
 915
 916                 case (BIC_594_CHIP):
 917                         tp->trc_mask = CSR_MSKCBUSY | CSR_WCSS;
 918                         outb(tp->trc_mask, ioaddr + CSR);
 919                         r = inb(ioaddr + IMCCR);
 920                         outb(r | IMCCR_EIL, ioaddr + IMCCR);
 921                         break;
 922         }
 923
 924         return (0);
 925 }
 926
 927 static int __init smctr_chk_isa(struct net_device *dev)
 928 {
 929         struct net_local *tp = netdev_priv(dev);
 930         int ioaddr = dev->base_addr;
 931         __u8 r1, r2, b, chksum = 0;
 932         __u16 r;
 933         int i;
 934         int err = -ENODEV;
 935
 936         if(smctr_debug > 10)
 937                 printk(KERN_DEBUG "%s: smctr_chk_isa %#4x\n", dev->name, ioaddr);
 938
 939         if((ioaddr & 0x1F) != 0)
 940                 goto out;
 941
 942         /* Grab the region so that no one else tries to probe our ioports. */
 943         if (!request_region(ioaddr, SMCTR_IO_EXTENT, smctr_name)) {
 944                 err = -EBUSY;
 945                 goto out;
 946         }
 947
 948         /* Checksum SMC node address */
 949         for(i = 0; i < 8; i++)
 950         {
 951                 b = inb(ioaddr + LAR0 + i);
 952                 chksum += b;
 953         }
 954
 955         if (chksum != NODE_ADDR_CKSUM)
 956                 goto out2;
 957
 958         b = inb(ioaddr + BDID);
 959         if(b != BRD_ID_8115T)
 960         {
 961                 printk(KERN_ERR "%s: The adapter found is not supported\n", dev->name);
 962                 goto out2;
 963         }
 964
 965         /* Check for 8115T Board ID */
 966         r2 = 0;
 967         for(r = 0; r < 8; r++)
 968         {
 969             r1 = inb(ioaddr + 0x8 + r);
 970             r2 += r1;
 971         }
 972
 973         /* value of RegF adds up the sum to 0xFF */
 974         if((r2 != 0xFF) && (r2 != 0xEE))
 975                 goto out2;
 976
 977         /* Get adapter ID */
 978         tp->board_id = smctr_get_boardid(dev, 0);
 979         switch(tp->board_id & 0xffff)
 980         {
 981                 case WD8115TA:
 982                         smctr_model = "8115T/A";
 983                         break;
 984
 985                 case WD8115T:
 986                         if(tp->extra_info & CHIP_REV_MASK)
 987                                 smctr_model = "8115T rev XE";
 988                         else
 989                                 smctr_model = "8115T rev XD";
 990                         break;
 991
 992                 default:
 993                         smctr_model = "Unknown";
 994                         break;
 995         }
 996
 997         /* Store BIC type. */
 998         tp->bic_type = BIC_584_CHIP;
 999         tp->nic_type = NIC_825_CHIP;
1000
1001         /* Copy Ram Size */
1002         tp->ram_usable  = CNFG_SIZE_16KB;
1003         tp->ram_size    = CNFG_SIZE_64KB;
1004
1005         /* Get 58x Ram Base */
1006         r1 = inb(ioaddr);
1007         r1 &= 0x3F;
1008
1009         r2 = inb(ioaddr + CNFG_LAAR_584);
1010         r2 &= CNFG_LAAR_MASK;
1011         r2 <<= 3;
1012         r2 |= ((r1 & 0x38) >> 3);
1013
1014         tp->ram_base = ((__u32)r2 << 16) + (((__u32)(r1 & 0x7)) << 13);
1015
1016         /* Get 584 Irq */
1017         r1 = 0;
1018         r1 = inb(ioaddr + CNFG_ICR_583);
1019         r1 &= CNFG_ICR_IR2_584;
1020
1021         r2 = inb(ioaddr + CNFG_IRR_583);
1022         r2 &= CNFG_IRR_IRQS;     /* 0x60 */
1023         r2 >>= 5;
1024
1025         switch(r2)
1026         {
1027                 case 0:
1028                         if(r1 == 0)
1029                                 dev->irq = 2;
1030                         else
1031                                 dev->irq = 10;
1032                         break;
1033
1034                 case 1:
1035                         if(r1 == 0)
1036                                 dev->irq = 3;
1037                         else
1038                                 dev->irq = 11;
1039                         break;
1040
1041                 case 2:
1042                         if(r1 == 0)
1043                         {
1044                                 if(tp->extra_info & ALTERNATE_IRQ_BIT)
1045                                         dev->irq = 5;
1046                                 else
1047                                         dev->irq = 4;
1048                         }
1049                         else
1050                                 dev->irq = 15;
1051                         break;
1052
1053                 case 3:
1054                         if(r1 == 0)
1055                                 dev->irq = 7;
1056                         else
1057                                 dev->irq = 4;
1058                         break;
1059
1060                 default:
1061                         printk(KERN_ERR "%s: No IRQ found aborting\n", dev->name);
1062                         goto out2;
1063          }
1064
1065         if (request_irq(dev->irq, smctr_interrupt, IRQF_SHARED, smctr_name, dev))
1066                 goto out2;
1067
1068         /* Get 58x Rom Base */
1069         r1 = inb(ioaddr + CNFG_BIO_583);
1070         r1 &= 0x3E;
1071         r1 |= 0x40;
1072
1073         tp->rom_base = (__u32)r1 << 13;
1074
1075         /* Get 58x Rom Size */
1076         r1 = inb(ioaddr + CNFG_BIO_583);
1077         r1 &= 0xC0;
1078         if(r1 == 0)
1079                 tp->rom_size = ROM_DISABLE;
1080         else
1081         {
1082                 r1 >>= 6;
1083                 tp->rom_size = (__u16)CNFG_SIZE_8KB << r1;
1084         }
1085
1086         /* Get 58x Boot Status */
1087         r1 = inb(ioaddr + CNFG_GP2);
1088
1089         tp->mode_bits &= (~BOOT_STATUS_MASK);
1090
1091         if(r1 & CNFG_GP2_BOOT_NIBBLE)
1092                 tp->mode_bits |= BOOT_TYPE_1;
1093
1094         /* Get 58x Zero Wait State */
1095         tp->mode_bits &= (~ZERO_WAIT_STATE_MASK);
1096
1097         r1 = inb(ioaddr + CNFG_IRR_583);
1098
1099         if(r1 & CNFG_IRR_ZWS)
1100                  tp->mode_bits |= ZERO_WAIT_STATE_8_BIT;
1101
1102         if(tp->board_id & BOARD_16BIT)
1103         {
1104                 r1 = inb(ioaddr + CNFG_LAAR_584);
1105
1106                 if(r1 & CNFG_LAAR_ZWS)
1107                         tp->mode_bits |= ZERO_WAIT_STATE_16_BIT;
1108         }
1109
1110         /* Get 584 Media Menu */
1111         tp->media_menu = 14;
1112         r1 = inb(ioaddr + CNFG_IRR_583);
1113
1114         tp->mode_bits &= 0xf8ff;       /* (~CNFG_INTERFACE_TYPE_MASK) */
1115         if((tp->board_id & TOKEN_MEDIA) == TOKEN_MEDIA)
1116         {
1117                 /* Get Advanced Features */
1118                 if(((r1 & 0x6) >> 1) == 0x3)
1119                         tp->media_type |= MEDIA_UTP_16;
1120                 else
1121                 {
1122                         if(((r1 & 0x6) >> 1) == 0x2)
1123                                 tp->media_type |= MEDIA_STP_16;
1124                         else
1125                         {
1126                                 if(((r1 & 0x6) >> 1) == 0x1)
1127                                         tp->media_type |= MEDIA_UTP_4;
1128
1129                                 else
1130                                         tp->media_type |= MEDIA_STP_4;
1131                         }
1132                 }
1133
1134                 r1 = inb(ioaddr + CNFG_GP2);
1135                 if(!(r1 & 0x2) )           /* GP2_ETRD */
1136                         tp->mode_bits |= EARLY_TOKEN_REL;
1137
1138                 /* see if the chip is corrupted
1139                 if(smctr_read_584_chksum(ioaddr))
1140                 {
1141                         printk(KERN_ERR "%s: EEPROM Checksum Failure\n", dev->name);
1142                         free_irq(dev->irq, dev);
1143                         goto out2;
1144                 }
1145                 */
1146         }
1147
1148         return (0);
1149
1150 out2:
1151         release_region(ioaddr, SMCTR_IO_EXTENT);
1152 out:
1153         return err;
1154 }
1155
1156 static int __init smctr_get_boardid(struct net_device *dev, int mca)
1157 {
1158         struct net_local *tp = netdev_priv(dev);
1159         int ioaddr = dev->base_addr;
1160         __u8 r, r1, IdByte;
1161         __u16 BoardIdMask;
1162
1163         tp->board_id = BoardIdMask = 0;
1164
1165         if(mca)
1166         {
1167                 BoardIdMask |= (MICROCHANNEL+INTERFACE_CHIP+TOKEN_MEDIA+PAGED_RAM+BOARD_16BIT);
1168                 tp->extra_info |= (INTERFACE_594_CHIP+RAM_SIZE_64K+NIC_825_BIT+ALTERNATE_IRQ_BIT+SLOT_16BIT);
1169         }
1170         else
1171         {
1172                 BoardIdMask|=(INTERFACE_CHIP+TOKEN_MEDIA+PAGED_RAM+BOARD_16BIT);
1173                 tp->extra_info |= (INTERFACE_584_CHIP + RAM_SIZE_64K
1174                         + NIC_825_BIT + ALTERNATE_IRQ_BIT);
1175         }
1176
1177         if(!mca)
1178         {
1179                 r = inb(ioaddr + BID_REG_1);
1180                 r &= 0x0c;
1181                 outb(r, ioaddr + BID_REG_1);
1182                 r = inb(ioaddr + BID_REG_1);
1183
1184                 if(r & BID_SIXTEEN_BIT_BIT)
1185                 {
1186                         tp->extra_info |= SLOT_16BIT;
1187                         tp->adapter_bus = BUS_ISA16_TYPE;
1188                 }
1189                 else
1190                         tp->adapter_bus = BUS_ISA8_TYPE;
1191         }
1192         else
1193                 tp->adapter_bus = BUS_MCA_TYPE;
1194
1195         /* Get Board Id Byte */
1196         IdByte = inb(ioaddr + BID_BOARD_ID_BYTE);
1197
1198         /* if Major version > 1.0 then
1199          *      return;
1200          */
1201         if(IdByte & 0xF8)
1202                 return (-1);
1203
1204         r1 = inb(ioaddr + BID_REG_1);
1205         r1 &= BID_ICR_MASK;
1206         r1 |= BID_OTHER_BIT;
1207
1208         outb(r1, ioaddr + BID_REG_1);
1209         r1 = inb(ioaddr + BID_REG_3);
1210
1211         r1 &= BID_EAR_MASK;
1212         r1 |= BID_ENGR_PAGE;
1213
1214         outb(r1, ioaddr + BID_REG_3);
1215         r1 = inb(ioaddr + BID_REG_1);
1216         r1 &= BID_ICR_MASK;
1217         r1 |= (BID_RLA | BID_OTHER_BIT);
1218
1219         outb(r1, ioaddr + BID_REG_1);
1220
1221         r1 = inb(ioaddr + BID_REG_1);
1222         while(r1 & BID_RECALL_DONE_MASK)
1223                 r1 = inb(ioaddr + BID_REG_1);
1224
1225         r = inb(ioaddr + BID_LAR_0 + BID_REG_6);
1226
1227         /* clear chip rev bits */
1228         tp->extra_info &= ~CHIP_REV_MASK;
1229         tp->extra_info |= ((r & BID_EEPROM_CHIP_REV_MASK) << 6);
1230
1231         r1 = inb(ioaddr + BID_REG_1);
1232         r1 &= BID_ICR_MASK;
1233         r1 |= BID_OTHER_BIT;
1234
1235         outb(r1, ioaddr + BID_REG_1);
1236         r1 = inb(ioaddr + BID_REG_3);
1237
1238         r1 &= BID_EAR_MASK;
1239         r1 |= BID_EA6;
1240
1241         outb(r1, ioaddr + BID_REG_3);
1242         r1 = inb(ioaddr + BID_REG_1);
1243
1244         r1 &= BID_ICR_MASK;
1245         r1 |= BID_RLA;
1246
1247         outb(r1, ioaddr + BID_REG_1);
1248         r1 = inb(ioaddr + BID_REG_1);
1249
1250         while(r1 & BID_RECALL_DONE_MASK)
1251                 r1 = inb(ioaddr + BID_REG_1);
1252
1253         return (BoardIdMask);
1254 }
1255
1256 static int smctr_get_group_address(struct net_device *dev)
1257 {
1258         smctr_issue_read_word_cmd(dev, RW_INDIVIDUAL_GROUP_ADDR);
1259
1260         return(smctr_wait_cmd(dev));
1261 }
1262
1263 static int smctr_get_functional_address(struct net_device *dev)
1264 {
1265         smctr_issue_read_word_cmd(dev, RW_FUNCTIONAL_ADDR);
1266
1267         return(smctr_wait_cmd(dev));
1268 }
1269
1270 /* Calculate number of Non-MAC receive BDB's and data buffers.
1271  * This function must simulate allocateing shared memory exactly
1272  * as the allocate_shared_memory function above.
1273  */
1274 static unsigned int smctr_get_num_rx_bdbs(struct net_device *dev)
1275 {
1276         struct net_local *tp = netdev_priv(dev);
1277         unsigned int mem_used = 0;
1278
1279         /* Allocate System Control Blocks. */
1280         mem_used += sizeof(SCGBlock);
1281
1282         mem_used += TO_PARAGRAPH_BOUNDRY(mem_used);
1283         mem_used += sizeof(SCLBlock);
1284
1285         mem_used += TO_PARAGRAPH_BOUNDRY(mem_used);
1286         mem_used += sizeof(ACBlock) * tp->num_acbs;
1287
1288         mem_used += TO_PARAGRAPH_BOUNDRY(mem_used);
1289         mem_used += sizeof(ISBlock);
1290
1291         mem_used += TO_PARAGRAPH_BOUNDRY(mem_used);
1292         mem_used += MISC_DATA_SIZE;
1293
1294         /* Allocate transmit FCB's. */
1295         mem_used += TO_PARAGRAPH_BOUNDRY(mem_used);
1296
1297         mem_used += sizeof(FCBlock) * tp->num_tx_fcbs[MAC_QUEUE];
1298         mem_used += sizeof(FCBlock) * tp->num_tx_fcbs[NON_MAC_QUEUE];
1299         mem_used += sizeof(FCBlock) * tp->num_tx_fcbs[BUG_QUEUE];
1300
1301         /* Allocate transmit BDBs. */
1302         mem_used += sizeof(BDBlock) * tp->num_tx_bdbs[MAC_QUEUE];
1303         mem_used += sizeof(BDBlock) * tp->num_tx_bdbs[NON_MAC_QUEUE];
1304         mem_used += sizeof(BDBlock) * tp->num_tx_bdbs[BUG_QUEUE];
1305
1306         /* Allocate receive FCBs. */
1307         mem_used += sizeof(FCBlock) * tp->num_rx_fcbs[MAC_QUEUE];
1308         mem_used += sizeof(FCBlock) * tp->num_rx_fcbs[NON_MAC_QUEUE];
1309
1310         /* Allocate receive BDBs. */
1311         mem_used += sizeof(BDBlock) * tp->num_rx_bdbs[MAC_QUEUE];
1312
1313         /* Allocate MAC transmit buffers.
1314          * MAC transmit buffers don't have to be on an ODD Boundry.
1315          */
1316         mem_used += tp->tx_buff_size[MAC_QUEUE];
1317
1318         /* Allocate BUG transmit buffers. */
1319         mem_used += tp->tx_buff_size[BUG_QUEUE];
1320
1321         /* Allocate MAC receive data buffers.
1322          * MAC receive buffers don't have to be on a 256 byte boundary.
1323          */
1324         mem_used += RX_DATA_BUFFER_SIZE * tp->num_rx_bdbs[MAC_QUEUE];
1325
1326         /* Allocate Non-MAC transmit buffers.
1327          * For maximum Netware performance, put Tx Buffers on
1328          * ODD Boundry,and then restore malloc to Even Boundrys.
1329          */
1330         mem_used += 1L;
1331         mem_used += tp->tx_buff_size[NON_MAC_QUEUE];
1332         mem_used += 1L;
1333
1334         /* CALCULATE NUMBER OF NON-MAC RX BDB'S
1335          * AND NON-MAC RX DATA BUFFERS
1336          *
1337          * Make sure the mem_used offset at this point is the
1338          * same as in allocate_shared memory or the following
1339          * boundary adjustment will be incorrect (i.e. not allocating
1340          * the non-mac receive buffers above cannot change the 256
1341          * byte offset).
1342          *
1343          * Since this cannot be guaranteed, adding the full 256 bytes
1344          * to the amount of shared memory used at this point will guaranteed
1345          * that the rx data buffers do not overflow shared memory.
1346          */
1347         mem_used += 0x100;
1348
1349         return((0xffff - mem_used) / (RX_DATA_BUFFER_SIZE + sizeof(BDBlock)));
1350 }
1351
1352 static int smctr_get_physical_drop_number(struct net_device *dev)
1353 {
1354         smctr_issue_read_word_cmd(dev, RW_PHYSICAL_DROP_NUMBER);
1355
1356         return(smctr_wait_cmd(dev));
1357 }
1358
1359 static __u8 * smctr_get_rx_pointer(struct net_device *dev, short queue)
1360 {
1361         struct net_local *tp = netdev_priv(dev);
1362         BDBlock *bdb;
1363
1364         bdb = (BDBlock *)((__u32)tp->ram_access
1365                 + (__u32)(tp->rx_fcb_curr[queue]->trc_bdb_ptr));
1366
1367         tp->rx_fcb_curr[queue]->bdb_ptr = bdb;
1368
1369         return ((__u8 *)bdb->data_block_ptr);
1370 }
1371
1372 static int smctr_get_station_id(struct net_device *dev)
1373 {
1374         smctr_issue_read_word_cmd(dev, RW_INDIVIDUAL_MAC_ADDRESS);
1375
1376         return(smctr_wait_cmd(dev));
1377 }
1378
1379 /*
1380  * Get the current statistics. This may be called with the card open
1381  * or closed.
1382  */
1383 static struct net_device_stats *smctr_get_stats(struct net_device *dev)
1384 {
1385         struct net_local *tp = netdev_priv(dev);
1386
1387         return ((struct net_device_stats *)&tp->MacStat);
1388 }
1389
1390 static FCBlock *smctr_get_tx_fcb(struct net_device *dev, __u16 queue,
1391         __u16 bytes_count)
1392 {
1393         struct net_local *tp = netdev_priv(dev);
1394         FCBlock *pFCB;
1395         BDBlock *pbdb;
1396         unsigned short alloc_size;
1397         unsigned short *temp;
1398
1399         if(smctr_debug > 20)
1400                 printk(KERN_DEBUG "smctr_get_tx_fcb\n");
1401
1402         /* check if there is enough FCB blocks */
1403         if(tp->num_tx_fcbs_used[queue] >= tp->num_tx_fcbs[queue])
1404                 return ((FCBlock *)(-1L));
1405
1406         /* round off the input pkt size to the nearest even number */
1407         alloc_size = (bytes_count + 1) & 0xfffe;
1408
1409         /* check if enough mem */
1410         if((tp->tx_buff_used[queue] + alloc_size) > tp->tx_buff_size[queue])
1411                 return ((FCBlock *)(-1L));
1412
1413         /* check if past the end ;
1414          * if exactly enough mem to end of ring, alloc from front.
1415          * this avoids update of curr when curr = end
1416          */
1417         if(((unsigned long)(tp->tx_buff_curr[queue]) + alloc_size)
1418                 >= (unsigned long)(tp->tx_buff_end[queue]))
1419         {
1420                 /* check if enough memory from ring head */
1421                 alloc_size = alloc_size +
1422                         (__u16)((__u32)tp->tx_buff_end[queue]
1423                         - (__u32)tp->tx_buff_curr[queue]);
1424
1425                 if((tp->tx_buff_used[queue] + alloc_size)
1426                         > tp->tx_buff_size[queue])
1427                 {
1428                         return ((FCBlock *)(-1L));
1429                 }
1430
1431                 /* ring wrap */
1432                 tp->tx_buff_curr[queue] = tp->tx_buff_head[queue];
1433         }
1434
1435         tp->tx_buff_used[queue] += alloc_size;
1436         tp->num_tx_fcbs_used[queue]++;
1437         tp->tx_fcb_curr[queue]->frame_length = bytes_count;
1438         tp->tx_fcb_curr[queue]->memory_alloc = alloc_size;
1439         temp = tp->tx_buff_curr[queue];
1440         tp->tx_buff_curr[queue]
1441                 = (__u16 *)((__u32)temp + (__u32)((bytes_count + 1) & 0xfffe));
1442
1443         pbdb = tp->tx_fcb_curr[queue]->bdb_ptr;
1444         pbdb->buffer_length = bytes_count;
1445         pbdb->data_block_ptr = temp;
1446         pbdb->trc_data_block_ptr = TRC_POINTER(temp);
1447
1448         pFCB = tp->tx_fcb_curr[queue];
1449         tp->tx_fcb_curr[queue] = tp->tx_fcb_curr[queue]->next_ptr;
1450
1451         return (pFCB);
1452 }
1453
1454 static int smctr_get_upstream_neighbor_addr(struct net_device *dev)
1455 {
1456         smctr_issue_read_word_cmd(dev, RW_UPSTREAM_NEIGHBOR_ADDRESS);
1457
1458         return(smctr_wait_cmd(dev));
1459 }
1460
1461 static int smctr_hardware_send_packet(struct net_device *dev,
1462         struct net_local *tp)
1463 {
1464         struct tr_statistics *tstat = &tp->MacStat;
1465         struct sk_buff *skb;
1466         FCBlock *fcb;
1467
1468         if(smctr_debug > 10)
1469                 printk(KERN_DEBUG"%s: smctr_hardware_send_packet\n", dev->name);
1470
1471         if(tp->status != OPEN)
1472                 return (-1);
1473
1474         if(tp->monitor_state_ready != 1)
1475                 return (-1);
1476
1477         for(;;)
1478         {
1479                 /* Send first buffer from queue */
1480                 skb = skb_dequeue(&tp->SendSkbQueue);
1481                 if(skb == NULL)
1482                         return (-1);
1483
1484                 tp->QueueSkb++;
1485
1486                 if(skb->len < SMC_HEADER_SIZE || skb->len > tp->max_packet_size)                        return (-1);
1487
1488                 smctr_enable_16bit(dev);
1489                 smctr_set_page(dev, (__u8 *)tp->ram_access);
1490
1491                 if((fcb = smctr_get_tx_fcb(dev, NON_MAC_QUEUE, skb->len))
1492                         == (FCBlock *)(-1L))
1493                 {
1494                         smctr_disable_16bit(dev);
1495                         return (-1);
1496                 }
1497
1498                 smctr_tx_move_frame(dev, skb,
1499                         (__u8 *)fcb->bdb_ptr->data_block_ptr, skb->len);
1500
1501                 smctr_set_page(dev, (__u8 *)fcb);
1502
1503                 smctr_trc_send_packet(dev, fcb, NON_MAC_QUEUE);
1504                 dev_kfree_skb(skb);
1505
1506                 tstat->tx_packets++;
1507
1508                 smctr_disable_16bit(dev);
1509         }
1510
1511         return (0);
1512 }
1513
1514 static int smctr_init_acbs(struct net_device *dev)
1515 {
1516         struct net_local *tp = netdev_priv(dev);
1517         unsigned int i;
1518         ACBlock *acb;
1519
1520         if(smctr_debug > 10)
1521                 printk(KERN_DEBUG "%s: smctr_init_acbs\n", dev->name);
1522
1523         acb                     = tp->acb_head;
1524         acb->cmd_done_status    = (ACB_COMMAND_DONE | ACB_COMMAND_SUCCESSFUL);
1525         acb->cmd_info           = ACB_CHAIN_END;
1526         acb->cmd                = 0;
1527         acb->subcmd             = 0;
1528         acb->data_offset_lo     = 0;
1529         acb->data_offset_hi     = 0;
1530         acb->next_ptr
1531                 = (ACBlock *)(((char *)acb) + sizeof(ACBlock));
1532         acb->trc_next_ptr       = TRC_POINTER(acb->next_ptr);
1533
1534         for(i = 1; i < tp->num_acbs; i++)
1535         {
1536                 acb             = acb->next_ptr;
1537                 acb->cmd_done_status
1538                         = (ACB_COMMAND_DONE | ACB_COMMAND_SUCCESSFUL);
1539                 acb->cmd_info = ACB_CHAIN_END;
1540                 acb->cmd        = 0;
1541                 acb->subcmd     = 0;
1542                 acb->data_offset_lo = 0;
1543                 acb->data_offset_hi = 0;
1544                 acb->next_ptr
1545                         = (ACBlock *)(((char *)acb) + sizeof(ACBlock));
1546                 acb->trc_next_ptr = TRC_POINTER(acb->next_ptr);
1547         }
1548
1549         acb->next_ptr           = tp->acb_head;
1550         acb->trc_next_ptr       = TRC_POINTER(tp->acb_head);
1551         tp->acb_next            = tp->acb_head->next_ptr;
1552         tp->acb_curr            = tp->acb_head->next_ptr;
1553         tp->num_acbs_used       = 0;
1554
1555         return (0);
1556 }
1557
1558 static int smctr_init_adapter(struct net_device *dev)
1559 {
1560         struct net_local *tp = netdev_priv(dev);
1561         int err;
1562
1563         if(smctr_debug > 10)
1564                 printk(KERN_DEBUG "%s: smctr_init_adapter\n", dev->name);
1565
1566         tp->status              = CLOSED;
1567         tp->page_offset_mask    = (tp->ram_usable * 1024) - 1;
1568         skb_queue_head_init(&tp->SendSkbQueue);
1569         tp->QueueSkb = MAX_TX_QUEUE;
1570
1571         if(!(tp->group_address_0 & 0x0080))
1572                 tp->group_address_0 |= 0x00C0;
1573
1574         if(!(tp->functional_address_0 & 0x00C0))
1575                 tp->functional_address_0 |= 0x00C0;
1576
1577         tp->functional_address[0] &= 0xFF7F;
1578
1579         if(tp->authorized_function_classes == 0)
1580                 tp->authorized_function_classes = 0x7FFF;
1581
1582         if(tp->authorized_access_priority == 0)
1583                 tp->authorized_access_priority = 0x06;
1584
1585         smctr_disable_bic_int(dev);
1586         smctr_set_trc_reset(dev->base_addr);
1587
1588         smctr_enable_16bit(dev);
1589         smctr_set_page(dev, (__u8 *)tp->ram_access);
1590
1591         if(smctr_checksum_firmware(dev))
1592         {
1593                 printk(KERN_ERR "%s: Previously loaded firmware is missing\n",dev->name);                return (-ENOENT);
1594         }
1595
1596         if((err = smctr_ram_memory_test(dev)))
1597         {
1598                 printk(KERN_ERR "%s: RAM memory test failed.\n", dev->name);
1599                 return (-EIO);
1600         }
1601
1602         smctr_set_rx_look_ahead(dev);
1603         smctr_load_node_addr(dev);
1604
1605         /* Initialize adapter for Internal Self Test. */
1606         smctr_reset_adapter(dev);
1607         if((err = smctr_init_card_real(dev)))
1608         {
1609                 printk(KERN_ERR "%s: Initialization of card failed (%d)\n",
1610                         dev->name, err);
1611                 return (-EINVAL);
1612         }
1613
1614         /* This routine clobbers the TRC's internal registers. */
1615         if((err = smctr_internal_self_test(dev)))
1616         {
1617                 printk(KERN_ERR "%s: Card failed internal self test (%d)\n",
1618                         dev->name, err);
1619                 return (-EINVAL);
1620         }
1621
1622         /* Re-Initialize adapter's internal registers */
1623         smctr_reset_adapter(dev);
1624         if((err = smctr_init_card_real(dev)))
1625         {
1626                 printk(KERN_ERR "%s: Initialization of card failed (%d)\n",
1627                         dev->name, err);
1628                 return (-EINVAL);
1629         }
1630
1631         smctr_enable_bic_int(dev);
1632
1633         if((err = smctr_issue_enable_int_cmd(dev, TRC_INTERRUPT_ENABLE_MASK)))
1634                 return (err);
1635
1636         smctr_disable_16bit(dev);
1637
1638         return (0);
1639 }
1640
1641 static int smctr_init_card_real(struct net_device *dev)
1642 {
1643         struct net_local *tp = netdev_priv(dev);
1644         int err = 0;
1645
1646         if(smctr_debug > 10)
1647                 printk(KERN_DEBUG "%s: smctr_init_card_real\n", dev->name);
1648
1649         tp->sh_mem_used = 0;
1650         tp->num_acbs    = NUM_OF_ACBS;
1651
1652         /* Range Check Max Packet Size */
1653         if(tp->max_packet_size < 256)
1654                 tp->max_packet_size = 256;
1655         else
1656         {
1657                 if(tp->max_packet_size > NON_MAC_TX_BUFFER_MEMORY)
1658                         tp->max_packet_size = NON_MAC_TX_BUFFER_MEMORY;
1659         }
1660
1661         tp->num_of_tx_buffs = (NON_MAC_TX_BUFFER_MEMORY
1662                 / tp->max_packet_size) - 1;
1663
1664         if(tp->num_of_tx_buffs > NUM_NON_MAC_TX_FCBS)
1665                 tp->num_of_tx_buffs = NUM_NON_MAC_TX_FCBS;
1666         else
1667         {
1668                 if(tp->num_of_tx_buffs == 0)
1669                         tp->num_of_tx_buffs = 1;
1670         }
1671
1672         /* Tx queue constants */
1673         tp->num_tx_fcbs        [BUG_QUEUE]     = NUM_BUG_TX_FCBS;
1674         tp->num_tx_bdbs        [BUG_QUEUE]     = NUM_BUG_TX_BDBS;
1675         tp->tx_buff_size       [BUG_QUEUE]     = BUG_TX_BUFFER_MEMORY;
1676         tp->tx_buff_used       [BUG_QUEUE]     = 0;
1677         tp->tx_queue_status    [BUG_QUEUE]     = NOT_TRANSMITING;
1678
1679         tp->num_tx_fcbs        [MAC_QUEUE]     = NUM_MAC_TX_FCBS;
1680         tp->num_tx_bdbs        [MAC_QUEUE]     = NUM_MAC_TX_BDBS;
1681         tp->tx_buff_size       [MAC_QUEUE]     = MAC_TX_BUFFER_MEMORY;
1682         tp->tx_buff_used       [MAC_QUEUE]     = 0;
1683         tp->tx_queue_status    [MAC_QUEUE]     = NOT_TRANSMITING;
1684
1685         tp->num_tx_fcbs        [NON_MAC_QUEUE] = NUM_NON_MAC_TX_FCBS;
1686         tp->num_tx_bdbs        [NON_MAC_QUEUE] = NUM_NON_MAC_TX_BDBS;
1687         tp->tx_buff_size       [NON_MAC_QUEUE] = NON_MAC_TX_BUFFER_MEMORY;
1688         tp->tx_buff_used       [NON_MAC_QUEUE] = 0;
1689         tp->tx_queue_status    [NON_MAC_QUEUE] = NOT_TRANSMITING;
1690
1691         /* Receive Queue Constants */
1692         tp->num_rx_fcbs[MAC_QUEUE] = NUM_MAC_RX_FCBS;
1693         tp->num_rx_bdbs[MAC_QUEUE] = NUM_MAC_RX_BDBS;
1694
1695         if(tp->extra_info & CHIP_REV_MASK)
1696                 tp->num_rx_fcbs[NON_MAC_QUEUE] = 78;    /* 825 Rev. XE */
1697         else
1698                 tp->num_rx_fcbs[NON_MAC_QUEUE] = 7;     /* 825 Rev. XD */
1699
1700         tp->num_rx_bdbs[NON_MAC_QUEUE] = smctr_get_num_rx_bdbs(dev);
1701
1702         smctr_alloc_shared_memory(dev);
1703         smctr_init_shared_memory(dev);
1704
1705         if((err = smctr_issue_init_timers_cmd(dev)))
1706                 return (err);
1707
1708         if((err = smctr_issue_init_txrx_cmd(dev)))
1709         {
1710                 printk(KERN_ERR "%s: Hardware failure\n", dev->name);
1711                 return (err);
1712         }
1713
1714         return (0);
1715 }
1716
1717 static int smctr_init_rx_bdbs(struct net_device *dev)
1718 {
1719         struct net_local *tp = netdev_priv(dev);
1720         unsigned int i, j;
1721         BDBlock *bdb;
1722         __u16 *buf;
1723
1724         if(smctr_debug > 10)
1725                 printk(KERN_DEBUG "%s: smctr_init_rx_bdbs\n", dev->name);
1726
1727         for(i = 0; i < NUM_RX_QS_USED; i++)
1728         {
1729                 bdb = tp->rx_bdb_head[i];
1730                 buf = tp->rx_buff_head[i];
1731                 bdb->info = (BDB_CHAIN_END | BDB_NO_WARNING);
1732                 bdb->buffer_length = RX_DATA_BUFFER_SIZE;
1733                 bdb->next_ptr = (BDBlock *)(((char *)bdb) + sizeof(BDBlock));
1734                 bdb->data_block_ptr = buf;
1735                 bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr);
1736
1737                 if(i == NON_MAC_QUEUE)
1738                         bdb->trc_data_block_ptr = RX_BUFF_TRC_POINTER(buf);
1739                 else
1740                         bdb->trc_data_block_ptr = TRC_POINTER(buf);
1741
1742                 for(j = 1; j < tp->num_rx_bdbs[i]; j++)
1743                 {
1744                         bdb->next_ptr->back_ptr = bdb;
1745                         bdb = bdb->next_ptr;
1746                         buf = (__u16 *)((char *)buf + RX_DATA_BUFFER_SIZE);
1747                         bdb->info = (BDB_NOT_CHAIN_END | BDB_NO_WARNING);
1748                         bdb->buffer_length = RX_DATA_BUFFER_SIZE;
1749                         bdb->next_ptr = (BDBlock *)(((char *)bdb) + sizeof(BDBlock));
1750                         bdb->data_block_ptr = buf;
1751                         bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr);
1752
1753                         if(i == NON_MAC_QUEUE)
1754                                 bdb->trc_data_block_ptr = RX_BUFF_TRC_POINTER(buf);
1755                         else
1756                                 bdb->trc_data_block_ptr = TRC_POINTER(buf);
1757                 }
1758
1759                 bdb->next_ptr           = tp->rx_bdb_head[i];
1760                 bdb->trc_next_ptr       = TRC_POINTER(tp->rx_bdb_head[i]);
1761
1762                 tp->rx_bdb_head[i]->back_ptr    = bdb;
1763                 tp->rx_bdb_curr[i]              = tp->rx_bdb_head[i]->next_ptr;
1764         }
1765
1766         return (0);
1767 }
1768
1769 static int smctr_init_rx_fcbs(struct net_device *dev)
1770 {
1771         struct net_local *tp = netdev_priv(dev);
1772         unsigned int i, j;
1773         FCBlock *fcb;
1774
1775         for(i = 0; i < NUM_RX_QS_USED; i++)
1776         {
1777                 fcb               = tp->rx_fcb_head[i];
1778                 fcb->frame_status = 0;
1779                 fcb->frame_length = 0;
1780                 fcb->info         = FCB_CHAIN_END;
1781                 fcb->next_ptr     = (FCBlock *)(((char*)fcb) + sizeof(FCBlock));
1782                 if(i == NON_MAC_QUEUE)
1783                         fcb->trc_next_ptr = RX_FCB_TRC_POINTER(fcb->next_ptr);
1784                 else
1785                         fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr);
1786
1787                 for(j = 1; j < tp->num_rx_fcbs[i]; j++)
1788                 {
1789                         fcb->next_ptr->back_ptr = fcb;
1790                         fcb                     = fcb->next_ptr;
1791                         fcb->frame_status       = 0;
1792                         fcb->frame_length       = 0;
1793                         fcb->info               = FCB_WARNING;
1794                         fcb->next_ptr
1795                                 = (FCBlock *)(((char *)fcb) + sizeof(FCBlock));
1796
1797                         if(i == NON_MAC_QUEUE)
1798                                 fcb->trc_next_ptr
1799                                         = RX_FCB_TRC_POINTER(fcb->next_ptr);
1800                         else
1801                                 fcb->trc_next_ptr
1802                                         = TRC_POINTER(fcb->next_ptr);
1803                 }
1804
1805                 fcb->next_ptr = tp->rx_fcb_head[i];
1806
1807                 if(i == NON_MAC_QUEUE)
1808                         fcb->trc_next_ptr = RX_FCB_TRC_POINTER(fcb->next_ptr);
1809                 else
1810                         fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr);
1811
1812                 tp->rx_fcb_head[i]->back_ptr    = fcb;
1813                 tp->rx_fcb_curr[i]              = tp->rx_fcb_head[i]->next_ptr;
1814         }
1815
1816         return(0);
1817 }
1818
1819 static int smctr_init_shared_memory(struct net_device *dev)
1820 {
1821         struct net_local *tp = netdev_priv(dev);
1822         unsigned int i;
1823         __u32 *iscpb;
1824
1825         if(smctr_debug > 10)
1826                 printk(KERN_DEBUG "%s: smctr_init_shared_memory\n", dev->name);
1827
1828         smctr_set_page(dev, (__u8 *)(unsigned int)tp->iscpb_ptr);
1829
1830         /* Initialize Initial System Configuration Point. (ISCP) */
1831         iscpb = (__u32 *)PAGE_POINTER(&tp->iscpb_ptr->trc_scgb_ptr);
1832         *iscpb = (__u32)(SWAP_WORDS(TRC_POINTER(tp->scgb_ptr)));
1833
1834         smctr_set_page(dev, (__u8 *)tp->ram_access);
1835
1836         /* Initialize System Configuration Pointers. (SCP) */
1837         tp->scgb_ptr->config = (SCGB_ADDRESS_POINTER_FORMAT
1838                 | SCGB_MULTI_WORD_CONTROL | SCGB_DATA_FORMAT
1839                 | SCGB_BURST_LENGTH);
1840
1841         tp->scgb_ptr->trc_sclb_ptr      = TRC_POINTER(tp->sclb_ptr);
1842         tp->scgb_ptr->trc_acb_ptr       = TRC_POINTER(tp->acb_head);
1843         tp->scgb_ptr->trc_isb_ptr       = TRC_POINTER(tp->isb_ptr);
1844         tp->scgb_ptr->isbsiz            = (sizeof(ISBlock)) - 2;
1845
1846         /* Initialize System Control Block. (SCB) */
1847         tp->sclb_ptr->valid_command    = SCLB_VALID | SCLB_CMD_NOP;
1848         tp->sclb_ptr->iack_code        = 0;
1849         tp->sclb_ptr->resume_control   = 0;
1850         tp->sclb_ptr->int_mask_control = 0;
1851         tp->sclb_ptr->int_mask_state   = 0;
1852
1853         /* Initialize Interrupt Status Block. (ISB) */
1854         for(i = 0; i < NUM_OF_INTERRUPTS; i++)
1855         {
1856                 tp->isb_ptr->IStatus[i].IType = 0xf0;
1857                 tp->isb_ptr->IStatus[i].ISubtype = 0;
1858         }
1859
1860         tp->current_isb_index = 0;
1861
1862         /* Initialize Action Command Block. (ACB) */
1863         smctr_init_acbs(dev);
1864
1865         /* Initialize transmit FCB's and BDB's. */
1866         smctr_link_tx_fcbs_to_bdbs(dev);
1867         smctr_init_tx_bdbs(dev);
1868         smctr_init_tx_fcbs(dev);
1869
1870         /* Initialize receive FCB's and BDB's. */
1871         smctr_init_rx_bdbs(dev);
1872         smctr_init_rx_fcbs(dev);
1873
1874         return (0);
1875 }
1876
1877 static int smctr_init_tx_bdbs(struct net_device *dev)
1878 {
1879         struct net_local *tp = netdev_priv(dev);
1880         unsigned int i, j;
1881         BDBlock *bdb;
1882
1883         for(i = 0; i < NUM_TX_QS_USED; i++)
1884         {
1885                 bdb = tp->tx_bdb_head[i];
1886                 bdb->info = (BDB_NOT_CHAIN_END | BDB_NO_WARNING);
1887                 bdb->next_ptr = (BDBlock *)(((char *)bdb) + sizeof(BDBlock));
1888                 bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr);
1889
1890                 for(j = 1; j < tp->num_tx_bdbs[i]; j++)
1891                 {
1892                         bdb->next_ptr->back_ptr = bdb;
1893                         bdb = bdb->next_ptr;
1894                         bdb->info = (BDB_NOT_CHAIN_END | BDB_NO_WARNING);
1895                         bdb->next_ptr
1896                                 = (BDBlock *)(((char *)bdb) + sizeof( BDBlock));                        bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr);
1897                 }
1898
1899                 bdb->next_ptr = tp->tx_bdb_head[i];
1900                 bdb->trc_next_ptr = TRC_POINTER(tp->tx_bdb_head[i]);
1901                 tp->tx_bdb_head[i]->back_ptr = bdb;
1902         }
1903
1904         return (0);
1905 }
1906
1907 static int smctr_init_tx_fcbs(struct net_device *dev)
1908 {
1909         struct net_local *tp = netdev_priv(dev);
1910         unsigned int i, j;
1911         FCBlock *fcb;
1912
1913         for(i = 0; i < NUM_TX_QS_USED; i++)
1914         {
1915                 fcb               = tp->tx_fcb_head[i];
1916                 fcb->frame_status = 0;
1917                 fcb->frame_length = 0;
1918                 fcb->info         = FCB_CHAIN_END;
1919                 fcb->next_ptr = (FCBlock *)(((char *)fcb) + sizeof(FCBlock));
1920                 fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr);
1921
1922                 for(j = 1; j < tp->num_tx_fcbs[i]; j++)
1923                 {
1924                         fcb->next_ptr->back_ptr = fcb;
1925                         fcb                     = fcb->next_ptr;
1926                         fcb->frame_status       = 0;
1927                         fcb->frame_length       = 0;
1928                         fcb->info               = FCB_CHAIN_END;
1929                         fcb->next_ptr
1930                                 = (FCBlock *)(((char *)fcb) + sizeof(FCBlock));
1931                         fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr);
1932                 }
1933
1934                 fcb->next_ptr           = tp->tx_fcb_head[i];
1935                 fcb->trc_next_ptr       = TRC_POINTER(tp->tx_fcb_head[i]);
1936
1937                 tp->tx_fcb_head[i]->back_ptr    = fcb;
1938                 tp->tx_fcb_end[i]               = tp->tx_fcb_head[i]->next_ptr;
1939                 tp->tx_fcb_curr[i]              = tp->tx_fcb_head[i]->next_ptr;
1940                 tp->num_tx_fcbs_used[i]         = 0;
1941         }
1942
1943         return (0);
1944 }
1945
1946 static int smctr_internal_self_test(struct net_device *dev)
1947 {
1948         struct net_local *tp = netdev_priv(dev);
1949         int err;
1950
1951         if((err = smctr_issue_test_internal_rom_cmd(dev)))
1952                 return (err);
1953
1954         if((err = smctr_wait_cmd(dev)))
1955                 return (err);
1956
1957         if(tp->acb_head->cmd_done_status & 0xff)
1958                 return (-1);
1959
1960         if((err = smctr_issue_test_hic_cmd(dev)))
1961                 return (err);
1962
1963         if((err = smctr_wait_cmd(dev)))
1964                 return (err);
1965
1966         if(tp->acb_head->cmd_done_status & 0xff)
1967                 return (-1);
1968
1969         if((err = smctr_issue_test_mac_reg_cmd(dev)))
1970                 return (err);
1971
1972         if((err = smctr_wait_cmd(dev)))
1973                 return (err);
1974
1975         if(tp->acb_head->cmd_done_status & 0xff)
1976                 return (-1);
1977
1978         return (0);
1979 }
1980
1981 /*
1982  * The typical workload of the driver: Handle the network interface interrupts.
1983  */
1984 static irqreturn_t smctr_interrupt(int irq, void *dev_id)
1985 {
1986         struct net_device *dev = dev_id;
1987         struct net_local *tp;
1988         int ioaddr;
1989         __u16 interrupt_unmask_bits = 0, interrupt_ack_code = 0xff00;
1990         __u16 err1, err = NOT_MY_INTERRUPT;
1991         __u8 isb_type, isb_subtype;
1992         __u16 isb_index;
1993
1994         ioaddr = dev->base_addr;
1995         tp = netdev_priv(dev);
1996
1997         if(tp->status == NOT_INITIALIZED)
1998                 return IRQ_NONE;
1999
2000         spin_lock(&tp->lock);
2001
2002         smctr_disable_bic_int(dev);
2003         smctr_enable_16bit(dev);
2004
2005         smctr_clear_int(dev);
2006
2007         /* First read the LSB */
2008         while((tp->isb_ptr->IStatus[tp->current_isb_index].IType & 0xf0) == 0)
2009         {
2010                 isb_index       = tp->current_isb_index;
2011                 isb_type        = tp->isb_ptr->IStatus[isb_index].IType;
2012                 isb_subtype     = tp->isb_ptr->IStatus[isb_index].ISubtype;
2013
2014                 (tp->current_isb_index)++;
2015                 if(tp->current_isb_index == NUM_OF_INTERRUPTS)
2016                         tp->current_isb_index = 0;
2017
2018                 if(isb_type >= 0x10)
2019                 {
2020                         smctr_disable_16bit(dev);
2021                         spin_unlock(&tp->lock);
2022                         return IRQ_HANDLED;
2023                 }
2024
2025                 err = HARDWARE_FAILED;
2026                 interrupt_ack_code = isb_index;
2027                 tp->isb_ptr->IStatus[isb_index].IType |= 0xf0;
2028
2029                 interrupt_unmask_bits |= (1 << (__u16)isb_type);
2030
2031                 switch(isb_type)
2032                 {
2033                         case ISB_IMC_MAC_TYPE_3:
2034                                 smctr_disable_16bit(dev);
2035
2036                                 switch(isb_subtype)
2037                                 {
2038                                         case 0:
2039                                                 tp->monitor_state = MS_MONITOR_FSM_INACTIVE;
2040                                                break;
2041
2042                                         case 1:
2043                                                 tp->monitor_state = MS_REPEAT_BEACON_STATE;
2044                                                 break;
2045
2046                                         case 2:
2047                                                 tp->monitor_state = MS_REPEAT_CLAIM_TOKEN_STATE;
2048                                                 break;
2049
2050                                         case 3:
2051                                                 tp->monitor_state = MS_TRANSMIT_CLAIM_TOKEN_STATE;                                                break;
2052
2053                                         case 4:
2054                                                 tp->monitor_state = MS_STANDBY_MONITOR_STATE;
2055                                                 break;
2056
2057                                         case 5:
2058                                                 tp->monitor_state = MS_TRANSMIT_BEACON_STATE;
2059                                                 break;
2060
2061                                         case 6:
2062                                                 tp->monitor_state = MS_ACTIVE_MONITOR_STATE;
2063                                                 break;
2064
2065                                         case 7:
2066                                                 tp->monitor_state = MS_TRANSMIT_RING_PURGE_STATE;
2067                                                 break;
2068
2069                                         case 8:   /* diagnostic state */
2070                                                 break;
2071
2072                                         case 9:
2073                                                 tp->monitor_state = MS_BEACON_TEST_STATE;
2074                                                 if(smctr_lobe_media_test(dev))
2075                                                 {
2076                                                         tp->ring_status_flags = RING_STATUS_CHANGED;
2077                                                         tp->ring_status = AUTO_REMOVAL_ERROR;
2078                                                         smctr_ring_status_chg(dev);
2079                                                         smctr_bypass_state(dev);
2080                                                 }
2081                                                 else
2082                                                         smctr_issue_insert_cmd(dev);
2083                                                 break;
2084
2085                                         /* case 0x0a-0xff, illegal states */
2086                                         default:
2087                                                 break;
2088                                 }
2089
2090                                 tp->ring_status_flags = MONITOR_STATE_CHANGED;
2091                                 err = smctr_ring_status_chg(dev);
2092
2093                                 smctr_enable_16bit(dev);
2094                                 break;
2095
2096                         /* Type 0x02 - MAC Error Counters Interrupt
2097                          * One or more MAC Error Counter is half full
2098                          *      MAC Error Counters
2099                          *      Lost_FR_Error_Counter
2100                          *      RCV_Congestion_Counter
2101                          *      FR_copied_Error_Counter
2102                          *      FREQ_Error_Counter
2103                          *      Token_Error_Counter
2104                          *      Line_Error_Counter
2105                          *      Internal_Error_Count
2106                          */
2107                         case ISB_IMC_MAC_ERROR_COUNTERS:
2108                                 /* Read 802.5 Error Counters */
2109                                 err = smctr_issue_read_ring_status_cmd(dev);
2110                                 break;
2111
2112                         /* Type 0x04 - MAC Type 2 Interrupt
2113                          * HOST needs to enqueue MAC Frame for transmission
2114                          * SubType Bit 15 - RQ_INIT_PDU( Request Initialization)                         * Changed from RQ_INIT_PDU to
2115                          * TRC_Status_Changed_Indicate
2116                          */
2117                         case ISB_IMC_MAC_TYPE_2:
2118                                 err = smctr_issue_read_ring_status_cmd(dev);
2119                                 break;
2120
2121
2122                         /* Type 0x05 - TX Frame Interrupt (FI). */
2123                         case ISB_IMC_TX_FRAME:
2124                                 /* BUG QUEUE for TRC stuck receive BUG */
2125                                 if(isb_subtype & TX_PENDING_PRIORITY_2)
2126                                 {
2127                                         if((err = smctr_tx_complete(dev, BUG_QUEUE)) != SUCCESS)
2128                                                 break;
2129                                 }
2130
2131                                 /* NON-MAC frames only */
2132                                 if(isb_subtype & TX_PENDING_PRIORITY_1)
2133                                 {
2134                                         if((err = smctr_tx_complete(dev, NON_MAC_QUEUE)) != SUCCESS)
2135                                                 break;
2136                                 }
2137
2138                                 /* MAC frames only */
2139                                 if(isb_subtype & TX_PENDING_PRIORITY_0)
2140                                         err = smctr_tx_complete(dev, MAC_QUEUE);                                break;
2141
2142                         /* Type 0x06 - TX END OF QUEUE (FE) */
2143                         case ISB_IMC_END_OF_TX_QUEUE:
2144                                 /* BUG queue */
2145                                 if(isb_subtype & TX_PENDING_PRIORITY_2)
2146                                 {
2147                                         /* ok to clear Receive FIFO overrun
2148                                          * imask send_BUG now completes.
2149                                          */
2150                                         interrupt_unmask_bits |= 0x800;
2151
2152                                         tp->tx_queue_status[BUG_QUEUE] = NOT_TRANSMITING;
2153                                         if((err = smctr_tx_complete(dev, BUG_QUEUE)) != SUCCESS)
2154                                                 break;
2155                                         if((err = smctr_restart_tx_chain(dev, BUG_QUEUE)) != SUCCESS)
2156                                                 break;
2157                                 }
2158
2159                                 /* NON-MAC queue only */
2160                                 if(isb_subtype & TX_PENDING_PRIORITY_1)
2161                                 {
2162                                         tp->tx_queue_status[NON_MAC_QUEUE] = NOT_TRANSMITING;
2163                                         if((err = smctr_tx_complete(dev, NON_MAC_QUEUE)) != SUCCESS)
2164                                                 break;
2165                                         if((err = smctr_restart_tx_chain(dev, NON_MAC_QUEUE)) != SUCCESS)
2166                                                 break;
2167                                 }
2168
2169                                 /* MAC queue only */
2170                                 if(isb_subtype & TX_PENDING_PRIORITY_0)
2171                                 {
2172                                         tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING;
2173                                         if((err = smctr_tx_complete(dev, MAC_QUEUE)) != SUCCESS)
2174                                                 break;
2175
2176                                         err = smctr_restart_tx_chain(dev, MAC_QUEUE);
2177                                 }
2178                                 break;
2179
2180                         /* Type 0x07 - NON-MAC RX Resource Interrupt
2181                          *   Subtype bit 12 - (BW) BDB warning
2182                          *   Subtype bit 13 - (FW) FCB warning
2183                          *   Subtype bit 14 - (BE) BDB End of chain
2184                          *   Subtype bit 15 - (FE) FCB End of chain
2185                          */
2186                         case ISB_IMC_NON_MAC_RX_RESOURCE:
2187                                 tp->rx_fifo_overrun_count = 0;
2188                                 tp->receive_queue_number = NON_MAC_QUEUE;
2189                                 err1 = smctr_rx_frame(dev);
2190
2191                                 if(isb_subtype & NON_MAC_RX_RESOURCE_FE)
2192                                 {
2193                                         if((err = smctr_issue_resume_rx_fcb_cmd(                                                dev, NON_MAC_QUEUE)) != SUCCESS)                                                break;
2194
2195                                         if(tp->ptr_rx_fcb_overruns)
2196                                                 (*tp->ptr_rx_fcb_overruns)++;
2197                                 }
2198
2199                                 if(isb_subtype & NON_MAC_RX_RESOURCE_BE)
2200                                 {
2201                                         if((err = smctr_issue_resume_rx_bdb_cmd(                                                dev, NON_MAC_QUEUE)) != SUCCESS)                                                break;
2202
2203                                         if(tp->ptr_rx_bdb_overruns)
2204                                                 (*tp->ptr_rx_bdb_overruns)++;
2205                                 }
2206                                 err = err1;
2207                                 break;
2208
2209                         /* Type 0x08 - MAC RX Resource Interrupt
2210                          *   Subtype bit 12 - (BW) BDB warning
2211                          *   Subtype bit 13 - (FW) FCB warning
2212                          *   Subtype bit 14 - (BE) BDB End of chain
2213                          *   Subtype bit 15 - (FE) FCB End of chain
2214                          */
2215                         case ISB_IMC_MAC_RX_RESOURCE:
2216                                 tp->receive_queue_number = MAC_QUEUE;
2217                                 err1 = smctr_rx_frame(dev);
2218
2219                                 if(isb_subtype & MAC_RX_RESOURCE_FE)
2220                                 {
2221                                         if((err = smctr_issue_resume_rx_fcb_cmd(                                                dev, MAC_QUEUE)) != SUCCESS)
2222                                                 break;
2223
2224                                         if(tp->ptr_rx_fcb_overruns)
2225                                                 (*tp->ptr_rx_fcb_overruns)++;
2226                                 }
2227
2228                                 if(isb_subtype & MAC_RX_RESOURCE_BE)
2229                                 {
2230                                         if((err = smctr_issue_resume_rx_bdb_cmd(                                                dev, MAC_QUEUE)) != SUCCESS)
2231                                                 break;
2232
2233                                         if(tp->ptr_rx_bdb_overruns)
2234                                                 (*tp->ptr_rx_bdb_overruns)++;
2235                                 }
2236                                 err = err1;
2237                                 break;
2238
2239                         /* Type 0x09 - NON_MAC RX Frame Interrupt */
2240                         case ISB_IMC_NON_MAC_RX_FRAME:
2241                                 tp->rx_fifo_overrun_count = 0;
2242                                 tp->receive_queue_number = NON_MAC_QUEUE;
2243                                 err = smctr_rx_frame(dev);
2244                                 break;
2245
2246                         /* Type 0x0A - MAC RX Frame Interrupt */
2247                         case ISB_IMC_MAC_RX_FRAME:
2248                                 tp->receive_queue_number = MAC_QUEUE;
2249                                 err = smctr_rx_frame(dev);
2250                                 break;
2251
2252                         /* Type 0x0B - TRC status
2253                          * TRC has encountered an error condition
2254                          * subtype bit 14 - transmit FIFO underrun
2255                          * subtype bit 15 - receive FIFO overrun
2256                          */
2257                         case ISB_IMC_TRC_FIFO_STATUS:
2258                                 if(isb_subtype & TRC_FIFO_STATUS_TX_UNDERRUN)
2259                                 {
2260                                         if(tp->ptr_tx_fifo_underruns)
2261                                                 (*tp->ptr_tx_fifo_underruns)++;
2262                                 }
2263
2264                                 if(isb_subtype & TRC_FIFO_STATUS_RX_OVERRUN)
2265                                 {
2266                                         /* update overrun stuck receive counter
2267                                          * if >= 3, has to clear it by sending
2268                                          * back to back frames. We pick
2269                                          * DAT(duplicate address MAC frame)
2270                                          */
2271                                         tp->rx_fifo_overrun_count++;
2272
2273                                         if(tp->rx_fifo_overrun_count >= 3)
2274                                         {
2275                                                 tp->rx_fifo_overrun_count = 0;
2276
2277                                                 /* delay clearing fifo overrun
2278                                                  * imask till send_BUG tx
2279                                                  * complete posted
2280                                                  */
2281                                                 interrupt_unmask_bits &= (~0x800);
2282                                                 printk(KERN_CRIT "Jay please send bug\n");//                                              smctr_send_bug(dev);
2283                                         }
2284
2285                                         if(tp->ptr_rx_fifo_overruns)
2286                                                 (*tp->ptr_rx_fifo_overruns)++;
2287                                 }
2288
2289                                 err = SUCCESS;
2290                                 break;
2291
2292                         /* Type 0x0C - Action Command Status Interrupt
2293                          * Subtype bit 14 - CB end of command chain (CE)
2294                          * Subtype bit 15 - CB command interrupt (CI)
2295                          */
2296                         case ISB_IMC_COMMAND_STATUS:
2297                                 err = SUCCESS;
2298                                 if(tp->acb_head->cmd == ACB_CMD_HIC_NOP)
2299                                 {
2300                                         printk(KERN_ERR "i1\n");
2301                                         smctr_disable_16bit(dev);
2302
2303                                         /* XXXXXXXXXXXXXXXXX */
2304                                 /*      err = UM_Interrupt(dev); */
2305
2306                                         smctr_enable_16bit(dev);
2307                                 }
2308                                 else
2309                                 {
2310                                         if((tp->acb_head->cmd
2311                                             == ACB_CMD_READ_TRC_STATUS) &&
2312                                            (tp->acb_head->subcmd
2313                                             == RW_TRC_STATUS_BLOCK))
2314                                         {
2315                                                 if(tp->ptr_bcn_type)
2316                                                 {
2317                                                         *(tp->ptr_bcn_type)
2318                                                                 = (__u32)((SBlock *)tp->misc_command_data)->BCN_Type;
2319                                                 }
2320
2321                                                 if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & ERROR_COUNTERS_CHANGED)
2322                                                 {
2323                                                         smctr_update_err_stats(dev);
2324                                                 }
2325
2326                                                 if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & TI_NDIS_RING_STATUS_CHANGED)
2327                                                 {
2328                                                         tp->ring_status
2329                                                                 = ((SBlock*)tp->misc_command_data)->TI_NDIS_Ring_Status;
2330                                                         smctr_disable_16bit(dev);
2331                                                         err = smctr_ring_status_chg(dev);
2332                                                         smctr_enable_16bit(dev);
2333                                                         if((tp->ring_status & REMOVE_RECEIVED) &&
2334                                                            (tp->config_word0 & NO_AUTOREMOVE))
2335                                                         {
2336                                                                 smctr_issue_remove_cmd(dev);
2337                                                         }
2338
2339                                                         if(err != SUCCESS)
2340                                                         {
2341                                                                 tp->acb_pending = 0;
2342                                                                 break;
2343                                                         }
2344                                                 }
2345
2346                                                 if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & UNA_CHANGED)
2347                                                 {
2348                                                         if(tp->ptr_una)
2349                                                         {
2350                                                                 tp->ptr_una[0] = SWAP_BYTES(((SBlock *)tp->misc_command_data)->UNA[0]);
2351                                                                 tp->ptr_una[1] = SWAP_BYTES(((SBlock *)tp->misc_command_data)->UNA[1]);
2352                                                                 tp->ptr_una[2] = SWAP_BYTES(((SBlock *)tp->misc_command_data)->UNA[2]);
2353                                                         }
2354
2355                                                 }
2356
2357                                                 if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & READY_TO_SEND_RQ_INIT)                                                {
2358                                                         err = smctr_send_rq_init(dev);
2359                                                 }
2360                                         }
2361                                 }
2362
2363                                 tp->acb_pending = 0;
2364                                 break;
2365
2366                         /* Type 0x0D - MAC Type 1 interrupt
2367                          * Subtype -- 00 FR_BCN received at S12
2368                          *            01 FR_BCN received at S21
2369                          *            02 FR_DAT(DA=MA, A<>0) received at S21
2370                          *            03 TSM_EXP at S21
2371                          *            04 FR_REMOVE received at S42
2372                          *            05 TBR_EXP, BR_FLAG_SET at S42
2373                          *            06 TBT_EXP at S53
2374                          */
2375                         case ISB_IMC_MAC_TYPE_1:
2376                                 if(isb_subtype > 8)
2377                                 {
2378                                         err = HARDWARE_FAILED;
2379                                         break;
2380                                 }
2381
2382                                 err = SUCCESS;
2383                                 switch(isb_subtype)
2384                                 {
2385                                         case 0:
2386                                                 tp->join_state = JS_BYPASS_STATE;
2387                                                 if(tp->status != CLOSED)
2388                                                 {
2389                                                         tp->status = CLOSED;
2390                                                         err = smctr_status_chg(dev);
2391                                                 }
2392                                                 break;
2393
2394                                         case 1:
2395                                                 tp->join_state = JS_LOBE_TEST_STATE;
2396                                                 break;
2397
2398                                         case 2:
2399                                                 tp->join_state = JS_DETECT_MONITOR_PRESENT_STATE;
2400                                                 break;
2401
2402                                         case 3:
2403                                                 tp->join_state = JS_AWAIT_NEW_MONITOR_STATE;
2404                                                 break;
2405
2406                                         case 4:
2407                                                 tp->join_state = JS_DUPLICATE_ADDRESS_TEST_STATE;
2408                                                 break;
2409
2410                                         case 5:
2411                                                 tp->join_state = JS_NEIGHBOR_NOTIFICATION_STATE;
2412                                                 break;
2413
2414                                         case 6:
2415                                                 tp->join_state = JS_REQUEST_INITIALIZATION_STATE;
2416                                                 break;
2417
2418                                         case 7:
2419                                                 tp->join_state = JS_JOIN_COMPLETE_STATE;
2420                                                 tp->status = OPEN;
2421                                                 err = smctr_status_chg(dev);
2422                                                 break;
2423
2424                                         case 8:
2425                                                 tp->join_state = JS_BYPASS_WAIT_STATE;
2426                                                 break;
2427                                 }
2428                                 break ;
2429
2430                         /* Type 0x0E - TRC Initialization Sequence Interrupt
2431                          * Subtype -- 00-FF Initializatin sequence complete
2432                          */
2433                         case ISB_IMC_TRC_INTRNL_TST_STATUS:
2434                                 tp->status = INITIALIZED;
2435                                 smctr_disable_16bit(dev);
2436                                 err = smctr_status_chg(dev);
2437                                 smctr_enable_16bit(dev);
2438                                 break;
2439
2440                         /* other interrupt types, illegal */
2441                         default:
2442                                 break;
2443                 }
2444
2445                 if(err != SUCCESS)
2446                         break;
2447         }
2448
2449         /* Checking the ack code instead of the unmask bits here is because :
2450          * while fixing the stuck receive, DAT frame are sent and mask off
2451          * FIFO overrun interrupt temporarily (interrupt_unmask_bits = 0)
2452          * but we still want to issue ack to ISB
2453          */
2454         if(!(interrupt_ack_code & 0xff00))
2455                 smctr_issue_int_ack(dev, interrupt_ack_code, interrupt_unmask_bits);
2456
2457         smctr_disable_16bit(dev);
2458         smctr_enable_bic_int(dev);
2459         spin_unlock(&tp->lock);
2460
2461         return IRQ_HANDLED;
2462 }
2463
2464 static int smctr_issue_enable_int_cmd(struct net_device *dev,
2465         __u16 interrupt_enable_mask)
2466 {
2467         struct net_local *tp = netdev_priv(dev);
2468         int err;
2469
2470         if((err = smctr_wait_while_cbusy(dev)))
2471                 return (err);
2472
2473         tp->sclb_ptr->int_mask_control  = interrupt_enable_mask;
2474         tp->sclb_ptr->valid_command     = SCLB_VALID | SCLB_CMD_CLEAR_INTERRUPT_MASK;
2475
2476         smctr_set_ctrl_attention(dev);
2477
2478         return (0);
2479 }
2480
2481 static int smctr_issue_int_ack(struct net_device *dev, __u16 iack_code, __u16 ibits)
2482 {
2483         struct net_local *tp = netdev_priv(dev);
2484
2485         if(smctr_wait_while_cbusy(dev))
2486                 return (-1);
2487
2488         tp->sclb_ptr->int_mask_control = ibits;
2489         tp->sclb_ptr->iack_code = iack_code << 1; /* use the offset from base */        tp->sclb_ptr->resume_control = 0;
2490         tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_IACK_CODE_VALID | SCLB_CMD_CLEAR_INTERRUPT_MASK;
2491
2492         smctr_set_ctrl_attention(dev);
2493
2494         return (0);
2495 }
2496
2497 static int smctr_issue_init_timers_cmd(struct net_device *dev)
2498 {
2499         struct net_local *tp = netdev_priv(dev);
2500         unsigned int i;
2501         int err;
2502         __u16 *pTimer_Struc = (__u16 *)tp->misc_command_data;
2503
2504         if((err = smctr_wait_while_cbusy(dev)))
2505                 return (err);
2506
2507         if((err = smctr_wait_cmd(dev)))
2508                 return (err);
2509
2510         tp->config_word0 = THDREN | DMA_TRIGGER | USETPT | NO_AUTOREMOVE;
2511         tp->config_word1 = 0;
2512
2513         if((tp->media_type == MEDIA_STP_16) ||
2514            (tp->media_type == MEDIA_UTP_16) ||
2515            (tp->media_type == MEDIA_STP_16_UTP_16))
2516         {
2517                 tp->config_word0 |= FREQ_16MB_BIT;
2518         }
2519
2520         if(tp->mode_bits & EARLY_TOKEN_REL)
2521                 tp->config_word0 |= ETREN;
2522
2523         if(tp->mode_bits & LOOPING_MODE_MASK)
2524                 tp->config_word0 |= RX_OWN_BIT;
2525         else
2526                 tp->config_word0 &= ~RX_OWN_BIT;
2527
2528         if(tp->receive_mask & PROMISCUOUS_MODE)
2529                 tp->config_word0 |= PROMISCUOUS_BIT;
2530         else
2531                 tp->config_word0 &= ~PROMISCUOUS_BIT;
2532
2533         if(tp->receive_mask & ACCEPT_ERR_PACKETS)
2534                 tp->config_word0 |= SAVBAD_BIT;
2535         else
2536                 tp->config_word0 &= ~SAVBAD_BIT;
2537
2538         if(tp->receive_mask & ACCEPT_ATT_MAC_FRAMES)
2539                 tp->config_word0 |= RXATMAC;
2540         else
2541                 tp->config_word0 &= ~RXATMAC;
2542
2543         if(tp->receive_mask & ACCEPT_MULTI_PROM)
2544                 tp->config_word1 |= MULTICAST_ADDRESS_BIT;
2545         else
2546                 tp->config_word1 &= ~MULTICAST_ADDRESS_BIT;
2547
2548         if(tp->receive_mask & ACCEPT_SOURCE_ROUTING_SPANNING)
2549                 tp->config_word1 |= SOURCE_ROUTING_SPANNING_BITS;
2550         else
2551         {
2552                 if(tp->receive_mask & ACCEPT_SOURCE_ROUTING)
2553                         tp->config_word1 |= SOURCE_ROUTING_EXPLORER_BIT;
2554                 else
2555                         tp->config_word1 &= ~SOURCE_ROUTING_SPANNING_BITS;
2556         }
2557
2558         if((tp->media_type == MEDIA_STP_16) ||
2559            (tp->media_type == MEDIA_UTP_16) ||
2560            (tp->media_type == MEDIA_STP_16_UTP_16))
2561         {
2562                 tp->config_word1 |= INTERFRAME_SPACING_16;
2563         }
2564         else
2565                 tp->config_word1 |= INTERFRAME_SPACING_4;
2566
2567         *pTimer_Struc++ = tp->config_word0;
2568         *pTimer_Struc++ = tp->config_word1;
2569
2570         if((tp->media_type == MEDIA_STP_4) ||
2571            (tp->media_type == MEDIA_UTP_4) ||
2572            (tp->media_type == MEDIA_STP_4_UTP_4))
2573         {
2574                 *pTimer_Struc++ = 0x00FA;       /* prescale */
2575                 *pTimer_Struc++ = 0x2710;       /* TPT_limit */
2576                 *pTimer_Struc++ = 0x2710;       /* TQP_limit */
2577                 *pTimer_Struc++ = 0x0A28;       /* TNT_limit */
2578                 *pTimer_Struc++ = 0x3E80;       /* TBT_limit */
2579                 *pTimer_Struc++ = 0x3A98;       /* TSM_limit */
2580                 *pTimer_Struc++ = 0x1B58;       /* TAM_limit */
2581                 *pTimer_Struc++ = 0x00C8;       /* TBR_limit */
2582                 *pTimer_Struc++ = 0x07D0;       /* TER_limit */
2583                 *pTimer_Struc++ = 0x000A;       /* TGT_limit */
2584                 *pTimer_Struc++ = 0x1162;       /* THT_limit */
2585                 *pTimer_Struc++ = 0x07D0;       /* TRR_limit */
2586                 *pTimer_Struc++ = 0x1388;       /* TVX_limit */
2587                 *pTimer_Struc++ = 0x0000;       /* reserved */
2588         }
2589         else
2590         {
2591                 *pTimer_Struc++ = 0x03E8;       /* prescale */
2592                 *pTimer_Struc++ = 0x9C40;       /* TPT_limit */
2593                 *pTimer_Struc++ = 0x9C40;       /* TQP_limit */
2594                 *pTimer_Struc++ = 0x0A28;       /* TNT_limit */
2595                 *pTimer_Struc++ = 0x3E80;       /* TBT_limit */
2596                 *pTimer_Struc++ = 0x3A98;       /* TSM_limit */
2597                 *pTimer_Struc++ = 0x1B58;       /* TAM_limit */
2598                 *pTimer_Struc++ = 0x00C8;       /* TBR_limit */
2599                 *pTimer_Struc++ = 0x07D0;       /* TER_limit */
2600                 *pTimer_Struc++ = 0x000A;       /* TGT_limit */
2601                 *pTimer_Struc++ = 0x4588;       /* THT_limit */
2602                 *pTimer_Struc++ = 0x1F40;       /* TRR_limit */
2603                 *pTimer_Struc++ = 0x4E20;       /* TVX_limit */
2604                 *pTimer_Struc++ = 0x0000;       /* reserved */
2605         }
2606
2607         /* Set node address. */
2608         *pTimer_Struc++ = dev->dev_addr[0] << 8
2609                 | (dev->dev_addr[1] & 0xFF);
2610         *pTimer_Struc++ = dev->dev_addr[2] << 8
2611                 | (dev->dev_addr[3] & 0xFF);
2612         *pTimer_Struc++ = dev->dev_addr[4] << 8
2613                 | (dev->dev_addr[5] & 0xFF);
2614
2615         /* Set group address. */
2616         *pTimer_Struc++ = tp->group_address_0 << 8
2617                 | tp->group_address_0 >> 8;
2618         *pTimer_Struc++ = tp->group_address[0] << 8
2619                 | tp->group_address[0] >> 8;
2620         *pTimer_Struc++ = tp->group_address[1] << 8
2621                 | tp->group_address[1] >> 8;
2622
2623         /* Set functional address. */
2624         *pTimer_Struc++ = tp->functional_address_0 << 8
2625                 | tp->functional_address_0 >> 8;
2626         *pTimer_Struc++ = tp->functional_address[0] << 8
2627                 | tp->functional_address[0] >> 8;
2628         *pTimer_Struc++ = tp->functional_address[1] << 8
2629                 | tp->functional_address[1] >> 8;
2630
2631         /* Set Bit-Wise group address. */
2632         *pTimer_Struc++ = tp->bitwise_group_address[0] << 8
2633                 | tp->bitwise_group_address[0] >> 8;
2634         *pTimer_Struc++ = tp->bitwise_group_address[1] << 8
2635                 | tp->bitwise_group_address[1] >> 8;
2636
2637         /* Set ring number address. */
2638         *pTimer_Struc++ = tp->source_ring_number;
2639         *pTimer_Struc++ = tp->target_ring_number;
2640
2641         /* Physical drop number. */
2642         *pTimer_Struc++ = (unsigned short)0;
2643         *pTimer_Struc++ = (unsigned short)0;
2644
2645         /* Product instance ID. */
2646         for(i = 0; i < 9; i++)
2647                 *pTimer_Struc++ = (unsigned short)0;
2648
2649         err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_INIT_TRC_TIMERS, 0);
2650
2651         return (err);
2652 }
2653
2654 static int smctr_issue_init_txrx_cmd(struct net_device *dev)
2655 {
2656         struct net_local *tp = netdev_priv(dev);
2657         unsigned int i;
2658         int err;
2659         void **txrx_ptrs = (void *)tp->misc_command_data;
2660
2661         if((err = smctr_wait_while_cbusy(dev)))
2662                 return (err);
2663
2664         if((err = smctr_wait_cmd(dev)))
2665         {
2666                 printk(KERN_ERR "%s: Hardware failure\n", dev->name);
2667                 return (err);
2668         }
2669
2670         /* Initialize Transmit Queue Pointers that are used, to point to
2671          * a single FCB.
2672          */
2673         for(i = 0; i < NUM_TX_QS_USED; i++)
2674                 *txrx_ptrs++ = (void *)TRC_POINTER(tp->tx_fcb_head[i]);
2675
2676         /* Initialize Transmit Queue Pointers that are NOT used to ZERO. */
2677         for(; i < MAX_TX_QS; i++)
2678                 *txrx_ptrs++ = (void *)0;
2679
2680         /* Initialize Receive Queue Pointers (MAC and Non-MAC) that are
2681          * used, to point to a single FCB and a BDB chain of buffers.
2682          */
2683         for(i = 0; i < NUM_RX_QS_USED; i++)
2684         {
2685                 *txrx_ptrs++ = (void *)TRC_POINTER(tp->rx_fcb_head[i]);
2686                 *txrx_ptrs++ = (void *)TRC_POINTER(tp->rx_bdb_head[i]);
2687         }
2688
2689         /* Initialize Receive Queue Pointers that are NOT used to ZERO. */
2690         for(; i < MAX_RX_QS; i++)
2691         {
2692                 *txrx_ptrs++ = (void *)0;
2693                 *txrx_ptrs++ = (void *)0;
2694         }
2695
2696         err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_INIT_TX_RX, 0);
2697
2698         return (err);
2699 }
2700
2701 static int smctr_issue_insert_cmd(struct net_device *dev)
2702 {
2703         int err;
2704
2705         err = smctr_setup_single_cmd(dev, ACB_CMD_INSERT, ACB_SUB_CMD_NOP);
2706
2707         return (err);
2708 }
2709
2710 static int smctr_issue_read_ring_status_cmd(struct net_device *dev)
2711 {
2712         int err;
2713
2714         if((err = smctr_wait_while_cbusy(dev)))
2715                 return (err);
2716
2717         if((err = smctr_wait_cmd(dev)))
2718                 return (err);
2719
2720         err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_READ_TRC_STATUS,
2721                 RW_TRC_STATUS_BLOCK);
2722
2723         return (err);
2724 }
2725
2726 static int smctr_issue_read_word_cmd(struct net_device *dev, __u16 aword_cnt)
2727 {
2728         int err;
2729
2730         if((err = smctr_wait_while_cbusy(dev)))
2731                 return (err);
2732
2733         if((err = smctr_wait_cmd(dev)))
2734                 return (err);
2735
2736         err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_MCT_READ_VALUE,
2737                 aword_cnt);
2738
2739         return (err);
2740 }
2741
2742 static int smctr_issue_remove_cmd(struct net_device *dev)
2743 {
2744         struct net_local *tp = netdev_priv(dev);
2745         int err;
2746
2747         if((err = smctr_wait_while_cbusy(dev)))
2748                 return (err);
2749
2750         tp->sclb_ptr->resume_control    = 0;
2751         tp->sclb_ptr->valid_command     = SCLB_VALID | SCLB_CMD_REMOVE;
2752
2753         smctr_set_ctrl_attention(dev);
2754
2755         return (0);
2756 }
2757
2758 static int smctr_issue_resume_acb_cmd(struct net_device *dev)
2759 {
2760         struct net_local *tp = netdev_priv(dev);
2761         int err;
2762
2763         if((err = smctr_wait_while_cbusy(dev)))
2764                 return (err);
2765
2766         tp->sclb_ptr->resume_control = SCLB_RC_ACB;
2767         tp->sclb_ptr->valid_command  = SCLB_VALID | SCLB_RESUME_CONTROL_VALID;
2768
2769         tp->acb_pending = 1;
2770
2771         smctr_set_ctrl_attention(dev);
2772
2773         return (0);
2774 }
2775
2776 static int smctr_issue_resume_rx_bdb_cmd(struct net_device *dev, __u16 queue)
2777 {
2778         struct net_local *tp = netdev_priv(dev);
2779         int err;
2780
2781         if((err = smctr_wait_while_cbusy(dev)))
2782                 return (err);
2783
2784         if(queue == MAC_QUEUE)
2785                 tp->sclb_ptr->resume_control = SCLB_RC_RX_MAC_BDB;
2786         else
2787                 tp->sclb_ptr->resume_control = SCLB_RC_RX_NON_MAC_BDB;
2788
2789         tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_RESUME_CONTROL_VALID;
2790
2791         smctr_set_ctrl_attention(dev);
2792
2793         return (0);
2794 }
2795
2796 static int smctr_issue_resume_rx_fcb_cmd(struct net_device *dev, __u16 queue)
2797 {
2798         struct net_local *tp = netdev_priv(dev);
2799
2800         if(smctr_debug > 10)
2801                 printk(KERN_DEBUG "%s: smctr_issue_resume_rx_fcb_cmd\n", dev->name);
2802
2803         if(smctr_wait_while_cbusy(dev))
2804                 return (-1);
2805
2806         if(queue == MAC_QUEUE)
2807                 tp->sclb_ptr->resume_control = SCLB_RC_RX_MAC_FCB;
2808         else
2809                 tp->sclb_ptr->resume_control = SCLB_RC_RX_NON_MAC_FCB;
2810
2811         tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_RESUME_CONTROL_VALID;
2812
2813         smctr_set_ctrl_attention(dev);
2814
2815         return (0);
2816 }
2817
2818 static int smctr_issue_resume_tx_fcb_cmd(struct net_device *dev, __u16 queue)
2819 {
2820         struct net_local *tp = netdev_priv(dev);
2821
2822         if(smctr_debug > 10)
2823                 printk(KERN_DEBUG "%s: smctr_issue_resume_tx_fcb_cmd\n", dev->name);
2824
2825         if(smctr_wait_while_cbusy(dev))
2826                 return (-1);
2827
2828         tp->sclb_ptr->resume_control = (SCLB_RC_TFCB0 << queue);
2829         tp->sclb_ptr->valid_command = SCLB_RESUME_CONTROL_VALID | SCLB_VALID;
2830
2831         smctr_set_ctrl_attention(dev);
2832
2833         return (0);
2834 }
2835
2836 static int smctr_issue_test_internal_rom_cmd(struct net_device *dev)
2837 {
2838         int err;
2839
2840         err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST,
2841                 TRC_INTERNAL_ROM_TEST);
2842
2843         return (err);
2844 }
2845
2846 static int smctr_issue_test_hic_cmd(struct net_device *dev)
2847 {
2848         int err;
2849
2850         err = smctr_setup_single_cmd(dev, ACB_CMD_HIC_TEST,
2851                 TRC_HOST_INTERFACE_REG_TEST);
2852
2853         return (err);
2854 }
2855
2856 static int smctr_issue_test_mac_reg_cmd(struct net_device *dev)
2857 {
2858         int err;
2859
2860         err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST,
2861                 TRC_MAC_REGISTERS_TEST);
2862
2863         return (err);
2864 }
2865
2866 static int smctr_issue_trc_loopback_cmd(struct net_device *dev)
2867 {
2868         int err;
2869
2870         err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST,
2871                 TRC_INTERNAL_LOOPBACK);
2872
2873         return (err);
2874 }
2875
2876 static int smctr_issue_tri_loopback_cmd(struct net_device *dev)
2877 {
2878         int err;
2879
2880         err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST,
2881                 TRC_TRI_LOOPBACK);
2882
2883         return (err);
2884 }
2885
2886 static int smctr_issue_write_byte_cmd(struct net_device *dev,
2887         short aword_cnt, void *byte)
2888 {
2889         struct net_local *tp = netdev_priv(dev);
2890         unsigned int iword, ibyte;
2891         int err;
2892
2893         if((err = smctr_wait_while_cbusy(dev)))
2894                 return (err);
2895
2896         if((err = smctr_wait_cmd(dev)))
2897                 return (err);
2898
2899         for(iword = 0, ibyte = 0; iword < (unsigned int)(aword_cnt & 0xff);
2900                 iword++, ibyte += 2)
2901         {
2902                 tp->misc_command_data[iword] = (*((__u8 *)byte + ibyte) << 8)
2903                         | (*((__u8 *)byte + ibyte + 1));
2904         }
2905
2906         return (smctr_setup_single_cmd_w_data(dev, ACB_CMD_MCT_WRITE_VALUE,
2907                 aword_cnt));
2908 }
2909
2910 static int smctr_issue_write_word_cmd(struct net_device *dev,
2911         short aword_cnt, void *word)
2912 {
2913         struct net_local *tp = netdev_priv(dev);
2914         unsigned int i, err;
2915
2916         if((err = smctr_wait_while_cbusy(dev)))
2917                 return (err);
2918
2919         if((err = smctr_wait_cmd(dev)))
2920                 return (err);
2921
2922         for(i = 0; i < (unsigned int)(aword_cnt & 0xff); i++)
2923                 tp->misc_command_data[i] = *((__u16 *)word + i);
2924
2925         err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_MCT_WRITE_VALUE,
2926                 aword_cnt);
2927
2928         return (err);
2929 }
2930
2931 static int smctr_join_complete_state(struct net_device *dev)
2932 {
2933         int err;
2934
2935         err = smctr_setup_single_cmd(dev, ACB_CMD_CHANGE_JOIN_STATE,
2936                 JS_JOIN_COMPLETE_STATE);
2937
2938         return (err);
2939 }
2940
2941 static int smctr_link_tx_fcbs_to_bdbs(struct net_device *dev)
2942 {
2943         struct net_local *tp = netdev_priv(dev);
2944         unsigned int i, j;
2945         FCBlock *fcb;
2946         BDBlock *bdb;
2947
2948         for(i = 0; i < NUM_TX_QS_USED; i++)
2949         {
2950                 fcb = tp->tx_fcb_head[i];
2951                 bdb = tp->tx_bdb_head[i];
2952
2953                 for(j = 0; j < tp->num_tx_fcbs[i]; j++)
2954                 {
2955                         fcb->bdb_ptr            = bdb;
2956                         fcb->trc_bdb_ptr        = TRC_POINTER(bdb);
2957                         fcb = (FCBlock *)((char *)fcb + sizeof(FCBlock));
2958                         bdb = (BDBlock *)((char *)bdb + sizeof(BDBlock));
2959                 }
2960         }
2961
2962         return (0);
2963 }
2964
2965 static int smctr_load_firmware(struct net_device *dev)
2966 {
2967         struct net_local *tp = netdev_priv(dev);
2968         const struct firmware *fw;
2969         __u16 i, checksum = 0;
2970         int err = 0;
2971
2972         if(smctr_debug > 10)
2973                 printk(KERN_DEBUG "%s: smctr_load_firmware\n", dev->name);
2974
2975         if (request_firmware(&fw, "tr_smctr.bin", &dev->dev)) {
2976                 printk(KERN_ERR "%s: firmware not found\n", dev->name);
2977                 return (UCODE_NOT_PRESENT);
2978         }
2979
2980         tp->num_of_tx_buffs     = 4;
2981         tp->mode_bits          |= UMAC;
2982         tp->receive_mask        = 0;
2983         tp->max_packet_size     = 4177;
2984
2985         /* Can only upload the firmware once per adapter reset. */
2986         if (tp->microcode_version != 0) {
2987                 err = (UCODE_PRESENT);
2988                 goto out;
2989         }
2990
2991         /* Verify the firmware exists and is there in the right amount. */
2992         if (!fw->data ||
2993             (*(fw->data + UCODE_VERSION_OFFSET) < UCODE_VERSION))
2994         {
2995                 err = (UCODE_NOT_PRESENT);
2996                 goto out;
2997         }
2998
2999         /* UCODE_SIZE is not included in Checksum. */
3000         for(i = 0; i < *((__u16 *)(fw->data + UCODE_SIZE_OFFSET)); i += 2)
3001                 checksum += *((__u16 *)(fw->data + 2 + i));
3002         if (checksum) {
3003                 err = (UCODE_NOT_PRESENT);
3004                 goto out;
3005         }
3006
3007         /* At this point we have a valid firmware image, lets kick it on up. */
3008         smctr_enable_adapter_ram(dev);
3009         smctr_enable_16bit(dev);
3010         smctr_set_page(dev, (__u8 *)tp->ram_access);
3011
3012         if((smctr_checksum_firmware(dev)) ||
3013            (*(fw->data + UCODE_VERSION_OFFSET) > tp->microcode_version))
3014         {
3015                 smctr_enable_adapter_ctrl_store(dev);
3016
3017                 /* Zero out ram space for firmware. */
3018                 for(i = 0; i < CS_RAM_SIZE; i += 2)
3019                         *((__u16 *)(tp->ram_access + i)) = 0;
3020
3021                 smctr_decode_firmware(dev, fw);
3022
3023                 tp->microcode_version = *(fw->data + UCODE_VERSION_OFFSET);                *((__u16 *)(tp->ram_access + CS_RAM_VERSION_OFFSET))
3024                         = (tp->microcode_version << 8);
3025                 *((__u16 *)(tp->ram_access + CS_RAM_CHECKSUM_OFFSET))
3026                         = ~(tp->microcode_version << 8) + 1;
3027
3028                 smctr_disable_adapter_ctrl_store(dev);
3029
3030                 if(smctr_checksum_firmware(dev))
3031                         err = HARDWARE_FAILED;
3032         }
3033         else
3034                 err = UCODE_PRESENT;
3035
3036         smctr_disable_16bit(dev);
3037  out:
3038         release_firmware(fw);
3039         return (err);
3040 }
3041
3042 static int smctr_load_node_addr(struct net_device *dev)
3043 {
3044         int ioaddr = dev->base_addr;
3045         unsigned int i;
3046         __u8 r;
3047
3048         for(i = 0; i < 6; i++)
3049         {
3050                 r = inb(ioaddr + LAR0 + i);
3051                 dev->dev_addr[i] = (char)r;
3052         }
3053         dev->addr_len = 6;
3054
3055         return (0);
3056 }
3057
3058 /* Lobe Media Test.
3059  * During the transmission of the initial 1500 lobe media MAC frames,
3060  * the phase lock loop in the 805 chip may lock, and then un-lock, causing
3061  * the 825 to go into a PURGE state. When performing a PURGE, the MCT
3062  * microcode will not transmit any frames given to it by the host, and
3063  * will consequently cause a timeout.
3064  *
3065  * NOTE 1: If the monitor_state is MS_BEACON_TEST_STATE, all transmit
3066  * queues other than the one used for the lobe_media_test should be
3067  * disabled.!?
3068  *
3069  * NOTE 2: If the monitor_state is MS_BEACON_TEST_STATE and the receive_mask
3070  * has any multi-cast or promiscous bits set, the receive_mask needs to
3071  * be changed to clear the multi-cast or promiscous mode bits, the lobe_test
3072  * run, and then the receive mask set back to its original value if the test
3073  * is successful.
3074  */
3075 static int smctr_lobe_media_test(struct net_device *dev)
3076 {
3077         struct net_local *tp = netdev_priv(dev);
3078         unsigned int i, perror = 0;
3079         unsigned short saved_rcv_mask;
3080
3081         if(smctr_debug > 10)
3082                 printk(KERN_DEBUG "%s: smctr_lobe_media_test\n", dev->name);
3083
3084         /* Clear receive mask for lobe test. */
3085         saved_rcv_mask          = tp->receive_mask;
3086         tp->receive_mask        = 0;
3087
3088         smctr_chg_rx_mask(dev);
3089
3090         /* Setup the lobe media test. */
3091         smctr_lobe_media_test_cmd(dev);
3092         if(smctr_wait_cmd(dev))
3093                 goto err;
3094
3095         /* Tx lobe media test frames. */
3096         for(i = 0; i < 1500; ++i)
3097         {
3098                 if(smctr_send_lobe_media_test(dev))
3099                 {
3100                         if(perror)
3101                                 goto err;
3102                         else
3103                         {
3104                                 perror = 1;
3105                                 if(smctr_lobe_media_test_cmd(dev))
3106                                         goto err;
3107                         }
3108                 }
3109         }
3110
3111         if(smctr_send_dat(dev))
3112         {
3113                 if(smctr_send_dat(dev))
3114                         goto err;
3115         }
3116
3117         /* Check if any frames received during test. */
3118         if((tp->rx_fcb_curr[MAC_QUEUE]->frame_status) ||
3119            (tp->rx_fcb_curr[NON_MAC_QUEUE]->frame_status))
3120                 goto err;
3121
3122         /* Set receive mask to "Promisc" mode. */
3123         tp->receive_mask = saved_rcv_mask;
3124
3125         smctr_chg_rx_mask(dev);
3126
3127          return 0;
3128 err:
3129         smctr_reset_adapter(dev);
3130         tp->status = CLOSED;
3131         return LOBE_MEDIA_TEST_FAILED;
3132 }
3133
3134 static int smctr_lobe_media_test_cmd(struct net_device *dev)
3135 {
3136         struct net_local *tp = netdev_priv(dev);
3137         int err;
3138
3139         if(smctr_debug > 10)
3140                 printk(KERN_DEBUG "%s: smctr_lobe_media_test_cmd\n", dev->name);
3141
3142         /* Change to lobe media test state. */
3143         if(tp->monitor_state != MS_BEACON_TEST_STATE)
3144         {
3145                 smctr_lobe_media_test_state(dev);
3146                 if(smctr_wait_cmd(dev))
3147                 {
3148                         printk(KERN_ERR "Lobe Failed test state\n");
3149                         return (LOBE_MEDIA_TEST_FAILED);
3150                 }
3151         }
3152
3153         err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST,
3154                 TRC_LOBE_MEDIA_TEST);
3155
3156         return (err);
3157 }
3158
3159 static int smctr_lobe_media_test_state(struct net_device *dev)
3160 {
3161         int err;
3162
3163         err = smctr_setup_single_cmd(dev, ACB_CMD_CHANGE_JOIN_STATE,
3164                 JS_LOBE_TEST_STATE);
3165
3166         return (err);
3167 }
3168
3169 static int smctr_make_8025_hdr(struct net_device *dev,
3170         MAC_HEADER *rmf, MAC_HEADER *tmf, __u16 ac_fc)
3171 {
3172         tmf->ac = MSB(ac_fc);                 /* msb is access control */
3173         tmf->fc = LSB(ac_fc);                 /* lsb is frame control */
3174
3175         tmf->sa[0] = dev->dev_addr[0];
3176         tmf->sa[1] = dev->dev_addr[1];
3177         tmf->sa[2] = dev->dev_addr[2];
3178         tmf->sa[3] = dev->dev_addr[3];
3179         tmf->sa[4] = dev->dev_addr[4];
3180         tmf->sa[5] = dev->dev_addr[5];
3181
3182         switch(tmf->vc)
3183         {
3184                 /* Send RQ_INIT to RPS */
3185                 case RQ_INIT:
3186                         tmf->da[0] = 0xc0;
3187                         tmf->da[1] = 0x00;
3188                         tmf->da[2] = 0x00;
3189                         tmf->da[3] = 0x00;
3190                         tmf->da[4] = 0x00;
3191                         tmf->da[5] = 0x02;
3192                         break;
3193
3194                 /* Send RPT_TX_FORWARD to CRS */
3195                 case RPT_TX_FORWARD:
3196                         tmf->da[0] = 0xc0;
3197                         tmf->da[1] = 0x00;
3198                         tmf->da[2] = 0x00;
3199                         tmf->da[3] = 0x00;
3200                         tmf->da[4] = 0x00;
3201                         tmf->da[5] = 0x10;
3202                         break;
3203
3204                 /* Everything else goes to sender */
3205                 default:
3206                         tmf->da[0] = rmf->sa[0];
3207                         tmf->da[1] = rmf->sa[1];
3208                         tmf->da[2] = rmf->sa[2];
3209                         tmf->da[3] = rmf->sa[3];
3210                         tmf->da[4] = rmf->sa[4];
3211                         tmf->da[5] = rmf->sa[5];
3212                         break;
3213         }
3214
3215         return (0);
3216 }
3217
3218 static int smctr_make_access_pri(struct net_device *dev, MAC_SUB_VECTOR *tsv)
3219 {
3220         struct net_local *tp = netdev_priv(dev);
3221
3222         tsv->svi = AUTHORIZED_ACCESS_PRIORITY;
3223         tsv->svl = S_AUTHORIZED_ACCESS_PRIORITY;
3224
3225         tsv->svv[0] = MSB(tp->authorized_access_priority);
3226         tsv->svv[1] = LSB(tp->authorized_access_priority);
3227
3228         return (0);
3229 }
3230
3231 static int smctr_make_addr_mod(struct net_device *dev, MAC_SUB_VECTOR *tsv)
3232 {
3233         tsv->svi = ADDRESS_MODIFER;
3234         tsv->svl = S_ADDRESS_MODIFER;
3235
3236         tsv->svv[0] = 0;
3237         tsv->svv[1] = 0;
3238
3239         return (0);
3240 }
3241
3242 static int smctr_make_auth_funct_class(struct net_device *dev,
3243         MAC_SUB_VECTOR *tsv)
3244 {
3245         struct net_local *tp = netdev_priv(dev);
3246
3247         tsv->svi = AUTHORIZED_FUNCTION_CLASS;
3248         tsv->svl = S_AUTHORIZED_FUNCTION_CLASS;
3249
3250         tsv->svv[0] = MSB(tp->authorized_function_classes);
3251         tsv->svv[1] = LSB(tp->authorized_function_classes);
3252
3253         return (0);
3254 }
3255
3256 static int smctr_make_corr(struct net_device *dev,
3257         MAC_SUB_VECTOR *tsv, __u16 correlator)
3258 {
3259         tsv->svi = CORRELATOR;
3260         tsv->svl = S_CORRELATOR;
3261
3262         tsv->svv[0] = MSB(correlator);
3263         tsv->svv[1] = LSB(correlator);
3264
3265         return (0);
3266 }
3267
3268 static int smctr_make_funct_addr(struct net_device *dev, MAC_SUB_VECTOR *tsv)
3269 {
3270         struct net_local *tp = netdev_priv(dev);
3271
3272         smctr_get_functional_address(dev);
3273
3274         tsv->svi = FUNCTIONAL_ADDRESS;
3275         tsv->svl = S_FUNCTIONAL_ADDRESS;
3276
3277         tsv->svv[0] = MSB(tp->misc_command_data[0]);
3278         tsv->svv[1] = LSB(tp->misc_command_data[0]);
3279
3280         tsv->svv[2] = MSB(tp->misc_command_data[1]);
3281         tsv->svv[3] = LSB(tp->misc_command_data[1]);
3282
3283         return (0);
3284 }
3285
3286 static int smctr_make_group_addr(struct net_device *dev, MAC_SUB_VECTOR *tsv)
3287 {
3288         struct net_local *tp = netdev_priv(dev);
3289
3290         smctr_get_group_address(dev);
3291
3292         tsv->svi = GROUP_ADDRESS;
3293         tsv->svl = S_GROUP_ADDRESS;
3294
3295         tsv->svv[0] = MSB(tp->misc_command_data[0]);
3296         tsv->svv[1] = LSB(tp->misc_command_data[0]);
3297
3298         tsv->svv[2] = MSB(tp->misc_command_data[1]);
3299         tsv->svv[3] = LSB(tp->misc_command_data[1]);
3300
3301         /* Set Group Address Sub-vector to all zeros if only the
3302          * Group Address/Functional Address Indicator is set.
3303          */
3304         if(tsv->svv[0] == 0x80 && tsv->svv[1] == 0x00 &&
3305            tsv->svv[2] == 0x00 && tsv->svv[3] == 0x00)
3306                 tsv->svv[0] = 0x00;
3307
3308         return (0);
3309 }
3310
3311 static int smctr_make_phy_drop_num(struct net_device *dev,
3312         MAC_SUB_VECTOR *tsv)
3313 {
3314         struct net_local *tp = netdev_priv(dev);
3315
3316         smctr_get_physical_drop_number(dev);
3317
3318         tsv->svi = PHYSICAL_DROP;
3319         tsv->svl = S_PHYSICAL_DROP;
3320
3321         tsv->svv[0] = MSB(tp->misc_command_data[0]);
3322         tsv->svv[1] = LSB(tp->misc_command_data[0]);
3323
3324         tsv->svv[2] = MSB(tp->misc_command_data[1]);
3325         tsv->svv[3] = LSB(tp->misc_command_data[1]);
3326
3327         return (0);
3328 }
3329
3330 static int smctr_make_product_id(struct net_device *dev, MAC_SUB_VECTOR *tsv)
3331 {
3332         int i;
3333
3334         tsv->svi = PRODUCT_INSTANCE_ID;
3335         tsv->svl = S_PRODUCT_INSTANCE_ID;
3336
3337         for(i = 0; i < 18; i++)
3338                 tsv->svv[i] = 0xF0;
3339
3340         return (0);
3341 }
3342
3343 static int smctr_make_station_id(struct net_device *dev, MAC_SUB_VECTOR *tsv)
3344 {
3345         struct net_local *tp = netdev_priv(dev);
3346
3347         smctr_get_station_id(dev);
3348
3349         tsv->svi = STATION_IDENTIFER;
3350         tsv->svl = S_STATION_IDENTIFER;
3351
3352         tsv->svv[0] = MSB(tp->misc_command_data[0]);
3353         tsv->svv[1] = LSB(tp->misc_command_data[0]);
3354
3355         tsv->svv[2] = MSB(tp->misc_command_data[1]);
3356         tsv->svv[3] = LSB(tp->misc_command_data[1]);
3357
3358         tsv->svv[4] = MSB(tp->misc_command_data[2]);
3359         tsv->svv[5] = LSB(tp->misc_command_data[2]);
3360
3361         return (0);
3362 }
3363
3364 static int smctr_make_ring_station_status(struct net_device *dev,
3365         MAC_SUB_VECTOR * tsv)
3366 {
3367         tsv->svi = RING_STATION_STATUS;
3368         tsv->svl = S_RING_STATION_STATUS;
3369
3370         tsv->svv[0] = 0;
3371         tsv->svv[1] = 0;
3372         tsv->svv[2] = 0;
3373         tsv->svv[3] = 0;
3374         tsv->svv[4] = 0;
3375         tsv->svv[5] = 0;
3376
3377         return (0);
3378 }
3379
3380 static int smctr_make_ring_station_version(struct net_device *dev,
3381         MAC_SUB_VECTOR *tsv)
3382 {
3383         struct net_local *tp = netdev_priv(dev);
3384
3385         tsv->svi = RING_STATION_VERSION_NUMBER;
3386         tsv->svl = S_RING_STATION_VERSION_NUMBER;
3387
3388         tsv->svv[0] = 0xe2;            /* EBCDIC - S */
3389         tsv->svv[1] = 0xd4;            /* EBCDIC - M */
3390         tsv->svv[2] = 0xc3;            /* EBCDIC - C */
3391         tsv->svv[3] = 0x40;            /* EBCDIC -   */
3392         tsv->svv[4] = 0xe5;            /* EBCDIC - V */
3393         tsv->svv[5] = 0xF0 + (tp->microcode_version >> 4);
3394         tsv->svv[6] = 0xF0 + (tp->microcode_version & 0x0f);
3395         tsv->svv[7] = 0x40;            /* EBCDIC -   */
3396         tsv->svv[8] = 0xe7;            /* EBCDIC - X */
3397
3398         if(tp->extra_info & CHIP_REV_MASK)
3399                 tsv->svv[9] = 0xc5;    /* EBCDIC - E */
3400         else
3401                 tsv->svv[9] = 0xc4;    /* EBCDIC - D */
3402
3403         return (0);
3404 }
3405
3406 static int smctr_make_tx_status_code(struct net_device *dev,
3407         MAC_SUB_VECTOR *tsv, __u16 tx_fstatus)
3408 {
3409         tsv->svi = TRANSMIT_STATUS_CODE;
3410         tsv->svl = S_TRANSMIT_STATUS_CODE;
3411
3412         tsv->svv[0] = ((tx_fstatus & 0x0100 >> 6) | IBM_PASS_SOURCE_ADDR);
3413
3414         /* Stripped frame status of Transmitted Frame */
3415         tsv->svv[1] = tx_fstatus & 0xff;
3416
3417         return (0);
3418 }
3419
3420 static int smctr_make_upstream_neighbor_addr(struct net_device *dev,
3421         MAC_SUB_VECTOR *tsv)
3422 {
3423         struct net_local *tp = netdev_priv(dev);
3424
3425         smctr_get_upstream_neighbor_addr(dev);
3426
3427         tsv->svi = UPSTREAM_NEIGHBOR_ADDRESS;
3428         tsv->svl = S_UPSTREAM_NEIGHBOR_ADDRESS;
3429
3430         tsv->svv[0] = MSB(tp->misc_command_data[0]);
3431         tsv->svv[1] = LSB(tp->misc_command_data[0]);
3432
3433         tsv->svv[2] = MSB(tp->misc_command_data[1]);
3434         tsv->svv[3] = LSB(tp->misc_command_data[1]);
3435
3436         tsv->svv[4] = MSB(tp->misc_command_data[2]);
3437         tsv->svv[5] = LSB(tp->misc_command_data[2]);
3438
3439         return (0);
3440 }
3441
3442 static int smctr_make_wrap_data(struct net_device *dev, MAC_SUB_VECTOR *tsv)
3443 {
3444         tsv->svi = WRAP_DATA;
3445         tsv->svl = S_WRAP_DATA;
3446
3447         return (0);
3448 }
3449
3450 /*
3451  * Open/initialize the board. This is called sometime after
3452  * booting when the 'ifconfig' program is run.
3453  *
3454  * This routine should set everything up anew at each open, even
3455  * registers that "should" only need to be set once at boot, so that
3456  * there is non-reboot way to recover if something goes wrong.
3457  */
3458 static int smctr_open(struct net_device *dev)
3459 {
3460         int err;
3461
3462         if(smctr_debug > 10)
3463                 printk(KERN_DEBUG "%s: smctr_open\n", dev->name);
3464
3465         err = smctr_init_adapter(dev);
3466         if(err < 0)
3467                 return (err);
3468
3469         return (err);
3470 }
3471
3472 /* Interrupt driven open of Token card. */
3473 static int smctr_open_tr(struct net_device *dev)
3474 {
3475         struct net_local *tp = netdev_priv(dev);
3476         unsigned long flags;
3477         int err;
3478
3479         if(smctr_debug > 10)
3480                 printk(KERN_DEBUG "%s: smctr_open_tr\n", dev->name);
3481
3482         /* Now we can actually open the adapter. */
3483         if(tp->status == OPEN)
3484                 return (0);
3485         if(tp->status != INITIALIZED)
3486                 return (-1);
3487
3488         /* FIXME: it would work a lot better if we masked the irq sources
3489            on the card here, then we could skip the locking and poll nicely */
3490         spin_lock_irqsave(&tp->lock, flags);
3491
3492         smctr_set_page(dev, (__u8 *)tp->ram_access);
3493
3494         if((err = smctr_issue_resume_rx_fcb_cmd(dev, (short)MAC_QUEUE)))
3495                 goto out;
3496
3497         if((err = smctr_issue_resume_rx_bdb_cmd(dev, (short)MAC_QUEUE)))
3498                 goto out;
3499
3500         if((err = smctr_issue_resume_rx_fcb_cmd(dev, (short)NON_MAC_QUEUE)))
3501                 goto out;
3502
3503         if((err = smctr_issue_resume_rx_bdb_cmd(dev, (short)NON_MAC_QUEUE)))
3504                 goto out;
3505
3506         tp->status = CLOSED;
3507
3508         /* Insert into the Ring or Enter Loopback Mode. */
3509         if((tp->mode_bits & LOOPING_MODE_MASK) == LOOPBACK_MODE_1)
3510         {
3511                 tp->status = CLOSED;
3512
3513                 if(!(err = smctr_issue_trc_loopback_cmd(dev)))
3514                 {
3515                         if(!(err = smctr_wait_cmd(dev)))
3516                                 tp->status = OPEN;
3517                 }
3518
3519                 smctr_status_chg(dev);
3520         }
3521         else
3522         {
3523                 if((tp->mode_bits & LOOPING_MODE_MASK) == LOOPBACK_MODE_2)
3524                 {
3525                         tp->status = CLOSED;
3526                         if(!(err = smctr_issue_tri_loopback_cmd(dev)))
3527                         {
3528                                 if(!(err = smctr_wait_cmd(dev)))
3529                                         tp->status = OPEN;
3530                         }
3531
3532                         smctr_status_chg(dev);
3533                 }
3534                 else
3535                 {
3536                         if((tp->mode_bits & LOOPING_MODE_MASK)
3537                                 == LOOPBACK_MODE_3)
3538                         {
3539                                 tp->status = CLOSED;
3540                                 if(!(err = smctr_lobe_media_test_cmd(dev)))
3541                                 {
3542                                         if(!(err = smctr_wait_cmd(dev)))
3543                                                 tp->status = OPEN;
3544                                 }
3545                                 smctr_status_chg(dev);
3546                         }
3547                         else
3548                         {
3549                                 if(!(err = smctr_lobe_media_test(dev)))
3550                                         err = smctr_issue_insert_cmd(dev);
3551                                 else
3552                                 {
3553                                         if(err == LOBE_MEDIA_TEST_FAILED)
3554                                                 printk(KERN_WARNING "%s: Lobe Media Test Failure - Check cable?\n", dev->name);
3555                                 }
3556                         }
3557                 }
3558         }
3559
3560 out:
3561         spin_unlock_irqrestore(&tp->lock, flags);
3562
3563         return (err);
3564 }
3565
3566 /* Check for a network adapter of this type,
3567  * and return device structure if one exists.
3568  */
3569 struct net_device __init *smctr_probe(int unit)
3570 {
3571         struct net_device *dev = alloc_trdev(sizeof(struct net_local));
3572         static const unsigned ports[] = {
3573                 0x200, 0x220, 0x240, 0x260, 0x280, 0x2A0, 0x2C0, 0x2E0, 0x300,
3574                 0x320, 0x340, 0x360, 0x380, 0
3575         };
3576         const unsigned *port;
3577         int err = 0;
3578
3579         if (!dev)
3580                 return ERR_PTR(-ENOMEM);
3581
3582         if (unit >= 0) {
3583                 sprintf(dev->name, "tr%d", unit);
3584                 netdev_boot_setup_check(dev);
3585         }
3586
3587         if (dev->base_addr > 0x1ff)    /* Check a single specified location. */
3588                 err = smctr_probe1(dev, dev->base_addr);
3589         else if(dev->base_addr != 0)  /* Don't probe at all. */
3590                 err =-ENXIO;
3591         else {
3592                 for (port = ports; *port; port++) {
3593                         err = smctr_probe1(dev, *port);
3594                         if (!err)
3595                                 break;
3596                 }
3597         }
3598         if (err)
3599                 goto out;
3600         err = register_netdev(dev);
3601         if (err)
3602                 goto out1;
3603         return dev;
3604 out1:
3605 #ifdef CONFIG_MCA_LEGACY
3606         { struct net_local *tp = netdev_priv(dev);
3607           if (tp->slot_num)
3608                 mca_mark_as_unused(tp->slot_num);
3609         }
3610 #endif
3611         release_region(dev->base_addr, SMCTR_IO_EXTENT);
3612         free_irq(dev->irq, dev);
3613 out:
3614         free_netdev(dev);
3615         return ERR_PTR(err);
3616 }
3617
3618 static const struct net_device_ops smctr_netdev_ops = {
3619         .ndo_open          = smctr_open,
3620         .ndo_stop          = smctr_close,
3621         .ndo_start_xmit    = smctr_send_packet,
3622         .ndo_tx_timeout    = smctr_timeout,
3623         .ndo_get_stats     = smctr_get_stats,
3624         .ndo_set_multicast_list = smctr_set_multicast_list,
3625 };
3626
3627 static int __init smctr_probe1(struct net_device *dev, int ioaddr)
3628 {
3629         static unsigned version_printed;
3630         struct net_local *tp = netdev_priv(dev);
3631         int err;
3632         __u32 *ram;
3633
3634         if(smctr_debug && version_printed++ == 0)
3635                 printk(version);
3636
3637         spin_lock_init(&tp->lock);
3638         dev->base_addr = ioaddr;
3639
3640         /* Actually detect an adapter now. */
3641         err = smctr_chk_isa(dev);
3642         if(err < 0)
3643         {
3644                 if ((err = smctr_chk_mca(dev)) < 0) {
3645                         err = -ENODEV;
3646                         goto out;
3647                 }
3648         }
3649
3650         tp = netdev_priv(dev);
3651         dev->mem_start = tp->ram_base;
3652         dev->mem_end = dev->mem_start + 0x10000;
3653         ram = (__u32 *)phys_to_virt(dev->mem_start);
3654         tp->ram_access = *(__u32 *)&ram;
3655         tp->status = NOT_INITIALIZED;
3656
3657         err = smctr_load_firmware(dev);
3658         if(err != UCODE_PRESENT && err != SUCCESS)
3659         {
3660                 printk(KERN_ERR "%s: Firmware load failed (%d)\n", dev->name, err);
3661                 err = -EIO;
3662                 goto out;
3663         }
3664
3665         /* Allow user to specify ring speed on module insert. */
3666         if(ringspeed == 4)
3667                 tp->media_type = MEDIA_UTP_4;
3668         else
3669                 tp->media_type = MEDIA_UTP_16;
3670
3671         printk(KERN_INFO "%s: %s %s at Io %#4x, Irq %d, Rom %#4x, Ram %#4x.\n",
3672                 dev->name, smctr_name, smctr_model,
3673                 (unsigned int)dev->base_addr,
3674                 dev->irq, tp->rom_base, tp->ram_base);
3675
3676         dev->netdev_ops = &smctr_netdev_ops;
3677         dev->watchdog_timeo     = HZ;
3678         return (0);
3679
3680 out:
3681         return err;
3682 }
3683
3684 static int smctr_process_rx_packet(MAC_HEADER *rmf, __u16 size,
3685         struct net_device *dev, __u16 rx_status)
3686 {
3687         struct net_local *tp = netdev_priv(dev);
3688         struct sk_buff *skb;
3689         __u16 rcode, correlator;
3690         int err = 0;
3691         __u8 xframe = 1;
3692
3693         rmf->vl = SWAP_BYTES(rmf->vl);
3694         if(rx_status & FCB_RX_STATUS_DA_MATCHED)
3695         {
3696                 switch(rmf->vc)
3697                 {
3698                         /* Received MAC Frames Processed by RS. */
3699                         case INIT:
3700                                 if((rcode = smctr_rcv_init(dev, rmf, &correlator)) == HARDWARE_FAILED)
3701                                 {
3702                                         return (rcode);
3703                                 }
3704
3705                                 if((err = smctr_send_rsp(dev, rmf, rcode,
3706                                         correlator)))
3707                                 {
3708                                         return (err);
3709                                 }
3710                                 break;
3711
3712                         case CHG_PARM:
3713                                 if((rcode = smctr_rcv_chg_param(dev, rmf,
3714                                         &correlator)) ==HARDWARE_FAILED)
3715                                 {
3716                                         return (rcode);
3717                                 }
3718
3719                                 if((err = smctr_send_rsp(dev, rmf, rcode,
3720                                         correlator)))
3721                                 {
3722                                         return (err);
3723                                 }
3724                                 break;
3725
3726                         case RQ_ADDR:
3727                                 if((rcode = smctr_rcv_rq_addr_state_attch(dev,
3728                                         rmf, &correlator)) != POSITIVE_ACK)
3729                                 {
3730                                         if(rcode == HARDWARE_FAILED)
3731                                                 return (rcode);
3732                                         else
3733                                                 return (smctr_send_rsp(dev, rmf,
3734                                                         rcode, correlator));
3735                                 }
3736
3737                                 if((err = smctr_send_rpt_addr(dev, rmf,
3738                                         correlator)))
3739                                 {
3740                                         return (err);
3741                                 }
3742                                 break;
3743
3744                         case RQ_ATTCH:
3745                                 if((rcode = smctr_rcv_rq_addr_state_attch(dev,
3746                                         rmf, &correlator)) != POSITIVE_ACK)
3747                                 {
3748                                         if(rcode == HARDWARE_FAILED)
3749                                                 return (rcode);
3750                                         else
3751                                                 return (smctr_send_rsp(dev, rmf,
3752                                                         rcode,
3753                                                         correlator));
3754                                 }
3755
3756                                 if((err = smctr_send_rpt_attch(dev, rmf,
3757                                         correlator)))
3758                                 {
3759                                         return (err);
3760                                 }
3761                                 break;
3762
3763                         case RQ_STATE:
3764                                 if((rcode = smctr_rcv_rq_addr_state_attch(dev,
3765                                         rmf, &correlator)) != POSITIVE_ACK)
3766                                 {
3767                                         if(rcode == HARDWARE_FAILED)
3768                                                 return (rcode);
3769                                         else
3770                                                 return (smctr_send_rsp(dev, rmf,
3771                                                         rcode,
3772                                                         correlator));
3773                                 }
3774
3775                                 if((err = smctr_send_rpt_state(dev, rmf,
3776                                         correlator)))
3777                                 {
3778                                         return (err);
3779                                 }
3780                                 break;
3781
3782                         case TX_FORWARD: {
3783                                 __u16 uninitialized_var(tx_fstatus);
3784
3785                                 if((rcode = smctr_rcv_tx_forward(dev, rmf))
3786                                         != POSITIVE_ACK)
3787                                 {
3788                                         if(rcode == HARDWARE_FAILED)
3789                                                 return (rcode);
3790                                         else
3791                                                 return (smctr_send_rsp(dev, rmf,
3792                                                         rcode,
3793                                                         correlator));
3794                                 }
3795
3796                                 if((err = smctr_send_tx_forward(dev, rmf,
3797                                         &tx_fstatus)) == HARDWARE_FAILED)
3798                                 {
3799                                         return (err);
3800                                 }
3801
3802                                 if(err == A_FRAME_WAS_FORWARDED)
3803                                 {
3804                                         if((err = smctr_send_rpt_tx_forward(dev,
3805                                                 rmf, tx_fstatus))
3806                                                 == HARDWARE_FAILED)
3807                                         {
3808                                                 return (err);
3809                                         }
3810                                 }
3811                                 break;
3812                         }
3813
3814                         /* Received MAC Frames Processed by CRS/REM/RPS. */
3815                         case RSP:
3816                         case RQ_INIT:
3817                         case RPT_NEW_MON:
3818                         case RPT_SUA_CHG:
3819                         case RPT_ACTIVE_ERR:
3820                         case RPT_NN_INCMP:
3821                         case RPT_ERROR:
3822                         case RPT_ATTCH:
3823                         case RPT_STATE:
3824                         case RPT_ADDR:
3825                                 break;
3826
3827                         /* Rcvd Att. MAC Frame (if RXATMAC set) or UNKNOWN */
3828                         default:
3829                                 xframe = 0;
3830                                 if(!(tp->receive_mask & ACCEPT_ATT_MAC_FRAMES))
3831                                 {
3832                                         rcode = smctr_rcv_unknown(dev, rmf,
3833                                                 &correlator);
3834                                         if((err = smctr_send_rsp(dev, rmf,rcode,
3835                                                 correlator)))
3836                                         {
3837                                                 return (err);
3838                                         }
3839                                 }
3840
3841                                 break;
3842                 }
3843         }
3844         else
3845         {
3846                 /* 1. DA doesn't match (Promiscuous Mode).
3847                  * 2. Parse for Extended MAC Frame Type.
3848                  */
3849                 switch(rmf->vc)
3850                 {
3851                         case RSP:
3852                         case INIT:
3853                         case RQ_INIT:
3854                         case RQ_ADDR:
3855                         case RQ_ATTCH:
3856                         case RQ_STATE:
3857                         case CHG_PARM:
3858                         case RPT_ADDR:
3859                         case RPT_ERROR:
3860                         case RPT_ATTCH:
3861                         case RPT_STATE:
3862                         case RPT_NEW_MON:
3863                         case RPT_SUA_CHG:
3864                         case RPT_NN_INCMP:
3865                         case RPT_ACTIVE_ERR:
3866                                 break;
3867
3868                         default:
3869                                 xframe = 0;
3870                                 break;
3871                 }
3872         }
3873
3874         /* NOTE: UNKNOWN MAC frames will NOT be passed up unless
3875          * ACCEPT_ATT_MAC_FRAMES is set.
3876          */
3877         if(((tp->receive_mask & ACCEPT_ATT_MAC_FRAMES) &&
3878             (xframe == (__u8)0)) ||
3879            ((tp->receive_mask & ACCEPT_EXT_MAC_FRAMES) &&
3880             (xframe == (__u8)1)))
3881         {
3882                 rmf->vl = SWAP_BYTES(rmf->vl);
3883
3884                 if (!(skb = dev_alloc_skb(size)))
3885                         return -ENOMEM;
3886                 skb->len = size;
3887
3888                 /* Slide data into a sleek skb. */
3889                 skb_put(skb, skb->len);
3890                 skb_copy_to_linear_data(skb, rmf, skb->len);
3891
3892                 /* Update Counters */
3893                 tp->MacStat.rx_packets++;
3894                 tp->MacStat.rx_bytes += skb->len;
3895
3896                 /* Kick the packet on up. */
3897                 skb->protocol = tr_type_trans(skb, dev);
3898                 netif_rx(skb);
3899                 err = 0;
3900         }
3901
3902         return (err);
3903 }
3904
3905 /* Adapter RAM test. Incremental word ODD boundary data test. */
3906 static int smctr_ram_memory_test(struct net_device *dev)
3907 {
3908         struct net_local *tp = netdev_priv(dev);
3909         __u16 page, pages_of_ram, start_pattern = 0, word_pattern = 0,
3910                 word_read = 0, err_word = 0, err_pattern = 0;
3911         unsigned int err_offset;
3912         __u32 j, pword;
3913         __u8 err = 0;
3914
3915         if(smctr_debug > 10)
3916                 printk(KERN_DEBUG "%s: smctr_ram_memory_test\n", dev->name);
3917
3918         start_pattern   = 0x0001;
3919         pages_of_ram    = tp->ram_size / tp->ram_usable;
3920         pword           = tp->ram_access;
3921
3922         /* Incremental word ODD boundary test. */
3923         for(page = 0; (page < pages_of_ram) && (~err);
3924                 page++, start_pattern += 0x8000)
3925         {
3926                 smctr_set_page(dev, (__u8 *)(tp->ram_access
3927                         + (page * tp->ram_usable * 1024) + 1));
3928                 word_pattern = start_pattern;
3929
3930                 for(j = 1; j < (__u32)(tp->ram_usable * 1024) - 1; j += 2)
3931                         *(__u16 *)(pword + j) = word_pattern++;
3932
3933                 word_pattern = start_pattern;
3934
3935                 for(j = 1; j < (__u32)(tp->ram_usable * 1024) - 1 && (~err);
3936                     j += 2, word_pattern++)
3937                 {
3938                         word_read = *(__u16 *)(pword + j);
3939                         if(word_read != word_pattern)
3940                         {
3941                                 err             = (__u8)1;
3942                                 err_offset      = j;
3943                                 err_word        = word_read;
3944                                 err_pattern     = word_pattern;
3945                                 return (RAM_TEST_FAILED);
3946                         }
3947                 }
3948         }
3949
3950         /* Zero out memory. */
3951         for(page = 0; page < pages_of_ram && (~err); page++)
3952         {
3953                 smctr_set_page(dev, (__u8 *)(tp->ram_access
3954                         + (page * tp->ram_usable * 1024)));
3955                 word_pattern = 0;
3956
3957                 for(j = 0; j < (__u32)tp->ram_usable * 1024; j +=2)
3958                         *(__u16 *)(pword + j) = word_pattern;
3959
3960                 for(j =0; j < (__u32)tp->ram_usable * 1024 && (~err); j += 2)
3961                 {
3962                         word_read = *(__u16 *)(pword + j);
3963                         if(word_read != word_pattern)
3964                         {
3965                                 err             = (__u8)1;
3966                                 err_offset      = j;
3967                                 err_word        = word_read;
3968                                 err_pattern     = word_pattern;
3969                                 return (RAM_TEST_FAILED);
3970                         }
3971                 }
3972         }
3973
3974         smctr_set_page(dev, (__u8 *)tp->ram_access);
3975
3976         return (0);
3977 }
3978
3979 static int smctr_rcv_chg_param(struct net_device *dev, MAC_HEADER *rmf,
3980         __u16 *correlator)
3981 {
3982         MAC_SUB_VECTOR *rsv;
3983         signed short vlen;
3984         __u16 rcode = POSITIVE_ACK;
3985         unsigned int svectors = F_NO_SUB_VECTORS_FOUND;
3986
3987         /* This Frame can only come from a CRS */
3988         if((rmf->dc_sc & SC_MASK) != SC_CRS)
3989                 return(E_INAPPROPRIATE_SOURCE_CLASS);
3990
3991         /* Remove MVID Length from total length. */
3992         vlen = (signed short)rmf->vl - 4;
3993
3994         /* Point to First SVID */
3995         rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER));
3996
3997         /* Search for Appropriate SVID's. */
3998         while((vlen > 0) && (rcode == POSITIVE_ACK))
3999         {
4000                 switch(rsv->svi)
4001                 {
4002                         case CORRELATOR:
4003                                 svectors |= F_CORRELATOR;
4004                                 rcode = smctr_set_corr(dev, rsv, correlator);
4005                                 break;
4006
4007                         case LOCAL_RING_NUMBER:
4008                                 svectors |= F_LOCAL_RING_NUMBER;
4009                                 rcode = smctr_set_local_ring_num(dev, rsv);
4010                                 break;
4011
4012                         case ASSIGN_PHYSICAL_DROP:
4013                                 svectors |= F_ASSIGN_PHYSICAL_DROP;
4014                                 rcode = smctr_set_phy_drop(dev, rsv);
4015                                 break;
4016
4017                         case ERROR_TIMER_VALUE:
4018                                 svectors |= F_ERROR_TIMER_VALUE;
4019                                 rcode = smctr_set_error_timer_value(dev, rsv);
4020                                 break;
4021
4022                         case AUTHORIZED_FUNCTION_CLASS:
4023                                 svectors |= F_AUTHORIZED_FUNCTION_CLASS;
4024                                 rcode = smctr_set_auth_funct_class(dev, rsv);
4025                                 break;
4026
4027                         case AUTHORIZED_ACCESS_PRIORITY:
4028                                 svectors |= F_AUTHORIZED_ACCESS_PRIORITY;
4029                                 rcode = smctr_set_auth_access_pri(dev, rsv);
4030                                 break;
4031
4032                         default:
4033                                 rcode = E_SUB_VECTOR_UNKNOWN;
4034                                 break;
4035                 }
4036
4037                 /* Let Sender Know if SUM of SV length's is
4038                  * larger then length in MVID length field
4039                  */
4040                 if((vlen -= rsv->svl) < 0)
4041                         rcode = E_VECTOR_LENGTH_ERROR;
4042
4043                 rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl);
4044         }
4045
4046         if(rcode == POSITIVE_ACK)
4047         {
4048                 /* Let Sender Know if MVID length field
4049                  * is larger then SUM of SV length's
4050                  */
4051                 if(vlen != 0)
4052                         rcode = E_VECTOR_LENGTH_ERROR;
4053                 else
4054                 {
4055                         /* Let Sender Know if Expected SVID Missing */
4056                         if((svectors & R_CHG_PARM) ^ R_CHG_PARM)
4057                                 rcode = E_MISSING_SUB_VECTOR;
4058                 }
4059         }
4060
4061         return (rcode);
4062 }
4063
4064 static int smctr_rcv_init(struct net_device *dev, MAC_HEADER *rmf,
4065         __u16 *correlator)
4066 {
4067         MAC_SUB_VECTOR *rsv;
4068         signed short vlen;
4069         __u16 rcode = POSITIVE_ACK;
4070         unsigned int svectors = F_NO_SUB_VECTORS_FOUND;
4071
4072         /* This Frame can only come from a RPS */
4073         if((rmf->dc_sc & SC_MASK) != SC_RPS)
4074                 return (E_INAPPROPRIATE_SOURCE_CLASS);
4075
4076         /* Remove MVID Length from total length. */
4077         vlen = (signed short)rmf->vl - 4;
4078
4079         /* Point to First SVID */
4080         rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER));
4081
4082         /* Search for Appropriate SVID's */
4083         while((vlen > 0) && (rcode == POSITIVE_ACK))
4084         {
4085                 switch(rsv->svi)
4086                 {
4087                         case CORRELATOR:
4088                                 svectors |= F_CORRELATOR;
4089                                 rcode = smctr_set_corr(dev, rsv, correlator);
4090                                 break;
4091
4092                         case LOCAL_RING_NUMBER:
4093                                 svectors |= F_LOCAL_RING_NUMBER;
4094                                 rcode = smctr_set_local_ring_num(dev, rsv);
4095                                 break;
4096
4097                         case ASSIGN_PHYSICAL_DROP:
4098                                 svectors |= F_ASSIGN_PHYSICAL_DROP;
4099                                 rcode = smctr_set_phy_drop(dev, rsv);
4100                                 break;
4101
4102                         case ERROR_TIMER_VALUE:
4103                                 svectors |= F_ERROR_TIMER_VALUE;
4104                                 rcode = smctr_set_error_timer_value(dev, rsv);
4105                                 break;
4106
4107                         default:
4108                                 rcode = E_SUB_VECTOR_UNKNOWN;
4109                                 break;
4110                 }
4111
4112                 /* Let Sender Know if SUM of SV length's is
4113                  * larger then length in MVID length field
4114                  */
4115                 if((vlen -= rsv->svl) < 0)
4116                         rcode = E_VECTOR_LENGTH_ERROR;
4117
4118                 rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl);
4119         }
4120
4121         if(rcode == POSITIVE_ACK)
4122         {
4123                 /* Let Sender Know if MVID length field
4124                  * is larger then SUM of SV length's
4125                  */
4126                 if(vlen != 0)
4127                         rcode = E_VECTOR_LENGTH_ERROR;
4128                 else
4129                 {
4130                         /* Let Sender Know if Expected SV Missing */
4131                         if((svectors & R_INIT) ^ R_INIT)
4132                                 rcode = E_MISSING_SUB_VECTOR;
4133                 }
4134         }
4135
4136         return (rcode);
4137 }
4138
4139 static int smctr_rcv_tx_forward(struct net_device *dev, MAC_HEADER *rmf)
4140 {
4141         MAC_SUB_VECTOR *rsv;
4142         signed short vlen;
4143         __u16 rcode = POSITIVE_ACK;
4144         unsigned int svectors = F_NO_SUB_VECTORS_FOUND;
4145
4146         /* This Frame can only come from a CRS */
4147         if((rmf->dc_sc & SC_MASK) != SC_CRS)
4148                 return (E_INAPPROPRIATE_SOURCE_CLASS);
4149
4150         /* Remove MVID Length from total length */
4151         vlen = (signed short)rmf->vl - 4;
4152
4153         /* Point to First SVID */
4154         rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER));
4155
4156         /* Search for Appropriate SVID's */
4157         while((vlen > 0) && (rcode == POSITIVE_ACK))
4158         {
4159                 switch(rsv->svi)
4160                 {
4161                         case FRAME_FORWARD:
4162                                 svectors |= F_FRAME_FORWARD;
4163                                 rcode = smctr_set_frame_forward(dev, rsv,
4164                                         rmf->dc_sc);
4165                                 break;
4166
4167                         default:
4168                                 rcode = E_SUB_VECTOR_UNKNOWN;
4169                                 break;
4170                 }
4171
4172                 /* Let Sender Know if SUM of SV length's is
4173                  * larger then length in MVID length field
4174                  */
4175                 if((vlen -= rsv->svl) < 0)
4176                         rcode = E_VECTOR_LENGTH_ERROR;
4177
4178                 rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl);
4179         }
4180
4181         if(rcode == POSITIVE_ACK)
4182         {
4183                 /* Let Sender Know if MVID length field
4184                  * is larger then SUM of SV length's
4185                  */
4186                 if(vlen != 0)
4187                         rcode = E_VECTOR_LENGTH_ERROR;
4188                 else
4189                 {
4190                         /* Let Sender Know if Expected SV Missing */
4191                         if((svectors & R_TX_FORWARD) ^ R_TX_FORWARD)
4192                                 rcode = E_MISSING_SUB_VECTOR;
4193                 }
4194         }
4195
4196         return (rcode);
4197 }
4198
4199 static int smctr_rcv_rq_addr_state_attch(struct net_device *dev,
4200         MAC_HEADER *rmf, __u16 *correlator)
4201 {
4202         MAC_SUB_VECTOR *rsv;
4203         signed short vlen;
4204         __u16 rcode = POSITIVE_ACK;
4205         unsigned int svectors = F_NO_SUB_VECTORS_FOUND;
4206
4207         /* Remove MVID Length from total length */
4208         vlen = (signed short)rmf->vl - 4;
4209
4210         /* Point to First SVID */
4211         rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER));
4212
4213         /* Search for Appropriate SVID's */
4214         while((vlen > 0) && (rcode == POSITIVE_ACK))
4215         {
4216                 switch(rsv->svi)
4217                 {
4218                         case CORRELATOR:
4219                                 svectors |= F_CORRELATOR;
4220                                 rcode = smctr_set_corr(dev, rsv, correlator);
4221                                 break;
4222
4223                         default:
4224                                 rcode = E_SUB_VECTOR_UNKNOWN;
4225                                 break;
4226                 }
4227
4228                 /* Let Sender Know if SUM of SV length's is
4229                  * larger then length in MVID length field
4230                  */
4231                 if((vlen -= rsv->svl) < 0)
4232                         rcode = E_VECTOR_LENGTH_ERROR;
4233
4234                 rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl);
4235         }
4236
4237         if(rcode == POSITIVE_ACK)
4238         {
4239                 /* Let Sender Know if MVID length field
4240                  * is larger then SUM of SV length's
4241                  */
4242                 if(vlen != 0)
4243                         rcode = E_VECTOR_LENGTH_ERROR;
4244                 else
4245                 {
4246                         /* Let Sender Know if Expected SVID Missing */
4247                         if((svectors & R_RQ_ATTCH_STATE_ADDR)
4248                                 ^ R_RQ_ATTCH_STATE_ADDR)
4249                                 rcode = E_MISSING_SUB_VECTOR;
4250                         }
4251         }
4252
4253         return (rcode);
4254 }
4255
4256 static int smctr_rcv_unknown(struct net_device *dev, MAC_HEADER *rmf,
4257         __u16 *correlator)
4258 {
4259         MAC_SUB_VECTOR *rsv;
4260         signed short vlen;
4261
4262         *correlator = 0;
4263
4264         /* Remove MVID Length from total length */
4265         vlen = (signed short)rmf->vl - 4;
4266
4267         /* Point to First SVID */
4268         rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER));
4269
4270         /* Search for CORRELATOR for RSP to UNKNOWN */
4271         while((vlen > 0) && (*correlator == 0))
4272         {
4273                 switch(rsv->svi)
4274                 {
4275                         case CORRELATOR:
4276                                 smctr_set_corr(dev, rsv, correlator);
4277                                 break;
4278
4279                         default:
4280                                 break;
4281                 }
4282
4283                 vlen -= rsv->svl;
4284                 rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl);
4285         }
4286
4287         return (E_UNRECOGNIZED_VECTOR_ID);
4288 }
4289
4290 /*
4291  * Reset the 825 NIC and exit w:
4292  * 1. The NIC reset cleared (non-reset state), halted and un-initialized.
4293  * 2. TINT masked.
4294  * 3. CBUSY masked.
4295  * 4. TINT clear.
4296  * 5. CBUSY clear.
4297  */
4298 static int smctr_reset_adapter(struct net_device *dev)
4299 {
4300         struct net_local *tp = netdev_priv(dev);
4301         int ioaddr = dev->base_addr;
4302
4303         /* Reseting the NIC will put it in a halted and un-initialized state. */        smctr_set_trc_reset(ioaddr);
4304         mdelay(200); /* ~2 ms */
4305
4306         smctr_clear_trc_reset(ioaddr);
4307         mdelay(200); /* ~2 ms */
4308
4309         /* Remove any latched interrupts that occurred prior to reseting the
4310          * adapter or possibily caused by line glitches due to the reset.
4311          */
4312         outb(tp->trc_mask | CSR_CLRTINT | CSR_CLRCBUSY, ioaddr + CSR);
4313
4314         return (0);
4315 }
4316
4317 static int smctr_restart_tx_chain(struct net_device *dev, short queue)
4318 {
4319         struct net_local *tp = netdev_priv(dev);
4320         int err = 0;
4321
4322         if(smctr_debug > 10)
4323                 printk(KERN_DEBUG "%s: smctr_restart_tx_chain\n", dev->name);
4324
4325         if(tp->num_tx_fcbs_used[queue] != 0 &&
4326            tp->tx_queue_status[queue] == NOT_TRANSMITING)
4327         {
4328                 tp->tx_queue_status[queue] = TRANSMITING;
4329                 err = smctr_issue_resume_tx_fcb_cmd(dev, queue);
4330         }
4331
4332         return (err);
4333 }
4334
4335 static int smctr_ring_status_chg(struct net_device *dev)
4336 {
4337         struct net_local *tp = netdev_priv(dev);
4338
4339         if(smctr_debug > 10)
4340                 printk(KERN_DEBUG "%s: smctr_ring_status_chg\n", dev->name);
4341
4342         /* Check for ring_status_flag: whenever MONITOR_STATE_BIT
4343          * Bit is set, check value of monitor_state, only then we
4344          * enable and start transmit/receive timeout (if and only
4345          * if it is MS_ACTIVE_MONITOR_STATE or MS_STANDBY_MONITOR_STATE)
4346          */
4347         if(tp->ring_status_flags == MONITOR_STATE_CHANGED)
4348         {
4349                 if((tp->monitor_state == MS_ACTIVE_MONITOR_STATE) ||
4350                    (tp->monitor_state == MS_STANDBY_MONITOR_STATE))
4351                 {
4352                         tp->monitor_state_ready = 1;
4353                 }
4354                 else
4355                 {
4356                         /* if adapter is NOT in either active monitor
4357                          * or standby monitor state => Disable
4358                          * transmit/receive timeout.
4359                          */
4360                         tp->monitor_state_ready = 0;
4361
4362                         /* Ring speed problem, switching to auto mode. */
4363                         if(tp->monitor_state == MS_MONITOR_FSM_INACTIVE &&
4364                            !tp->cleanup)
4365                         {
4366                                 printk(KERN_INFO "%s: Incorrect ring speed switching.\n",
4367                                         dev->name);
4368                                 smctr_set_ring_speed(dev);
4369                         }
4370                 }
4371         }
4372
4373         if(!(tp->ring_status_flags & RING_STATUS_CHANGED))
4374                 return (0);
4375
4376         switch(tp->ring_status)
4377         {
4378                 case RING_RECOVERY:
4379                         printk(KERN_INFO "%s: Ring Recovery\n", dev->name);
4380                         break;
4381
4382                 case SINGLE_STATION:
4383                         printk(KERN_INFO "%s: Single Statinon\n", dev->name);
4384                         break;
4385
4386                 case COUNTER_OVERFLOW:
4387                         printk(KERN_INFO "%s: Counter Overflow\n", dev->name);
4388                         break;
4389
4390                 case REMOVE_RECEIVED:
4391                         printk(KERN_INFO "%s: Remove Received\n", dev->name);
4392                         break;
4393
4394                 case AUTO_REMOVAL_ERROR:
4395                         printk(KERN_INFO "%s: Auto Remove Error\n", dev->name);
4396                         break;
4397
4398                 case LOBE_WIRE_FAULT:
4399                         printk(KERN_INFO "%s: Lobe Wire Fault\n", dev->name);
4400                         break;
4401
4402                 case TRANSMIT_BEACON:
4403                         printk(KERN_INFO "%s: Transmit Beacon\n", dev->name);
4404                         break;
4405
4406                 case SOFT_ERROR:
4407                         printk(KERN_INFO "%s: Soft Error\n", dev->name);
4408                         break;
4409
4410                 case HARD_ERROR:
4411                         printk(KERN_INFO "%s: Hard Error\n", dev->name);
4412                         break;
4413
4414                 case SIGNAL_LOSS:
4415                         printk(KERN_INFO "%s: Signal Loss\n", dev->name);
4416                         break;
4417
4418                 default:
4419                         printk(KERN_INFO "%s: Unknown ring status change\n",
4420                                 dev->name);
4421                         break;
4422         }
4423
4424         return (0);
4425 }
4426
4427 static int smctr_rx_frame(struct net_device *dev)
4428 {
4429         struct net_local *tp = netdev_priv(dev);
4430         __u16 queue, status, rx_size, err = 0;
4431         __u8 *pbuff;
4432
4433         if(smctr_debug > 10)
4434                 printk(KERN_DEBUG "%s: smctr_rx_frame\n", dev->name);
4435
4436         queue = tp->receive_queue_number;
4437
4438         while((status = tp->rx_fcb_curr[queue]->frame_status) != SUCCESS)
4439         {
4440                 err = HARDWARE_FAILED;
4441
4442                 if(((status & 0x007f) == 0) ||
4443                    ((tp->receive_mask & ACCEPT_ERR_PACKETS) != 0))
4444                 {
4445                         /* frame length less the CRC (4 bytes) + FS (1 byte) */
4446                         rx_size = tp->rx_fcb_curr[queue]->frame_length - 5;
4447
4448                         pbuff = smctr_get_rx_pointer(dev, queue);
4449
4450                         smctr_set_page(dev, pbuff);
4451                         smctr_disable_16bit(dev);
4452
4453                         /* pbuff points to addr within one page */
4454                         pbuff = (__u8 *)PAGE_POINTER(pbuff);
4455
4456                         if(queue == NON_MAC_QUEUE)
4457                         {
4458                                 struct sk_buff *skb;
4459
4460                                 skb = dev_alloc_skb(rx_size);
4461                                 if (skb) {
4462                                         skb_put(skb, rx_size);
4463
4464                                         skb_copy_to_linear_data(skb, pbuff, rx_size);
4465
4466                                         /* Update Counters */
4467                                         tp->MacStat.rx_packets++;
4468                                         tp->MacStat.rx_bytes += skb->len;
4469
4470                                         /* Kick the packet on up. */
4471                                         skb->protocol = tr_type_trans(skb, dev);
4472                                         netif_rx(skb);
4473                                 } else {
4474                                 }
4475                         }
4476                         else
4477                                 smctr_process_rx_packet((MAC_HEADER *)pbuff,
4478                                         rx_size, dev, status);
4479                 }
4480
4481                 smctr_enable_16bit(dev);
4482                 smctr_set_page(dev, (__u8 *)tp->ram_access);
4483                 smctr_update_rx_chain(dev, queue);
4484
4485                 if(err != SUCCESS)
4486                         break;
4487         }
4488
4489         return (err);
4490 }
4491
4492 static int smctr_send_dat(struct net_device *dev)
4493 {
4494         struct net_local *tp = netdev_priv(dev);
4495         unsigned int i, err;
4496         MAC_HEADER *tmf;
4497         FCBlock *fcb;
4498
4499         if(smctr_debug > 10)
4500                 printk(KERN_DEBUG "%s: smctr_send_dat\n", dev->name);
4501
4502         if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE,
4503                 sizeof(MAC_HEADER))) == (FCBlock *)(-1L))
4504         {
4505                 return (OUT_OF_RESOURCES);
4506         }
4507
4508         /* Initialize DAT Data Fields. */
4509         tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
4510         tmf->ac = MSB(AC_FC_DAT);
4511         tmf->fc = LSB(AC_FC_DAT);
4512
4513         for(i = 0; i < 6; i++)
4514         {
4515                 tmf->sa[i] = dev->dev_addr[i];
4516                 tmf->da[i] = dev->dev_addr[i];
4517
4518         }
4519
4520         tmf->vc        = DAT;
4521         tmf->dc_sc     = DC_RS | SC_RS;
4522         tmf->vl        = 4;
4523         tmf->vl        = SWAP_BYTES(tmf->vl);
4524
4525         /* Start Transmit. */
4526         if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE)))
4527                 return (err);
4528
4529         /* Wait for Transmit to Complete */
4530         for(i = 0; i < 10000; i++)
4531         {
4532                 if(fcb->frame_status & FCB_COMMAND_DONE)
4533                         break;
4534                 mdelay(1);
4535         }
4536
4537         /* Check if GOOD frame Tx'ed. */
4538         if(!(fcb->frame_status &  FCB_COMMAND_DONE) ||
4539            fcb->frame_status & (FCB_TX_STATUS_E | FCB_TX_AC_BITS))
4540         {
4541                 return (INITIALIZE_FAILED);
4542         }
4543
4544         /* De-allocated Tx FCB and Frame Buffer
4545          * The FCB must be de-allocated manually if executing with
4546          * interrupts disabled, other wise the ISR (LM_Service_Events)
4547          * will de-allocate it when the interrupt occurs.
4548          */
4549         tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING;
4550         smctr_update_tx_chain(dev, fcb, MAC_QUEUE);
4551
4552         return (0);
4553 }
4554
4555 static void smctr_timeout(struct net_device *dev)
4556 {
4557         /*
4558          * If we get here, some higher level has decided we are broken.
4559          * There should really be a "kick me" function call instead.
4560          *
4561          * Resetting the token ring adapter takes a long time so just
4562          * fake transmission time and go on trying. Our own timeout
4563          * routine is in sktr_timer_chk()
4564          */
4565         dev->trans_start = jiffies;
4566         netif_wake_queue(dev);
4567 }
4568
4569 /*
4570  * Gets skb from system, queues it and checks if it can be sent
4571  */
4572 static netdev_tx_t smctr_send_packet(struct sk_buff *skb,
4573                                            struct net_device *dev)
4574 {
4575         struct net_local *tp = netdev_priv(dev);
4576
4577         if(smctr_debug > 10)
4578                 printk(KERN_DEBUG "%s: smctr_send_packet\n", dev->name);
4579
4580         /*
4581          * Block a transmit overlap
4582          */
4583
4584         netif_stop_queue(dev);
4585
4586         if(tp->QueueSkb == 0)
4587                 return NETDEV_TX_BUSY;     /* Return with tbusy set: queue full */
4588
4589         tp->QueueSkb--;
4590         skb_queue_tail(&tp->SendSkbQueue, skb);
4591         smctr_hardware_send_packet(dev, tp);
4592         if(tp->QueueSkb > 0)
4593                 netif_wake_queue(dev);
4594
4595         return NETDEV_TX_OK;
4596 }
4597
4598 static int smctr_send_lobe_media_test(struct net_device *dev)
4599 {
4600         struct net_local *tp = netdev_priv(dev);
4601         MAC_SUB_VECTOR *tsv;
4602         MAC_HEADER *tmf;
4603         FCBlock *fcb;
4604         __u32 i;
4605         int err;
4606
4607         if(smctr_debug > 15)
4608                 printk(KERN_DEBUG "%s: smctr_send_lobe_media_test\n", dev->name);
4609
4610         if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(struct trh_hdr)
4611                 + S_WRAP_DATA + S_WRAP_DATA)) == (FCBlock *)(-1L))
4612         {
4613                 return (OUT_OF_RESOURCES);
4614         }
4615
4616         /* Initialize DAT Data Fields. */
4617         tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
4618         tmf->ac = MSB(AC_FC_LOBE_MEDIA_TEST);
4619         tmf->fc = LSB(AC_FC_LOBE_MEDIA_TEST);
4620
4621         for(i = 0; i < 6; i++)
4622         {
4623                 tmf->da[i] = 0;
4624                 tmf->sa[i] = dev->dev_addr[i];
4625         }
4626
4627         tmf->vc        = LOBE_MEDIA_TEST;
4628         tmf->dc_sc     = DC_RS | SC_RS;
4629         tmf->vl        = 4;
4630
4631         tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
4632         smctr_make_wrap_data(dev, tsv);
4633         tmf->vl += tsv->svl;
4634
4635         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4636         smctr_make_wrap_data(dev, tsv);
4637         tmf->vl += tsv->svl;
4638
4639         /* Start Transmit. */
4640         tmf->vl = SWAP_BYTES(tmf->vl);
4641         if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE)))
4642                 return (err);
4643
4644         /* Wait for Transmit to Complete. (10 ms). */
4645         for(i=0; i < 10000; i++)
4646         {
4647                 if(fcb->frame_status & FCB_COMMAND_DONE)
4648                         break;
4649                 mdelay(1);
4650         }
4651
4652         /* Check if GOOD frame Tx'ed */
4653         if(!(fcb->frame_status & FCB_COMMAND_DONE) ||
4654            fcb->frame_status & (FCB_TX_STATUS_E | FCB_TX_AC_BITS))
4655         {
4656                 return (LOBE_MEDIA_TEST_FAILED);
4657         }
4658
4659         /* De-allocated Tx FCB and Frame Buffer
4660          * The FCB must be de-allocated manually if executing with
4661          * interrupts disabled, other wise the ISR (LM_Service_Events)
4662          * will de-allocate it when the interrupt occurs.
4663          */
4664         tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING;
4665         smctr_update_tx_chain(dev, fcb, MAC_QUEUE);
4666
4667         return (0);
4668 }
4669
4670 static int smctr_send_rpt_addr(struct net_device *dev, MAC_HEADER *rmf,
4671         __u16 correlator)
4672 {
4673         MAC_HEADER *tmf;
4674         MAC_SUB_VECTOR *tsv;
4675         FCBlock *fcb;
4676
4677         if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
4678                 + S_CORRELATOR + S_PHYSICAL_DROP + S_UPSTREAM_NEIGHBOR_ADDRESS
4679                 + S_ADDRESS_MODIFER + S_GROUP_ADDRESS + S_FUNCTIONAL_ADDRESS))
4680                 == (FCBlock *)(-1L))
4681         {
4682                 return (0);
4683         }
4684
4685         tmf             = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
4686         tmf->vc         = RPT_ADDR;
4687         tmf->dc_sc      = (rmf->dc_sc & SC_MASK) << 4;
4688         tmf->vl         = 4;
4689
4690         smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_ADDR);
4691
4692         tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
4693         smctr_make_corr(dev, tsv, correlator);
4694
4695         tmf->vl += tsv->svl;
4696         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4697         smctr_make_phy_drop_num(dev, tsv);
4698
4699         tmf->vl += tsv->svl;
4700         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4701         smctr_make_upstream_neighbor_addr(dev, tsv);
4702
4703         tmf->vl += tsv->svl;
4704         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4705         smctr_make_addr_mod(dev, tsv);
4706
4707         tmf->vl += tsv->svl;
4708         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4709         smctr_make_group_addr(dev, tsv);
4710
4711         tmf->vl += tsv->svl;
4712         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4713         smctr_make_funct_addr(dev, tsv);
4714
4715         tmf->vl += tsv->svl;
4716
4717         /* Subtract out MVID and MVL which is
4718          * include in both vl and MAC_HEADER
4719          */
4720 /*      fcb->frame_length           = tmf->vl + sizeof(MAC_HEADER) - 4;
4721         fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4;
4722 */
4723         tmf->vl = SWAP_BYTES(tmf->vl);
4724
4725         return (smctr_trc_send_packet(dev, fcb, MAC_QUEUE));
4726 }
4727
4728 static int smctr_send_rpt_attch(struct net_device *dev, MAC_HEADER *rmf,
4729         __u16 correlator)
4730 {
4731         MAC_HEADER *tmf;
4732         MAC_SUB_VECTOR *tsv;
4733         FCBlock *fcb;
4734
4735         if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
4736                 + S_CORRELATOR + S_PRODUCT_INSTANCE_ID + S_FUNCTIONAL_ADDRESS
4737                 + S_AUTHORIZED_FUNCTION_CLASS + S_AUTHORIZED_ACCESS_PRIORITY))
4738                 == (FCBlock *)(-1L))
4739         {
4740                 return (0);
4741         }
4742
4743         tmf        = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
4744         tmf->vc    = RPT_ATTCH;
4745         tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4;
4746         tmf->vl    = 4;
4747
4748         smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_ATTCH);
4749
4750         tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
4751         smctr_make_corr(dev, tsv, correlator);
4752
4753         tmf->vl += tsv->svl;
4754         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4755         smctr_make_product_id(dev, tsv);
4756
4757         tmf->vl += tsv->svl;
4758         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4759         smctr_make_funct_addr(dev, tsv);
4760
4761         tmf->vl += tsv->svl;
4762         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4763         smctr_make_auth_funct_class(dev, tsv);
4764
4765         tmf->vl += tsv->svl;
4766         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4767         smctr_make_access_pri(dev, tsv);
4768
4769         tmf->vl += tsv->svl;
4770
4771         /* Subtract out MVID and MVL which is
4772          * include in both vl and MAC_HEADER
4773          */
4774 /*      fcb->frame_length           = tmf->vl + sizeof(MAC_HEADER) - 4;
4775         fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4;
4776 */
4777         tmf->vl = SWAP_BYTES(tmf->vl);
4778
4779         return (smctr_trc_send_packet(dev, fcb, MAC_QUEUE));
4780 }
4781
4782 static int smctr_send_rpt_state(struct net_device *dev, MAC_HEADER *rmf,
4783         __u16 correlator)
4784 {
4785         MAC_HEADER *tmf;
4786         MAC_SUB_VECTOR *tsv;
4787         FCBlock *fcb;
4788
4789         if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
4790                 + S_CORRELATOR + S_RING_STATION_VERSION_NUMBER
4791                 + S_RING_STATION_STATUS + S_STATION_IDENTIFER))
4792                 == (FCBlock *)(-1L))
4793         {
4794                 return (0);
4795         }
4796
4797         tmf        = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
4798         tmf->vc    = RPT_STATE;
4799         tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4;
4800         tmf->vl    = 4;
4801
4802         smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_STATE);
4803
4804         tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
4805         smctr_make_corr(dev, tsv, correlator);
4806
4807         tmf->vl += tsv->svl;
4808         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4809         smctr_make_ring_station_version(dev, tsv);
4810
4811         tmf->vl += tsv->svl;
4812         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4813         smctr_make_ring_station_status(dev, tsv);
4814
4815         tmf->vl += tsv->svl;
4816         tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4817         smctr_make_station_id(dev, tsv);
4818
4819         tmf->vl += tsv->svl;
4820
4821         /* Subtract out MVID and MVL which is
4822          * include in both vl and MAC_HEADER
4823          */
4824 /*      fcb->frame_length           = tmf->vl + sizeof(MAC_HEADER) - 4;
4825         fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4;
4826 */
4827         tmf->vl = SWAP_BYTES(tmf->vl);
4828
4829         return (smctr_trc_send_packet(dev, fcb, MAC_QUEUE));
4830 }
4831
4832 static int smctr_send_rpt_tx_forward(struct net_device *dev,
4833         MAC_HEADER *rmf, __u16 tx_fstatus)
4834 {
4835         MAC_HEADER *tmf;
4836         MAC_SUB_VECTOR *tsv;
4837         FCBlock *fcb;
4838
4839         if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
4840                 + S_TRANSMIT_STATUS_CODE)) == (FCBlock *)(-1L))
4841         {
4842                 return (0);
4843         }
4844
4845         tmf        = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
4846         tmf->vc    = RPT_TX_FORWARD;
4847         tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4;
4848         tmf->vl    = 4;
4849
4850         smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_TX_FORWARD);
4851
4852         tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
4853         smctr_make_tx_status_code(dev, tsv, tx_fstatus);
4854
4855         tmf->vl += tsv->svl;
4856
4857         /* Subtract out MVID and MVL which is
4858          * include in both vl and MAC_HEADER
4859          */
4860 /*      fcb->frame_length           = tmf->vl + sizeof(MAC_HEADER) - 4;
4861         fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4;
4862 */
4863         tmf->vl = SWAP_BYTES(tmf->vl);
4864
4865         return(smctr_trc_send_packet(dev, fcb, MAC_QUEUE));
4866 }
4867
4868 static int smctr_send_rsp(struct net_device *dev, MAC_HEADER *rmf,
4869         __u16 rcode, __u16 correlator)
4870 {
4871         MAC_HEADER *tmf;
4872         MAC_SUB_VECTOR *tsv;
4873         FCBlock *fcb;
4874
4875         if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
4876                 + S_CORRELATOR + S_RESPONSE_CODE)) == (FCBlock *)(-1L))
4877         {
4878                 return (0);
4879         }
4880
4881         tmf        = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
4882         tmf->vc    = RSP;
4883         tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4;
4884         tmf->vl    = 4;
4885
4886         smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RSP);
4887
4888         tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
4889         smctr_make_corr(dev, tsv, correlator);
4890
4891         return (0);
4892 }
4893
4894 static int smctr_send_rq_init(struct net_device *dev)
4895 {
4896         struct net_local *tp = netdev_priv(dev);
4897         MAC_HEADER *tmf;
4898         MAC_SUB_VECTOR *tsv;
4899         FCBlock *fcb;
4900         unsigned int i, count = 0;
4901         __u16 fstatus;
4902         int err;
4903
4904         do {
4905                 if(((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
4906                         + S_PRODUCT_INSTANCE_ID + S_UPSTREAM_NEIGHBOR_ADDRESS
4907                         + S_RING_STATION_VERSION_NUMBER + S_ADDRESS_MODIFER))
4908                         == (FCBlock *)(-1L)))
4909                 {
4910                         return (0);
4911                 }
4912
4913                 tmf        = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
4914                 tmf->vc    = RQ_INIT;
4915                 tmf->dc_sc = DC_RPS | SC_RS;
4916                 tmf->vl    = 4;
4917
4918                 smctr_make_8025_hdr(dev, NULL, tmf, AC_FC_RQ_INIT);
4919
4920                 tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
4921                 smctr_make_product_id(dev, tsv);
4922
4923                 tmf->vl += tsv->svl;
4924                 tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4925                 smctr_make_upstream_neighbor_addr(dev, tsv);
4926
4927                 tmf->vl += tsv->svl;
4928                 tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4929                 smctr_make_ring_station_version(dev, tsv);
4930
4931                 tmf->vl += tsv->svl;
4932                 tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
4933                 smctr_make_addr_mod(dev, tsv);
4934
4935                 tmf->vl += tsv->svl;
4936
4937                 /* Subtract out MVID and MVL which is
4938                  * include in both vl and MAC_HEADER
4939                  */
4940 /*              fcb->frame_length           = tmf->vl + sizeof(MAC_HEADER) - 4;
4941                 fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4;
4942 */
4943                 tmf->vl = SWAP_BYTES(tmf->vl);
4944
4945                 if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE)))
4946                         return (err);
4947
4948                 /* Wait for Transmit to Complete */
4949                 for(i = 0; i < 10000; i++)
4950                 {
4951                         if(fcb->frame_status & FCB_COMMAND_DONE)
4952                                 break;
4953                         mdelay(1);
4954                 }
4955
4956                 /* Check if GOOD frame Tx'ed */
4957                 fstatus = fcb->frame_status;
4958
4959                 if(!(fstatus & FCB_COMMAND_DONE))
4960                         return (HARDWARE_FAILED);
4961
4962                 if(!(fstatus & FCB_TX_STATUS_E))
4963                         count++;
4964
4965                 /* De-allocated Tx FCB and Frame Buffer
4966                  * The FCB must be de-allocated manually if executing with
4967                  * interrupts disabled, other wise the ISR (LM_Service_Events)
4968                  * will de-allocate it when the interrupt occurs.
4969                  */
4970                 tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING;
4971                 smctr_update_tx_chain(dev, fcb, MAC_QUEUE);
4972         } while(count < 4 && ((fstatus & FCB_TX_AC_BITS) ^ FCB_TX_AC_BITS));
4973
4974         return (smctr_join_complete_state(dev));
4975 }
4976
4977 static int smctr_send_tx_forward(struct net_device *dev, MAC_HEADER *rmf,
4978         __u16 *tx_fstatus)
4979 {
4980         struct net_local *tp = netdev_priv(dev);
4981         FCBlock *fcb;
4982         unsigned int i;
4983         int err;
4984
4985         /* Check if this is the END POINT of the Transmit Forward Chain. */
4986         if(rmf->vl <= 18)
4987                 return (0);
4988
4989         /* Allocate Transmit FCB only by requesting 0 bytes
4990          * of data buffer.
4991          */
4992         if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, 0)) == (FCBlock *)(-1L))
4993                 return (0);
4994
4995         /* Set pointer to Transmit Frame Buffer to the data
4996          * portion of the received TX Forward frame, making
4997          * sure to skip over the Vector Code (vc) and Vector
4998          * length (vl).
4999          */
5000         fcb->bdb_ptr->trc_data_block_ptr = TRC_POINTER((__u32)rmf
5001                 + sizeof(MAC_HEADER) + 2);
5002         fcb->bdb_ptr->data_block_ptr     = (__u16 *)((__u32)rmf
5003                 + sizeof(MAC_HEADER) + 2);
5004
5005         fcb->frame_length                = rmf->vl - 4 - 2;
5006         fcb->bdb_ptr->buffer_length      = rmf->vl - 4 - 2;
5007
5008         if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE)))
5009                 return (err);
5010
5011         /* Wait for Transmit to Complete */
5012         for(i = 0; i < 10000; i++)
5013         {
5014                 if(fcb->frame_status & FCB_COMMAND_DONE)
5015                         break;
5016                 mdelay(1);
5017         }
5018
5019         /* Check if GOOD frame Tx'ed */
5020         if(!(fcb->frame_status & FCB_COMMAND_DONE))
5021         {
5022                 if((err = smctr_issue_resume_tx_fcb_cmd(dev, MAC_QUEUE)))
5023                         return (err);
5024
5025                 for(i = 0; i < 10000; i++)
5026                 {
5027                         if(fcb->frame_status & FCB_COMMAND_DONE)
5028                                 break;
5029                         mdelay(1);
5030                 }
5031
5032                 if(!(fcb->frame_status & FCB_COMMAND_DONE))
5033                         return (HARDWARE_FAILED);
5034         }
5035
5036         *tx_fstatus = fcb->frame_status;
5037
5038         return (A_FRAME_WAS_FORWARDED);
5039 }
5040
5041 static int smctr_set_auth_access_pri(struct net_device *dev,
5042         MAC_SUB_VECTOR *rsv)
5043 {
5044         struct net_local *tp = netdev_priv(dev);
5045
5046         if(rsv->svl != S_AUTHORIZED_ACCESS_PRIORITY)
5047                 return (E_SUB_VECTOR_LENGTH_ERROR);
5048
5049         tp->authorized_access_priority = (rsv->svv[0] << 8 | rsv->svv[1]);
5050
5051         return (POSITIVE_ACK);
5052 }
5053
5054 static int smctr_set_auth_funct_class(struct net_device *dev,
5055         MAC_SUB_VECTOR *rsv)
5056 {
5057         struct net_local *tp = netdev_priv(dev);
5058
5059         if(rsv->svl != S_AUTHORIZED_FUNCTION_CLASS)
5060                 return (E_SUB_VECTOR_LENGTH_ERROR);
5061
5062         tp->authorized_function_classes = (rsv->svv[0] << 8 | rsv->svv[1]);
5063
5064         return (POSITIVE_ACK);
5065 }
5066
5067 static int smctr_set_corr(struct net_device *dev, MAC_SUB_VECTOR *rsv,
5068         __u16 *correlator)
5069 {
5070         if(rsv->svl != S_CORRELATOR)
5071                 return (E_SUB_VECTOR_LENGTH_ERROR);
5072
5073         *correlator = (rsv->svv[0] << 8 | rsv->svv[1]);
5074
5075         return (POSITIVE_ACK);
5076 }
5077
5078 static int smctr_set_error_timer_value(struct net_device *dev,
5079         MAC_SUB_VECTOR *rsv)
5080 {
5081         __u16 err_tval;
5082         int err;
5083
5084         if(rsv->svl != S_ERROR_TIMER_VALUE)
5085                 return (E_SUB_VECTOR_LENGTH_ERROR);
5086
5087         err_tval = (rsv->svv[0] << 8 | rsv->svv[1])*10;
5088
5089         smctr_issue_write_word_cmd(dev, RW_TER_THRESHOLD, &err_tval);
5090
5091         if((err = smctr_wait_cmd(dev)))
5092                 return (err);
5093
5094         return (POSITIVE_ACK);
5095 }
5096
5097 static int smctr_set_frame_forward(struct net_device *dev,
5098         MAC_SUB_VECTOR *rsv, __u8 dc_sc)
5099 {
5100         if((rsv->svl < 2) || (rsv->svl > S_FRAME_FORWARD))
5101                 return (E_SUB_VECTOR_LENGTH_ERROR);
5102
5103         if((dc_sc & DC_MASK) != DC_CRS)
5104         {
5105                 if(rsv->svl >= 2 && rsv->svl < 20)
5106                         return (E_TRANSMIT_FORWARD_INVALID);
5107
5108                 if((rsv->svv[0] != 0) || (rsv->svv[1] != 0))
5109                         return (E_TRANSMIT_FORWARD_INVALID);
5110         }
5111
5112         return (POSITIVE_ACK);
5113 }
5114
5115 static int smctr_set_local_ring_num(struct net_device *dev,
5116         MAC_SUB_VECTOR *rsv)
5117 {
5118         struct net_local *tp = netdev_priv(dev);
5119
5120         if(rsv->svl != S_LOCAL_RING_NUMBER)
5121                 return (E_SUB_VECTOR_LENGTH_ERROR);
5122
5123         if(tp->ptr_local_ring_num)
5124                 *(__u16 *)(tp->ptr_local_ring_num)
5125                         = (rsv->svv[0] << 8 | rsv->svv[1]);
5126
5127         return (POSITIVE_ACK);
5128 }
5129
5130 static unsigned short smctr_set_ctrl_attention(struct net_device *dev)
5131 {
5132         struct net_local *tp = netdev_priv(dev);
5133         int ioaddr = dev->base_addr;
5134
5135         if(tp->bic_type == BIC_585_CHIP)
5136                 outb((tp->trc_mask | HWR_CA), ioaddr + HWR);
5137         else
5138         {
5139                 outb((tp->trc_mask | CSR_CA), ioaddr + CSR);
5140                 outb(tp->trc_mask, ioaddr + CSR);
5141         }
5142
5143         return (0);
5144 }
5145
5146 static void smctr_set_multicast_list(struct net_device *dev)
5147 {
5148         if(smctr_debug > 10)
5149                 printk(KERN_DEBUG "%s: smctr_set_multicast_list\n", dev->name);
5150
5151         return;
5152 }
5153
5154 static int smctr_set_page(struct net_device *dev, __u8 *buf)
5155 {
5156         struct net_local *tp = netdev_priv(dev);
5157         __u8 amask;
5158         __u32 tptr;
5159
5160         tptr = (__u32)buf - (__u32)tp->ram_access;
5161         amask = (__u8)((tptr & PR_PAGE_MASK) >> 8);
5162         outb(amask, dev->base_addr + PR);
5163
5164         return (0);
5165 }
5166
5167 static int smctr_set_phy_drop(struct net_device *dev, MAC_SUB_VECTOR *rsv)
5168 {
5169         int err;
5170
5171         if(rsv->svl != S_PHYSICAL_DROP)
5172                 return (E_SUB_VECTOR_LENGTH_ERROR);
5173
5174         smctr_issue_write_byte_cmd(dev, RW_PHYSICAL_DROP_NUMBER, &rsv->svv[0]);
5175         if((err = smctr_wait_cmd(dev)))
5176                 return (err);
5177
5178         return (POSITIVE_ACK);
5179 }
5180
5181 /* Reset the ring speed to the opposite of what it was. This auto-pilot
5182  * mode requires a complete reset and re-init of the adapter.
5183  */
5184 static int smctr_set_ring_speed(struct net_device *dev)
5185 {
5186         struct net_local *tp = netdev_priv(dev);
5187         int err;
5188
5189         if(tp->media_type == MEDIA_UTP_16)
5190                 tp->media_type = MEDIA_UTP_4;
5191         else
5192                 tp->media_type = MEDIA_UTP_16;
5193
5194         smctr_enable_16bit(dev);
5195
5196         /* Re-Initialize adapter's internal registers */
5197         smctr_reset_adapter(dev);
5198
5199         if((err = smctr_init_card_real(dev)))
5200                 return (err);
5201
5202         smctr_enable_bic_int(dev);
5203
5204         if((err = smctr_issue_enable_int_cmd(dev, TRC_INTERRUPT_ENABLE_MASK)))
5205                 return (err);
5206
5207         smctr_disable_16bit(dev);
5208
5209         return (0);
5210 }
5211
5212 static int smctr_set_rx_look_ahead(struct net_device *dev)
5213 {
5214         struct net_local *tp = netdev_priv(dev);
5215         __u16 sword, rword;
5216
5217         if(smctr_debug > 10)
5218                 printk(KERN_DEBUG "%s: smctr_set_rx_look_ahead_flag\n", dev->name);
5219
5220         tp->adapter_flags &= ~(FORCED_16BIT_MODE);
5221         tp->adapter_flags |= RX_VALID_LOOKAHEAD;
5222
5223         if(tp->adapter_bus == BUS_ISA16_TYPE)
5224         {
5225                 sword = *((__u16 *)(tp->ram_access));
5226                 *((__u16 *)(tp->ram_access)) = 0x1234;
5227
5228                 smctr_disable_16bit(dev);
5229                 rword = *((__u16 *)(tp->ram_access));
5230                 smctr_enable_16bit(dev);
5231
5232                 if(rword != 0x1234)
5233                         tp->adapter_flags |= FORCED_16BIT_MODE;
5234
5235                 *((__u16 *)(tp->ram_access)) = sword;
5236         }
5237
5238         return (0);
5239 }
5240
5241 static int smctr_set_trc_reset(int ioaddr)
5242 {
5243         __u8 r;
5244
5245         r = inb(ioaddr + MSR);
5246         outb(MSR_RST | r, ioaddr + MSR);
5247
5248         return (0);
5249 }
5250
5251 /*
5252  * This function can be called if the adapter is busy or not.
5253  */
5254 static int smctr_setup_single_cmd(struct net_device *dev,
5255         __u16 command, __u16 subcommand)
5256 {
5257         struct net_local *tp = netdev_priv(dev);
5258         unsigned int err;
5259
5260         if(smctr_debug > 10)
5261                 printk(KERN_DEBUG "%s: smctr_setup_single_cmd\n", dev->name);
5262
5263         if((err = smctr_wait_while_cbusy(dev)))
5264                 return (err);
5265
5266         if((err = (unsigned int)smctr_wait_cmd(dev)))
5267                 return (err);
5268
5269         tp->acb_head->cmd_done_status   = 0;
5270         tp->acb_head->cmd               = command;
5271         tp->acb_head->subcmd            = subcommand;
5272
5273         err = smctr_issue_resume_acb_cmd(dev);
5274
5275         return (err);
5276 }
5277
5278 /*
5279  * This function can not be called with the adapter busy.
5280  */
5281 static int smctr_setup_single_cmd_w_data(struct net_device *dev,
5282         __u16 command, __u16 subcommand)
5283 {
5284         struct net_local *tp = netdev_priv(dev);
5285
5286         tp->acb_head->cmd_done_status   = ACB_COMMAND_NOT_DONE;
5287         tp->acb_head->cmd               = command;
5288         tp->acb_head->subcmd            = subcommand;
5289         tp->acb_head->data_offset_lo
5290                 = (__u16)TRC_POINTER(tp->misc_command_data);
5291
5292         return(smctr_issue_resume_acb_cmd(dev));
5293 }
5294
5295 static char *smctr_malloc(struct net_device *dev, __u16 size)
5296 {
5297         struct net_local *tp = netdev_priv(dev);
5298         char *m;
5299
5300         m = (char *)(tp->ram_access + tp->sh_mem_used);
5301         tp->sh_mem_used += (__u32)size;
5302
5303         return (m);
5304 }
5305
5306 static int smctr_status_chg(struct net_device *dev)
5307 {
5308         struct net_local *tp = netdev_priv(dev);
5309
5310         if(smctr_debug > 10)
5311                 printk(KERN_DEBUG "%s: smctr_status_chg\n", dev->name);
5312
5313         switch(tp->status)
5314         {
5315                 case OPEN:
5316                         break;
5317
5318                 case CLOSED:
5319                         break;
5320
5321                 /* Interrupt driven open() completion. XXX */
5322                 case INITIALIZED:
5323                         tp->group_address_0 = 0;
5324                         tp->group_address[0] = 0;
5325                         tp->group_address[1] = 0;
5326                         tp->functional_address_0 = 0;
5327                         tp->functional_address[0] = 0;
5328                         tp->functional_address[1] = 0;
5329                         smctr_open_tr(dev);
5330                         break;
5331
5332                 default:
5333                         printk(KERN_INFO "%s: status change unknown %x\n",
5334                                 dev->name, tp->status);
5335                         break;
5336         }
5337
5338         return (0);
5339 }
5340
5341 static int smctr_trc_send_packet(struct net_device *dev, FCBlock *fcb,
5342         __u16 queue)
5343 {
5344         struct net_local *tp = netdev_priv(dev);
5345         int err = 0;
5346
5347         if(smctr_debug > 10)
5348                 printk(KERN_DEBUG "%s: smctr_trc_send_packet\n", dev->name);
5349
5350         fcb->info = FCB_CHAIN_END | FCB_ENABLE_TFS;
5351         if(tp->num_tx_fcbs[queue] != 1)
5352                 fcb->back_ptr->info = FCB_INTERRUPT_ENABLE | FCB_ENABLE_TFS;
5353
5354         if(tp->tx_queue_status[queue] == NOT_TRANSMITING)
5355         {
5356                 tp->tx_queue_status[queue] = TRANSMITING;
5357                 err = smctr_issue_resume_tx_fcb_cmd(dev, queue);
5358         }
5359
5360         return (err);
5361 }
5362
5363 static __u16 smctr_tx_complete(struct net_device *dev, __u16 queue)
5364 {
5365         struct net_local *tp = netdev_priv(dev);
5366         __u16 status, err = 0;
5367         int cstatus;
5368
5369         if(smctr_debug > 10)
5370                 printk(KERN_DEBUG "%s: smctr_tx_complete\n", dev->name);
5371
5372         while((status = tp->tx_fcb_end[queue]->frame_status) != SUCCESS)
5373         {
5374                 if(status & 0x7e00 )
5375                 {
5376                         err = HARDWARE_FAILED;
5377                         break;
5378                 }
5379
5380                 if((err = smctr_update_tx_chain(dev, tp->tx_fcb_end[queue],
5381                         queue)) != SUCCESS)
5382                         break;
5383
5384                 smctr_disable_16bit(dev);
5385
5386                 if(tp->mode_bits & UMAC)
5387                 {
5388                         if(!(status & (FCB_TX_STATUS_AR1 | FCB_TX_STATUS_AR2)))
5389                                 cstatus = NO_SUCH_DESTINATION;
5390                         else
5391                         {
5392                                 if(!(status & (FCB_TX_STATUS_CR1 | FCB_TX_STATUS_CR2)))
5393                                         cstatus = DEST_OUT_OF_RESOURCES;
5394                                 else
5395                                 {
5396                                         if(status & FCB_TX_STATUS_E)
5397                                                 cstatus = MAX_COLLISIONS;
5398                                         else
5399                                                 cstatus = SUCCESS;
5400                                 }
5401                         }
5402                 }
5403                 else
5404                         cstatus = SUCCESS;
5405
5406                 if(queue == BUG_QUEUE)
5407                         err = SUCCESS;
5408
5409                 smctr_enable_16bit(dev);
5410                 if(err != SUCCESS)
5411                         break;
5412         }
5413
5414         return (err);
5415 }
5416
5417 static unsigned short smctr_tx_move_frame(struct net_device *dev,
5418         struct sk_buff *skb, __u8 *pbuff, unsigned int bytes)
5419 {
5420         struct net_local *tp = netdev_priv(dev);
5421         unsigned int ram_usable;
5422         __u32 flen, len, offset = 0;
5423         __u8 *frag, *page;
5424
5425         if(smctr_debug > 10)
5426                 printk(KERN_DEBUG "%s: smctr_tx_move_frame\n", dev->name);
5427
5428         ram_usable = ((unsigned int)tp->ram_usable) << 10;
5429         frag       = skb->data;
5430         flen       = skb->len;
5431
5432         while(flen > 0 && bytes > 0)
5433         {
5434                 smctr_set_page(dev, pbuff);
5435
5436                 offset = SMC_PAGE_OFFSET(pbuff);
5437
5438                 if(offset + flen > ram_usable)
5439                         len = ram_usable - offset;
5440                 else
5441                         len = flen;
5442
5443                 if(len > bytes)
5444                         len = bytes;
5445
5446                 page = (char *) (offset + tp->ram_access);
5447                 memcpy(page, frag, len);
5448
5449                 flen -=len;
5450                 bytes -= len;
5451                 frag += len;
5452                 pbuff += len;
5453         }
5454
5455         return (0);
5456 }
5457
5458 /* Update the error statistic counters for this adapter. */
5459 static int smctr_update_err_stats(struct net_device *dev)
5460 {
5461         struct net_local *tp = netdev_priv(dev);
5462         struct tr_statistics *tstat = &tp->MacStat;
5463
5464         if(tstat->internal_errors)
5465                 tstat->internal_errors
5466                         += *(tp->misc_command_data + 0) & 0x00ff;
5467
5468         if(tstat->line_errors)
5469                 tstat->line_errors += *(tp->misc_command_data + 0) >> 8;
5470
5471         if(tstat->A_C_errors)
5472                 tstat->A_C_errors += *(tp->misc_command_data + 1) & 0x00ff;
5473
5474         if(tstat->burst_errors)
5475                 tstat->burst_errors += *(tp->misc_command_data + 1) >> 8;
5476
5477         if(tstat->abort_delimiters)
5478                 tstat->abort_delimiters += *(tp->misc_command_data + 2) >> 8;
5479
5480         if(tstat->recv_congest_count)
5481                 tstat->recv_congest_count
5482                         += *(tp->misc_command_data + 3) & 0x00ff;
5483
5484         if(tstat->lost_frames)
5485                 tstat->lost_frames
5486                         += *(tp->misc_command_data + 3) >> 8;
5487
5488         if(tstat->frequency_errors)
5489                 tstat->frequency_errors += *(tp->misc_command_data + 4) & 0x00ff;
5490
5491         if(tstat->frame_copied_errors)
5492                  tstat->frame_copied_errors
5493                         += *(tp->misc_command_data + 4) >> 8;
5494
5495         if(tstat->token_errors)
5496                 tstat->token_errors += *(tp->misc_command_data + 5) >> 8;
5497
5498         return (0);
5499 }
5500
5501 static int smctr_update_rx_chain(struct net_device *dev, __u16 queue)
5502 {
5503         struct net_local *tp = netdev_priv(dev);
5504         FCBlock *fcb;
5505         BDBlock *bdb;
5506         __u16 size, len;
5507
5508         fcb = tp->rx_fcb_curr[queue];
5509         len = fcb->frame_length;
5510
5511         fcb->frame_status = 0;
5512         fcb->info = FCB_CHAIN_END;
5513         fcb->back_ptr->info = FCB_WARNING;
5514
5515         tp->rx_fcb_curr[queue] = tp->rx_fcb_curr[queue]->next_ptr;
5516
5517         /* update RX BDBs */
5518         size = (len >> RX_BDB_SIZE_SHIFT);
5519         if(len & RX_DATA_BUFFER_SIZE_MASK)
5520                 size += sizeof(BDBlock);
5521         size &= (~RX_BDB_SIZE_MASK);
5522
5523         /* check if wrap around */
5524         bdb = (BDBlock *)((__u32)(tp->rx_bdb_curr[queue]) + (__u32)(size));
5525         if((__u32)bdb >= (__u32)tp->rx_bdb_end[queue])
5526         {
5527                 bdb = (BDBlock *)((__u32)(tp->rx_bdb_head[queue])
5528                         + (__u32)(bdb) - (__u32)(tp->rx_bdb_end[queue]));
5529         }
5530
5531         bdb->back_ptr->info = BDB_CHAIN_END;
5532         tp->rx_bdb_curr[queue]->back_ptr->info = BDB_NOT_CHAIN_END;
5533         tp->rx_bdb_curr[queue] = bdb;
5534
5535         return (0);
5536 }
5537
5538 static int smctr_update_tx_chain(struct net_device *dev, FCBlock *fcb,
5539         __u16 queue)
5540 {
5541         struct net_local *tp = netdev_priv(dev);
5542
5543         if(smctr_debug > 20)
5544                 printk(KERN_DEBUG "smctr_update_tx_chain\n");
5545
5546         if(tp->num_tx_fcbs_used[queue] <= 0)
5547                 return (HARDWARE_FAILED);
5548         else
5549         {
5550                 if(tp->tx_buff_used[queue] < fcb->memory_alloc)
5551                 {
5552                         tp->tx_buff_used[queue] = 0;
5553                         return (HARDWARE_FAILED);
5554                 }
5555
5556                 tp->tx_buff_used[queue] -= fcb->memory_alloc;
5557
5558                 /* if all transmit buffer are cleared
5559                  * need to set the tx_buff_curr[] to tx_buff_head[]
5560                  * otherwise, tx buffer will be segregate and cannot
5561                  * accommodate and buffer greater than (curr - head) and
5562                  * (end - curr) since we do not allow wrap around allocation.
5563                  */
5564                 if(tp->tx_buff_used[queue] == 0)
5565                         tp->tx_buff_curr[queue] = tp->tx_buff_head[queue];
5566
5567                 tp->num_tx_fcbs_used[queue]--;
5568                 fcb->frame_status = 0;
5569                 tp->tx_fcb_end[queue] = fcb->next_ptr;
5570                 netif_wake_queue(dev);
5571                 return (0);
5572         }
5573 }
5574
5575 static int smctr_wait_cmd(struct net_device *dev)
5576 {
5577         struct net_local *tp = netdev_priv(dev);
5578         unsigned int loop_count = 0x20000;
5579
5580         if(smctr_debug > 10)
5581                 printk(KERN_DEBUG "%s: smctr_wait_cmd\n", dev->name);
5582
5583         while(loop_count)
5584         {
5585                 if(tp->acb_head->cmd_done_status & ACB_COMMAND_DONE)
5586                         break;
5587                 udelay(1);
5588                 loop_count--;
5589         }
5590
5591         if(loop_count == 0)
5592                 return(HARDWARE_FAILED);
5593
5594         if(tp->acb_head->cmd_done_status & 0xff)
5595                 return(HARDWARE_FAILED);
5596
5597         return (0);
5598 }
5599
5600 static int smctr_wait_while_cbusy(struct net_device *dev)
5601 {
5602         struct net_local *tp = netdev_priv(dev);
5603         unsigned int timeout = 0x20000;
5604         int ioaddr = dev->base_addr;
5605         __u8 r;
5606
5607         if(tp->bic_type == BIC_585_CHIP)
5608         {
5609                 while(timeout)
5610                 {
5611                         r = inb(ioaddr + HWR);
5612                         if((r & HWR_CBUSY) == 0)
5613                                 break;
5614                         timeout--;
5615                 }
5616         }
5617         else
5618         {
5619                 while(timeout)
5620                 {
5621                         r = inb(ioaddr + CSR);
5622                         if((r & CSR_CBUSY) == 0)
5623                                 break;
5624                         timeout--;
5625                 }
5626         }
5627
5628         if(timeout)
5629                 return (0);
5630         else
5631                 return (HARDWARE_FAILED);
5632 }
5633
5634 #ifdef MODULE
5635
5636 static struct net_device* dev_smctr[SMCTR_MAX_ADAPTERS];
5637 static int io[SMCTR_MAX_ADAPTERS];
5638 static int irq[SMCTR_MAX_ADAPTERS];
5639
5640 MODULE_LICENSE("GPL");
5641 MODULE_FIRMWARE("tr_smctr.bin");
5642
5643 module_param_array(io, int, NULL, 0);
5644 module_param_array(irq, int, NULL, 0);
5645 module_param(ringspeed, int, 0);
5646
5647 static struct net_device * __init setup_card(int n)
5648 {
5649         struct net_device *dev = alloc_trdev(sizeof(struct net_local));
5650         int err;
5651
5652         if (!dev)
5653                 return ERR_PTR(-ENOMEM);
5654
5655         dev->irq = irq[n];
5656         err = smctr_probe1(dev, io[n]);
5657         if (err)
5658                 goto out;
5659
5660         err = register_netdev(dev);
5661         if (err)
5662                 goto out1;
5663         return dev;
5664  out1:
5665 #ifdef CONFIG_MCA_LEGACY
5666         { struct net_local *tp = netdev_priv(dev);
5667           if (tp->slot_num)
5668                 mca_mark_as_unused(tp->slot_num);
5669         }
5670 #endif
5671         release_region(dev->base_addr, SMCTR_IO_EXTENT);
5672         free_irq(dev->irq, dev);
5673 out:
5674         free_netdev(dev);
5675         return ERR_PTR(err);
5676 }
5677
5678 int __init init_module(void)
5679 {
5680         int i, found = 0;
5681         struct net_device *dev;
5682
5683         for(i = 0; i < SMCTR_MAX_ADAPTERS; i++) {
5684                 dev = io[0]? setup_card(i) : smctr_probe(-1);
5685                 if (!IS_ERR(dev)) {
5686                         ++found;
5687                         dev_smctr[i] = dev;
5688                 }
5689         }
5690
5691         return found ? 0 : -ENODEV;
5692 }
5693
5694 void __exit cleanup_module(void)
5695 {
5696         int i;
5697
5698         for(i = 0; i < SMCTR_MAX_ADAPTERS; i++) {
5699                 struct net_device *dev = dev_smctr[i];
5700
5701                 if (dev) {
5702
5703                         unregister_netdev(dev);
5704 #ifdef CONFIG_MCA_LEGACY
5705                         { struct net_local *tp = netdev_priv(dev);
5706                         if (tp->slot_num)
5707                                 mca_mark_as_unused(tp->slot_num);
5708                         }
5709 #endif
5710                         release_region(dev->base_addr, SMCTR_IO_EXTENT);
5711                         if (dev->irq)
5712                                 free_irq(dev->irq, dev);
5713
5714                         free_netdev(dev);
5715                 }
5716         }
5717 }
5718 #endif /* MODULE */