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