More meth updates.
[linux-2.6/linux-mips.git] / drivers / net / gt96100eth.c
blobc4a811740b0bff37132a086592330ac7f6761148
1 /*
2 * Copyright 2000, 2001 MontaVista Software Inc.
3 * Author: MontaVista Software, Inc.
4 * stevel@mvista.com or source@mvista.com
6 * This program is free software; you can distribute it and/or modify it
7 * under the terms of the GNU General Public License (Version 2) as
8 * published by the Free Software Foundation.
10 * This program is distributed in the hope it will be useful, but WITHOUT
11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
13 * for more details.
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
19 * Ethernet driver for the MIPS GT96100 Advanced Communication Controller.
21 * Revision history
23 * 11.11.2001 Moved to 2.4.14, ppopov@mvista.com. Modified driver to add
24 * proper gt96100A support.
25 * 12.05.2001 Moved eth port 0 to irq 3 (mapped to GT_SERINT0 on EV96100A)
26 * in order for both ports to work. Also cleaned up boot
27 * option support (mac address string parsing), fleshed out
28 * gt96100_cleanup_module(), and other general code cleanups
29 * <stevel@mvista.com>.
31 #include <linux/config.h>
32 #include <linux/module.h>
33 #include <linux/kernel.h>
34 #include <linux/string.h>
35 #include <linux/timer.h>
36 #include <linux/errno.h>
37 #include <linux/in.h>
38 #include <linux/ioport.h>
39 #include <linux/slab.h>
40 #include <linux/interrupt.h>
41 #include <linux/pci.h>
42 #include <linux/init.h>
43 #include <linux/netdevice.h>
44 #include <linux/etherdevice.h>
45 #include <linux/skbuff.h>
46 #include <linux/delay.h>
47 #include <linux/ctype.h>
49 #include <asm/irq.h>
50 #include <asm/bitops.h>
51 #include <asm/io.h>
53 #define DESC_BE 1
54 #define DESC_DATA_BE 1
56 #define GT96100_DEBUG 2
58 #include "gt96100eth.h"
60 // prototypes
61 static void* dmaalloc(size_t size, dma_addr_t *dma_handle);
62 static void dmafree(size_t size, void *vaddr);
63 static void gt96100_delay(int msec);
64 static int gt96100_add_hash_entry(struct net_device *dev,
65 unsigned char* addr);
66 static void read_mib_counters(struct gt96100_private *gp);
67 static int read_MII(int phy_addr, u32 reg);
68 static int write_MII(int phy_addr, u32 reg, u16 data);
69 #if 0
70 static void dump_tx_ring(struct net_device *dev);
71 static void dump_rx_ring(struct net_device *dev);
72 #endif
73 static int gt96100_init_module(void);
74 static void gt96100_cleanup_module(void);
75 static void dump_MII(int dbg_lvl, struct net_device *dev);
76 static void dump_tx_desc(int dbg_lvl, struct net_device *dev, int i);
77 static void dump_rx_desc(int dbg_lvl, struct net_device *dev, int i);
78 static void dump_skb(int dbg_lvl, struct net_device *dev,
79 struct sk_buff *skb);
80 static void dump_hw_addr(int dbg_lvl, struct net_device *dev,
81 const char* pfx, unsigned char* addr_str);
82 static void update_stats(struct gt96100_private *gp);
83 static void abort(struct net_device *dev, u32 abort_bits);
84 static void hard_stop(struct net_device *dev);
85 static void enable_ether_irq(struct net_device *dev);
86 static void disable_ether_irq(struct net_device *dev);
87 static int gt96100_probe1(int port_num);
88 static void reset_tx(struct net_device *dev);
89 static void reset_rx(struct net_device *dev);
90 static int gt96100_check_tx_consistent(struct gt96100_private *gp);
91 static int gt96100_init(struct net_device *dev);
92 static int gt96100_open(struct net_device *dev);
93 static int gt96100_close(struct net_device *dev);
94 static int gt96100_tx(struct sk_buff *skb, struct net_device *dev);
95 static int gt96100_rx(struct net_device *dev, u32 status);
96 static irqreturn_t gt96100_interrupt(int irq, void *dev_id, struct pt_regs *regs);
97 static void gt96100_tx_timeout(struct net_device *dev);
98 static void gt96100_set_rx_mode(struct net_device *dev);
99 static struct net_device_stats* gt96100_get_stats(struct net_device *dev);
101 extern char * __init prom_getcmdline(void);
103 static int max_interrupt_work = 32;
105 #define nibswap(x) ((((x) >> 4) & 0x0f) | (((x) << 4) & 0xf0))
107 #define RUN_AT(x) (jiffies + (x))
109 // For reading/writing 32-bit words and half-words from/to DMA memory
110 #ifdef DESC_BE
111 #define cpu_to_dma32 cpu_to_be32
112 #define dma32_to_cpu be32_to_cpu
113 #define cpu_to_dma16 cpu_to_be16
114 #define dma16_to_cpu be16_to_cpu
115 #else
116 #define cpu_to_dma32 cpu_to_le32
117 #define dma32_to_cpu le32_to_cpu
118 #define cpu_to_dma16 cpu_to_le16
119 #define dma16_to_cpu le16_to_cpu
120 #endif
122 static char mac0[18] = "00.02.03.04.05.06";
123 static char mac1[18] = "00.01.02.03.04.05";
124 MODULE_PARM(mac0, "c18");
125 MODULE_PARM(mac1, "c18");
126 MODULE_PARM_DESC(mac0, "MAC address for GT96100 ethernet port 0");
127 MODULE_PARM_DESC(mac1, "MAC address for GT96100 ethernet port 1");
130 * Info for the GT96100 ethernet controller's ports.
132 static struct gt96100_if_t {
133 struct net_device *dev;
134 unsigned int iobase; // IO Base address of this port
135 int irq; // IRQ number of this port
136 char *mac_str;
137 } gt96100_iflist[NUM_INTERFACES] = {
139 NULL,
140 GT96100_ETH0_BASE, GT96100_ETHER0_IRQ,
141 mac0
144 NULL,
145 GT96100_ETH1_BASE, GT96100_ETHER1_IRQ,
146 mac1
150 static inline const char*
151 chip_name(int chip_rev)
153 switch (chip_rev) {
154 case REV_GT96100:
155 return "GT96100";
156 case REV_GT96100A_1:
157 case REV_GT96100A:
158 return "GT96100A";
159 default:
160 return "Unknown GT96100";
165 DMA memory allocation, derived from pci_alloc_consistent.
167 static void *
168 dmaalloc(size_t size, dma_addr_t *dma_handle)
170 void *ret;
172 ret = (void *)__get_free_pages(GFP_ATOMIC | GFP_DMA,
173 get_order(size));
175 if (ret != NULL) {
176 dma_cache_inv((unsigned long)ret, size);
177 if (dma_handle != NULL)
178 *dma_handle = virt_to_phys(ret);
180 /* bump virtual address up to non-cached area */
181 ret = (void*)KSEG1ADDR(ret);
184 return ret;
187 static void
188 dmafree(size_t size, void *vaddr)
190 vaddr = (void*)KSEG0ADDR(vaddr);
191 free_pages((unsigned long)vaddr, get_order(size));
196 static void
197 gt96100_delay(int ms)
199 if (in_interrupt())
200 return;
201 else {
202 current->state = TASK_INTERRUPTIBLE;
203 schedule_timeout(ms*HZ/1000);
207 static int
208 parse_mac_addr(struct net_device *dev, char* macstr)
210 int i, j;
211 unsigned char result, value;
213 for (i=0; i<6; i++) {
214 result = 0;
215 if (i != 5 && *(macstr+2) != '.') {
216 err(__FILE__ "invalid mac address format: %d %c\n",
217 i, *(macstr+2));
218 return -EINVAL;
221 for (j=0; j<2; j++) {
222 if (isxdigit(*macstr) &&
223 (value = isdigit(*macstr) ? *macstr-'0' :
224 toupper(*macstr)-'A'+10) < 16) {
225 result = result*16 + value;
226 macstr++;
227 } else {
228 err(__FILE__ "invalid mac address "
229 "character: %c\n", *macstr);
230 return -EINVAL;
234 macstr++; // step over '.'
235 dev->dev_addr[i] = result;
238 return 0;
242 static int
243 read_MII(int phy_addr, u32 reg)
245 int timedout = 20;
246 u32 smir = smirOpCode | (phy_addr << smirPhyAdBit) |
247 (reg << smirRegAdBit);
249 // wait for last operation to complete
250 while (GT96100_READ(GT96100_ETH_SMI_REG) & smirBusy) {
251 // snooze for 1 msec and check again
252 gt96100_delay(1);
254 if (--timedout == 0) {
255 printk(KERN_ERR "%s: busy timeout!!\n", __FUNCTION__);
256 return -ENODEV;
260 GT96100_WRITE(GT96100_ETH_SMI_REG, smir);
262 timedout = 20;
263 // wait for read to complete
264 while (!((smir = GT96100_READ(GT96100_ETH_SMI_REG)) & smirReadValid)) {
265 // snooze for 1 msec and check again
266 gt96100_delay(1);
268 if (--timedout == 0) {
269 printk(KERN_ERR "%s: timeout!!\n", __FUNCTION__);
270 return -ENODEV;
274 return (int)(smir & smirDataMask);
277 static void
278 dump_tx_desc(int dbg_lvl, struct net_device *dev, int i)
280 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
281 gt96100_td_t *td = &gp->tx_ring[i];
283 dbg(dbg_lvl, "Tx descriptor at 0x%08lx:\n", virt_to_phys(td));
284 dbg(dbg_lvl,
285 " cmdstat=%04x, byte_cnt=%04x, buff_ptr=%04x, next=%04x\n",
286 dma32_to_cpu(td->cmdstat),
287 dma16_to_cpu(td->byte_cnt),
288 dma32_to_cpu(td->buff_ptr),
289 dma32_to_cpu(td->next));
292 static void
293 dump_rx_desc(int dbg_lvl, struct net_device *dev, int i)
295 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
296 gt96100_rd_t *rd = &gp->rx_ring[i];
298 dbg(dbg_lvl, "Rx descriptor at 0x%08lx:\n", virt_to_phys(rd));
299 dbg(dbg_lvl, " cmdstat=%04x, buff_sz=%04x, byte_cnt=%04x, "
300 "buff_ptr=%04x, next=%04x\n",
301 dma32_to_cpu(rd->cmdstat),
302 dma16_to_cpu(rd->buff_sz),
303 dma16_to_cpu(rd->byte_cnt),
304 dma32_to_cpu(rd->buff_ptr),
305 dma32_to_cpu(rd->next));
308 static int
309 write_MII(int phy_addr, u32 reg, u16 data)
311 int timedout = 20;
312 u32 smir = (phy_addr << smirPhyAdBit) |
313 (reg << smirRegAdBit) | data;
315 // wait for last operation to complete
316 while (GT96100_READ(GT96100_ETH_SMI_REG) & smirBusy) {
317 // snooze for 1 msec and check again
318 gt96100_delay(1);
320 if (--timedout == 0) {
321 printk(KERN_ERR "%s: busy timeout!!\n", __FUNCTION__);
322 return -1;
326 GT96100_WRITE(GT96100_ETH_SMI_REG, smir);
327 return 0;
330 #if 0
331 // These routines work, just disabled to avoid compile warnings
332 static void
333 dump_tx_ring(struct net_device *dev)
335 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
336 int i;
338 dbg(0, "%s: txno/txni/cnt=%d/%d/%d\n", __FUNCTION__,
339 gp->tx_next_out, gp->tx_next_in, gp->tx_count);
341 for (i=0; i<TX_RING_SIZE; i++)
342 dump_tx_desc(0, dev, i);
345 static void
346 dump_rx_ring(struct net_device *dev)
348 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
349 int i;
351 dbg(0, "%s: rxno=%d\n", __FUNCTION__, gp->rx_next_out);
353 for (i=0; i<RX_RING_SIZE; i++)
354 dump_rx_desc(0, dev, i);
356 #endif
358 static void
359 dump_MII(int dbg_lvl, struct net_device *dev)
361 int i, val;
362 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
364 if (dbg_lvl <= GT96100_DEBUG) {
365 for (i=0; i<7; i++) {
366 if ((val = read_MII(gp->phy_addr, i)) >= 0)
367 printk("MII Reg %d=%x\n", i, val);
369 for (i=16; i<21; i++) {
370 if ((val = read_MII(gp->phy_addr, i)) >= 0)
371 printk("MII Reg %d=%x\n", i, val);
376 static void
377 dump_hw_addr(int dbg_lvl, struct net_device *dev, const char* pfx,
378 unsigned char* addr_str)
380 int i;
381 char buf[100], octet[5];
383 if (dbg_lvl <= GT96100_DEBUG) {
384 strcpy(buf, pfx);
385 for (i = 0; i < 6; i++) {
386 sprintf(octet, "%2.2x%s",
387 addr_str[i], i<5 ? ":" : "\n");
388 strcat(buf, octet);
390 info("%s", buf);
395 static void
396 dump_skb(int dbg_lvl, struct net_device *dev, struct sk_buff *skb)
398 int i;
399 unsigned char* skbdata;
401 if (dbg_lvl <= GT96100_DEBUG) {
402 dbg(dbg_lvl, "%s: skb=%p, skb->data=%p, skb->len=%d\n",
403 __FUNCTION__, skb, skb->data, skb->len);
405 skbdata = (unsigned char*)KSEG1ADDR(skb->data);
407 for (i=0; i<skb->len; i++) {
408 if (!(i % 16))
409 printk(KERN_DEBUG "\n %3.3x: %2.2x,",
410 i, skbdata[i]);
411 else
412 printk(KERN_DEBUG "%2.2x,", skbdata[i]);
414 printk(KERN_DEBUG "\n");
419 static int
420 gt96100_add_hash_entry(struct net_device *dev, unsigned char* addr)
422 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
423 //u16 hashResult, stmp;
424 //unsigned char ctmp, hash_ea[6];
425 u32 tblEntry1, tblEntry0, *tblEntryAddr;
426 int i;
428 tblEntry1 = hteValid | hteRD;
429 tblEntry1 |= (u32)addr[5] << 3;
430 tblEntry1 |= (u32)addr[4] << 11;
431 tblEntry1 |= (u32)addr[3] << 19;
432 tblEntry1 |= ((u32)addr[2] & 0x1f) << 27;
433 dbg(3, "%s: tblEntry1=%x\n", __FUNCTION__, tblEntry1);
434 tblEntry0 = ((u32)addr[2] >> 5) & 0x07;
435 tblEntry0 |= (u32)addr[1] << 3;
436 tblEntry0 |= (u32)addr[0] << 11;
437 dbg(3, "%s: tblEntry0=%x\n", __FUNCTION__, tblEntry0);
439 #if 0
441 for (i=0; i<6; i++) {
442 // nibble swap
443 ctmp = nibswap(addr[i]);
444 // invert every nibble
445 hash_ea[i] = ((ctmp&1)<<3) | ((ctmp&8)>>3) |
446 ((ctmp&2)<<1) | ((ctmp&4)>>1);
447 hash_ea[i] |= ((ctmp&0x10)<<3) | ((ctmp&0x80)>>3) |
448 ((ctmp&0x20)<<1) | ((ctmp&0x40)>>1);
451 dump_hw_addr(3, dev, "%s: nib swap/invt addr=", __FUNCTION__, hash_ea);
453 if (gp->hash_mode == 0) {
454 hashResult = ((u16)hash_ea[0] & 0xfc) << 7;
455 stmp = ((u16)hash_ea[0] & 0x03) |
456 (((u16)hash_ea[1] & 0x7f) << 2);
457 stmp ^= (((u16)hash_ea[1] >> 7) & 0x01) |
458 ((u16)hash_ea[2] << 1);
459 stmp ^= (u16)hash_ea[3] | (((u16)hash_ea[4] & 1) << 8);
460 hashResult |= stmp;
461 } else {
462 return -1; // don't support hash mode 1
465 dbg(3, "%s: hashResult=%x\n", __FUNCTION__, hashResult);
467 tblEntryAddr =
468 (u32 *)(&gp->hash_table[((u32)hashResult & 0x7ff) << 3]);
470 dbg(3, "%s: tblEntryAddr=%p\n", tblEntryAddr, __FUNCTION__);
472 for (i=0; i<HASH_HOP_NUMBER; i++) {
473 if ((*tblEntryAddr & hteValid) &&
474 !(*tblEntryAddr & hteSkip)) {
475 // This entry is already occupied, go to next entry
476 tblEntryAddr += 2;
477 dbg(3, "%s: skipping to %p\n", __FUNCTION__,
478 tblEntryAddr);
479 } else {
480 memset(tblEntryAddr, 0, 8);
481 tblEntryAddr[1] = cpu_to_dma32(tblEntry1);
482 tblEntryAddr[0] = cpu_to_dma32(tblEntry0);
483 break;
487 if (i >= HASH_HOP_NUMBER) {
488 err("%s: expired!\n", __FUNCTION__);
489 return -1; // Couldn't find an unused entry
492 #else
494 tblEntryAddr = (u32 *)gp->hash_table;
495 for (i=0; i<RX_HASH_TABLE_SIZE/4; i+=2) {
496 tblEntryAddr[i+1] = cpu_to_dma32(tblEntry1);
497 tblEntryAddr[i] = cpu_to_dma32(tblEntry0);
500 #endif
502 return 0;
506 static void
507 read_mib_counters(struct gt96100_private *gp)
509 u32* mib_regs = (u32*)&gp->mib;
510 int i;
512 for (i=0; i<sizeof(mib_counters_t)/sizeof(u32); i++)
513 mib_regs[i] = GT96100ETH_READ(gp, GT96100_ETH_MIB_COUNT_BASE +
514 i*sizeof(u32));
518 static void
519 update_stats(struct gt96100_private *gp)
521 mib_counters_t *mib = &gp->mib;
522 struct net_device_stats *stats = &gp->stats;
524 read_mib_counters(gp);
526 stats->rx_packets = mib->totalFramesReceived;
527 stats->tx_packets = mib->framesSent;
528 stats->rx_bytes = mib->totalByteReceived;
529 stats->tx_bytes = mib->byteSent;
530 stats->rx_errors = mib->totalFramesReceived - mib->framesReceived;
531 //the tx error counters are incremented by the ISR
532 //rx_dropped incremented by gt96100_rx
533 //tx_dropped incremented by gt96100_tx
534 stats->multicast = mib->multicastFramesReceived;
535 // collisions incremented by gt96100_tx_complete
536 stats->rx_length_errors = mib->oversizeFrames + mib->fragments;
537 // The RxError condition means the Rx DMA encountered a
538 // CPU owned descriptor, which, if things are working as
539 // they should, means the Rx ring has overflowed.
540 stats->rx_over_errors = mib->macRxError;
541 stats->rx_crc_errors = mib->cRCError;
544 static void
545 abort(struct net_device *dev, u32 abort_bits)
547 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
548 int timedout = 100; // wait up to 100 msec for hard stop to complete
550 dbg(3, "%s\n", __FUNCTION__);
552 // Return if neither Rx or Tx abort bits are set
553 if (!(abort_bits & (sdcmrAR | sdcmrAT)))
554 return;
556 // make sure only the Rx/Tx abort bits are set
557 abort_bits &= (sdcmrAR | sdcmrAT);
559 spin_lock(&gp->lock);
561 // abort any Rx/Tx DMA immediately
562 GT96100ETH_WRITE(gp, GT96100_ETH_SDMA_COMM, abort_bits);
564 dbg(3, "%s: SDMA comm = %x\n", __FUNCTION__,
565 GT96100ETH_READ(gp, GT96100_ETH_SDMA_COMM));
567 // wait for abort to complete
568 while (GT96100ETH_READ(gp, GT96100_ETH_SDMA_COMM) & abort_bits) {
569 // snooze for 20 msec and check again
570 gt96100_delay(1);
572 if (--timedout == 0) {
573 err("%s: timeout!!\n", __FUNCTION__);
574 break;
578 spin_unlock(&gp->lock);
582 static void
583 hard_stop(struct net_device *dev)
585 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
587 dbg(3, "%s\n", __FUNCTION__);
589 disable_ether_irq(dev);
591 abort(dev, sdcmrAR | sdcmrAT);
593 // disable port
594 GT96100ETH_WRITE(gp, GT96100_ETH_PORT_CONFIG, 0);
598 static void
599 enable_ether_irq(struct net_device *dev)
601 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
602 u32 intMask;
604 * route ethernet interrupt to GT_SERINT0 for port 0,
605 * GT_INT0 for port 1.
607 int intr_mask_reg = (gp->port_num == 0) ?
608 GT96100_SERINT0_MASK : GT96100_INT0_HIGH_MASK;
610 if (gp->chip_rev >= REV_GT96100A_1) {
611 intMask = icrTxBufferLow | icrTxEndLow |
612 icrTxErrorLow | icrRxOVR | icrTxUdr |
613 icrRxBufferQ0 | icrRxErrorQ0 |
614 icrMIIPhySTC | icrEtherIntSum;
616 else {
617 intMask = icrTxBufferLow | icrTxEndLow |
618 icrTxErrorLow | icrRxOVR | icrTxUdr |
619 icrRxBuffer | icrRxError |
620 icrMIIPhySTC | icrEtherIntSum;
623 // unmask interrupts
624 GT96100ETH_WRITE(gp, GT96100_ETH_INT_MASK, intMask);
626 intMask = GT96100_READ(intr_mask_reg);
627 intMask |= 1<<gp->port_num;
628 GT96100_WRITE(intr_mask_reg, intMask);
631 static void
632 disable_ether_irq(struct net_device *dev)
634 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
635 u32 intMask;
636 int intr_mask_reg = (gp->port_num == 0) ?
637 GT96100_SERINT0_MASK : GT96100_INT0_HIGH_MASK;
639 intMask = GT96100_READ(intr_mask_reg);
640 intMask &= ~(1<<gp->port_num);
641 GT96100_WRITE(intr_mask_reg, intMask);
643 GT96100ETH_WRITE(gp, GT96100_ETH_INT_MASK, 0);
648 * Init GT96100 ethernet controller driver
650 int gt96100_init_module(void)
652 int i, retval=0;
653 u16 vendor_id, device_id;
654 u32 cpuConfig;
656 #ifndef CONFIG_MIPS_GT96100ETH
657 return -ENODEV;
658 #endif
660 // probe for GT96100 by reading PCI0 vendor/device ID register
661 pcibios_read_config_word(0, 0, PCI_VENDOR_ID, &vendor_id);
662 pcibios_read_config_word(0, 0, PCI_DEVICE_ID, &device_id);
664 if (vendor_id != PCI_VENDOR_ID_GALILEO ||
665 (device_id != PCI_DEVICE_ID_GALILEO_GT96100 &&
666 device_id != PCI_DEVICE_ID_GALILEO_GT96100A)) {
667 printk(KERN_ERR __FILE__ ": GT96100 not found!\n");
668 return -ENODEV;
671 cpuConfig = GT96100_READ(GT96100_CPU_INTERF_CONFIG);
672 if (cpuConfig & (1<<12)) {
673 printk(KERN_ERR __FILE__
674 ": must be in Big Endian mode!\n");
675 return -ENODEV;
678 for (i=0; i < NUM_INTERFACES; i++) {
679 retval |= gt96100_probe1(i);
682 return retval;
687 static int __init
688 gt96100_probe1(int port_num)
690 struct gt96100_private *gp = NULL;
691 struct gt96100_if_t *gtif = &gt96100_iflist[port_num];
692 int phy_addr, phy_id1, phy_id2;
693 u32 phyAD;
694 int retval;
695 unsigned char chip_rev;
696 struct net_device *dev = NULL;
698 if (gtif->irq < 0) {
699 printk(KERN_ERR "%s: irq unknown - probing not supported\n", __FUNCTION_);
700 return -ENODEV;
703 pcibios_read_config_byte(0, 0, PCI_REVISION_ID, &chip_rev);
705 if (chip_rev >= REV_GT96100A_1) {
706 phyAD = GT96100_READ(GT96100_ETH_PHY_ADDR_REG);
707 phy_addr = (phyAD >> (5*port_num)) & 0x1f;
708 } else {
710 * not sure what's this about -- probably
711 * a gt bug
713 phy_addr = port_num;
714 phyAD = GT96100_READ(GT96100_ETH_PHY_ADDR_REG);
715 phyAD &= ~(0x1f << (port_num*5));
716 phyAD |= phy_addr << (port_num*5);
717 GT96100_WRITE(GT96100_ETH_PHY_ADDR_REG, phyAD);
720 // probe for the external PHY
721 if ((phy_id1 = read_MII(phy_addr, 2)) <= 0 ||
722 (phy_id2 = read_MII(phy_addr, 3)) <= 0) {
723 printk(KERN_ERR "%s: no PHY found on MII%d\n", __FUNCTION__, port_num);
724 return -ENODEV;
727 if (!request_region(gtif->iobase, GT96100_ETH_IO_SIZE, "GT96100ETH")) {
728 printk(KERN_ERR "%s: request_region failed\n", __FUNCTION__);
729 return -EBUSY;
732 dev = init_etherdev(0, sizeof(struct gt96100_private));
733 gtif->dev = dev;
735 /* private struct aligned and zeroed by init_etherdev */
736 /* Fill in the 'dev' fields. */
737 dev->base_addr = gtif->iobase;
738 dev->irq = gtif->irq;
740 if ((retval = parse_mac_addr(dev, gtif->mac_str))) {
741 err("%s: MAC address parse failed\n", __FUNCTION__);
742 retval = -EINVAL;
743 goto free_region;
746 gp = dev->priv;
748 memset(gp, 0, sizeof(*gp)); // clear it
750 gp->port_num = port_num;
751 gp->io_size = GT96100_ETH_IO_SIZE;
752 gp->port_offset = port_num * GT96100_ETH_IO_SIZE;
753 gp->phy_addr = phy_addr;
754 gp->chip_rev = chip_rev;
756 info("%s found at 0x%x, irq %d\n",
757 chip_name(gp->chip_rev), gtif->iobase, gtif->irq);
758 dump_hw_addr(0, dev, "HW Address ", dev->dev_addr);
759 info("%s chip revision=%d\n", chip_name(gp->chip_rev), gp->chip_rev);
760 info("%s ethernet port %d\n", chip_name(gp->chip_rev), gp->port_num);
761 info("external PHY ID1=0x%04x, ID2=0x%04x\n", phy_id1, phy_id2);
763 // Allocate Rx and Tx descriptor rings
764 if (gp->rx_ring == NULL) {
765 // All descriptors in ring must be 16-byte aligned
766 gp->rx_ring = dmaalloc(sizeof(gt96100_rd_t) * RX_RING_SIZE
767 + sizeof(gt96100_td_t) * TX_RING_SIZE,
768 &gp->rx_ring_dma);
769 if (gp->rx_ring == NULL) {
770 retval = -ENOMEM;
771 goto free_region;
774 gp->tx_ring = (gt96100_td_t *)(gp->rx_ring + RX_RING_SIZE);
775 gp->tx_ring_dma =
776 gp->rx_ring_dma + sizeof(gt96100_rd_t) * RX_RING_SIZE;
779 // Allocate the Rx Data Buffers
780 if (gp->rx_buff == NULL) {
781 gp->rx_buff = dmaalloc(PKT_BUF_SZ*RX_RING_SIZE,
782 &gp->rx_buff_dma);
783 if (gp->rx_buff == NULL) {
784 dmafree(sizeof(gt96100_rd_t) * RX_RING_SIZE
785 + sizeof(gt96100_td_t) * TX_RING_SIZE,
786 gp->rx_ring);
787 retval = -ENOMEM;
788 goto free_region;
792 dbg(3, "%s: rx_ring=%p, tx_ring=%p\n", __FUNCTION__,
793 gp->rx_ring, gp->tx_ring);
795 // Allocate Rx Hash Table
796 if (gp->hash_table == NULL) {
797 gp->hash_table = (char*)dmaalloc(RX_HASH_TABLE_SIZE,
798 &gp->hash_table_dma);
799 if (gp->hash_table == NULL) {
800 dmafree(sizeof(gt96100_rd_t) * RX_RING_SIZE
801 + sizeof(gt96100_td_t) * TX_RING_SIZE,
802 gp->rx_ring);
803 dmafree(PKT_BUF_SZ*RX_RING_SIZE, gp->rx_buff);
804 retval = -ENOMEM;
805 goto free_region;
809 dbg(3, "%s: hash=%p\n", __FUNCTION__, gp->hash_table);
811 spin_lock_init(&gp->lock);
813 dev->open = gt96100_open;
814 dev->hard_start_xmit = gt96100_tx;
815 dev->stop = gt96100_close;
816 dev->get_stats = gt96100_get_stats;
817 //dev->do_ioctl = gt96100_ioctl;
818 dev->set_multicast_list = gt96100_set_rx_mode;
819 dev->tx_timeout = gt96100_tx_timeout;
820 dev->watchdog_timeo = GT96100ETH_TX_TIMEOUT;
822 /* Fill in the fields of the device structure with ethernet values. */
823 ether_setup(dev);
824 return 0;
826 free_region:
827 release_region(gtif->iobase, GT96100_ETH_IO_SIZE);
828 unregister_netdev(dev);
829 kfree (dev);
830 err("%s failed. Returns %d\n", __FUNCTION__, retval);
831 return retval;
835 static void
836 reset_tx(struct net_device *dev)
838 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
839 int i;
841 abort(dev, sdcmrAT);
843 for (i=0; i<TX_RING_SIZE; i++) {
844 if (gp->tx_skbuff[i]) {
845 if (in_interrupt())
846 dev_kfree_skb_irq(gp->tx_skbuff[i]);
847 else
848 dev_kfree_skb(gp->tx_skbuff[i]);
849 gp->tx_skbuff[i] = NULL;
852 gp->tx_ring[i].cmdstat = 0; // CPU owns
853 gp->tx_ring[i].byte_cnt = 0;
854 gp->tx_ring[i].buff_ptr = 0;
855 gp->tx_ring[i].next =
856 cpu_to_dma32(gp->tx_ring_dma +
857 sizeof(gt96100_td_t) * (i+1));
858 dump_tx_desc(4, dev, i);
860 /* Wrap the ring. */
861 gp->tx_ring[i-1].next = cpu_to_dma32(gp->tx_ring_dma);
863 // setup only the lowest priority TxCDP reg
864 GT96100ETH_WRITE(gp, GT96100_ETH_CURR_TX_DESC_PTR0, gp->tx_ring_dma);
865 GT96100ETH_WRITE(gp, GT96100_ETH_CURR_TX_DESC_PTR1, 0);
867 // init Tx indeces and pkt counter
868 gp->tx_next_in = gp->tx_next_out = 0;
869 gp->tx_count = 0;
873 static void
874 reset_rx(struct net_device *dev)
876 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
877 int i;
879 abort(dev, sdcmrAR);
881 for (i=0; i<RX_RING_SIZE; i++) {
882 gp->rx_ring[i].next =
883 cpu_to_dma32(gp->rx_ring_dma +
884 sizeof(gt96100_rd_t) * (i+1));
885 gp->rx_ring[i].buff_ptr =
886 cpu_to_dma32(gp->rx_buff_dma + i*PKT_BUF_SZ);
887 gp->rx_ring[i].buff_sz = cpu_to_dma16(PKT_BUF_SZ);
888 // Give ownership to device, set first and last, enable intr
889 gp->rx_ring[i].cmdstat =
890 cpu_to_dma32((u32)(rxFirst | rxLast | rxOwn | rxEI));
891 dump_rx_desc(4, dev, i);
893 /* Wrap the ring. */
894 gp->rx_ring[i-1].next = cpu_to_dma32(gp->rx_ring_dma);
896 // Setup only the lowest priority RxFDP and RxCDP regs
897 for (i=0; i<4; i++) {
898 if (i == 0) {
899 GT96100ETH_WRITE(gp, GT96100_ETH_1ST_RX_DESC_PTR0,
900 gp->rx_ring_dma);
901 GT96100ETH_WRITE(gp, GT96100_ETH_CURR_RX_DESC_PTR0,
902 gp->rx_ring_dma);
903 } else {
904 GT96100ETH_WRITE(gp,
905 GT96100_ETH_1ST_RX_DESC_PTR0 + i*4,
907 GT96100ETH_WRITE(gp,
908 GT96100_ETH_CURR_RX_DESC_PTR0 + i*4,
913 // init Rx NextOut index
914 gp->rx_next_out = 0;
918 // Returns 1 if the Tx counter and indeces don't gel
919 static int
920 gt96100_check_tx_consistent(struct gt96100_private *gp)
922 int diff = gp->tx_next_in - gp->tx_next_out;
924 diff = diff<0 ? TX_RING_SIZE + diff : diff;
925 diff = gp->tx_count == TX_RING_SIZE ? diff + TX_RING_SIZE : diff;
927 return (diff != gp->tx_count);
930 static int
931 gt96100_init(struct net_device *dev)
933 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
934 u32 tmp;
935 u16 mii_reg;
937 dbg(3, "%s: dev=%p\n", __FUNCTION__, dev);
938 dbg(3, "%s: scs10_lo=%4x, scs10_hi=%4x\n", __FUNCTION__,
939 GT96100_READ(0x8), GT96100_READ(0x10));
940 dbg(3, "%s: scs32_lo=%4x, scs32_hi=%4x\n", __FUNCTION__,
941 GT96100_READ(0x18), GT96100_READ(0x20));
943 // Stop and disable Port
944 hard_stop(dev);
946 // Setup CIU Arbiter
947 tmp = GT96100_READ(GT96100_CIU_ARBITER_CONFIG);
948 tmp |= (0x0c << (gp->port_num*2)); // set Ether DMA req priority to hi
949 #ifndef DESC_BE
950 tmp &= ~(1<<31); // set desc endianess to little
951 #else
952 tmp |= (1<<31);
953 #endif
954 GT96100_WRITE(GT96100_CIU_ARBITER_CONFIG, tmp);
955 dbg(3, "%s: CIU Config=%x/%x\n", __FUNCTION__,
956 tmp, GT96100_READ(GT96100_CIU_ARBITER_CONFIG));
958 // Set routing.
959 tmp = GT96100_READ(GT96100_ROUTE_MAIN) & (0x3f << 18);
960 tmp |= (0x07 << (18 + gp->port_num*3));
961 GT96100_WRITE(GT96100_ROUTE_MAIN, tmp);
963 /* set MII as peripheral func */
964 tmp = GT96100_READ(GT96100_GPP_CONFIG2);
965 tmp |= 0x7fff << (gp->port_num*16);
966 GT96100_WRITE(GT96100_GPP_CONFIG2, tmp);
968 /* Set up MII port pin directions */
969 tmp = GT96100_READ(GT96100_GPP_IO2);
970 tmp |= 0x003d << (gp->port_num*16);
971 GT96100_WRITE(GT96100_GPP_IO2, tmp);
973 // Set-up hash table
974 memset(gp->hash_table, 0, RX_HASH_TABLE_SIZE); // clear it
975 gp->hash_mode = 0;
976 // Add a single entry to hash table - our ethernet address
977 gt96100_add_hash_entry(dev, dev->dev_addr);
978 // Set-up DMA ptr to hash table
979 GT96100ETH_WRITE(gp, GT96100_ETH_HASH_TBL_PTR, gp->hash_table_dma);
980 dbg(3, "%s: Hash Tbl Ptr=%x\n", __FUNCTION__,
981 GT96100ETH_READ(gp, GT96100_ETH_HASH_TBL_PTR));
983 // Setup Tx
984 reset_tx(dev);
986 dbg(3, "%s: Curr Tx Desc Ptr0=%x\n", __FUNCTION__,
987 GT96100ETH_READ(gp, GT96100_ETH_CURR_TX_DESC_PTR0));
989 // Setup Rx
990 reset_rx(dev);
992 dbg(3, "%s: 1st/Curr Rx Desc Ptr0=%x/%x\n", __FUNCTION__,
993 GT96100ETH_READ(gp, GT96100_ETH_1ST_RX_DESC_PTR0),
994 GT96100ETH_READ(gp, GT96100_ETH_CURR_RX_DESC_PTR0));
996 // eth port config register
997 GT96100ETH_WRITE(gp, GT96100_ETH_PORT_CONFIG_EXT,
998 pcxrFCTL | pcxrFCTLen | pcxrFLP | pcxrDPLXen);
1000 mii_reg = read_MII(gp->phy_addr, 0x11); /* int enable register */
1001 mii_reg |= 2; /* enable mii interrupt */
1002 write_MII(gp->phy_addr, 0x11, mii_reg);
1004 dbg(3, "%s: PhyAD=%x\n", __FUNCTION__,
1005 GT96100_READ(GT96100_ETH_PHY_ADDR_REG));
1007 // setup DMA
1009 // We want the Rx/Tx DMA to write/read data to/from memory in
1010 // Big Endian mode. Also set DMA Burst Size to 8 64Bit words.
1011 #ifdef DESC_DATA_BE
1012 GT96100ETH_WRITE(gp, GT96100_ETH_SDMA_CONFIG,
1013 (0xf<<sdcrRCBit) | sdcrRIFB | (3<<sdcrBSZBit));
1014 #else
1015 GT96100ETH_WRITE(gp, GT96100_ETH_SDMA_CONFIG,
1016 sdcrBLMR | sdcrBLMT |
1017 (0xf<<sdcrRCBit) | sdcrRIFB | (3<<sdcrBSZBit));
1018 #endif
1019 dbg(3, "%s: SDMA Config=%x\n", __FUNCTION__,
1020 GT96100ETH_READ(gp, GT96100_ETH_SDMA_CONFIG));
1022 // start Rx DMA
1023 GT96100ETH_WRITE(gp, GT96100_ETH_SDMA_COMM, sdcmrERD);
1024 dbg(3, "%s: SDMA Comm=%x\n", __FUNCTION__,
1025 GT96100ETH_READ(gp, GT96100_ETH_SDMA_COMM));
1027 // enable this port (set hash size to 1/2K)
1028 GT96100ETH_WRITE(gp, GT96100_ETH_PORT_CONFIG, pcrEN | pcrHS);
1029 dbg(3, "%s: Port Config=%x\n", __FUNCTION__,
1030 GT96100ETH_READ(gp, GT96100_ETH_PORT_CONFIG));
1033 * Disable all Type-of-Service queueing. All Rx packets will be
1034 * treated normally and will be sent to the lowest priority
1035 * queue.
1037 * Disable flow-control for now. FIXME: support flow control?
1040 // clear all the MIB ctr regs
1041 GT96100ETH_WRITE(gp, GT96100_ETH_PORT_CONFIG_EXT,
1042 pcxrFCTL | pcxrFCTLen | pcxrFLP |
1043 pcxrPRIOrxOverride);
1044 read_mib_counters(gp);
1045 GT96100ETH_WRITE(gp, GT96100_ETH_PORT_CONFIG_EXT,
1046 pcxrFCTL | pcxrFCTLen | pcxrFLP |
1047 pcxrPRIOrxOverride | pcxrMIBclrMode);
1049 dbg(3, "%s: Port Config Ext=%x\n", __FUNCTION__,
1050 GT96100ETH_READ(gp, GT96100_ETH_PORT_CONFIG_EXT));
1052 netif_start_queue(dev);
1054 dump_MII(4, dev);
1056 // enable interrupts
1057 enable_ether_irq(dev);
1059 // we should now be receiving frames
1060 return 0;
1064 static int
1065 gt96100_open(struct net_device *dev)
1067 int retval;
1069 MOD_INC_USE_COUNT;
1071 dbg(2, "%s: dev=%p\n", __FUNCTION__, dev);
1073 // Initialize and startup the GT-96100 ethernet port
1074 if ((retval = gt96100_init(dev))) {
1075 err("error in gt96100_init\n");
1076 free_irq(dev->irq, dev);
1077 MOD_DEC_USE_COUNT;
1078 return retval;
1081 if ((retval = request_irq(dev->irq, &gt96100_interrupt,
1082 SA_SHIRQ, dev->name, dev))) {
1083 err("unable to get IRQ %d\n", dev->irq);
1084 MOD_DEC_USE_COUNT;
1085 return retval;
1088 dbg(2, "%s: Initialization done.\n", __FUNCTION__);
1090 return 0;
1093 static int
1094 gt96100_close(struct net_device *dev)
1096 dbg(3, "%s: dev=%p\n", __FUNCTION__, dev);
1098 // stop the device
1099 if (netif_device_present(dev)) {
1100 netif_stop_queue(dev);
1101 hard_stop(dev);
1104 free_irq(dev->irq, dev);
1106 MOD_DEC_USE_COUNT;
1107 return 0;
1111 static int
1112 gt96100_tx(struct sk_buff *skb, struct net_device *dev)
1114 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
1115 unsigned long flags;
1116 int nextIn;
1118 spin_lock_irqsave(&gp->lock, flags);
1120 nextIn = gp->tx_next_in;
1122 dbg(3, "%s: nextIn=%d\n", __FUNCTION__, nextIn);
1124 if (gp->tx_count >= TX_RING_SIZE) {
1125 warn("Tx Ring full, pkt dropped.\n");
1126 gp->stats.tx_dropped++;
1127 spin_unlock_irqrestore(&gp->lock, flags);
1128 return 1;
1131 if (!(gp->last_psr & psrLink)) {
1132 err("%s: Link down, pkt dropped.\n", __FUNCTION__);
1133 gp->stats.tx_dropped++;
1134 spin_unlock_irqrestore(&gp->lock, flags);
1135 return 1;
1138 if (dma32_to_cpu(gp->tx_ring[nextIn].cmdstat) & txOwn) {
1139 err("%s: device owns descriptor, pkt dropped.\n", __FUNCTION__);
1140 gp->stats.tx_dropped++;
1141 // stop the queue, so Tx timeout can fix it
1142 netif_stop_queue(dev);
1143 spin_unlock_irqrestore(&gp->lock, flags);
1144 return 1;
1147 // Prepare the Descriptor at tx_next_in
1148 gp->tx_skbuff[nextIn] = skb;
1149 gp->tx_ring[nextIn].byte_cnt = cpu_to_dma16(skb->len);
1150 gp->tx_ring[nextIn].buff_ptr = cpu_to_dma32(virt_to_phys(skb->data));
1151 // make sure packet gets written back to memory
1152 dma_cache_wback_inv((unsigned long)(skb->data), skb->len);
1153 // Give ownership to device, set first and last desc, enable interrupt
1154 // Setting of ownership bit must be *last*!
1155 gp->tx_ring[nextIn].cmdstat =
1156 cpu_to_dma32((u32)(txOwn | txGenCRC | txEI |
1157 txPad | txFirst | txLast));
1159 dump_tx_desc(4, dev, nextIn);
1160 dump_skb(4, dev, skb);
1162 // increment tx_next_in with wrap
1163 gp->tx_next_in = (nextIn + 1) % TX_RING_SIZE;
1164 // If DMA is stopped, restart
1165 if (!(GT96100ETH_READ(gp, GT96100_ETH_PORT_STATUS) & psrTxLow))
1166 GT96100ETH_WRITE(gp, GT96100_ETH_SDMA_COMM,
1167 sdcmrERD | sdcmrTXDL);
1169 // increment count and stop queue if full
1170 if (++gp->tx_count == TX_RING_SIZE) {
1171 gp->tx_full = 1;
1172 netif_stop_queue(dev);
1173 dbg(2, "Tx Ring now full, queue stopped.\n");
1176 dev->trans_start = jiffies;
1177 spin_unlock_irqrestore(&gp->lock, flags);
1179 return 0;
1183 static int
1184 gt96100_rx(struct net_device *dev, u32 status)
1186 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
1187 struct sk_buff *skb;
1188 int pkt_len, nextOut, cdp;
1189 gt96100_rd_t *rd;
1190 u32 cmdstat;
1192 dbg(3, "%s: dev=%p, status=%x\n", __FUNCTION__, dev, status);
1194 cdp = (GT96100ETH_READ(gp, GT96100_ETH_1ST_RX_DESC_PTR0)
1195 - gp->rx_ring_dma) / sizeof(gt96100_rd_t);
1197 // Continue until we reach 1st descriptor pointer
1198 for (nextOut = gp->rx_next_out; nextOut != cdp;
1199 nextOut = (nextOut + 1) % RX_RING_SIZE) {
1201 if (--gp->intr_work_done == 0)
1202 break;
1204 rd = &gp->rx_ring[nextOut];
1205 cmdstat = dma32_to_cpu(rd->cmdstat);
1207 dbg(4, "%s: Rx desc cmdstat=%x, nextOut=%d\n", __FUNCTION__,
1208 cmdstat, nextOut);
1210 if (cmdstat & (u32)rxOwn) {
1211 //err(__FUNCTION__ ": device owns descriptor!\n");
1212 // DMA is not finished updating descriptor???
1213 // Leave and come back later to pick-up where
1214 // we left off.
1215 break;
1218 // Drop this received pkt if there were any errors
1219 if (((cmdstat & (u32)(rxErrorSummary)) &&
1220 (cmdstat & (u32)(rxFirst))) || (status & icrRxError)) {
1221 // update the detailed rx error counters that
1222 // are not covered by the MIB counters.
1223 if (cmdstat & (u32)rxOverrun)
1224 gp->stats.rx_fifo_errors++;
1225 cmdstat |= (u32)rxOwn;
1226 rd->cmdstat = cpu_to_dma32(cmdstat);
1227 continue;
1231 * Must be first and last (ie only) descriptor of packet. We
1232 * ignore (drop) any packets that do not fit in one descriptor.
1233 * Every descriptor's receive buffer is large enough to hold
1234 * the maximum 802.3 frame size, so a multi-descriptor packet
1235 * indicates an error. Most if not all corrupted packets will
1236 * have already been dropped by the above check for the
1237 * rxErrorSummary status bit.
1239 if (!(cmdstat & (u32)rxFirst) || !(cmdstat & (u32)rxLast)) {
1240 if (cmdstat & (u32)rxFirst) {
1242 * This is the first descriptor of a
1243 * multi-descriptor packet. It isn't corrupted
1244 * because the above check for rxErrorSummary
1245 * would have dropped it already, so what's
1246 * the deal with this packet? Good question,
1247 * let's dump it out.
1249 err("%s: desc not first and last!\n", __FUNCTION__);
1250 dump_rx_desc(0, dev, nextOut);
1252 cmdstat |= (u32)rxOwn;
1253 rd->cmdstat = cpu_to_dma32(cmdstat);
1254 // continue to drop every descriptor of this packet
1255 continue;
1258 pkt_len = dma16_to_cpu(rd->byte_cnt);
1260 /* Create new skb. */
1261 skb = dev_alloc_skb(pkt_len+2);
1262 if (skb == NULL) {
1263 err("%s: Memory squeeze, dropping packet.\n", __FUNCTION__);
1264 gp->stats.rx_dropped++;
1265 cmdstat |= (u32)rxOwn;
1266 rd->cmdstat = cpu_to_dma32(cmdstat);
1267 continue;
1269 skb->dev = dev;
1270 skb_reserve(skb, 2); /* 16 byte IP header align */
1271 memcpy(skb_put(skb, pkt_len),
1272 &gp->rx_buff[nextOut*PKT_BUF_SZ], pkt_len);
1273 skb->protocol = eth_type_trans(skb, dev);
1274 dump_skb(4, dev, skb);
1276 netif_rx(skb); /* pass the packet to upper layers */
1277 dev->last_rx = jiffies;
1279 // now we can release ownership of this desc back to device
1280 cmdstat |= (u32)rxOwn;
1281 rd->cmdstat = cpu_to_dma32(cmdstat);
1284 if (nextOut == gp->rx_next_out)
1285 dbg(3, "%s: RxCDP did not increment?\n", __FUNCTION__);
1287 gp->rx_next_out = nextOut;
1288 return 0;
1292 static void
1293 gt96100_tx_complete(struct net_device *dev, u32 status)
1295 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
1296 int nextOut, cdp;
1297 gt96100_td_t *td;
1298 u32 cmdstat;
1300 cdp = (GT96100ETH_READ(gp, GT96100_ETH_CURR_TX_DESC_PTR0)
1301 - gp->tx_ring_dma) / sizeof(gt96100_td_t);
1303 // Continue until we reach the current descriptor pointer
1304 for (nextOut = gp->tx_next_out; nextOut != cdp;
1305 nextOut = (nextOut + 1) % TX_RING_SIZE) {
1307 if (--gp->intr_work_done == 0)
1308 break;
1310 td = &gp->tx_ring[nextOut];
1311 cmdstat = dma32_to_cpu(td->cmdstat);
1313 dbg(3, "%s: Tx desc cmdstat=%x, nextOut=%d\n", __FUNCTION__,
1314 cmdstat, nextOut);
1316 if (cmdstat & (u32)txOwn) {
1317 //dump_tx_ring(dev);
1318 // DMA is not finished writing descriptor???
1319 // Leave and come back later to pick-up where
1320 // we left off.
1321 break;
1324 // increment Tx error stats
1325 if (cmdstat & (u32)txErrorSummary) {
1326 dbg(2, "%s: Tx error, cmdstat = %x\n", __FUNCTION__,
1327 cmdstat);
1328 gp->stats.tx_errors++;
1329 if (cmdstat & (u32)txReTxLimit)
1330 gp->stats.tx_aborted_errors++;
1331 if (cmdstat & (u32)txUnderrun)
1332 gp->stats.tx_fifo_errors++;
1333 if (cmdstat & (u32)txLateCollision)
1334 gp->stats.tx_window_errors++;
1337 if (cmdstat & (u32)txCollision)
1338 gp->stats.collisions +=
1339 (u32)((cmdstat & txReTxCntMask) >>
1340 txReTxCntBit);
1342 // Wake the queue if the ring was full
1343 if (gp->tx_full) {
1344 gp->tx_full = 0;
1345 if (gp->last_psr & psrLink) {
1346 netif_wake_queue(dev);
1347 dbg(2, "%s: Tx Ring was full, queue waked\n", __FUNCTION_);
1351 // decrement tx ring buffer count
1352 if (gp->tx_count) gp->tx_count--;
1354 // free the skb
1355 if (gp->tx_skbuff[nextOut]) {
1356 dbg(3, "%s: good Tx, skb=%p\n", __FUNCTION__,
1357 gp->tx_skbuff[nextOut]);
1358 dev_kfree_skb_irq(gp->tx_skbuff[nextOut]);
1359 gp->tx_skbuff[nextOut] = NULL;
1360 } else {
1361 err("%s: no skb!\n", __FUNCTION__);
1365 gp->tx_next_out = nextOut;
1367 if (gt96100_check_tx_consistent(gp)) {
1368 err("%s: Tx queue inconsistent!\n", __FUNCTION__);
1371 if ((status & icrTxEndLow) && gp->tx_count != 0) {
1372 // we must restart the DMA
1373 dbg(3, "%s: Restarting Tx DMA\n", __FUNCTION__);
1374 GT96100ETH_WRITE(gp, GT96100_ETH_SDMA_COMM,
1375 sdcmrERD | sdcmrTXDL);
1380 static irqreturn_t
1381 gt96100_interrupt(int irq, void *dev_id, struct pt_regs *regs)
1383 struct net_device *dev = (struct net_device *)dev_id;
1384 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
1385 u32 status;
1386 int handled = 0;
1388 if (dev == NULL) {
1389 err("%s: null dev ptr\n", __FUNCTION__);
1390 return IRQ_NONE;
1393 dbg(3, "%s: entry, icr=%x\n", __FUNCTION__,
1394 GT96100ETH_READ(gp, GT96100_ETH_INT_CAUSE));
1396 spin_lock(&gp->lock);
1398 gp->intr_work_done = max_interrupt_work;
1400 while (gp->intr_work_done > 0) {
1402 status = GT96100ETH_READ(gp, GT96100_ETH_INT_CAUSE);
1403 // ACK interrupts
1404 GT96100ETH_WRITE(gp, GT96100_ETH_INT_CAUSE, ~status);
1406 if ((status & icrEtherIntSum) == 0 &&
1407 !(status & (icrTxBufferLow|icrTxBufferHigh|icrRxBuffer)))
1408 break;
1410 handled = 1;
1412 if (status & icrMIIPhySTC) {
1413 u32 psr = GT96100ETH_READ(gp, GT96100_ETH_PORT_STATUS);
1414 if (gp->last_psr != psr) {
1415 dbg(0, "port status:\n");
1416 dbg(0, " %s MBit/s, %s-duplex, "
1417 "flow-control %s, link is %s,\n",
1418 psr & psrSpeed ? "100":"10",
1419 psr & psrDuplex ? "full":"half",
1420 psr & psrFctl ? "disabled":"enabled",
1421 psr & psrLink ? "up":"down");
1422 dbg(0, " TxLowQ is %s, TxHighQ is %s, "
1423 "Transmitter is %s\n",
1424 psr & psrTxLow ? "running":"stopped",
1425 psr & psrTxHigh ? "running":"stopped",
1426 psr & psrTxInProg ? "on":"off");
1428 if ((psr & psrLink) && !gp->tx_full &&
1429 netif_queue_stopped(dev)) {
1430 dbg(0, ": Link up, waking queue.\n",
1431 __FUNCTION_);
1432 netif_wake_queue(dev);
1433 } else if (!(psr & psrLink) &&
1434 !netif_queue_stopped(dev)) {
1435 dbg(0, "Link down, stopping queue.\n",
1436 __FUNCTION__);
1437 netif_stop_queue(dev);
1440 gp->last_psr = psr;
1443 if (--gp->intr_work_done == 0)
1444 break;
1447 if (status & (icrTxBufferLow | icrTxEndLow))
1448 gt96100_tx_complete(dev, status);
1450 if (status & (icrRxBuffer | icrRxError)) {
1451 gt96100_rx(dev, status);
1454 // Now check TX errors (RX errors were handled in gt96100_rx)
1455 if (status & icrTxErrorLow) {
1456 err("%s: Tx resource error\n", __FUNCTION__);
1457 if (--gp->intr_work_done == 0)
1458 break;
1461 if (status & icrTxUdr) {
1462 err("%s: Tx underrun error\n", __FUNCTION__);
1463 if (--gp->intr_work_done == 0)
1464 break;
1468 if (gp->intr_work_done == 0) {
1469 // ACK any remaining pending interrupts
1470 GT96100ETH_WRITE(gp, GT96100_ETH_INT_CAUSE, 0);
1471 dbg(3, "%s: hit max work\n", __FUNCTION__);
1474 dbg(3, "%s: exit, icr=%x\n", __FUNCTION__,
1475 GT96100ETH_READ(gp, GT96100_ETH_INT_CAUSE));
1477 spin_unlock(&gp->lock);
1478 return IRQ_RETVAL(handled);
1482 static void
1483 gt96100_tx_timeout(struct net_device *dev)
1485 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
1486 unsigned long flags;
1488 spin_lock_irqsave(&gp->lock, flags);
1490 if (!(gp->last_psr & psrLink)) {
1491 err("tx_timeout: link down.\n");
1492 spin_unlock_irqrestore(&gp->lock, flags);
1493 } else {
1494 if (gt96100_check_tx_consistent(gp))
1495 err("tx_timeout: Tx ring error.\n");
1497 disable_ether_irq(dev);
1498 spin_unlock_irqrestore(&gp->lock, flags);
1499 reset_tx(dev);
1500 enable_ether_irq(dev);
1502 netif_wake_queue(dev);
1507 static void
1508 gt96100_set_rx_mode(struct net_device *dev)
1510 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
1511 unsigned long flags;
1512 //struct dev_mc_list *mcptr;
1514 dbg(3, "%s: dev=%p, flags=%x\n", __FUNCTION__, dev, dev->flags);
1516 // stop the Receiver DMA
1517 abort(dev, sdcmrAR);
1519 spin_lock_irqsave(&gp->lock, flags);
1521 if (dev->flags & IFF_PROMISC) {
1522 GT96100ETH_WRITE(gp, GT96100_ETH_PORT_CONFIG,
1523 pcrEN | pcrHS | pcrPM);
1526 #if 0
1528 FIXME: currently multicast doesn't work - need to get hash table
1529 working first.
1531 if (dev->mc_count) {
1532 // clear hash table
1533 memset(gp->hash_table, 0, RX_HASH_TABLE_SIZE);
1534 // Add our ethernet address
1535 gt96100_add_hash_entry(dev, dev->dev_addr);
1537 for (mcptr = dev->mc_list; mcptr; mcptr = mcptr->next) {
1538 dump_hw_addr(2, dev, __FUNCTION__ ": addr=",
1539 mcptr->dmi_addr);
1540 gt96100_add_hash_entry(dev, mcptr->dmi_addr);
1543 #endif
1545 // restart Rx DMA
1546 GT96100ETH_WRITE(gp, GT96100_ETH_SDMA_COMM, sdcmrERD);
1548 spin_unlock_irqrestore(&gp->lock, flags);
1551 static struct net_device_stats *
1552 gt96100_get_stats(struct net_device *dev)
1554 struct gt96100_private *gp = (struct gt96100_private *)dev->priv;
1555 unsigned long flags;
1557 dbg(3, "%s: dev=%p\n", __FUNCTION__, dev);
1559 if (netif_device_present(dev)) {
1560 spin_lock_irqsave (&gp->lock, flags);
1561 update_stats(gp);
1562 spin_unlock_irqrestore (&gp->lock, flags);
1565 return &gp->stats;
1568 static void gt96100_cleanup_module(void)
1570 int i;
1571 for (i=0; i<NUM_INTERFACES; i++) {
1572 struct gt96100_if_t *gtif = &gt96100_iflist[i];
1573 if (gtif->dev != NULL) {
1574 struct gt96100_private *gp =
1575 (struct gt96100_private *)gtif->dev->priv;
1576 release_region(gtif->iobase, gp->io_size);
1577 unregister_netdev(gtif->dev);
1578 kfree (gtif->dev);
1584 #ifndef MODULE
1586 static int __init gt96100_setup(char *options)
1588 char *this_opt;
1590 if (!options || !*options)
1591 return 0;
1593 while ((this_opt = strsep (&options, ",")) != NULL) {
1594 if (!*this_opt)
1595 continue;
1596 if (!strncmp(this_opt, "mac0:", 5)) {
1597 memcpy(mac0, this_opt+5, 17);
1598 mac0[17]= '\0';
1599 } else if (!strncmp(this_opt, "mac1:", 5)) {
1600 memcpy(mac1, this_opt+5, 17);
1601 mac1[17]= '\0';
1605 return 1;
1608 __setup("gt96100eth=", gt96100_setup);
1610 #endif /* !MODULE */
1613 module_init(gt96100_init_module);
1614 module_exit(gt96100_cleanup_module);
1616 MODULE_AUTHOR("Steve Longerbeam <stevel@mvista.com>");
1617 MODULE_DESCRIPTION("GT96100 Ethernet driver");