?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
[PATCH] revert "swsusp add check for suspension of X controlled devices"
[linux/fpc-iii.git] / drivers / net / amd8111e.c
blobd9ba8be72af804462735ef7a6facad667f3da765
1
2 /* Advanced Micro Devices Inc. AMD8111E Linux Network Driver
3 * Copyright (C) 2004 Advanced Micro Devices
4 *
5 *
6 * Copyright 2001,2002 Jeff Garzik <jgarzik@mandrakesoft.com> [ 8139cp.c,tg3.c ]
7 * Copyright (C) 2001, 2002 David S. Miller (davem@redhat.com)[ tg3.c]
8 * Copyright 1996-1999 Thomas Bogendoerfer [ pcnet32.c ]
9 * Derived from the lance driver written 1993,1994,1995 by Donald Becker.
10 * Copyright 1993 United States Government as represented by the
11 * Director, National Security Agency.[ pcnet32.c ]
12 * Carsten Langgaard, carstenl@mips.com [ pcnet32.c ]
13 * Copyright (C) 2000 MIPS Technologies, Inc. All rights reserved.
14 *
15 *
16 * This program is free software; you can redistribute it and/or modify
17 * it under the terms of the GNU General Public License as published by
18 * the Free Software Foundation; either version 2 of the License, or
19 * (at your option) any later version.
20 *
21 * This program is distributed in the hope that it will be useful,
22 * but WITHOUT ANY WARRANTY; without even the implied warranty of
23 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
24 * GNU General Public License for more details.
25 *
26 * You should have received a copy of the GNU General Public License
27 * along with this program; if not, write to the Free Software
28 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
29 * USA
30
31 Module Name:
32
33 amd8111e.c
34
35 Abstract:
36
37 AMD8111 based 10/100 Ethernet Controller Driver.
38
39 Environment:
40
41 Kernel Mode
42
43 Revision History:
44 3.0.0
45 Initial Revision.
46 3.0.1
47 1. Dynamic interrupt coalescing.
48 2. Removed prev_stats.
49 3. MII support.
50 4. Dynamic IPG support
51 3.0.2 05/29/2003
52 1. Bug fix: Fixed failure to send jumbo packets larger than 4k.
53 2. Bug fix: Fixed VLAN support failure.
54 3. Bug fix: Fixed receive interrupt coalescing bug.
55 4. Dynamic IPG support is disabled by default.
56 3.0.3 06/05/2003
57 1. Bug fix: Fixed failure to close the interface if SMP is enabled.
58 3.0.4 12/09/2003
59 1. Added set_mac_address routine for bonding driver support.
60 2. Tested the driver for bonding support
61 3. Bug fix: Fixed mismach in actual receive buffer lenth and lenth
62 indicated to the h/w.
63 4. Modified amd8111e_rx() routine to receive all the received packets
64 in the first interrupt.
65 5. Bug fix: Corrected rx_errors reported in get_stats() function.
66 3.0.5 03/22/2004
67 1. Added NAPI support
68
69 */
70
71
72 #include <linux/config.h>
73 #include <linux/module.h>
74 #include <linux/kernel.h>
75 #include <linux/types.h>
76 #include <linux/compiler.h>
77 #include <linux/slab.h>
78 #include <linux/delay.h>
79 #include <linux/init.h>
80 #include <linux/ioport.h>
81 #include <linux/pci.h>
82 #include <linux/netdevice.h>
83 #include <linux/etherdevice.h>
84 #include <linux/skbuff.h>
85 #include <linux/ethtool.h>
86 #include <linux/mii.h>
87 #include <linux/if_vlan.h>
88 #include <linux/ctype.h>
89 #include <linux/crc32.h>
90 #include <linux/dma-mapping.h>
91
92 #include <asm/system.h>
93 #include <asm/io.h>
94 #include <asm/byteorder.h>
95 #include <asm/uaccess.h>
96
97 #if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)
98 #define AMD8111E_VLAN_TAG_USED 1
99 #else
100 #define AMD8111E_VLAN_TAG_USED 0
101 #endif
102
103 #include "amd8111e.h"
104 #define MODULE_NAME "amd8111e"
105 #define MODULE_VERS "3.0.5"
106 MODULE_AUTHOR("Advanced Micro Devices, Inc.");
107 MODULE_DESCRIPTION ("AMD8111 based 10/100 Ethernet Controller. Driver Version 3.0.3");
108 MODULE_LICENSE("GPL");
109 MODULE_DEVICE_TABLE(pci, amd8111e_pci_tbl);
110 module_param_array(speed_duplex, int, NULL, 0);
111 MODULE_PARM_DESC(speed_duplex, "Set device speed and duplex modes, 0: Auto Negotitate, 1: 10Mbps Half Duplex, 2: 10Mbps Full Duplex, 3: 100Mbps Half Duplex, 4: 100Mbps Full Duplex");
112 module_param_array(coalesce, bool, NULL, 0);
113 MODULE_PARM_DESC(coalesce, "Enable or Disable interrupt coalescing, 1: Enable, 0: Disable");
114 module_param_array(dynamic_ipg, bool, NULL, 0);
115 MODULE_PARM_DESC(dynamic_ipg, "Enable or Disable dynamic IPG, 1: Enable, 0: Disable");
116
117 static struct pci_device_id amd8111e_pci_tbl[] = {
118
119 { PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD8111E_7462,
120 PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL },
121 { 0, }
122
123 };
124 /*
125 This function will read the PHY registers.
126 */
127 static int amd8111e_read_phy(struct amd8111e_priv* lp, int phy_id, int reg, u32* val)
128 {
129 void __iomem *mmio = lp->mmio;
130 unsigned int reg_val;
131 unsigned int repeat= REPEAT_CNT;
132
133 reg_val = readl(mmio + PHY_ACCESS);
134 while (reg_val & PHY_CMD_ACTIVE)
135 reg_val = readl( mmio + PHY_ACCESS );
136
137 writel( PHY_RD_CMD | ((phy_id & 0x1f) << 21) |
138 ((reg & 0x1f) << 16), mmio +PHY_ACCESS);
139 do{
140 reg_val = readl(mmio + PHY_ACCESS);
141 udelay(30); /* It takes 30 us to read/write data */
142 } while (--repeat && (reg_val & PHY_CMD_ACTIVE));
143 if(reg_val & PHY_RD_ERR)
144 goto err_phy_read;
145
146 *val = reg_val & 0xffff;
147 return 0;
148 err_phy_read:
149 *val = 0;
150 return -EINVAL;
151
152 }
153
154 /*
155 This function will write into PHY registers.
156 */
157 static int amd8111e_write_phy(struct amd8111e_priv* lp,int phy_id, int reg, u32 val)
158 {
159 unsigned int repeat = REPEAT_CNT
160 void __iomem *mmio = lp->mmio;
161 unsigned int reg_val;
162
163 reg_val = readl(mmio + PHY_ACCESS);
164 while (reg_val & PHY_CMD_ACTIVE)
165 reg_val = readl( mmio + PHY_ACCESS );
166
167 writel( PHY_WR_CMD | ((phy_id & 0x1f) << 21) |
168 ((reg & 0x1f) << 16)|val, mmio + PHY_ACCESS);
169
170 do{
171 reg_val = readl(mmio + PHY_ACCESS);
172 udelay(30); /* It takes 30 us to read/write the data */
173 } while (--repeat && (reg_val & PHY_CMD_ACTIVE));
174
175 if(reg_val & PHY_RD_ERR)
176 goto err_phy_write;
177
178 return 0;
179
180 err_phy_write:
181 return -EINVAL;
182
183 }
184 /*
185 This is the mii register read function provided to the mii interface.
186 */
187 static int amd8111e_mdio_read(struct net_device * dev, int phy_id, int reg_num)
188 {
189 struct amd8111e_priv* lp = netdev_priv(dev);
190 unsigned int reg_val;
191
192 amd8111e_read_phy(lp,phy_id,reg_num,&reg_val);
193 return reg_val;
194
195 }
196
197 /*
198 This is the mii register write function provided to the mii interface.
199 */
200 static void amd8111e_mdio_write(struct net_device * dev, int phy_id, int reg_num, int val)
201 {
202 struct amd8111e_priv* lp = netdev_priv(dev);
203
204 amd8111e_write_phy(lp, phy_id, reg_num, val);
205 }
206
207 /*
208 This function will set PHY speed. During initialization sets the original speed to 100 full.
209 */
210 static void amd8111e_set_ext_phy(struct net_device *dev)
211 {
212 struct amd8111e_priv *lp = netdev_priv(dev);
213 u32 bmcr,advert,tmp;
214
215 /* Determine mii register values to set the speed */
216 advert = amd8111e_mdio_read(dev, lp->ext_phy_addr, MII_ADVERTISE);
217 tmp = advert & ~(ADVERTISE_ALL | ADVERTISE_100BASE4);
218 switch (lp->ext_phy_option){
219
220 default:
221 case SPEED_AUTONEG: /* advertise all values */
222 tmp |= ( ADVERTISE_10HALF|ADVERTISE_10FULL|
223 ADVERTISE_100HALF|ADVERTISE_100FULL) ;
224 break;
225 case SPEED10_HALF:
226 tmp |= ADVERTISE_10HALF;
227 break;
228 case SPEED10_FULL:
229 tmp |= ADVERTISE_10FULL;
230 break;
231 case SPEED100_HALF:
232 tmp |= ADVERTISE_100HALF;
233 break;
234 case SPEED100_FULL:
235 tmp |= ADVERTISE_100FULL;
236 break;
237 }
238
239 if(advert != tmp)
240 amd8111e_mdio_write(dev, lp->ext_phy_addr, MII_ADVERTISE, tmp);
241 /* Restart auto negotiation */
242 bmcr = amd8111e_mdio_read(dev, lp->ext_phy_addr, MII_BMCR);
243 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
244 amd8111e_mdio_write(dev, lp->ext_phy_addr, MII_BMCR, bmcr);
245
246 }
247
248 /*
249 This function will unmap skb->data space and will free
250 all transmit and receive skbuffs.
251 */
252 static int amd8111e_free_skbs(struct net_device *dev)
253 {
254 struct amd8111e_priv *lp = netdev_priv(dev);
255 struct sk_buff* rx_skbuff;
256 int i;
257
258 /* Freeing transmit skbs */
259 for(i = 0; i < NUM_TX_BUFFERS; i++){
260 if(lp->tx_skbuff[i]){
261 pci_unmap_single(lp->pci_dev,lp->tx_dma_addr[i], lp->tx_skbuff[i]->len,PCI_DMA_TODEVICE);
262 dev_kfree_skb (lp->tx_skbuff[i]);
263 lp->tx_skbuff[i] = NULL;
264 lp->tx_dma_addr[i] = 0;
265 }
266 }
267 /* Freeing previously allocated receive buffers */
268 for (i = 0; i < NUM_RX_BUFFERS; i++){
269 rx_skbuff = lp->rx_skbuff[i];
270 if(rx_skbuff != NULL){
271 pci_unmap_single(lp->pci_dev,lp->rx_dma_addr[i],
272 lp->rx_buff_len - 2,PCI_DMA_FROMDEVICE);
273 dev_kfree_skb(lp->rx_skbuff[i]);
274 lp->rx_skbuff[i] = NULL;
275 lp->rx_dma_addr[i] = 0;
276 }
277 }
278
279 return 0;
280 }
281
282 /*
283 This will set the receive buffer length corresponding to the mtu size of networkinterface.
284 */
285 static inline void amd8111e_set_rx_buff_len(struct net_device* dev)
286 {
287 struct amd8111e_priv* lp = netdev_priv(dev);
288 unsigned int mtu = dev->mtu;
289
290 if (mtu > ETH_DATA_LEN){
291 /* MTU + ethernet header + FCS
292 + optional VLAN tag + skb reserve space 2 */
293
294 lp->rx_buff_len = mtu + ETH_HLEN + 10;
295 lp->options |= OPTION_JUMBO_ENABLE;
296 } else{
297 lp->rx_buff_len = PKT_BUFF_SZ;
298 lp->options &= ~OPTION_JUMBO_ENABLE;
299 }
300 }
301
302 /*
303 This function will free all the previously allocated buffers, determine new receive buffer length and will allocate new receive buffers. This function also allocates and initializes both the transmitter and receive hardware descriptors.
304 */
305 static int amd8111e_init_ring(struct net_device *dev)
306 {
307 struct amd8111e_priv *lp = netdev_priv(dev);
308 int i;
309
310 lp->rx_idx = lp->tx_idx = 0;
311 lp->tx_complete_idx = 0;
312 lp->tx_ring_idx = 0;
313
314
315 if(lp->opened)
316 /* Free previously allocated transmit and receive skbs */
317 amd8111e_free_skbs(dev);
318
319 else{
320 /* allocate the tx and rx descriptors */
321 if((lp->tx_ring = pci_alloc_consistent(lp->pci_dev,
322 sizeof(struct amd8111e_tx_dr)*NUM_TX_RING_DR,
323 &lp->tx_ring_dma_addr)) == NULL)
324
325 goto err_no_mem;
326
327 if((lp->rx_ring = pci_alloc_consistent(lp->pci_dev,
328 sizeof(struct amd8111e_rx_dr)*NUM_RX_RING_DR,
329 &lp->rx_ring_dma_addr)) == NULL)
330
331 goto err_free_tx_ring;
332
333 }
334 /* Set new receive buff size */
335 amd8111e_set_rx_buff_len(dev);
336
337 /* Allocating receive skbs */
338 for (i = 0; i < NUM_RX_BUFFERS; i++) {
339
340 if (!(lp->rx_skbuff[i] = dev_alloc_skb(lp->rx_buff_len))) {
341 /* Release previos allocated skbs */
342 for(--i; i >= 0 ;i--)
343 dev_kfree_skb(lp->rx_skbuff[i]);
344 goto err_free_rx_ring;
345 }
346 skb_reserve(lp->rx_skbuff[i],2);
347 }
348 /* Initilaizing receive descriptors */
349 for (i = 0; i < NUM_RX_BUFFERS; i++) {
350 lp->rx_dma_addr[i] = pci_map_single(lp->pci_dev,
351 lp->rx_skbuff[i]->data,lp->rx_buff_len-2, PCI_DMA_FROMDEVICE);
352
353 lp->rx_ring[i].buff_phy_addr = cpu_to_le32(lp->rx_dma_addr[i]);
354 lp->rx_ring[i].buff_count = cpu_to_le16(lp->rx_buff_len-2);
355 wmb();
356 lp->rx_ring[i].rx_flags = cpu_to_le16(OWN_BIT);
357 }
358
359 /* Initializing transmit descriptors */
360 for (i = 0; i < NUM_TX_RING_DR; i++) {
361 lp->tx_ring[i].buff_phy_addr = 0;
362 lp->tx_ring[i].tx_flags = 0;
363 lp->tx_ring[i].buff_count = 0;
364 }
365
366 return 0;
367
368 err_free_rx_ring:
369
370 pci_free_consistent(lp->pci_dev,
371 sizeof(struct amd8111e_rx_dr)*NUM_RX_RING_DR,lp->rx_ring,
372 lp->rx_ring_dma_addr);
373
374 err_free_tx_ring:
375
376 pci_free_consistent(lp->pci_dev,
377 sizeof(struct amd8111e_tx_dr)*NUM_TX_RING_DR,lp->tx_ring,
378 lp->tx_ring_dma_addr);
379
380 err_no_mem:
381 return -ENOMEM;
382 }
383 /* This function will set the interrupt coalescing according to the input arguments */
384 static int amd8111e_set_coalesce(struct net_device * dev, enum coal_mode cmod)
385 {
386 unsigned int timeout;
387 unsigned int event_count;
388
389 struct amd8111e_priv *lp = netdev_priv(dev);
390 void __iomem *mmio = lp->mmio;
391 struct amd8111e_coalesce_conf * coal_conf = &lp->coal_conf;
392
393
394 switch(cmod)
395 {
396 case RX_INTR_COAL :
397 timeout = coal_conf->rx_timeout;
398 event_count = coal_conf->rx_event_count;
399 if( timeout > MAX_TIMEOUT ||
400 event_count > MAX_EVENT_COUNT )
401 return -EINVAL;
402
403 timeout = timeout * DELAY_TIMER_CONV;
404 writel(VAL0|STINTEN, mmio+INTEN0);
405 writel((u32)DLY_INT_A_R0|( event_count<< 16 )|timeout,
406 mmio+DLY_INT_A);
407 break;
408
409 case TX_INTR_COAL :
410 timeout = coal_conf->tx_timeout;
411 event_count = coal_conf->tx_event_count;
412 if( timeout > MAX_TIMEOUT ||
413 event_count > MAX_EVENT_COUNT )
414 return -EINVAL;
415
416
417 timeout = timeout * DELAY_TIMER_CONV;
418 writel(VAL0|STINTEN,mmio+INTEN0);
419 writel((u32)DLY_INT_B_T0|( event_count<< 16 )|timeout,
420 mmio+DLY_INT_B);
421 break;
422
423 case DISABLE_COAL:
424 writel(0,mmio+STVAL);
425 writel(STINTEN, mmio+INTEN0);
426 writel(0, mmio +DLY_INT_B);
427 writel(0, mmio+DLY_INT_A);
428 break;
429 case ENABLE_COAL:
430 /* Start the timer */
431 writel((u32)SOFT_TIMER_FREQ, mmio+STVAL); /* 0.5 sec */
432 writel(VAL0|STINTEN, mmio+INTEN0);
433 break;
434 default:
435 break;
436
437 }
438 return 0;
439
440 }
441
442 /*
443 This function initializes the device registers and starts the device.
444 */
445 static int amd8111e_restart(struct net_device *dev)
446 {
447 struct amd8111e_priv *lp = netdev_priv(dev);
448 void __iomem *mmio = lp->mmio;
449 int i,reg_val;
450
451 /* stop the chip */
452 writel(RUN, mmio + CMD0);
453
454 if(amd8111e_init_ring(dev))
455 return -ENOMEM;
456
457 /* enable the port manager and set auto negotiation always */
458 writel((u32) VAL1|EN_PMGR, mmio + CMD3 );
459 writel((u32)XPHYANE|XPHYRST , mmio + CTRL2);
460
461 amd8111e_set_ext_phy(dev);
462
463 /* set control registers */
464 reg_val = readl(mmio + CTRL1);
465 reg_val &= ~XMTSP_MASK;
466 writel( reg_val| XMTSP_128 | CACHE_ALIGN, mmio + CTRL1 );
467
468 /* enable interrupt */
469 writel( APINT5EN | APINT4EN | APINT3EN | APINT2EN | APINT1EN |
470 APINT0EN | MIIPDTINTEN | MCCIINTEN | MCCINTEN | MREINTEN |
471 SPNDINTEN | MPINTEN | SINTEN | STINTEN, mmio + INTEN0);
472
473 writel(VAL3 | LCINTEN | VAL1 | TINTEN0 | VAL0 | RINTEN0, mmio + INTEN0);
474
475 /* initialize tx and rx ring base addresses */
476 writel((u32)lp->tx_ring_dma_addr,mmio + XMT_RING_BASE_ADDR0);
477 writel((u32)lp->rx_ring_dma_addr,mmio+ RCV_RING_BASE_ADDR0);
478
479 writew((u32)NUM_TX_RING_DR, mmio + XMT_RING_LEN0);
480 writew((u16)NUM_RX_RING_DR, mmio + RCV_RING_LEN0);
481
482 /* set default IPG to 96 */
483 writew((u32)DEFAULT_IPG,mmio+IPG);
484 writew((u32)(DEFAULT_IPG-IFS1_DELTA), mmio + IFS1);
485
486 if(lp->options & OPTION_JUMBO_ENABLE){
487 writel((u32)VAL2|JUMBO, mmio + CMD3);
488 /* Reset REX_UFLO */
489 writel( REX_UFLO, mmio + CMD2);
490 /* Should not set REX_UFLO for jumbo frames */
491 writel( VAL0 | APAD_XMT|REX_RTRY , mmio + CMD2);
492 }else{
493 writel( VAL0 | APAD_XMT | REX_RTRY|REX_UFLO, mmio + CMD2);
494 writel((u32)JUMBO, mmio + CMD3);
495 }
496
497 #if AMD8111E_VLAN_TAG_USED
498 writel((u32) VAL2|VSIZE|VL_TAG_DEL, mmio + CMD3);
499 #endif
500 writel( VAL0 | APAD_XMT | REX_RTRY, mmio + CMD2 );
501
502 /* Setting the MAC address to the device */
503 for(i = 0; i < ETH_ADDR_LEN; i++)
504 writeb( dev->dev_addr[i], mmio + PADR + i );
505
506 /* Enable interrupt coalesce */
507 if(lp->options & OPTION_INTR_COAL_ENABLE){
508 printk(KERN_INFO "%s: Interrupt Coalescing Enabled.\n",
509 dev->name);
510 amd8111e_set_coalesce(dev,ENABLE_COAL);
511 }
512
513 /* set RUN bit to start the chip */
514 writel(VAL2 | RDMD0, mmio + CMD0);
515 writel(VAL0 | INTREN | RUN, mmio + CMD0);
516
517 /* To avoid PCI posting bug */
518 readl(mmio+CMD0);
519 return 0;
520 }
521 /*
522 This function clears necessary the device registers.
523 */
524 static void amd8111e_init_hw_default( struct amd8111e_priv* lp)
525 {
526 unsigned int reg_val;
527 unsigned int logic_filter[2] ={0,};
528 void __iomem *mmio = lp->mmio;
529
530
531 /* stop the chip */
532 writel(RUN, mmio + CMD0);
533
534 /* AUTOPOLL0 Register *//*TBD default value is 8100 in FPS */
535 writew( 0x8100 | lp->ext_phy_addr, mmio + AUTOPOLL0);
536
537 /* Clear RCV_RING_BASE_ADDR */
538 writel(0, mmio + RCV_RING_BASE_ADDR0);
539
540 /* Clear XMT_RING_BASE_ADDR */
541 writel(0, mmio + XMT_RING_BASE_ADDR0);
542 writel(0, mmio + XMT_RING_BASE_ADDR1);
543 writel(0, mmio + XMT_RING_BASE_ADDR2);
544 writel(0, mmio + XMT_RING_BASE_ADDR3);
545
546 /* Clear CMD0 */
547 writel(CMD0_CLEAR,mmio + CMD0);
548
549 /* Clear CMD2 */
550 writel(CMD2_CLEAR, mmio +CMD2);
551
552 /* Clear CMD7 */
553 writel(CMD7_CLEAR , mmio + CMD7);
554
555 /* Clear DLY_INT_A and DLY_INT_B */
556 writel(0x0, mmio + DLY_INT_A);
557 writel(0x0, mmio + DLY_INT_B);
558
559 /* Clear FLOW_CONTROL */
560 writel(0x0, mmio + FLOW_CONTROL);
561
562 /* Clear INT0 write 1 to clear register */
563 reg_val = readl(mmio + INT0);
564 writel(reg_val, mmio + INT0);
565
566 /* Clear STVAL */
567 writel(0x0, mmio + STVAL);
568
569 /* Clear INTEN0 */
570 writel( INTEN0_CLEAR, mmio + INTEN0);
571
572 /* Clear LADRF */
573 writel(0x0 , mmio + LADRF);
574
575 /* Set SRAM_SIZE & SRAM_BOUNDARY registers */
576 writel( 0x80010,mmio + SRAM_SIZE);
577
578 /* Clear RCV_RING0_LEN */
579 writel(0x0, mmio + RCV_RING_LEN0);
580
581 /* Clear XMT_RING0/1/2/3_LEN */
582 writel(0x0, mmio + XMT_RING_LEN0);
583 writel(0x0, mmio + XMT_RING_LEN1);
584 writel(0x0, mmio + XMT_RING_LEN2);
585 writel(0x0, mmio + XMT_RING_LEN3);
586
587 /* Clear XMT_RING_LIMIT */
588 writel(0x0, mmio + XMT_RING_LIMIT);
589
590 /* Clear MIB */
591 writew(MIB_CLEAR, mmio + MIB_ADDR);
592
593 /* Clear LARF */
594 amd8111e_writeq(*(u64*)logic_filter,mmio+LADRF);
595
596 /* SRAM_SIZE register */
597 reg_val = readl(mmio + SRAM_SIZE);
598
599 if(lp->options & OPTION_JUMBO_ENABLE)
600 writel( VAL2|JUMBO, mmio + CMD3);
601 #if AMD8111E_VLAN_TAG_USED
602 writel(VAL2|VSIZE|VL_TAG_DEL, mmio + CMD3 );
603 #endif
604 /* Set default value to CTRL1 Register */
605 writel(CTRL1_DEFAULT, mmio + CTRL1);
606
607 /* To avoid PCI posting bug */
608 readl(mmio + CMD2);
609
610 }
611
612 /*
613 This function disables the interrupt and clears all the pending
614 interrupts in INT0
615 */
616 static void amd8111e_disable_interrupt(struct amd8111e_priv* lp)
617 {
618 u32 intr0;
619
620 /* Disable interrupt */
621 writel(INTREN, lp->mmio + CMD0);
622
623 /* Clear INT0 */
624 intr0 = readl(lp->mmio + INT0);
625 writel(intr0, lp->mmio + INT0);
626
627 /* To avoid PCI posting bug */
628 readl(lp->mmio + INT0);
629
630 }
631
632 /*
633 This function stops the chip.
634 */
635 static void amd8111e_stop_chip(struct amd8111e_priv* lp)
636 {
637 writel(RUN, lp->mmio + CMD0);
638
639 /* To avoid PCI posting bug */
640 readl(lp->mmio + CMD0);
641 }
642
643 /*
644 This function frees the transmiter and receiver descriptor rings.
645 */
646 static void amd8111e_free_ring(struct amd8111e_priv* lp)
647 {
648
649 /* Free transmit and receive skbs */
650 amd8111e_free_skbs(lp->amd8111e_net_dev);
651
652 /* Free transmit and receive descriptor rings */
653 if(lp->rx_ring){
654 pci_free_consistent(lp->pci_dev,
655 sizeof(struct amd8111e_rx_dr)*NUM_RX_RING_DR,
656 lp->rx_ring, lp->rx_ring_dma_addr);
657 lp->rx_ring = NULL;
658 }
659
660 if(lp->tx_ring){
661 pci_free_consistent(lp->pci_dev,
662 sizeof(struct amd8111e_tx_dr)*NUM_TX_RING_DR,
663 lp->tx_ring, lp->tx_ring_dma_addr);
664
665 lp->tx_ring = NULL;
666 }
667
668 }
669 #if AMD8111E_VLAN_TAG_USED
670 /*
671 This is the receive indication function for packets with vlan tag.
672 */
673 static int amd8111e_vlan_rx(struct amd8111e_priv *lp, struct sk_buff *skb, u16 vlan_tag)
674 {
675 #ifdef CONFIG_AMD8111E_NAPI
676 return vlan_hwaccel_receive_skb(skb, lp->vlgrp,vlan_tag);
677 #else
678 return vlan_hwaccel_rx(skb, lp->vlgrp, vlan_tag);
679 #endif /* CONFIG_AMD8111E_NAPI */
680 }
681 #endif
682
683 /*
684 This function will free all the transmit skbs that are actually transmitted by the device. It will check the ownership of the skb before freeing the skb.
685 */
686 static int amd8111e_tx(struct net_device *dev)
687 {
688 struct amd8111e_priv* lp = netdev_priv(dev);
689 int tx_index = lp->tx_complete_idx & TX_RING_DR_MOD_MASK;
690 int status;
691 /* Complete all the transmit packet */
692 while (lp->tx_complete_idx != lp->tx_idx){
693 tx_index = lp->tx_complete_idx & TX_RING_DR_MOD_MASK;
694 status = le16_to_cpu(lp->tx_ring[tx_index].tx_flags);
695
696 if(status & OWN_BIT)
697 break; /* It still hasn't been Txed */
698
699 lp->tx_ring[tx_index].buff_phy_addr = 0;
700
701 /* We must free the original skb */
702 if (lp->tx_skbuff[tx_index]) {
703 pci_unmap_single(lp->pci_dev, lp->tx_dma_addr[tx_index],
704 lp->tx_skbuff[tx_index]->len,
705 PCI_DMA_TODEVICE);
706 dev_kfree_skb_irq (lp->tx_skbuff[tx_index]);
707 lp->tx_skbuff[tx_index] = NULL;
708 lp->tx_dma_addr[tx_index] = 0;
709 }
710 lp->tx_complete_idx++;
711 /*COAL update tx coalescing parameters */
712 lp->coal_conf.tx_packets++;
713 lp->coal_conf.tx_bytes += lp->tx_ring[tx_index].buff_count;
714
715 if (netif_queue_stopped(dev) &&
716 lp->tx_complete_idx > lp->tx_idx - NUM_TX_BUFFERS +2){
717 /* The ring is no longer full, clear tbusy. */
718 /* lp->tx_full = 0; */
719 netif_wake_queue (dev);
720 }
721 }
722 return 0;
723 }
724
725 #ifdef CONFIG_AMD8111E_NAPI
726 /* This function handles the driver receive operation in polling mode */
727 static int amd8111e_rx_poll(struct net_device *dev, int * budget)
728 {
729 struct amd8111e_priv *lp = netdev_priv(dev);
730 int rx_index = lp->rx_idx & RX_RING_DR_MOD_MASK;
731 void __iomem *mmio = lp->mmio;
732 struct sk_buff *skb,*new_skb;
733 int min_pkt_len, status;
734 unsigned int intr0;
735 int num_rx_pkt = 0;
736 /*int max_rx_pkt = NUM_RX_BUFFERS;*/
737 short pkt_len;
738 #if AMD8111E_VLAN_TAG_USED
739 short vtag;
740 #endif
741 int rx_pkt_limit = dev->quota;
742 unsigned long flags;
743
744 do{
745 /* process receive packets until we use the quota*/
746 /* If we own the next entry, it's a new packet. Send it up. */
747 while(1) {
748 status = le16_to_cpu(lp->rx_ring[rx_index].rx_flags);
749 if (status & OWN_BIT)
750 break;
751
752 /*
753 * There is a tricky error noted by John Murphy,
754 * <murf@perftech.com> to Russ Nelson: Even with
755 * full-sized * buffers it's possible for a
756 * jabber packet to use two buffers, with only
757 * the last correctly noting the error.
758 */
759
760 if(status & ERR_BIT) {
761 /* reseting flags */
762 lp->rx_ring[rx_index].rx_flags &= RESET_RX_FLAGS;
763 goto err_next_pkt;
764 }
765 /* check for STP and ENP */
766 if(!((status & STP_BIT) && (status & ENP_BIT))){
767 /* reseting flags */
768 lp->rx_ring[rx_index].rx_flags &= RESET_RX_FLAGS;
769 goto err_next_pkt;
770 }
771 pkt_len = le16_to_cpu(lp->rx_ring[rx_index].msg_count) - 4;
772
773 #if AMD8111E_VLAN_TAG_USED
774 vtag = status & TT_MASK;
775 /*MAC will strip vlan tag*/
776 if(lp->vlgrp != NULL && vtag !=0)
777 min_pkt_len =MIN_PKT_LEN - 4;
778 else
779 #endif
780 min_pkt_len =MIN_PKT_LEN;
781
782 if (pkt_len < min_pkt_len) {
783 lp->rx_ring[rx_index].rx_flags &= RESET_RX_FLAGS;
784 lp->drv_rx_errors++;
785 goto err_next_pkt;
786 }
787 if(--rx_pkt_limit < 0)
788 goto rx_not_empty;
789 if(!(new_skb = dev_alloc_skb(lp->rx_buff_len))){
790 /* if allocation fail,
791 ignore that pkt and go to next one */
792 lp->rx_ring[rx_index].rx_flags &= RESET_RX_FLAGS;
793 lp->drv_rx_errors++;
794 goto err_next_pkt;
795 }
796
797 skb_reserve(new_skb, 2);
798 skb = lp->rx_skbuff[rx_index];
799 pci_unmap_single(lp->pci_dev,lp->rx_dma_addr[rx_index],
800 lp->rx_buff_len-2, PCI_DMA_FROMDEVICE);
801 skb_put(skb, pkt_len);
802 skb->dev = dev;
803 lp->rx_skbuff[rx_index] = new_skb;
804 new_skb->dev = dev;
805 lp->rx_dma_addr[rx_index] = pci_map_single(lp->pci_dev,
806 new_skb->data,
807 lp->rx_buff_len-2,
808 PCI_DMA_FROMDEVICE);
809
810 skb->protocol = eth_type_trans(skb, dev);
811
812 #if AMD8111E_VLAN_TAG_USED
813 if(lp->vlgrp != NULL && (vtag == TT_VLAN_TAGGED)){
814 amd8111e_vlan_rx(lp, skb,
815 le16_to_cpu(lp->rx_ring[rx_index].tag_ctrl_info));
816 } else
817 #endif
818 netif_receive_skb(skb);
819 /*COAL update rx coalescing parameters*/
820 lp->coal_conf.rx_packets++;
821 lp->coal_conf.rx_bytes += pkt_len;
822 num_rx_pkt++;
823 dev->last_rx = jiffies;
824
825 err_next_pkt:
826 lp->rx_ring[rx_index].buff_phy_addr
827 = cpu_to_le32(lp->rx_dma_addr[rx_index]);
828 lp->rx_ring[rx_index].buff_count =
829 cpu_to_le16(lp->rx_buff_len-2);
830 wmb();
831 lp->rx_ring[rx_index].rx_flags |= cpu_to_le16(OWN_BIT);
832 rx_index = (++lp->rx_idx) & RX_RING_DR_MOD_MASK;
833 }
834 /* Check the interrupt status register for more packets in the
835 mean time. Process them since we have not used up our quota.*/
836
837 intr0 = readl(mmio + INT0);
838 /*Ack receive packets */
839 writel(intr0 & RINT0,mmio + INT0);
840
841 } while(intr0 & RINT0);
842
843 /* Receive descriptor is empty now */
844 dev->quota -= num_rx_pkt;
845 *budget -= num_rx_pkt;
846
847 spin_lock_irqsave(&lp->lock, flags);
848 netif_rx_complete(dev);
849 writel(VAL0|RINTEN0, mmio + INTEN0);
850 writel(VAL2 | RDMD0, mmio + CMD0);
851 spin_unlock_irqrestore(&lp->lock, flags);
852 return 0;
853
854 rx_not_empty:
855 /* Do not call a netif_rx_complete */
856 dev->quota -= num_rx_pkt;
857 *budget -= num_rx_pkt;
858 return 1;
859 }
860
861 #else
862 /*
863 This function will check the ownership of receive buffers and descriptors. It will indicate to kernel up to half the number of maximum receive buffers in the descriptor ring, in a single receive interrupt. It will also replenish the descriptors with new skbs.
864 */
865 static int amd8111e_rx(struct net_device *dev)
866 {
867 struct amd8111e_priv *lp = netdev_priv(dev);
868 struct sk_buff *skb,*new_skb;
869 int rx_index = lp->rx_idx & RX_RING_DR_MOD_MASK;
870 int min_pkt_len, status;
871 int num_rx_pkt = 0;
872 int max_rx_pkt = NUM_RX_BUFFERS;
873 short pkt_len;
874 #if AMD8111E_VLAN_TAG_USED
875 short vtag;
876 #endif
877
878 /* If we own the next entry, it's a new packet. Send it up. */
879 while(++num_rx_pkt <= max_rx_pkt){
880 status = le16_to_cpu(lp->rx_ring[rx_index].rx_flags);
881 if(status & OWN_BIT)
882 return 0;
883
884 /* check if err summary bit is set */
885 if(status & ERR_BIT){
886 /*
887 * There is a tricky error noted by John Murphy,
888 * <murf@perftech.com> to Russ Nelson: Even with full-sized
889 * buffers it's possible for a jabber packet to use two
890 * buffers, with only the last correctly noting the error. */
891 /* reseting flags */
892 lp->rx_ring[rx_index].rx_flags &= RESET_RX_FLAGS;
893 goto err_next_pkt;
894 }
895 /* check for STP and ENP */
896 if(!((status & STP_BIT) && (status & ENP_BIT))){
897 /* reseting flags */
898 lp->rx_ring[rx_index].rx_flags &= RESET_RX_FLAGS;
899 goto err_next_pkt;
900 }
901 pkt_len = le16_to_cpu(lp->rx_ring[rx_index].msg_count) - 4;
902
903 #if AMD8111E_VLAN_TAG_USED
904 vtag = status & TT_MASK;
905 /*MAC will strip vlan tag*/
906 if(lp->vlgrp != NULL && vtag !=0)
907 min_pkt_len =MIN_PKT_LEN - 4;
908 else
909 #endif
910 min_pkt_len =MIN_PKT_LEN;
911
912 if (pkt_len < min_pkt_len) {
913 lp->rx_ring[rx_index].rx_flags &= RESET_RX_FLAGS;
914 lp->drv_rx_errors++;
915 goto err_next_pkt;
916 }
917 if(!(new_skb = dev_alloc_skb(lp->rx_buff_len))){
918 /* if allocation fail,
919 ignore that pkt and go to next one */
920 lp->rx_ring[rx_index].rx_flags &= RESET_RX_FLAGS;
921 lp->drv_rx_errors++;
922 goto err_next_pkt;
923 }
924
925 skb_reserve(new_skb, 2);
926 skb = lp->rx_skbuff[rx_index];
927 pci_unmap_single(lp->pci_dev,lp->rx_dma_addr[rx_index],
928 lp->rx_buff_len-2, PCI_DMA_FROMDEVICE);
929 skb_put(skb, pkt_len);
930 skb->dev = dev;
931 lp->rx_skbuff[rx_index] = new_skb;
932 new_skb->dev = dev;
933 lp->rx_dma_addr[rx_index] = pci_map_single(lp->pci_dev,
934 new_skb->data, lp->rx_buff_len-2,PCI_DMA_FROMDEVICE);
935
936 skb->protocol = eth_type_trans(skb, dev);
937
938 #if AMD8111E_VLAN_TAG_USED
939 if(lp->vlgrp != NULL && (vtag == TT_VLAN_TAGGED)){
940 amd8111e_vlan_rx(lp, skb,
941 le16_to_cpu(lp->rx_ring[rx_index].tag_ctrl_info));
942 } else
943 #endif
944
945 netif_rx (skb);
946 /*COAL update rx coalescing parameters*/
947 lp->coal_conf.rx_packets++;
948 lp->coal_conf.rx_bytes += pkt_len;
949
950 dev->last_rx = jiffies;
951
952 err_next_pkt:
953 lp->rx_ring[rx_index].buff_phy_addr
954 = cpu_to_le32(lp->rx_dma_addr[rx_index]);
955 lp->rx_ring[rx_index].buff_count =
956 cpu_to_le16(lp->rx_buff_len-2);
957 wmb();
958 lp->rx_ring[rx_index].rx_flags |= cpu_to_le16(OWN_BIT);
959 rx_index = (++lp->rx_idx) & RX_RING_DR_MOD_MASK;
960 }
961
962 return 0;
963 }
964 #endif /* CONFIG_AMD8111E_NAPI */
965 /*
966 This function will indicate the link status to the kernel.
967 */
968 static int amd8111e_link_change(struct net_device* dev)
969 {
970 struct amd8111e_priv *lp = netdev_priv(dev);
971 int status0,speed;
972
973 /* read the link change */
974 status0 = readl(lp->mmio + STAT0);
975
976 if(status0 & LINK_STATS){
977 if(status0 & AUTONEG_COMPLETE)
978 lp->link_config.autoneg = AUTONEG_ENABLE;
979 else
980 lp->link_config.autoneg = AUTONEG_DISABLE;
981
982 if(status0 & FULL_DPLX)
983 lp->link_config.duplex = DUPLEX_FULL;
984 else
985 lp->link_config.duplex = DUPLEX_HALF;
986 speed = (status0 & SPEED_MASK) >> 7;
987 if(speed == PHY_SPEED_10)
988 lp->link_config.speed = SPEED_10;
989 else if(speed == PHY_SPEED_100)
990 lp->link_config.speed = SPEED_100;
991
992 printk(KERN_INFO "%s: Link is Up. Speed is %s Mbps %s Duplex\n", dev->name,
993 (lp->link_config.speed == SPEED_100) ? "100": "10",
994 (lp->link_config.duplex == DUPLEX_FULL)? "Full": "Half");
995 netif_carrier_on(dev);
996 }
997 else{
998 lp->link_config.speed = SPEED_INVALID;
999 lp->link_config.duplex = DUPLEX_INVALID;
1000 lp->link_config.autoneg = AUTONEG_INVALID;
1001 printk(KERN_INFO "%s: Link is Down.\n",dev->name);
1002 netif_carrier_off(dev);
1003 }
1004
1005 return 0;
1006 }
1007 /*
1008 This function reads the mib counters.
1009 */
1010 static int amd8111e_read_mib(void __iomem *mmio, u8 MIB_COUNTER)
1011 {
1012 unsigned int status;
1013 unsigned int data;
1014 unsigned int repeat = REPEAT_CNT;
1015
1016 writew( MIB_RD_CMD | MIB_COUNTER, mmio + MIB_ADDR);
1017 do {
1018 status = readw(mmio + MIB_ADDR);
1019 udelay(2); /* controller takes MAX 2 us to get mib data */
1020 }
1021 while (--repeat && (status & MIB_CMD_ACTIVE));
1022
1023 data = readl(mmio + MIB_DATA);
1024 return data;
1025 }
1026
1027 /*
1028 This function reads the mib registers and returns the hardware statistics. It updates previous internal driver statistics with new values.
1029 */
1030 static struct net_device_stats *amd8111e_get_stats(struct net_device * dev)
1031 {
1032 struct amd8111e_priv *lp = netdev_priv(dev);
1033 void __iomem *mmio = lp->mmio;
1034 unsigned long flags;
1035 /* struct net_device_stats *prev_stats = &lp->prev_stats; */
1036 struct net_device_stats* new_stats = &lp->stats;
1037
1038 if(!lp->opened)
1039 return &lp->stats;
1040 spin_lock_irqsave (&lp->lock, flags);
1041
1042 /* stats.rx_packets */
1043 new_stats->rx_packets = amd8111e_read_mib(mmio, rcv_broadcast_pkts)+
1044 amd8111e_read_mib(mmio, rcv_multicast_pkts)+
1045 amd8111e_read_mib(mmio, rcv_unicast_pkts);
1046
1047 /* stats.tx_packets */
1048 new_stats->tx_packets = amd8111e_read_mib(mmio, xmt_packets);
1049
1050 /*stats.rx_bytes */
1051 new_stats->rx_bytes = amd8111e_read_mib(mmio, rcv_octets);
1052
1053 /* stats.tx_bytes */
1054 new_stats->tx_bytes = amd8111e_read_mib(mmio, xmt_octets);
1055
1056 /* stats.rx_errors */
1057 /* hw errors + errors driver reported */
1058 new_stats->rx_errors = amd8111e_read_mib(mmio, rcv_undersize_pkts)+
1059 amd8111e_read_mib(mmio, rcv_fragments)+
1060 amd8111e_read_mib(mmio, rcv_jabbers)+
1061 amd8111e_read_mib(mmio, rcv_alignment_errors)+
1062 amd8111e_read_mib(mmio, rcv_fcs_errors)+
1063 amd8111e_read_mib(mmio, rcv_miss_pkts)+
1064 lp->drv_rx_errors;
1065
1066 /* stats.tx_errors */
1067 new_stats->tx_errors = amd8111e_read_mib(mmio, xmt_underrun_pkts);
1068
1069 /* stats.rx_dropped*/
1070 new_stats->rx_dropped = amd8111e_read_mib(mmio, rcv_miss_pkts);
1071
1072 /* stats.tx_dropped*/
1073 new_stats->tx_dropped = amd8111e_read_mib(mmio, xmt_underrun_pkts);
1074
1075 /* stats.multicast*/
1076 new_stats->multicast = amd8111e_read_mib(mmio, rcv_multicast_pkts);
1077
1078 /* stats.collisions*/
1079 new_stats->collisions = amd8111e_read_mib(mmio, xmt_collisions);
1080
1081 /* stats.rx_length_errors*/
1082 new_stats->rx_length_errors =
1083 amd8111e_read_mib(mmio, rcv_undersize_pkts)+
1084 amd8111e_read_mib(mmio, rcv_oversize_pkts);
1085
1086 /* stats.rx_over_errors*/
1087 new_stats->rx_over_errors = amd8111e_read_mib(mmio, rcv_miss_pkts);
1088
1089 /* stats.rx_crc_errors*/
1090 new_stats->rx_crc_errors = amd8111e_read_mib(mmio, rcv_fcs_errors);
1091
1092 /* stats.rx_frame_errors*/
1093 new_stats->rx_frame_errors =
1094 amd8111e_read_mib(mmio, rcv_alignment_errors);
1095
1096 /* stats.rx_fifo_errors */
1097 new_stats->rx_fifo_errors = amd8111e_read_mib(mmio, rcv_miss_pkts);
1098
1099 /* stats.rx_missed_errors */
1100 new_stats->rx_missed_errors = amd8111e_read_mib(mmio, rcv_miss_pkts);
1101
1102 /* stats.tx_aborted_errors*/
1103 new_stats->tx_aborted_errors =
1104 amd8111e_read_mib(mmio, xmt_excessive_collision);
1105
1106 /* stats.tx_carrier_errors*/
1107 new_stats->tx_carrier_errors =
1108 amd8111e_read_mib(mmio, xmt_loss_carrier);
1109
1110 /* stats.tx_fifo_errors*/
1111 new_stats->tx_fifo_errors = amd8111e_read_mib(mmio, xmt_underrun_pkts);
1112
1113 /* stats.tx_window_errors*/
1114 new_stats->tx_window_errors =
1115 amd8111e_read_mib(mmio, xmt_late_collision);
1116
1117 /* Reset the mibs for collecting new statistics */
1118 /* writew(MIB_CLEAR, mmio + MIB_ADDR);*/
1119
1120 spin_unlock_irqrestore (&lp->lock, flags);
1121
1122 return new_stats;
1123 }
1124 /* This function recalculate the interupt coalescing mode on every interrupt
1125 according to the datarate and the packet rate.
1126 */
1127 static int amd8111e_calc_coalesce(struct net_device *dev)
1128 {
1129 struct amd8111e_priv *lp = netdev_priv(dev);
1130 struct amd8111e_coalesce_conf * coal_conf = &lp->coal_conf;
1131 int tx_pkt_rate;
1132 int rx_pkt_rate;
1133 int tx_data_rate;
1134 int rx_data_rate;
1135 int rx_pkt_size;
1136 int tx_pkt_size;
1137
1138 tx_pkt_rate = coal_conf->tx_packets - coal_conf->tx_prev_packets;
1139 coal_conf->tx_prev_packets = coal_conf->tx_packets;
1140
1141 tx_data_rate = coal_conf->tx_bytes - coal_conf->tx_prev_bytes;
1142 coal_conf->tx_prev_bytes = coal_conf->tx_bytes;
1143
1144 rx_pkt_rate = coal_conf->rx_packets - coal_conf->rx_prev_packets;
1145 coal_conf->rx_prev_packets = coal_conf->rx_packets;
1146
1147 rx_data_rate = coal_conf->rx_bytes - coal_conf->rx_prev_bytes;
1148 coal_conf->rx_prev_bytes = coal_conf->rx_bytes;
1149
1150 if(rx_pkt_rate < 800){
1151 if(coal_conf->rx_coal_type != NO_COALESCE){
1152
1153 coal_conf->rx_timeout = 0x0;
1154 coal_conf->rx_event_count = 0;
1155 amd8111e_set_coalesce(dev,RX_INTR_COAL);
1156 coal_conf->rx_coal_type = NO_COALESCE;
1157 }
1158 }
1159 else{
1160
1161 rx_pkt_size = rx_data_rate/rx_pkt_rate;
1162 if (rx_pkt_size < 128){
1163 if(coal_conf->rx_coal_type != NO_COALESCE){
1164
1165 coal_conf->rx_timeout = 0;
1166 coal_conf->rx_event_count = 0;
1167 amd8111e_set_coalesce(dev,RX_INTR_COAL);
1168 coal_conf->rx_coal_type = NO_COALESCE;
1169 }
1170
1171 }
1172 else if ( (rx_pkt_size >= 128) && (rx_pkt_size < 512) ){
1173
1174 if(coal_conf->rx_coal_type != LOW_COALESCE){
1175 coal_conf->rx_timeout = 1;
1176 coal_conf->rx_event_count = 4;
1177 amd8111e_set_coalesce(dev,RX_INTR_COAL);
1178 coal_conf->rx_coal_type = LOW_COALESCE;
1179 }
1180 }
1181 else if ((rx_pkt_size >= 512) && (rx_pkt_size < 1024)){
1182
1183 if(coal_conf->rx_coal_type != MEDIUM_COALESCE){
1184 coal_conf->rx_timeout = 1;
1185 coal_conf->rx_event_count = 4;
1186 amd8111e_set_coalesce(dev,RX_INTR_COAL);
1187 coal_conf->rx_coal_type = MEDIUM_COALESCE;
1188 }
1189
1190 }
1191 else if(rx_pkt_size >= 1024){
1192 if(coal_conf->rx_coal_type != HIGH_COALESCE){
1193 coal_conf->rx_timeout = 2;
1194 coal_conf->rx_event_count = 3;
1195 amd8111e_set_coalesce(dev,RX_INTR_COAL);
1196 coal_conf->rx_coal_type = HIGH_COALESCE;
1197 }
1198 }
1199 }
1200 /* NOW FOR TX INTR COALESC */
1201 if(tx_pkt_rate < 800){
1202 if(coal_conf->tx_coal_type != NO_COALESCE){
1203
1204 coal_conf->tx_timeout = 0x0;
1205 coal_conf->tx_event_count = 0;
1206 amd8111e_set_coalesce(dev,TX_INTR_COAL);
1207 coal_conf->tx_coal_type = NO_COALESCE;
1208 }
1209 }
1210 else{
1211
1212 tx_pkt_size = tx_data_rate/tx_pkt_rate;
1213 if (tx_pkt_size < 128){
1214
1215 if(coal_conf->tx_coal_type != NO_COALESCE){
1216
1217 coal_conf->tx_timeout = 0;
1218 coal_conf->tx_event_count = 0;
1219 amd8111e_set_coalesce(dev,TX_INTR_COAL);
1220 coal_conf->tx_coal_type = NO_COALESCE;
1221 }
1222
1223 }
1224 else if ( (tx_pkt_size >= 128) && (tx_pkt_size < 512) ){
1225
1226 if(coal_conf->tx_coal_type != LOW_COALESCE){
1227 coal_conf->tx_timeout = 1;
1228 coal_conf->tx_event_count = 2;
1229 amd8111e_set_coalesce(dev,TX_INTR_COAL);
1230 coal_conf->tx_coal_type = LOW_COALESCE;
1231
1232 }
1233 }
1234 else if ((tx_pkt_size >= 512) && (tx_pkt_size < 1024)){
1235
1236 if(coal_conf->tx_coal_type != MEDIUM_COALESCE){
1237 coal_conf->tx_timeout = 2;
1238 coal_conf->tx_event_count = 5;
1239 amd8111e_set_coalesce(dev,TX_INTR_COAL);
1240 coal_conf->tx_coal_type = MEDIUM_COALESCE;
1241 }
1242
1243 }
1244 else if(tx_pkt_size >= 1024){
1245 if (tx_pkt_size >= 1024){
1246 if(coal_conf->tx_coal_type != HIGH_COALESCE){
1247 coal_conf->tx_timeout = 4;
1248 coal_conf->tx_event_count = 8;
1249 amd8111e_set_coalesce(dev,TX_INTR_COAL);
1250 coal_conf->tx_coal_type = HIGH_COALESCE;
1251 }
1252 }
1253 }
1254 }
1255 return 0;
1256
1257 }
1258 /*
1259 This is device interrupt function. It handles transmit, receive,link change and hardware timer interrupts.
1260 */
1261 static irqreturn_t amd8111e_interrupt(int irq, void *dev_id, struct pt_regs *regs)
1262 {
1263
1264 struct net_device * dev = (struct net_device *) dev_id;
1265 struct amd8111e_priv *lp = netdev_priv(dev);
1266 void __iomem *mmio = lp->mmio;
1267 unsigned int intr0, intren0;
1268 unsigned int handled = 1;
1269
1270 if(unlikely(dev == NULL))
1271 return IRQ_NONE;
1272
1273 spin_lock(&lp->lock);
1274
1275 /* disabling interrupt */
1276 writel(INTREN, mmio + CMD0);
1277
1278 /* Read interrupt status */
1279 intr0 = readl(mmio + INT0);
1280 intren0 = readl(mmio + INTEN0);
1281
1282 /* Process all the INT event until INTR bit is clear. */
1283
1284 if (!(intr0 & INTR)){
1285 handled = 0;
1286 goto err_no_interrupt;
1287 }
1288
1289 /* Current driver processes 4 interrupts : RINT,TINT,LCINT,STINT */
1290 writel(intr0, mmio + INT0);
1291
1292 /* Check if Receive Interrupt has occurred. */
1293 #ifdef CONFIG_AMD8111E_NAPI
1294 if(intr0 & RINT0){
1295 if(netif_rx_schedule_prep(dev)){
1296 /* Disable receive interupts */
1297 writel(RINTEN0, mmio + INTEN0);
1298 /* Schedule a polling routine */
1299 __netif_rx_schedule(dev);
1300 }
1301 else if (intren0 & RINTEN0) {
1302 printk("************Driver bug! \
1303 interrupt while in poll\n");
1304 /* Fix by disable receive interrupts */
1305 writel(RINTEN0, mmio + INTEN0);
1306 }
1307 }
1308 #else
1309 if(intr0 & RINT0){
1310 amd8111e_rx(dev);
1311 writel(VAL2 | RDMD0, mmio + CMD0);
1312 }
1313 #endif /* CONFIG_AMD8111E_NAPI */
1314 /* Check if Transmit Interrupt has occurred. */
1315 if(intr0 & TINT0)
1316 amd8111e_tx(dev);
1317
1318 /* Check if Link Change Interrupt has occurred. */
1319 if (intr0 & LCINT)
1320 amd8111e_link_change(dev);
1321
1322 /* Check if Hardware Timer Interrupt has occurred. */
1323 if (intr0 & STINT)
1324 amd8111e_calc_coalesce(dev);
1325
1326 err_no_interrupt:
1327 writel( VAL0 | INTREN,mmio + CMD0);
1328
1329 spin_unlock(&lp->lock);
1330
1331 return IRQ_RETVAL(handled);
1332 }
1333
1334 #ifdef CONFIG_NET_POLL_CONTROLLER
1335 static void amd8111e_poll(struct net_device *dev)
1336 {
1337 unsigned long flags;
1338 local_save_flags(flags);
1339 local_irq_disable();
1340 amd8111e_interrupt(0, dev, NULL);
1341 local_irq_restore(flags);
1342 }
1343 #endif
1344
1345
1346 /*
1347 This function closes the network interface and updates the statistics so that most recent statistics will be available after the interface is down.
1348 */
1349 static int amd8111e_close(struct net_device * dev)
1350 {
1351 struct amd8111e_priv *lp = netdev_priv(dev);
1352 netif_stop_queue(dev);
1353
1354 spin_lock_irq(&lp->lock);
1355
1356 amd8111e_disable_interrupt(lp);
1357 amd8111e_stop_chip(lp);
1358 amd8111e_free_ring(lp);
1359
1360 netif_carrier_off(lp->amd8111e_net_dev);
1361
1362 /* Delete ipg timer */
1363 if(lp->options & OPTION_DYN_IPG_ENABLE)
1364 del_timer_sync(&lp->ipg_data.ipg_timer);
1365
1366 spin_unlock_irq(&lp->lock);
1367 free_irq(dev->irq, dev);
1368
1369 /* Update the statistics before closing */
1370 amd8111e_get_stats(dev);
1371 lp->opened = 0;
1372 return 0;
1373 }
1374 /* This function opens new interface.It requests irq for the device, initializes the device,buffers and descriptors, and starts the device.
1375 */
1376 static int amd8111e_open(struct net_device * dev )
1377 {
1378 struct amd8111e_priv *lp = netdev_priv(dev);
1379
1380 if(dev->irq ==0 || request_irq(dev->irq, amd8111e_interrupt, SA_SHIRQ,
1381 dev->name, dev))
1382 return -EAGAIN;
1383
1384 spin_lock_irq(&lp->lock);
1385
1386 amd8111e_init_hw_default(lp);
1387
1388 if(amd8111e_restart(dev)){
1389 spin_unlock_irq(&lp->lock);
1390 if (dev->irq)
1391 free_irq(dev->irq, dev);
1392 return -ENOMEM;
1393 }
1394 /* Start ipg timer */
1395 if(lp->options & OPTION_DYN_IPG_ENABLE){
1396 add_timer(&lp->ipg_data.ipg_timer);
1397 printk(KERN_INFO "%s: Dynamic IPG Enabled.\n",dev->name);
1398 }
1399
1400 lp->opened = 1;
1401
1402 spin_unlock_irq(&lp->lock);
1403
1404 netif_start_queue(dev);
1405
1406 return 0;
1407 }
1408 /*
1409 This function checks if there is any transmit descriptors available to queue more packet.
1410 */
1411 static int amd8111e_tx_queue_avail(struct amd8111e_priv* lp )
1412 {
1413 int tx_index = lp->tx_idx & TX_BUFF_MOD_MASK;
1414 if(lp->tx_skbuff[tx_index] != 0)
1415 return -1;
1416 else
1417 return 0;
1418
1419 }
1420 /*
1421 This function will queue the transmit packets to the descriptors and will trigger the send operation. It also initializes the transmit descriptors with buffer physical address, byte count, ownership to hardware etc.
1422 */
1423
1424 static int amd8111e_start_xmit(struct sk_buff *skb, struct net_device * dev)
1425 {
1426 struct amd8111e_priv *lp = netdev_priv(dev);
1427 int tx_index;
1428 unsigned long flags;
1429
1430 spin_lock_irqsave(&lp->lock, flags);
1431
1432 tx_index = lp->tx_idx & TX_RING_DR_MOD_MASK;
1433
1434 lp->tx_ring[tx_index].buff_count = cpu_to_le16(skb->len);
1435
1436 lp->tx_skbuff[tx_index] = skb;
1437 lp->tx_ring[tx_index].tx_flags = 0;
1438
1439 #if AMD8111E_VLAN_TAG_USED
1440 if((lp->vlgrp != NULL) && vlan_tx_tag_present(skb)){
1441 lp->tx_ring[tx_index].tag_ctrl_cmd |=
1442 cpu_to_le16(TCC_VLAN_INSERT);
1443 lp->tx_ring[tx_index].tag_ctrl_info =
1444 cpu_to_le16(vlan_tx_tag_get(skb));
1445
1446 }
1447 #endif
1448 lp->tx_dma_addr[tx_index] =
1449 pci_map_single(lp->pci_dev, skb->data, skb->len, PCI_DMA_TODEVICE);
1450 lp->tx_ring[tx_index].buff_phy_addr =
1451 (u32) cpu_to_le32(lp->tx_dma_addr[tx_index]);
1452
1453 /* Set FCS and LTINT bits */
1454 wmb();
1455 lp->tx_ring[tx_index].tx_flags |=
1456 cpu_to_le16(OWN_BIT | STP_BIT | ENP_BIT|ADD_FCS_BIT|LTINT_BIT);
1457
1458 lp->tx_idx++;
1459
1460 /* Trigger an immediate send poll. */
1461 writel( VAL1 | TDMD0, lp->mmio + CMD0);
1462 writel( VAL2 | RDMD0,lp->mmio + CMD0);
1463
1464 dev->trans_start = jiffies;
1465
1466 if(amd8111e_tx_queue_avail(lp) < 0){
1467 netif_stop_queue(dev);
1468 }
1469 spin_unlock_irqrestore(&lp->lock, flags);
1470 return 0;
1471 }
1472 /*
1473 This function returns all the memory mapped registers of the device.
1474 */
1475 static void amd8111e_read_regs(struct amd8111e_priv *lp, u32 *buf)
1476 {
1477 void __iomem *mmio = lp->mmio;
1478 /* Read only necessary registers */
1479 buf[0] = readl(mmio + XMT_RING_BASE_ADDR0);
1480 buf[1] = readl(mmio + XMT_RING_LEN0);
1481 buf[2] = readl(mmio + RCV_RING_BASE_ADDR0);
1482 buf[3] = readl(mmio + RCV_RING_LEN0);
1483 buf[4] = readl(mmio + CMD0);
1484 buf[5] = readl(mmio + CMD2);
1485 buf[6] = readl(mmio + CMD3);
1486 buf[7] = readl(mmio + CMD7);
1487 buf[8] = readl(mmio + INT0);
1488 buf[9] = readl(mmio + INTEN0);
1489 buf[10] = readl(mmio + LADRF);
1490 buf[11] = readl(mmio + LADRF+4);
1491 buf[12] = readl(mmio + STAT0);
1492 }
1493
1494 /*
1495 amd8111e crc generator implementation is different from the kernel
1496 ether_crc() function.
1497 */
1498 static int amd8111e_ether_crc(int len, char* mac_addr)
1499 {
1500 int i,byte;
1501 unsigned char octet;
1502 u32 crc= INITCRC;
1503
1504 for(byte=0; byte < len; byte++){
1505 octet = mac_addr[byte];
1506 for( i=0;i < 8; i++){
1507 /*If the next bit form the input stream is 1,subtract the divisor (CRC32) from the dividend(crc).*/
1508 if( (octet & 0x1) ^ (crc & 0x1) ){
1509 crc >>= 1;
1510 crc ^= CRC32;
1511 }
1512 else
1513 crc >>= 1;
1514
1515 octet >>= 1;
1516 }
1517 }
1518 return crc;
1519 }
1520 /*
1521 This function sets promiscuos mode, all-multi mode or the multicast address
1522 list to the device.
1523 */
1524 static void amd8111e_set_multicast_list(struct net_device *dev)
1525 {
1526 struct dev_mc_list* mc_ptr;
1527 struct amd8111e_priv *lp = netdev_priv(dev);
1528 u32 mc_filter[2] ;
1529 int i,bit_num;
1530 if(dev->flags & IFF_PROMISC){
1531 printk(KERN_INFO "%s: Setting promiscuous mode.\n",dev->name);
1532 writel( VAL2 | PROM, lp->mmio + CMD2);
1533 return;
1534 }
1535 else
1536 writel( PROM, lp->mmio + CMD2);
1537 if(dev->flags & IFF_ALLMULTI || dev->mc_count > MAX_FILTER_SIZE){
1538 /* get all multicast packet */
1539 mc_filter[1] = mc_filter[0] = 0xffffffff;
1540 lp->mc_list = dev->mc_list;
1541 lp->options |= OPTION_MULTICAST_ENABLE;
1542 amd8111e_writeq(*(u64*)mc_filter,lp->mmio + LADRF);
1543 return;
1544 }
1545 if( dev->mc_count == 0 ){
1546 /* get only own packets */
1547 mc_filter[1] = mc_filter[0] = 0;
1548 lp->mc_list = NULL;
1549 lp->options &= ~OPTION_MULTICAST_ENABLE;
1550 amd8111e_writeq(*(u64*)mc_filter,lp->mmio + LADRF);
1551 /* disable promiscous mode */
1552 writel(PROM, lp->mmio + CMD2);
1553 return;
1554 }
1555 /* load all the multicast addresses in the logic filter */
1556 lp->options |= OPTION_MULTICAST_ENABLE;
1557 lp->mc_list = dev->mc_list;
1558 mc_filter[1] = mc_filter[0] = 0;
1559 for (i = 0, mc_ptr = dev->mc_list; mc_ptr && i < dev->mc_count;
1560 i++, mc_ptr = mc_ptr->next) {
1561 bit_num = ( amd8111e_ether_crc(ETH_ALEN,mc_ptr->dmi_addr) >> 26 ) & 0x3f;
1562 mc_filter[bit_num >> 5] |= 1 << (bit_num & 31);
1563 }
1564 amd8111e_writeq(*(u64*)mc_filter,lp->mmio+ LADRF);
1565
1566 /* To eliminate PCI posting bug */
1567 readl(lp->mmio + CMD2);
1568
1569 }
1570
1571 static void amd8111e_get_drvinfo(struct net_device* dev, struct ethtool_drvinfo *info)
1572 {
1573 struct amd8111e_priv *lp = netdev_priv(dev);
1574 struct pci_dev *pci_dev = lp->pci_dev;
1575 strcpy (info->driver, MODULE_NAME);
1576 strcpy (info->version, MODULE_VERS);
1577 sprintf(info->fw_version,"%u",chip_version);
1578 strcpy (info->bus_info, pci_name(pci_dev));
1579 }
1580
1581 static int amd8111e_get_regs_len(struct net_device *dev)
1582 {
1583 return AMD8111E_REG_DUMP_LEN;
1584 }
1585
1586 static void amd8111e_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *buf)
1587 {
1588 struct amd8111e_priv *lp = netdev_priv(dev);
1589 regs->version = 0;
1590 amd8111e_read_regs(lp, buf);
1591 }
1592
1593 static int amd8111e_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
1594 {
1595 struct amd8111e_priv *lp = netdev_priv(dev);
1596 spin_lock_irq(&lp->lock);
1597 mii_ethtool_gset(&lp->mii_if, ecmd);
1598 spin_unlock_irq(&lp->lock);
1599 return 0;
1600 }
1601
1602 static int amd8111e_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
1603 {
1604 struct amd8111e_priv *lp = netdev_priv(dev);
1605 int res;
1606 spin_lock_irq(&lp->lock);
1607 res = mii_ethtool_sset(&lp->mii_if, ecmd);
1608 spin_unlock_irq(&lp->lock);
1609 return res;
1610 }
1611
1612 static int amd8111e_nway_reset(struct net_device *dev)
1613 {
1614 struct amd8111e_priv *lp = netdev_priv(dev);
1615 return mii_nway_restart(&lp->mii_if);
1616 }
1617
1618 static u32 amd8111e_get_link(struct net_device *dev)
1619 {
1620 struct amd8111e_priv *lp = netdev_priv(dev);
1621 return mii_link_ok(&lp->mii_if);
1622 }
1623
1624 static void amd8111e_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol_info)
1625 {
1626 struct amd8111e_priv *lp = netdev_priv(dev);
1627 wol_info->supported = WAKE_MAGIC|WAKE_PHY;
1628 if (lp->options & OPTION_WOL_ENABLE)
1629 wol_info->wolopts = WAKE_MAGIC;
1630 }
1631
1632 static int amd8111e_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol_info)
1633 {
1634 struct amd8111e_priv *lp = netdev_priv(dev);
1635 if (wol_info->wolopts & ~(WAKE_MAGIC|WAKE_PHY))
1636 return -EINVAL;
1637 spin_lock_irq(&lp->lock);
1638 if (wol_info->wolopts & WAKE_MAGIC)
1639 lp->options |=
1640 (OPTION_WOL_ENABLE | OPTION_WAKE_MAGIC_ENABLE);
1641 else if(wol_info->wolopts & WAKE_PHY)
1642 lp->options |=
1643 (OPTION_WOL_ENABLE | OPTION_WAKE_PHY_ENABLE);
1644 else
1645 lp->options &= ~OPTION_WOL_ENABLE;
1646 spin_unlock_irq(&lp->lock);
1647 return 0;
1648 }
1649
1650 static struct ethtool_ops ops = {
1651 .get_drvinfo = amd8111e_get_drvinfo,
1652 .get_regs_len = amd8111e_get_regs_len,
1653 .get_regs = amd8111e_get_regs,
1654 .get_settings = amd8111e_get_settings,
1655 .set_settings = amd8111e_set_settings,
1656 .nway_reset = amd8111e_nway_reset,
1657 .get_link = amd8111e_get_link,
1658 .get_wol = amd8111e_get_wol,
1659 .set_wol = amd8111e_set_wol,
1660 };
1661
1662 /*
1663 This function handles all the ethtool ioctls. It gives driver info, gets/sets driver speed, gets memory mapped register values, forces auto negotiation, sets/gets WOL options for ethtool application.
1664 */
1665
1666 static int amd8111e_ioctl(struct net_device * dev , struct ifreq *ifr, int cmd)
1667 {
1668 struct mii_ioctl_data *data = if_mii(ifr);
1669 struct amd8111e_priv *lp = netdev_priv(dev);
1670 int err;
1671 u32 mii_regval;
1672
1673 if (!capable(CAP_NET_ADMIN))
1674 return -EPERM;
1675
1676 switch(cmd) {
1677 case SIOCGMIIPHY:
1678 data->phy_id = lp->ext_phy_addr;
1679
1680 /* fallthru */
1681 case SIOCGMIIREG:
1682
1683 spin_lock_irq(&lp->lock);
1684 err = amd8111e_read_phy(lp, data->phy_id,
1685 data->reg_num & PHY_REG_ADDR_MASK, &mii_regval);
1686 spin_unlock_irq(&lp->lock);
1687
1688 data->val_out = mii_regval;
1689 return err;
1690
1691 case SIOCSMIIREG:
1692
1693 spin_lock_irq(&lp->lock);
1694 err = amd8111e_write_phy(lp, data->phy_id,
1695 data->reg_num & PHY_REG_ADDR_MASK, data->val_in);
1696 spin_unlock_irq(&lp->lock);
1697
1698 return err;
1699
1700 default:
1701 /* do nothing */
1702 break;
1703 }
1704 return -EOPNOTSUPP;
1705 }
1706 static int amd8111e_set_mac_address(struct net_device *dev, void *p)
1707 {
1708 struct amd8111e_priv *lp = netdev_priv(dev);
1709 int i;
1710 struct sockaddr *addr = p;
1711
1712 memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
1713 spin_lock_irq(&lp->lock);
1714 /* Setting the MAC address to the device */
1715 for(i = 0; i < ETH_ADDR_LEN; i++)
1716 writeb( dev->dev_addr[i], lp->mmio + PADR + i );
1717
1718 spin_unlock_irq(&lp->lock);
1719
1720 return 0;
1721 }
1722
1723 /*
1724 This function changes the mtu of the device. It restarts the device to initialize the descriptor with new receive buffers.
1725 */
1726 static int amd8111e_change_mtu(struct net_device *dev, int new_mtu)
1727 {
1728 struct amd8111e_priv *lp = netdev_priv(dev);
1729 int err;
1730
1731 if ((new_mtu < AMD8111E_MIN_MTU) || (new_mtu > AMD8111E_MAX_MTU))
1732 return -EINVAL;
1733
1734 if (!netif_running(dev)) {
1735 /* new_mtu will be used
1736 when device starts netxt time */
1737 dev->mtu = new_mtu;
1738 return 0;
1739 }
1740
1741 spin_lock_irq(&lp->lock);
1742
1743 /* stop the chip */
1744 writel(RUN, lp->mmio + CMD0);
1745
1746 dev->mtu = new_mtu;
1747
1748 err = amd8111e_restart(dev);
1749 spin_unlock_irq(&lp->lock);
1750 if(!err)
1751 netif_start_queue(dev);
1752 return err;
1753 }
1754
1755 #if AMD8111E_VLAN_TAG_USED
1756 static void amd8111e_vlan_rx_register(struct net_device *dev, struct vlan_group *grp)
1757 {
1758 struct amd8111e_priv *lp = netdev_priv(dev);
1759 spin_lock_irq(&lp->lock);
1760 lp->vlgrp = grp;
1761 spin_unlock_irq(&lp->lock);
1762 }
1763
1764 static void amd8111e_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid)
1765 {
1766 struct amd8111e_priv *lp = netdev_priv(dev);
1767 spin_lock_irq(&lp->lock);
1768 if (lp->vlgrp)
1769 lp->vlgrp->vlan_devices[vid] = NULL;
1770 spin_unlock_irq(&lp->lock);
1771 }
1772 #endif
1773 static int amd8111e_enable_magicpkt(struct amd8111e_priv* lp)
1774 {
1775 writel( VAL1|MPPLBA, lp->mmio + CMD3);
1776 writel( VAL0|MPEN_SW, lp->mmio + CMD7);
1777
1778 /* To eliminate PCI posting bug */
1779 readl(lp->mmio + CMD7);
1780 return 0;
1781 }
1782
1783 static int amd8111e_enable_link_change(struct amd8111e_priv* lp)
1784 {
1785
1786 /* Adapter is already stoped/suspended/interrupt-disabled */
1787 writel(VAL0|LCMODE_SW,lp->mmio + CMD7);
1788
1789 /* To eliminate PCI posting bug */
1790 readl(lp->mmio + CMD7);
1791 return 0;
1792 }
1793 /* This function is called when a packet transmission fails to complete within a resonable period, on the assumption that an interrupts have been failed or the interface is locked up. This function will reinitialize the hardware */
1794
1795 static void amd8111e_tx_timeout(struct net_device *dev)
1796 {
1797 struct amd8111e_priv* lp = netdev_priv(dev);
1798 int err;
1799
1800 printk(KERN_ERR "%s: transmit timed out, resetting\n",
1801 dev->name);
1802 spin_lock_irq(&lp->lock);
1803 err = amd8111e_restart(dev);
1804 spin_unlock_irq(&lp->lock);
1805 if(!err)
1806 netif_wake_queue(dev);
1807 }
1808 static int amd8111e_suspend(struct pci_dev *pci_dev, pm_message_t state)
1809 {
1810 struct net_device *dev = pci_get_drvdata(pci_dev);
1811 struct amd8111e_priv *lp = netdev_priv(dev);
1812
1813 if (!netif_running(dev))
1814 return 0;
1815
1816 /* disable the interrupt */
1817 spin_lock_irq(&lp->lock);
1818 amd8111e_disable_interrupt(lp);
1819 spin_unlock_irq(&lp->lock);
1820
1821 netif_device_detach(dev);
1822
1823 /* stop chip */
1824 spin_lock_irq(&lp->lock);
1825 if(lp->options & OPTION_DYN_IPG_ENABLE)
1826 del_timer_sync(&lp->ipg_data.ipg_timer);
1827 amd8111e_stop_chip(lp);
1828 spin_unlock_irq(&lp->lock);
1829
1830 if(lp->options & OPTION_WOL_ENABLE){
1831 /* enable wol */
1832 if(lp->options & OPTION_WAKE_MAGIC_ENABLE)
1833 amd8111e_enable_magicpkt(lp);
1834 if(lp->options & OPTION_WAKE_PHY_ENABLE)
1835 amd8111e_enable_link_change(lp);
1836
1837 pci_enable_wake(pci_dev, PCI_D3hot, 1);
1838 pci_enable_wake(pci_dev, PCI_D3cold, 1);
1839
1840 }
1841 else{
1842 pci_enable_wake(pci_dev, PCI_D3hot, 0);
1843 pci_enable_wake(pci_dev, PCI_D3cold, 0);
1844 }
1845
1846 pci_save_state(pci_dev);
1847 pci_set_power_state(pci_dev, PCI_D3hot);
1848
1849 return 0;
1850 }
1851 static int amd8111e_resume(struct pci_dev *pci_dev)
1852 {
1853 struct net_device *dev = pci_get_drvdata(pci_dev);
1854 struct amd8111e_priv *lp = netdev_priv(dev);
1855
1856 if (!netif_running(dev))
1857 return 0;
1858
1859 pci_set_power_state(pci_dev, PCI_D0);
1860 pci_restore_state(pci_dev);
1861
1862 pci_enable_wake(pci_dev, PCI_D3hot, 0);
1863 pci_enable_wake(pci_dev, PCI_D3cold, 0); /* D3 cold */
1864
1865 netif_device_attach(dev);
1866
1867 spin_lock_irq(&lp->lock);
1868 amd8111e_restart(dev);
1869 /* Restart ipg timer */
1870 if(lp->options & OPTION_DYN_IPG_ENABLE)
1871 mod_timer(&lp->ipg_data.ipg_timer,
1872 jiffies + IPG_CONVERGE_JIFFIES);
1873 spin_unlock_irq(&lp->lock);
1874
1875 return 0;
1876 }
1877
1878
1879 static void __devexit amd8111e_remove_one(struct pci_dev *pdev)
1880 {
1881 struct net_device *dev = pci_get_drvdata(pdev);
1882 if (dev) {
1883 unregister_netdev(dev);
1884 iounmap(((struct amd8111e_priv *)netdev_priv(dev))->mmio);
1885 free_netdev(dev);
1886 pci_release_regions(pdev);
1887 pci_disable_device(pdev);
1888 pci_set_drvdata(pdev, NULL);
1889 }
1890 }
1891 static void amd8111e_config_ipg(struct net_device* dev)
1892 {
1893 struct amd8111e_priv *lp = netdev_priv(dev);
1894 struct ipg_info* ipg_data = &lp->ipg_data;
1895 void __iomem *mmio = lp->mmio;
1896 unsigned int prev_col_cnt = ipg_data->col_cnt;
1897 unsigned int total_col_cnt;
1898 unsigned int tmp_ipg;
1899
1900 if(lp->link_config.duplex == DUPLEX_FULL){
1901 ipg_data->ipg = DEFAULT_IPG;
1902 return;
1903 }
1904
1905 if(ipg_data->ipg_state == SSTATE){
1906
1907 if(ipg_data->timer_tick == IPG_STABLE_TIME){
1908
1909 ipg_data->timer_tick = 0;
1910 ipg_data->ipg = MIN_IPG - IPG_STEP;
1911 ipg_data->current_ipg = MIN_IPG;
1912 ipg_data->diff_col_cnt = 0xFFFFFFFF;
1913 ipg_data->ipg_state = CSTATE;
1914 }
1915 else
1916 ipg_data->timer_tick++;
1917 }
1918
1919 if(ipg_data->ipg_state == CSTATE){
1920
1921 /* Get the current collision count */
1922
1923 total_col_cnt = ipg_data->col_cnt =
1924 amd8111e_read_mib(mmio, xmt_collisions);
1925
1926 if ((total_col_cnt - prev_col_cnt) <
1927 (ipg_data->diff_col_cnt)){
1928
1929 ipg_data->diff_col_cnt =
1930 total_col_cnt - prev_col_cnt ;
1931
1932 ipg_data->ipg = ipg_data->current_ipg;
1933 }
1934
1935 ipg_data->current_ipg += IPG_STEP;
1936
1937 if (ipg_data->current_ipg <= MAX_IPG)
1938 tmp_ipg = ipg_data->current_ipg;
1939 else{
1940 tmp_ipg = ipg_data->ipg;
1941 ipg_data->ipg_state = SSTATE;
1942 }
1943 writew((u32)tmp_ipg, mmio + IPG);
1944 writew((u32)(tmp_ipg - IFS1_DELTA), mmio + IFS1);
1945 }
1946 mod_timer(&lp->ipg_data.ipg_timer, jiffies + IPG_CONVERGE_JIFFIES);
1947 return;
1948
1949 }
1950
1951 static void __devinit amd8111e_probe_ext_phy(struct net_device* dev)
1952 {
1953 struct amd8111e_priv *lp = netdev_priv(dev);
1954 int i;
1955
1956 for (i = 0x1e; i >= 0; i--) {
1957 u32 id1, id2;
1958
1959 if (amd8111e_read_phy(lp, i, MII_PHYSID1, &id1))
1960 continue;
1961 if (amd8111e_read_phy(lp, i, MII_PHYSID2, &id2))
1962 continue;
1963 lp->ext_phy_id = (id1 << 16) | id2;
1964 lp->ext_phy_addr = i;
1965 return;
1966 }
1967 lp->ext_phy_id = 0;
1968 lp->ext_phy_addr = 1;
1969 }
1970
1971 static int __devinit amd8111e_probe_one(struct pci_dev *pdev,
1972 const struct pci_device_id *ent)
1973 {
1974 int err,i,pm_cap;
1975 unsigned long reg_addr,reg_len;
1976 struct amd8111e_priv* lp;
1977 struct net_device* dev;
1978
1979 err = pci_enable_device(pdev);
1980 if(err){
1981 printk(KERN_ERR "amd8111e: Cannot enable new PCI device,"
1982 "exiting.\n");
1983 return err;
1984 }
1985
1986 if(!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)){
1987 printk(KERN_ERR "amd8111e: Cannot find PCI base address"
1988 "exiting.\n");
1989 err = -ENODEV;
1990 goto err_disable_pdev;
1991 }
1992
1993 err = pci_request_regions(pdev, MODULE_NAME);
1994 if(err){
1995 printk(KERN_ERR "amd8111e: Cannot obtain PCI resources, "
1996 "exiting.\n");
1997 goto err_disable_pdev;
1998 }
1999
2000 pci_set_master(pdev);
2001
2002 /* Find power-management capability. */
2003 if((pm_cap = pci_find_capability(pdev, PCI_CAP_ID_PM))==0){
2004 printk(KERN_ERR "amd8111e: No Power Management capability, "
2005 "exiting.\n");
2006 goto err_free_reg;
2007 }
2008
2009 /* Initialize DMA */
2010 if (pci_set_dma_mask(pdev, DMA_32BIT_MASK) < 0) {
2011 printk(KERN_ERR "amd8111e: DMA not supported,"
2012 "exiting.\n");
2013 goto err_free_reg;
2014 }
2015
2016 reg_addr = pci_resource_start(pdev, 0);
2017 reg_len = pci_resource_len(pdev, 0);
2018
2019 dev = alloc_etherdev(sizeof(struct amd8111e_priv));
2020 if (!dev) {
2021 printk(KERN_ERR "amd8111e: Etherdev alloc failed, exiting.\n");
2022 err = -ENOMEM;
2023 goto err_free_reg;
2024 }
2025
2026 SET_MODULE_OWNER(dev);
2027 SET_NETDEV_DEV(dev, &pdev->dev);
2028
2029 #if AMD8111E_VLAN_TAG_USED
2030 dev->features |= NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX ;
2031 dev->vlan_rx_register =amd8111e_vlan_rx_register;
2032 dev->vlan_rx_kill_vid = amd8111e_vlan_rx_kill_vid;
2033 #endif
2034
2035 lp = netdev_priv(dev);
2036 lp->pci_dev = pdev;
2037 lp->amd8111e_net_dev = dev;
2038 lp->pm_cap = pm_cap;
2039
2040 spin_lock_init(&lp->lock);
2041
2042 lp->mmio = ioremap(reg_addr, reg_len);
2043 if (lp->mmio == 0) {
2044 printk(KERN_ERR "amd8111e: Cannot map device registers, "
2045 "exiting\n");
2046 err = -ENOMEM;
2047 goto err_free_dev;
2048 }
2049
2050 /* Initializing MAC address */
2051 for(i = 0; i < ETH_ADDR_LEN; i++)
2052 dev->dev_addr[i] =readb(lp->mmio + PADR + i);
2053
2054 /* Setting user defined parametrs */
2055 lp->ext_phy_option = speed_duplex[card_idx];
2056 if(coalesce[card_idx])
2057 lp->options |= OPTION_INTR_COAL_ENABLE;
2058 if(dynamic_ipg[card_idx++])
2059 lp->options |= OPTION_DYN_IPG_ENABLE;
2060
2061 /* Initialize driver entry points */
2062 dev->open = amd8111e_open;
2063 dev->hard_start_xmit = amd8111e_start_xmit;
2064 dev->stop = amd8111e_close;
2065 dev->get_stats = amd8111e_get_stats;
2066 dev->set_multicast_list = amd8111e_set_multicast_list;
2067 dev->set_mac_address = amd8111e_set_mac_address;
2068 dev->do_ioctl = amd8111e_ioctl;
2069 dev->change_mtu = amd8111e_change_mtu;
2070 SET_ETHTOOL_OPS(dev, &ops);
2071 dev->irq =pdev->irq;
2072 dev->tx_timeout = amd8111e_tx_timeout;
2073 dev->watchdog_timeo = AMD8111E_TX_TIMEOUT;
2074 #ifdef CONFIG_AMD8111E_NAPI
2075 dev->poll = amd8111e_rx_poll;
2076 dev->weight = 32;
2077 #endif
2078 #ifdef CONFIG_NET_POLL_CONTROLLER
2079 dev->poll_controller = amd8111e_poll;
2080 #endif
2081
2082 #if AMD8111E_VLAN_TAG_USED
2083 dev->features |= NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX;
2084 dev->vlan_rx_register =amd8111e_vlan_rx_register;
2085 dev->vlan_rx_kill_vid = amd8111e_vlan_rx_kill_vid;
2086 #endif
2087 /* Probe the external PHY */
2088 amd8111e_probe_ext_phy(dev);
2089
2090 /* setting mii default values */
2091 lp->mii_if.dev = dev;
2092 lp->mii_if.mdio_read = amd8111e_mdio_read;
2093 lp->mii_if.mdio_write = amd8111e_mdio_write;
2094 lp->mii_if.phy_id = lp->ext_phy_addr;
2095
2096 /* Set receive buffer length and set jumbo option*/
2097 amd8111e_set_rx_buff_len(dev);
2098
2099
2100 err = register_netdev(dev);
2101 if (err) {
2102 printk(KERN_ERR "amd8111e: Cannot register net device, "
2103 "exiting.\n");
2104 goto err_iounmap;
2105 }
2106
2107 pci_set_drvdata(pdev, dev);
2108
2109 /* Initialize software ipg timer */
2110 if(lp->options & OPTION_DYN_IPG_ENABLE){
2111 init_timer(&lp->ipg_data.ipg_timer);
2112 lp->ipg_data.ipg_timer.data = (unsigned long) dev;
2113 lp->ipg_data.ipg_timer.function = (void *)&amd8111e_config_ipg;
2114 lp->ipg_data.ipg_timer.expires = jiffies +
2115 IPG_CONVERGE_JIFFIES;
2116 lp->ipg_data.ipg = DEFAULT_IPG;
2117 lp->ipg_data.ipg_state = CSTATE;
2118 };
2119
2120 /* display driver and device information */
2121
2122 chip_version = (readl(lp->mmio + CHIPID) & 0xf0000000)>>28;
2123 printk(KERN_INFO "%s: AMD-8111e Driver Version: %s\n", dev->name,MODULE_VERS);
2124 printk(KERN_INFO "%s: [ Rev %x ] PCI 10/100BaseT Ethernet ", dev->name, chip_version);
2125 for (i = 0; i < 6; i++)
2126 printk("%2.2x%c",dev->dev_addr[i],i == 5 ? ' ' : ':');
2127 printk( "\n");
2128 if (lp->ext_phy_id)
2129 printk(KERN_INFO "%s: Found MII PHY ID 0x%08x at address 0x%02x\n",
2130 dev->name, lp->ext_phy_id, lp->ext_phy_addr);
2131 else
2132 printk(KERN_INFO "%s: Couldn't detect MII PHY, assuming address 0x01\n",
2133 dev->name);
2134 return 0;
2135 err_iounmap:
2136 iounmap(lp->mmio);
2137
2138 err_free_dev:
2139 free_netdev(dev);
2140
2141 err_free_reg:
2142 pci_release_regions(pdev);
2143
2144 err_disable_pdev:
2145 pci_disable_device(pdev);
2146 pci_set_drvdata(pdev, NULL);
2147 return err;
2148
2149 }
2150
2151 static struct pci_driver amd8111e_driver = {
2152 .name = MODULE_NAME,
2153 .id_table = amd8111e_pci_tbl,
2154 .probe = amd8111e_probe_one,
2155 .remove = __devexit_p(amd8111e_remove_one),
2156 .suspend = amd8111e_suspend,
2157 .resume = amd8111e_resume
2158 };
2159
2160 static int __init amd8111e_init(void)
2161 {
2162 return pci_module_init(&amd8111e_driver);
2163 }
2164
2165 static void __exit amd8111e_cleanup(void)
2166 {
2167 pci_unregister_driver(&amd8111e_driver);
2168 }
2169
2170 module_init(amd8111e_init);
2171 module_exit(amd8111e_cleanup);
Linux with added FPC-III support