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