2 * Copyright(c) 2007 Atheros Corporation. All rights reserved.
4 * Derived from Intel e1000 driver
5 * Copyright(c) 1999 - 2005 Intel Corporation. All rights reserved.
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the Free
9 * Software Foundation; either version 2 of the License, or (at your option)
12 * This program is distributed in the hope that it will be useful, but WITHOUT
13 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
14 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
17 * You should have received a copy of the GNU General Public License along with
18 * this program; if not, write to the Free Software Foundation, Inc., 59
19 * Temple Place - Suite 330, Boston, MA 02111-1307, USA.
24 #define DRV_VERSION "1.0.0.7-NAPI"
26 char atl1e_driver_name
[] = "ATL1E";
27 char atl1e_driver_version
[] = DRV_VERSION
;
28 #define PCI_DEVICE_ID_ATTANSIC_L1E 0x1026
30 * atl1e_pci_tbl - PCI Device ID Table
32 * Wildcard entries (PCI_ANY_ID) should come last
33 * Last entry must be all 0s
35 * { Vendor ID, Device ID, SubVendor ID, SubDevice ID,
36 * Class, Class Mask, private data (not used) }
38 static const struct pci_device_id atl1e_pci_tbl
[] = {
39 {PCI_DEVICE(PCI_VENDOR_ID_ATTANSIC
, PCI_DEVICE_ID_ATTANSIC_L1E
)},
40 {PCI_DEVICE(PCI_VENDOR_ID_ATTANSIC
, 0x1066)},
41 /* required last entry */
44 MODULE_DEVICE_TABLE(pci
, atl1e_pci_tbl
);
46 MODULE_AUTHOR("Atheros Corporation, <xiong.huang@atheros.com>, Jie Yang <jie.yang@atheros.com>");
47 MODULE_DESCRIPTION("Atheros 1000M Ethernet Network Driver");
48 MODULE_LICENSE("GPL");
49 MODULE_VERSION(DRV_VERSION
);
51 static void atl1e_setup_mac_ctrl(struct atl1e_adapter
*adapter
);
54 atl1e_rx_page_vld_regs
[AT_MAX_RECEIVE_QUEUE
][AT_PAGE_NUM_PER_QUEUE
] =
56 {REG_HOST_RXF0_PAGE0_VLD
, REG_HOST_RXF0_PAGE1_VLD
},
57 {REG_HOST_RXF1_PAGE0_VLD
, REG_HOST_RXF1_PAGE1_VLD
},
58 {REG_HOST_RXF2_PAGE0_VLD
, REG_HOST_RXF2_PAGE1_VLD
},
59 {REG_HOST_RXF3_PAGE0_VLD
, REG_HOST_RXF3_PAGE1_VLD
}
62 static const u16 atl1e_rx_page_hi_addr_regs
[AT_MAX_RECEIVE_QUEUE
] =
64 REG_RXF0_BASE_ADDR_HI
,
65 REG_RXF1_BASE_ADDR_HI
,
66 REG_RXF2_BASE_ADDR_HI
,
71 atl1e_rx_page_lo_addr_regs
[AT_MAX_RECEIVE_QUEUE
][AT_PAGE_NUM_PER_QUEUE
] =
73 {REG_HOST_RXF0_PAGE0_LO
, REG_HOST_RXF0_PAGE1_LO
},
74 {REG_HOST_RXF1_PAGE0_LO
, REG_HOST_RXF1_PAGE1_LO
},
75 {REG_HOST_RXF2_PAGE0_LO
, REG_HOST_RXF2_PAGE1_LO
},
76 {REG_HOST_RXF3_PAGE0_LO
, REG_HOST_RXF3_PAGE1_LO
}
80 atl1e_rx_page_write_offset_regs
[AT_MAX_RECEIVE_QUEUE
][AT_PAGE_NUM_PER_QUEUE
] =
82 {REG_HOST_RXF0_MB0_LO
, REG_HOST_RXF0_MB1_LO
},
83 {REG_HOST_RXF1_MB0_LO
, REG_HOST_RXF1_MB1_LO
},
84 {REG_HOST_RXF2_MB0_LO
, REG_HOST_RXF2_MB1_LO
},
85 {REG_HOST_RXF3_MB0_LO
, REG_HOST_RXF3_MB1_LO
}
88 static const u16 atl1e_pay_load_size
[] = {
89 128, 256, 512, 1024, 2048, 4096,
93 * atl1e_irq_enable - Enable default interrupt generation settings
94 * @adapter: board private structure
96 static inline void atl1e_irq_enable(struct atl1e_adapter
*adapter
)
98 if (likely(atomic_dec_and_test(&adapter
->irq_sem
))) {
99 AT_WRITE_REG(&adapter
->hw
, REG_ISR
, 0);
100 AT_WRITE_REG(&adapter
->hw
, REG_IMR
, IMR_NORMAL_MASK
);
101 AT_WRITE_FLUSH(&adapter
->hw
);
106 * atl1e_irq_disable - Mask off interrupt generation on the NIC
107 * @adapter: board private structure
109 static inline void atl1e_irq_disable(struct atl1e_adapter
*adapter
)
111 atomic_inc(&adapter
->irq_sem
);
112 AT_WRITE_REG(&adapter
->hw
, REG_IMR
, 0);
113 AT_WRITE_FLUSH(&adapter
->hw
);
114 synchronize_irq(adapter
->pdev
->irq
);
118 * atl1e_irq_reset - reset interrupt confiure on the NIC
119 * @adapter: board private structure
121 static inline void atl1e_irq_reset(struct atl1e_adapter
*adapter
)
123 atomic_set(&adapter
->irq_sem
, 0);
124 AT_WRITE_REG(&adapter
->hw
, REG_ISR
, 0);
125 AT_WRITE_REG(&adapter
->hw
, REG_IMR
, 0);
126 AT_WRITE_FLUSH(&adapter
->hw
);
130 * atl1e_phy_config - Timer Call-back
131 * @data: pointer to netdev cast into an unsigned long
133 static void atl1e_phy_config(unsigned long data
)
135 struct atl1e_adapter
*adapter
= (struct atl1e_adapter
*) data
;
136 struct atl1e_hw
*hw
= &adapter
->hw
;
139 spin_lock_irqsave(&adapter
->mdio_lock
, flags
);
140 atl1e_restart_autoneg(hw
);
141 spin_unlock_irqrestore(&adapter
->mdio_lock
, flags
);
144 void atl1e_reinit_locked(struct atl1e_adapter
*adapter
)
147 WARN_ON(in_interrupt());
148 while (test_and_set_bit(__AT_RESETTING
, &adapter
->flags
))
152 clear_bit(__AT_RESETTING
, &adapter
->flags
);
155 static void atl1e_reset_task(struct work_struct
*work
)
157 struct atl1e_adapter
*adapter
;
158 adapter
= container_of(work
, struct atl1e_adapter
, reset_task
);
160 atl1e_reinit_locked(adapter
);
163 static int atl1e_check_link(struct atl1e_adapter
*adapter
)
165 struct atl1e_hw
*hw
= &adapter
->hw
;
166 struct net_device
*netdev
= adapter
->netdev
;
168 u16 speed
, duplex
, phy_data
;
170 /* MII_BMSR must read twice */
171 atl1e_read_phy_reg(hw
, MII_BMSR
, &phy_data
);
172 atl1e_read_phy_reg(hw
, MII_BMSR
, &phy_data
);
173 if ((phy_data
& BMSR_LSTATUS
) == 0) {
175 if (netif_carrier_ok(netdev
)) { /* old link state: Up */
178 value
= AT_READ_REG(hw
, REG_MAC_CTRL
);
179 value
&= ~MAC_CTRL_RX_EN
;
180 AT_WRITE_REG(hw
, REG_MAC_CTRL
, value
);
181 adapter
->link_speed
= SPEED_0
;
182 netif_carrier_off(netdev
);
183 netif_stop_queue(netdev
);
187 err
= atl1e_get_speed_and_duplex(hw
, &speed
, &duplex
);
191 /* link result is our setting */
192 if (adapter
->link_speed
!= speed
||
193 adapter
->link_duplex
!= duplex
) {
194 adapter
->link_speed
= speed
;
195 adapter
->link_duplex
= duplex
;
196 atl1e_setup_mac_ctrl(adapter
);
198 "NIC Link is Up <%d Mbps %s Duplex>\n",
200 adapter
->link_duplex
== FULL_DUPLEX
?
204 if (!netif_carrier_ok(netdev
)) {
205 /* Link down -> Up */
206 netif_carrier_on(netdev
);
207 netif_wake_queue(netdev
);
214 * atl1e_link_chg_task - deal with link change event Out of interrupt context
215 * @netdev: network interface device structure
217 static void atl1e_link_chg_task(struct work_struct
*work
)
219 struct atl1e_adapter
*adapter
;
222 adapter
= container_of(work
, struct atl1e_adapter
, link_chg_task
);
223 spin_lock_irqsave(&adapter
->mdio_lock
, flags
);
224 atl1e_check_link(adapter
);
225 spin_unlock_irqrestore(&adapter
->mdio_lock
, flags
);
228 static void atl1e_link_chg_event(struct atl1e_adapter
*adapter
)
230 struct net_device
*netdev
= adapter
->netdev
;
234 spin_lock(&adapter
->mdio_lock
);
235 atl1e_read_phy_reg(&adapter
->hw
, MII_BMSR
, &phy_data
);
236 atl1e_read_phy_reg(&adapter
->hw
, MII_BMSR
, &phy_data
);
237 spin_unlock(&adapter
->mdio_lock
);
238 link_up
= phy_data
& BMSR_LSTATUS
;
239 /* notify upper layer link down ASAP */
241 if (netif_carrier_ok(netdev
)) {
242 /* old link state: Up */
243 netdev_info(netdev
, "NIC Link is Down\n");
244 adapter
->link_speed
= SPEED_0
;
245 netif_stop_queue(netdev
);
248 schedule_work(&adapter
->link_chg_task
);
251 static void atl1e_del_timer(struct atl1e_adapter
*adapter
)
253 del_timer_sync(&adapter
->phy_config_timer
);
256 static void atl1e_cancel_work(struct atl1e_adapter
*adapter
)
258 cancel_work_sync(&adapter
->reset_task
);
259 cancel_work_sync(&adapter
->link_chg_task
);
263 * atl1e_tx_timeout - Respond to a Tx Hang
264 * @netdev: network interface device structure
266 static void atl1e_tx_timeout(struct net_device
*netdev
)
268 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
270 /* Do the reset outside of interrupt context */
271 schedule_work(&adapter
->reset_task
);
275 * atl1e_set_multi - Multicast and Promiscuous mode set
276 * @netdev: network interface device structure
278 * The set_multi entry point is called whenever the multicast address
279 * list or the network interface flags are updated. This routine is
280 * responsible for configuring the hardware for proper multicast,
281 * promiscuous mode, and all-multi behavior.
283 static void atl1e_set_multi(struct net_device
*netdev
)
285 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
286 struct atl1e_hw
*hw
= &adapter
->hw
;
287 struct netdev_hw_addr
*ha
;
288 u32 mac_ctrl_data
= 0;
291 /* Check for Promiscuous and All Multicast modes */
292 mac_ctrl_data
= AT_READ_REG(hw
, REG_MAC_CTRL
);
294 if (netdev
->flags
& IFF_PROMISC
) {
295 mac_ctrl_data
|= MAC_CTRL_PROMIS_EN
;
296 } else if (netdev
->flags
& IFF_ALLMULTI
) {
297 mac_ctrl_data
|= MAC_CTRL_MC_ALL_EN
;
298 mac_ctrl_data
&= ~MAC_CTRL_PROMIS_EN
;
300 mac_ctrl_data
&= ~(MAC_CTRL_PROMIS_EN
| MAC_CTRL_MC_ALL_EN
);
303 AT_WRITE_REG(hw
, REG_MAC_CTRL
, mac_ctrl_data
);
305 /* clear the old settings from the multicast hash table */
306 AT_WRITE_REG(hw
, REG_RX_HASH_TABLE
, 0);
307 AT_WRITE_REG_ARRAY(hw
, REG_RX_HASH_TABLE
, 1, 0);
309 /* comoute mc addresses' hash value ,and put it into hash table */
310 netdev_for_each_mc_addr(ha
, netdev
) {
311 hash_value
= atl1e_hash_mc_addr(hw
, ha
->addr
);
312 atl1e_hash_set(hw
, hash_value
);
316 static void __atl1e_rx_mode(netdev_features_t features
, u32
*mac_ctrl_data
)
319 if (features
& NETIF_F_RXALL
) {
320 /* enable RX of ALL frames */
321 *mac_ctrl_data
|= MAC_CTRL_DBG
;
323 /* disable RX of ALL frames */
324 *mac_ctrl_data
&= ~MAC_CTRL_DBG
;
328 static void atl1e_rx_mode(struct net_device
*netdev
,
329 netdev_features_t features
)
331 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
332 u32 mac_ctrl_data
= 0;
334 netdev_dbg(adapter
->netdev
, "%s\n", __func__
);
336 atl1e_irq_disable(adapter
);
337 mac_ctrl_data
= AT_READ_REG(&adapter
->hw
, REG_MAC_CTRL
);
338 __atl1e_rx_mode(features
, &mac_ctrl_data
);
339 AT_WRITE_REG(&adapter
->hw
, REG_MAC_CTRL
, mac_ctrl_data
);
340 atl1e_irq_enable(adapter
);
344 static void __atl1e_vlan_mode(netdev_features_t features
, u32
*mac_ctrl_data
)
346 if (features
& NETIF_F_HW_VLAN_CTAG_RX
) {
347 /* enable VLAN tag insert/strip */
348 *mac_ctrl_data
|= MAC_CTRL_RMV_VLAN
;
350 /* disable VLAN tag insert/strip */
351 *mac_ctrl_data
&= ~MAC_CTRL_RMV_VLAN
;
355 static void atl1e_vlan_mode(struct net_device
*netdev
,
356 netdev_features_t features
)
358 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
359 u32 mac_ctrl_data
= 0;
361 netdev_dbg(adapter
->netdev
, "%s\n", __func__
);
363 atl1e_irq_disable(adapter
);
364 mac_ctrl_data
= AT_READ_REG(&adapter
->hw
, REG_MAC_CTRL
);
365 __atl1e_vlan_mode(features
, &mac_ctrl_data
);
366 AT_WRITE_REG(&adapter
->hw
, REG_MAC_CTRL
, mac_ctrl_data
);
367 atl1e_irq_enable(adapter
);
370 static void atl1e_restore_vlan(struct atl1e_adapter
*adapter
)
372 netdev_dbg(adapter
->netdev
, "%s\n", __func__
);
373 atl1e_vlan_mode(adapter
->netdev
, adapter
->netdev
->features
);
377 * atl1e_set_mac - Change the Ethernet Address of the NIC
378 * @netdev: network interface device structure
379 * @p: pointer to an address structure
381 * Returns 0 on success, negative on failure
383 static int atl1e_set_mac_addr(struct net_device
*netdev
, void *p
)
385 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
386 struct sockaddr
*addr
= p
;
388 if (!is_valid_ether_addr(addr
->sa_data
))
389 return -EADDRNOTAVAIL
;
391 if (netif_running(netdev
))
394 memcpy(netdev
->dev_addr
, addr
->sa_data
, netdev
->addr_len
);
395 memcpy(adapter
->hw
.mac_addr
, addr
->sa_data
, netdev
->addr_len
);
397 atl1e_hw_set_mac_addr(&adapter
->hw
);
402 static netdev_features_t
atl1e_fix_features(struct net_device
*netdev
,
403 netdev_features_t features
)
406 * Since there is no support for separate rx/tx vlan accel
407 * enable/disable make sure tx flag is always in same state as rx.
409 if (features
& NETIF_F_HW_VLAN_CTAG_RX
)
410 features
|= NETIF_F_HW_VLAN_CTAG_TX
;
412 features
&= ~NETIF_F_HW_VLAN_CTAG_TX
;
417 static int atl1e_set_features(struct net_device
*netdev
,
418 netdev_features_t features
)
420 netdev_features_t changed
= netdev
->features
^ features
;
422 if (changed
& NETIF_F_HW_VLAN_CTAG_RX
)
423 atl1e_vlan_mode(netdev
, features
);
425 if (changed
& NETIF_F_RXALL
)
426 atl1e_rx_mode(netdev
, features
);
433 * atl1e_change_mtu - Change the Maximum Transfer Unit
434 * @netdev: network interface device structure
435 * @new_mtu: new value for maximum frame size
437 * Returns 0 on success, negative on failure
439 static int atl1e_change_mtu(struct net_device
*netdev
, int new_mtu
)
441 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
442 int old_mtu
= netdev
->mtu
;
443 int max_frame
= new_mtu
+ ETH_HLEN
+ ETH_FCS_LEN
+ VLAN_HLEN
;
445 if ((max_frame
< ETH_ZLEN
+ ETH_FCS_LEN
) ||
446 (max_frame
> MAX_JUMBO_FRAME_SIZE
)) {
447 netdev_warn(adapter
->netdev
, "invalid MTU setting\n");
451 if (old_mtu
!= new_mtu
&& netif_running(netdev
)) {
452 while (test_and_set_bit(__AT_RESETTING
, &adapter
->flags
))
454 netdev
->mtu
= new_mtu
;
455 adapter
->hw
.max_frame_size
= new_mtu
;
456 adapter
->hw
.rx_jumbo_th
= (max_frame
+ 7) >> 3;
459 clear_bit(__AT_RESETTING
, &adapter
->flags
);
465 * caller should hold mdio_lock
467 static int atl1e_mdio_read(struct net_device
*netdev
, int phy_id
, int reg_num
)
469 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
472 atl1e_read_phy_reg(&adapter
->hw
, reg_num
& MDIO_REG_ADDR_MASK
, &result
);
476 static void atl1e_mdio_write(struct net_device
*netdev
, int phy_id
,
477 int reg_num
, int val
)
479 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
481 atl1e_write_phy_reg(&adapter
->hw
, reg_num
& MDIO_REG_ADDR_MASK
, val
);
484 static int atl1e_mii_ioctl(struct net_device
*netdev
,
485 struct ifreq
*ifr
, int cmd
)
487 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
488 struct mii_ioctl_data
*data
= if_mii(ifr
);
492 if (!netif_running(netdev
))
495 spin_lock_irqsave(&adapter
->mdio_lock
, flags
);
502 if (atl1e_read_phy_reg(&adapter
->hw
, data
->reg_num
& 0x1F,
510 if (data
->reg_num
& ~(0x1F)) {
515 netdev_dbg(adapter
->netdev
, "<atl1e_mii_ioctl> write %x %x\n",
516 data
->reg_num
, data
->val_in
);
517 if (atl1e_write_phy_reg(&adapter
->hw
,
518 data
->reg_num
, data
->val_in
)) {
525 retval
= -EOPNOTSUPP
;
529 spin_unlock_irqrestore(&adapter
->mdio_lock
, flags
);
534 static int atl1e_ioctl(struct net_device
*netdev
, struct ifreq
*ifr
, int cmd
)
540 return atl1e_mii_ioctl(netdev
, ifr
, cmd
);
546 static void atl1e_setup_pcicmd(struct pci_dev
*pdev
)
550 pci_read_config_word(pdev
, PCI_COMMAND
, &cmd
);
551 cmd
&= ~(PCI_COMMAND_INTX_DISABLE
| PCI_COMMAND_IO
);
552 cmd
|= (PCI_COMMAND_MEMORY
| PCI_COMMAND_MASTER
);
553 pci_write_config_word(pdev
, PCI_COMMAND
, cmd
);
556 * some motherboards BIOS(PXE/EFI) driver may set PME
557 * while they transfer control to OS (Windows/Linux)
558 * so we should clear this bit before NIC work normally
560 pci_write_config_dword(pdev
, REG_PM_CTRLSTAT
, 0);
565 * atl1e_alloc_queues - Allocate memory for all rings
566 * @adapter: board private structure to initialize
569 static int atl1e_alloc_queues(struct atl1e_adapter
*adapter
)
575 * atl1e_sw_init - Initialize general software structures (struct atl1e_adapter)
576 * @adapter: board private structure to initialize
578 * atl1e_sw_init initializes the Adapter private data structure.
579 * Fields are initialized based on PCI device information and
580 * OS network device settings (MTU size).
582 static int atl1e_sw_init(struct atl1e_adapter
*adapter
)
584 struct atl1e_hw
*hw
= &adapter
->hw
;
585 struct pci_dev
*pdev
= adapter
->pdev
;
586 u32 phy_status_data
= 0;
589 adapter
->link_speed
= SPEED_0
; /* hardware init */
590 adapter
->link_duplex
= FULL_DUPLEX
;
591 adapter
->num_rx_queues
= 1;
593 /* PCI config space info */
594 hw
->vendor_id
= pdev
->vendor
;
595 hw
->device_id
= pdev
->device
;
596 hw
->subsystem_vendor_id
= pdev
->subsystem_vendor
;
597 hw
->subsystem_id
= pdev
->subsystem_device
;
598 hw
->revision_id
= pdev
->revision
;
600 pci_read_config_word(pdev
, PCI_COMMAND
, &hw
->pci_cmd_word
);
602 phy_status_data
= AT_READ_REG(hw
, REG_PHY_STATUS
);
604 if (hw
->revision_id
>= 0xF0) {
605 hw
->nic_type
= athr_l2e_revB
;
607 if (phy_status_data
& PHY_STATUS_100M
)
608 hw
->nic_type
= athr_l1e
;
610 hw
->nic_type
= athr_l2e_revA
;
613 phy_status_data
= AT_READ_REG(hw
, REG_PHY_STATUS
);
615 if (phy_status_data
& PHY_STATUS_EMI_CA
)
620 hw
->phy_configured
= false;
621 hw
->preamble_len
= 7;
622 hw
->max_frame_size
= adapter
->netdev
->mtu
;
623 hw
->rx_jumbo_th
= (hw
->max_frame_size
+ ETH_HLEN
+
624 VLAN_HLEN
+ ETH_FCS_LEN
+ 7) >> 3;
626 hw
->rrs_type
= atl1e_rrs_disable
;
627 hw
->indirect_tab
= 0;
632 hw
->ict
= 50000; /* 100ms */
633 hw
->smb_timer
= 200000; /* 200ms */
636 hw
->tpd_thresh
= adapter
->tx_ring
.count
/ 2;
637 hw
->rx_count_down
= 4; /* 2us resolution */
638 hw
->tx_count_down
= hw
->imt
* 4 / 3;
639 hw
->dmar_block
= atl1e_dma_req_1024
;
640 hw
->dmaw_block
= atl1e_dma_req_1024
;
641 hw
->dmar_dly_cnt
= 15;
642 hw
->dmaw_dly_cnt
= 4;
644 if (atl1e_alloc_queues(adapter
)) {
645 netdev_err(adapter
->netdev
, "Unable to allocate memory for queues\n");
649 atomic_set(&adapter
->irq_sem
, 1);
650 spin_lock_init(&adapter
->mdio_lock
);
652 set_bit(__AT_DOWN
, &adapter
->flags
);
658 * atl1e_clean_tx_ring - Free Tx-skb
659 * @adapter: board private structure
661 static void atl1e_clean_tx_ring(struct atl1e_adapter
*adapter
)
663 struct atl1e_tx_ring
*tx_ring
= &adapter
->tx_ring
;
664 struct atl1e_tx_buffer
*tx_buffer
= NULL
;
665 struct pci_dev
*pdev
= adapter
->pdev
;
666 u16 index
, ring_count
;
668 if (tx_ring
->desc
== NULL
|| tx_ring
->tx_buffer
== NULL
)
671 ring_count
= tx_ring
->count
;
672 /* first unmmap dma */
673 for (index
= 0; index
< ring_count
; index
++) {
674 tx_buffer
= &tx_ring
->tx_buffer
[index
];
675 if (tx_buffer
->dma
) {
676 if (tx_buffer
->flags
& ATL1E_TX_PCIMAP_SINGLE
)
677 pci_unmap_single(pdev
, tx_buffer
->dma
,
678 tx_buffer
->length
, PCI_DMA_TODEVICE
);
679 else if (tx_buffer
->flags
& ATL1E_TX_PCIMAP_PAGE
)
680 pci_unmap_page(pdev
, tx_buffer
->dma
,
681 tx_buffer
->length
, PCI_DMA_TODEVICE
);
685 /* second free skb */
686 for (index
= 0; index
< ring_count
; index
++) {
687 tx_buffer
= &tx_ring
->tx_buffer
[index
];
688 if (tx_buffer
->skb
) {
689 dev_kfree_skb_any(tx_buffer
->skb
);
690 tx_buffer
->skb
= NULL
;
693 /* Zero out Tx-buffers */
694 memset(tx_ring
->desc
, 0, sizeof(struct atl1e_tpd_desc
) *
696 memset(tx_ring
->tx_buffer
, 0, sizeof(struct atl1e_tx_buffer
) *
701 * atl1e_clean_rx_ring - Free rx-reservation skbs
702 * @adapter: board private structure
704 static void atl1e_clean_rx_ring(struct atl1e_adapter
*adapter
)
706 struct atl1e_rx_ring
*rx_ring
=
708 struct atl1e_rx_page_desc
*rx_page_desc
= rx_ring
->rx_page_desc
;
712 if (adapter
->ring_vir_addr
== NULL
)
714 /* Zero out the descriptor ring */
715 for (i
= 0; i
< adapter
->num_rx_queues
; i
++) {
716 for (j
= 0; j
< AT_PAGE_NUM_PER_QUEUE
; j
++) {
717 if (rx_page_desc
[i
].rx_page
[j
].addr
!= NULL
) {
718 memset(rx_page_desc
[i
].rx_page
[j
].addr
, 0,
719 rx_ring
->real_page_size
);
725 static void atl1e_cal_ring_size(struct atl1e_adapter
*adapter
, u32
*ring_size
)
727 *ring_size
= ((u32
)(adapter
->tx_ring
.count
*
728 sizeof(struct atl1e_tpd_desc
) + 7
729 /* tx ring, qword align */
730 + adapter
->rx_ring
.real_page_size
* AT_PAGE_NUM_PER_QUEUE
*
731 adapter
->num_rx_queues
+ 31
732 /* rx ring, 32 bytes align */
733 + (1 + AT_PAGE_NUM_PER_QUEUE
* adapter
->num_rx_queues
) *
735 /* tx, rx cmd, dword align */
738 static void atl1e_init_ring_resources(struct atl1e_adapter
*adapter
)
740 struct atl1e_rx_ring
*rx_ring
= NULL
;
742 rx_ring
= &adapter
->rx_ring
;
744 rx_ring
->real_page_size
= adapter
->rx_ring
.page_size
745 + adapter
->hw
.max_frame_size
746 + ETH_HLEN
+ VLAN_HLEN
748 rx_ring
->real_page_size
= roundup(rx_ring
->real_page_size
, 32);
749 atl1e_cal_ring_size(adapter
, &adapter
->ring_size
);
751 adapter
->ring_vir_addr
= NULL
;
752 adapter
->rx_ring
.desc
= NULL
;
753 rwlock_init(&adapter
->tx_ring
.tx_lock
);
757 * Read / Write Ptr Initialize:
759 static void atl1e_init_ring_ptrs(struct atl1e_adapter
*adapter
)
761 struct atl1e_tx_ring
*tx_ring
= NULL
;
762 struct atl1e_rx_ring
*rx_ring
= NULL
;
763 struct atl1e_rx_page_desc
*rx_page_desc
= NULL
;
766 tx_ring
= &adapter
->tx_ring
;
767 rx_ring
= &adapter
->rx_ring
;
768 rx_page_desc
= rx_ring
->rx_page_desc
;
770 tx_ring
->next_to_use
= 0;
771 atomic_set(&tx_ring
->next_to_clean
, 0);
773 for (i
= 0; i
< adapter
->num_rx_queues
; i
++) {
774 rx_page_desc
[i
].rx_using
= 0;
775 rx_page_desc
[i
].rx_nxseq
= 0;
776 for (j
= 0; j
< AT_PAGE_NUM_PER_QUEUE
; j
++) {
777 *rx_page_desc
[i
].rx_page
[j
].write_offset_addr
= 0;
778 rx_page_desc
[i
].rx_page
[j
].read_offset
= 0;
784 * atl1e_free_ring_resources - Free Tx / RX descriptor Resources
785 * @adapter: board private structure
787 * Free all transmit software resources
789 static void atl1e_free_ring_resources(struct atl1e_adapter
*adapter
)
791 struct pci_dev
*pdev
= adapter
->pdev
;
793 atl1e_clean_tx_ring(adapter
);
794 atl1e_clean_rx_ring(adapter
);
796 if (adapter
->ring_vir_addr
) {
797 pci_free_consistent(pdev
, adapter
->ring_size
,
798 adapter
->ring_vir_addr
, adapter
->ring_dma
);
799 adapter
->ring_vir_addr
= NULL
;
802 if (adapter
->tx_ring
.tx_buffer
) {
803 kfree(adapter
->tx_ring
.tx_buffer
);
804 adapter
->tx_ring
.tx_buffer
= NULL
;
809 * atl1e_setup_mem_resources - allocate Tx / RX descriptor resources
810 * @adapter: board private structure
812 * Return 0 on success, negative on failure
814 static int atl1e_setup_ring_resources(struct atl1e_adapter
*adapter
)
816 struct pci_dev
*pdev
= adapter
->pdev
;
817 struct atl1e_tx_ring
*tx_ring
;
818 struct atl1e_rx_ring
*rx_ring
;
819 struct atl1e_rx_page_desc
*rx_page_desc
;
824 if (adapter
->ring_vir_addr
!= NULL
)
825 return 0; /* alloced already */
827 tx_ring
= &adapter
->tx_ring
;
828 rx_ring
= &adapter
->rx_ring
;
830 /* real ring DMA buffer */
832 size
= adapter
->ring_size
;
833 adapter
->ring_vir_addr
= pci_zalloc_consistent(pdev
, adapter
->ring_size
,
835 if (adapter
->ring_vir_addr
== NULL
) {
836 netdev_err(adapter
->netdev
,
837 "pci_alloc_consistent failed, size = D%d\n", size
);
841 rx_page_desc
= rx_ring
->rx_page_desc
;
844 tx_ring
->dma
= roundup(adapter
->ring_dma
, 8);
845 offset
= tx_ring
->dma
- adapter
->ring_dma
;
846 tx_ring
->desc
= adapter
->ring_vir_addr
+ offset
;
847 size
= sizeof(struct atl1e_tx_buffer
) * (tx_ring
->count
);
848 tx_ring
->tx_buffer
= kzalloc(size
, GFP_KERNEL
);
849 if (tx_ring
->tx_buffer
== NULL
) {
855 offset
+= (sizeof(struct atl1e_tpd_desc
) * tx_ring
->count
);
856 offset
= roundup(offset
, 32);
858 for (i
= 0; i
< adapter
->num_rx_queues
; i
++) {
859 for (j
= 0; j
< AT_PAGE_NUM_PER_QUEUE
; j
++) {
860 rx_page_desc
[i
].rx_page
[j
].dma
=
861 adapter
->ring_dma
+ offset
;
862 rx_page_desc
[i
].rx_page
[j
].addr
=
863 adapter
->ring_vir_addr
+ offset
;
864 offset
+= rx_ring
->real_page_size
;
868 /* Init CMB dma address */
869 tx_ring
->cmb_dma
= adapter
->ring_dma
+ offset
;
870 tx_ring
->cmb
= adapter
->ring_vir_addr
+ offset
;
871 offset
+= sizeof(u32
);
873 for (i
= 0; i
< adapter
->num_rx_queues
; i
++) {
874 for (j
= 0; j
< AT_PAGE_NUM_PER_QUEUE
; j
++) {
875 rx_page_desc
[i
].rx_page
[j
].write_offset_dma
=
876 adapter
->ring_dma
+ offset
;
877 rx_page_desc
[i
].rx_page
[j
].write_offset_addr
=
878 adapter
->ring_vir_addr
+ offset
;
879 offset
+= sizeof(u32
);
883 if (unlikely(offset
> adapter
->ring_size
)) {
884 netdev_err(adapter
->netdev
, "offset(%d) > ring size(%d) !!\n",
885 offset
, adapter
->ring_size
);
892 if (adapter
->ring_vir_addr
!= NULL
) {
893 pci_free_consistent(pdev
, adapter
->ring_size
,
894 adapter
->ring_vir_addr
, adapter
->ring_dma
);
895 adapter
->ring_vir_addr
= NULL
;
900 static inline void atl1e_configure_des_ring(struct atl1e_adapter
*adapter
)
903 struct atl1e_hw
*hw
= &adapter
->hw
;
904 struct atl1e_rx_ring
*rx_ring
= &adapter
->rx_ring
;
905 struct atl1e_tx_ring
*tx_ring
= &adapter
->tx_ring
;
906 struct atl1e_rx_page_desc
*rx_page_desc
= NULL
;
909 AT_WRITE_REG(hw
, REG_DESC_BASE_ADDR_HI
,
910 (u32
)((adapter
->ring_dma
& AT_DMA_HI_ADDR_MASK
) >> 32));
911 AT_WRITE_REG(hw
, REG_TPD_BASE_ADDR_LO
,
912 (u32
)((tx_ring
->dma
) & AT_DMA_LO_ADDR_MASK
));
913 AT_WRITE_REG(hw
, REG_TPD_RING_SIZE
, (u16
)(tx_ring
->count
));
914 AT_WRITE_REG(hw
, REG_HOST_TX_CMB_LO
,
915 (u32
)((tx_ring
->cmb_dma
) & AT_DMA_LO_ADDR_MASK
));
917 rx_page_desc
= rx_ring
->rx_page_desc
;
918 /* RXF Page Physical address / Page Length */
919 for (i
= 0; i
< AT_MAX_RECEIVE_QUEUE
; i
++) {
920 AT_WRITE_REG(hw
, atl1e_rx_page_hi_addr_regs
[i
],
921 (u32
)((adapter
->ring_dma
&
922 AT_DMA_HI_ADDR_MASK
) >> 32));
923 for (j
= 0; j
< AT_PAGE_NUM_PER_QUEUE
; j
++) {
927 page_phy_addr
= rx_page_desc
[i
].rx_page
[j
].dma
;
929 rx_page_desc
[i
].rx_page
[j
].write_offset_dma
;
931 AT_WRITE_REG(hw
, atl1e_rx_page_lo_addr_regs
[i
][j
],
932 page_phy_addr
& AT_DMA_LO_ADDR_MASK
);
933 AT_WRITE_REG(hw
, atl1e_rx_page_write_offset_regs
[i
][j
],
934 offset_phy_addr
& AT_DMA_LO_ADDR_MASK
);
935 AT_WRITE_REGB(hw
, atl1e_rx_page_vld_regs
[i
][j
], 1);
939 AT_WRITE_REG(hw
, REG_HOST_RXFPAGE_SIZE
, rx_ring
->page_size
);
940 /* Load all of base address above */
941 AT_WRITE_REG(hw
, REG_LOAD_PTR
, 1);
944 static inline void atl1e_configure_tx(struct atl1e_adapter
*adapter
)
946 struct atl1e_hw
*hw
= &adapter
->hw
;
947 u32 dev_ctrl_data
= 0;
948 u32 max_pay_load
= 0;
949 u32 jumbo_thresh
= 0;
950 u32 extra_size
= 0; /* Jumbo frame threshold in QWORD unit */
952 /* configure TXQ param */
953 if (hw
->nic_type
!= athr_l2e_revB
) {
954 extra_size
= ETH_HLEN
+ VLAN_HLEN
+ ETH_FCS_LEN
;
955 if (hw
->max_frame_size
<= 1500) {
956 jumbo_thresh
= hw
->max_frame_size
+ extra_size
;
957 } else if (hw
->max_frame_size
< 6*1024) {
959 (hw
->max_frame_size
+ extra_size
) * 2 / 3;
961 jumbo_thresh
= (hw
->max_frame_size
+ extra_size
) / 2;
963 AT_WRITE_REG(hw
, REG_TX_EARLY_TH
, (jumbo_thresh
+ 7) >> 3);
966 dev_ctrl_data
= AT_READ_REG(hw
, REG_DEVICE_CTRL
);
968 max_pay_load
= ((dev_ctrl_data
>> DEVICE_CTRL_MAX_PAYLOAD_SHIFT
)) &
969 DEVICE_CTRL_MAX_PAYLOAD_MASK
;
971 hw
->dmaw_block
= min_t(u32
, max_pay_load
, hw
->dmaw_block
);
973 max_pay_load
= ((dev_ctrl_data
>> DEVICE_CTRL_MAX_RREQ_SZ_SHIFT
)) &
974 DEVICE_CTRL_MAX_RREQ_SZ_MASK
;
975 hw
->dmar_block
= min_t(u32
, max_pay_load
, hw
->dmar_block
);
977 if (hw
->nic_type
!= athr_l2e_revB
)
978 AT_WRITE_REGW(hw
, REG_TXQ_CTRL
+ 2,
979 atl1e_pay_load_size
[hw
->dmar_block
]);
981 AT_WRITE_REGW(hw
, REG_TXQ_CTRL
,
982 (((u16
)hw
->tpd_burst
& TXQ_CTRL_NUM_TPD_BURST_MASK
)
983 << TXQ_CTRL_NUM_TPD_BURST_SHIFT
)
984 | TXQ_CTRL_ENH_MODE
| TXQ_CTRL_EN
);
987 static inline void atl1e_configure_rx(struct atl1e_adapter
*adapter
)
989 struct atl1e_hw
*hw
= &adapter
->hw
;
993 u32 rxf_thresh_data
= 0;
994 u32 rxq_ctrl_data
= 0;
996 if (hw
->nic_type
!= athr_l2e_revB
) {
997 AT_WRITE_REGW(hw
, REG_RXQ_JMBOSZ_RRDTIM
,
998 (u16
)((hw
->rx_jumbo_th
& RXQ_JMBOSZ_TH_MASK
) <<
999 RXQ_JMBOSZ_TH_SHIFT
|
1000 (1 & RXQ_JMBO_LKAH_MASK
) <<
1001 RXQ_JMBO_LKAH_SHIFT
));
1003 rxf_len
= AT_READ_REG(hw
, REG_SRAM_RXF_LEN
);
1004 rxf_high
= rxf_len
* 4 / 5;
1005 rxf_low
= rxf_len
/ 5;
1006 rxf_thresh_data
= ((rxf_high
& RXQ_RXF_PAUSE_TH_HI_MASK
)
1007 << RXQ_RXF_PAUSE_TH_HI_SHIFT
) |
1008 ((rxf_low
& RXQ_RXF_PAUSE_TH_LO_MASK
)
1009 << RXQ_RXF_PAUSE_TH_LO_SHIFT
);
1011 AT_WRITE_REG(hw
, REG_RXQ_RXF_PAUSE_THRESH
, rxf_thresh_data
);
1015 AT_WRITE_REG(hw
, REG_IDT_TABLE
, hw
->indirect_tab
);
1016 AT_WRITE_REG(hw
, REG_BASE_CPU_NUMBER
, hw
->base_cpu
);
1018 if (hw
->rrs_type
& atl1e_rrs_ipv4
)
1019 rxq_ctrl_data
|= RXQ_CTRL_HASH_TYPE_IPV4
;
1021 if (hw
->rrs_type
& atl1e_rrs_ipv4_tcp
)
1022 rxq_ctrl_data
|= RXQ_CTRL_HASH_TYPE_IPV4_TCP
;
1024 if (hw
->rrs_type
& atl1e_rrs_ipv6
)
1025 rxq_ctrl_data
|= RXQ_CTRL_HASH_TYPE_IPV6
;
1027 if (hw
->rrs_type
& atl1e_rrs_ipv6_tcp
)
1028 rxq_ctrl_data
|= RXQ_CTRL_HASH_TYPE_IPV6_TCP
;
1030 if (hw
->rrs_type
!= atl1e_rrs_disable
)
1032 (RXQ_CTRL_HASH_ENABLE
| RXQ_CTRL_RSS_MODE_MQUESINT
);
1034 rxq_ctrl_data
|= RXQ_CTRL_IPV6_XSUM_VERIFY_EN
| RXQ_CTRL_PBA_ALIGN_32
|
1035 RXQ_CTRL_CUT_THRU_EN
| RXQ_CTRL_EN
;
1037 AT_WRITE_REG(hw
, REG_RXQ_CTRL
, rxq_ctrl_data
);
1040 static inline void atl1e_configure_dma(struct atl1e_adapter
*adapter
)
1042 struct atl1e_hw
*hw
= &adapter
->hw
;
1043 u32 dma_ctrl_data
= 0;
1045 dma_ctrl_data
= DMA_CTRL_RXCMB_EN
;
1046 dma_ctrl_data
|= (((u32
)hw
->dmar_block
) & DMA_CTRL_DMAR_BURST_LEN_MASK
)
1047 << DMA_CTRL_DMAR_BURST_LEN_SHIFT
;
1048 dma_ctrl_data
|= (((u32
)hw
->dmaw_block
) & DMA_CTRL_DMAW_BURST_LEN_MASK
)
1049 << DMA_CTRL_DMAW_BURST_LEN_SHIFT
;
1050 dma_ctrl_data
|= DMA_CTRL_DMAR_REQ_PRI
| DMA_CTRL_DMAR_OUT_ORDER
;
1051 dma_ctrl_data
|= (((u32
)hw
->dmar_dly_cnt
) & DMA_CTRL_DMAR_DLY_CNT_MASK
)
1052 << DMA_CTRL_DMAR_DLY_CNT_SHIFT
;
1053 dma_ctrl_data
|= (((u32
)hw
->dmaw_dly_cnt
) & DMA_CTRL_DMAW_DLY_CNT_MASK
)
1054 << DMA_CTRL_DMAW_DLY_CNT_SHIFT
;
1056 AT_WRITE_REG(hw
, REG_DMA_CTRL
, dma_ctrl_data
);
1059 static void atl1e_setup_mac_ctrl(struct atl1e_adapter
*adapter
)
1062 struct atl1e_hw
*hw
= &adapter
->hw
;
1063 struct net_device
*netdev
= adapter
->netdev
;
1065 /* Config MAC CTRL Register */
1066 value
= MAC_CTRL_TX_EN
|
1069 if (FULL_DUPLEX
== adapter
->link_duplex
)
1070 value
|= MAC_CTRL_DUPLX
;
1072 value
|= ((u32
)((SPEED_1000
== adapter
->link_speed
) ?
1073 MAC_CTRL_SPEED_1000
: MAC_CTRL_SPEED_10_100
) <<
1074 MAC_CTRL_SPEED_SHIFT
);
1075 value
|= (MAC_CTRL_TX_FLOW
| MAC_CTRL_RX_FLOW
);
1077 value
|= (MAC_CTRL_ADD_CRC
| MAC_CTRL_PAD
);
1078 value
|= (((u32
)adapter
->hw
.preamble_len
&
1079 MAC_CTRL_PRMLEN_MASK
) << MAC_CTRL_PRMLEN_SHIFT
);
1081 __atl1e_vlan_mode(netdev
->features
, &value
);
1083 value
|= MAC_CTRL_BC_EN
;
1084 if (netdev
->flags
& IFF_PROMISC
)
1085 value
|= MAC_CTRL_PROMIS_EN
;
1086 if (netdev
->flags
& IFF_ALLMULTI
)
1087 value
|= MAC_CTRL_MC_ALL_EN
;
1088 if (netdev
->features
& NETIF_F_RXALL
)
1089 value
|= MAC_CTRL_DBG
;
1090 AT_WRITE_REG(hw
, REG_MAC_CTRL
, value
);
1094 * atl1e_configure - Configure Transmit&Receive Unit after Reset
1095 * @adapter: board private structure
1097 * Configure the Tx /Rx unit of the MAC after a reset.
1099 static int atl1e_configure(struct atl1e_adapter
*adapter
)
1101 struct atl1e_hw
*hw
= &adapter
->hw
;
1103 u32 intr_status_data
= 0;
1105 /* clear interrupt status */
1106 AT_WRITE_REG(hw
, REG_ISR
, ~0);
1108 /* 1. set MAC Address */
1109 atl1e_hw_set_mac_addr(hw
);
1111 /* 2. Init the Multicast HASH table done by set_muti */
1113 /* 3. Clear any WOL status */
1114 AT_WRITE_REG(hw
, REG_WOL_CTRL
, 0);
1116 /* 4. Descripter Ring BaseMem/Length/Read ptr/Write ptr
1117 * TPD Ring/SMB/RXF0 Page CMBs, they use the same
1118 * High 32bits memory */
1119 atl1e_configure_des_ring(adapter
);
1121 /* 5. set Interrupt Moderator Timer */
1122 AT_WRITE_REGW(hw
, REG_IRQ_MODU_TIMER_INIT
, hw
->imt
);
1123 AT_WRITE_REGW(hw
, REG_IRQ_MODU_TIMER2_INIT
, hw
->imt
);
1124 AT_WRITE_REG(hw
, REG_MASTER_CTRL
, MASTER_CTRL_LED_MODE
|
1125 MASTER_CTRL_ITIMER_EN
| MASTER_CTRL_ITIMER2_EN
);
1127 /* 6. rx/tx threshold to trig interrupt */
1128 AT_WRITE_REGW(hw
, REG_TRIG_RRD_THRESH
, hw
->rrd_thresh
);
1129 AT_WRITE_REGW(hw
, REG_TRIG_TPD_THRESH
, hw
->tpd_thresh
);
1130 AT_WRITE_REGW(hw
, REG_TRIG_RXTIMER
, hw
->rx_count_down
);
1131 AT_WRITE_REGW(hw
, REG_TRIG_TXTIMER
, hw
->tx_count_down
);
1133 /* 7. set Interrupt Clear Timer */
1134 AT_WRITE_REGW(hw
, REG_CMBDISDMA_TIMER
, hw
->ict
);
1137 AT_WRITE_REG(hw
, REG_MTU
, hw
->max_frame_size
+ ETH_HLEN
+
1138 VLAN_HLEN
+ ETH_FCS_LEN
);
1140 /* 9. config TXQ early tx threshold */
1141 atl1e_configure_tx(adapter
);
1143 /* 10. config RXQ */
1144 atl1e_configure_rx(adapter
);
1146 /* 11. config DMA Engine */
1147 atl1e_configure_dma(adapter
);
1149 /* 12. smb timer to trig interrupt */
1150 AT_WRITE_REG(hw
, REG_SMB_STAT_TIMER
, hw
->smb_timer
);
1152 intr_status_data
= AT_READ_REG(hw
, REG_ISR
);
1153 if (unlikely((intr_status_data
& ISR_PHY_LINKDOWN
) != 0)) {
1154 netdev_err(adapter
->netdev
,
1155 "atl1e_configure failed, PCIE phy link down\n");
1159 AT_WRITE_REG(hw
, REG_ISR
, 0x7fffffff);
1164 * atl1e_get_stats - Get System Network Statistics
1165 * @netdev: network interface device structure
1167 * Returns the address of the device statistics structure.
1168 * The statistics are actually updated from the timer callback.
1170 static struct net_device_stats
*atl1e_get_stats(struct net_device
*netdev
)
1172 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
1173 struct atl1e_hw_stats
*hw_stats
= &adapter
->hw_stats
;
1174 struct net_device_stats
*net_stats
= &netdev
->stats
;
1176 net_stats
->rx_bytes
= hw_stats
->rx_byte_cnt
;
1177 net_stats
->tx_bytes
= hw_stats
->tx_byte_cnt
;
1178 net_stats
->multicast
= hw_stats
->rx_mcast
;
1179 net_stats
->collisions
= hw_stats
->tx_1_col
+
1180 hw_stats
->tx_2_col
+
1181 hw_stats
->tx_late_col
+
1182 hw_stats
->tx_abort_col
;
1184 net_stats
->rx_errors
= hw_stats
->rx_frag
+
1185 hw_stats
->rx_fcs_err
+
1186 hw_stats
->rx_len_err
+
1187 hw_stats
->rx_sz_ov
+
1188 hw_stats
->rx_rrd_ov
+
1189 hw_stats
->rx_align_err
+
1190 hw_stats
->rx_rxf_ov
;
1192 net_stats
->rx_fifo_errors
= hw_stats
->rx_rxf_ov
;
1193 net_stats
->rx_length_errors
= hw_stats
->rx_len_err
;
1194 net_stats
->rx_crc_errors
= hw_stats
->rx_fcs_err
;
1195 net_stats
->rx_frame_errors
= hw_stats
->rx_align_err
;
1196 net_stats
->rx_dropped
= hw_stats
->rx_rrd_ov
;
1198 net_stats
->tx_errors
= hw_stats
->tx_late_col
+
1199 hw_stats
->tx_abort_col
+
1200 hw_stats
->tx_underrun
+
1203 net_stats
->tx_fifo_errors
= hw_stats
->tx_underrun
;
1204 net_stats
->tx_aborted_errors
= hw_stats
->tx_abort_col
;
1205 net_stats
->tx_window_errors
= hw_stats
->tx_late_col
;
1207 net_stats
->rx_packets
= hw_stats
->rx_ok
+ net_stats
->rx_errors
;
1208 net_stats
->tx_packets
= hw_stats
->tx_ok
+ net_stats
->tx_errors
;
1213 static void atl1e_update_hw_stats(struct atl1e_adapter
*adapter
)
1215 u16 hw_reg_addr
= 0;
1216 unsigned long *stats_item
= NULL
;
1218 /* update rx status */
1219 hw_reg_addr
= REG_MAC_RX_STATUS_BIN
;
1220 stats_item
= &adapter
->hw_stats
.rx_ok
;
1221 while (hw_reg_addr
<= REG_MAC_RX_STATUS_END
) {
1222 *stats_item
+= AT_READ_REG(&adapter
->hw
, hw_reg_addr
);
1226 /* update tx status */
1227 hw_reg_addr
= REG_MAC_TX_STATUS_BIN
;
1228 stats_item
= &adapter
->hw_stats
.tx_ok
;
1229 while (hw_reg_addr
<= REG_MAC_TX_STATUS_END
) {
1230 *stats_item
+= AT_READ_REG(&adapter
->hw
, hw_reg_addr
);
1236 static inline void atl1e_clear_phy_int(struct atl1e_adapter
*adapter
)
1240 spin_lock(&adapter
->mdio_lock
);
1241 atl1e_read_phy_reg(&adapter
->hw
, MII_INT_STATUS
, &phy_data
);
1242 spin_unlock(&adapter
->mdio_lock
);
1245 static bool atl1e_clean_tx_irq(struct atl1e_adapter
*adapter
)
1247 struct atl1e_tx_ring
*tx_ring
= &adapter
->tx_ring
;
1248 struct atl1e_tx_buffer
*tx_buffer
= NULL
;
1249 u16 hw_next_to_clean
= AT_READ_REGW(&adapter
->hw
, REG_TPD_CONS_IDX
);
1250 u16 next_to_clean
= atomic_read(&tx_ring
->next_to_clean
);
1252 while (next_to_clean
!= hw_next_to_clean
) {
1253 tx_buffer
= &tx_ring
->tx_buffer
[next_to_clean
];
1254 if (tx_buffer
->dma
) {
1255 if (tx_buffer
->flags
& ATL1E_TX_PCIMAP_SINGLE
)
1256 pci_unmap_single(adapter
->pdev
, tx_buffer
->dma
,
1257 tx_buffer
->length
, PCI_DMA_TODEVICE
);
1258 else if (tx_buffer
->flags
& ATL1E_TX_PCIMAP_PAGE
)
1259 pci_unmap_page(adapter
->pdev
, tx_buffer
->dma
,
1260 tx_buffer
->length
, PCI_DMA_TODEVICE
);
1264 if (tx_buffer
->skb
) {
1265 dev_kfree_skb_irq(tx_buffer
->skb
);
1266 tx_buffer
->skb
= NULL
;
1269 if (++next_to_clean
== tx_ring
->count
)
1273 atomic_set(&tx_ring
->next_to_clean
, next_to_clean
);
1275 if (netif_queue_stopped(adapter
->netdev
) &&
1276 netif_carrier_ok(adapter
->netdev
)) {
1277 netif_wake_queue(adapter
->netdev
);
1284 * atl1e_intr - Interrupt Handler
1285 * @irq: interrupt number
1286 * @data: pointer to a network interface device structure
1288 static irqreturn_t
atl1e_intr(int irq
, void *data
)
1290 struct net_device
*netdev
= data
;
1291 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
1292 struct atl1e_hw
*hw
= &adapter
->hw
;
1293 int max_ints
= AT_MAX_INT_WORK
;
1294 int handled
= IRQ_NONE
;
1298 status
= AT_READ_REG(hw
, REG_ISR
);
1299 if ((status
& IMR_NORMAL_MASK
) == 0 ||
1300 (status
& ISR_DIS_INT
) != 0) {
1301 if (max_ints
!= AT_MAX_INT_WORK
)
1302 handled
= IRQ_HANDLED
;
1306 if (status
& ISR_GPHY
)
1307 atl1e_clear_phy_int(adapter
);
1309 AT_WRITE_REG(hw
, REG_ISR
, status
| ISR_DIS_INT
);
1311 handled
= IRQ_HANDLED
;
1312 /* check if PCIE PHY Link down */
1313 if (status
& ISR_PHY_LINKDOWN
) {
1314 netdev_err(adapter
->netdev
,
1315 "pcie phy linkdown %x\n", status
);
1316 if (netif_running(adapter
->netdev
)) {
1318 atl1e_irq_reset(adapter
);
1319 schedule_work(&adapter
->reset_task
);
1324 /* check if DMA read/write error */
1325 if (status
& (ISR_DMAR_TO_RST
| ISR_DMAW_TO_RST
)) {
1326 netdev_err(adapter
->netdev
,
1327 "PCIE DMA RW error (status = 0x%x)\n",
1329 atl1e_irq_reset(adapter
);
1330 schedule_work(&adapter
->reset_task
);
1334 if (status
& ISR_SMB
)
1335 atl1e_update_hw_stats(adapter
);
1338 if (status
& (ISR_GPHY
| ISR_MANUAL
)) {
1339 netdev
->stats
.tx_carrier_errors
++;
1340 atl1e_link_chg_event(adapter
);
1344 /* transmit event */
1345 if (status
& ISR_TX_EVENT
)
1346 atl1e_clean_tx_irq(adapter
);
1348 if (status
& ISR_RX_EVENT
) {
1350 * disable rx interrupts, without
1351 * the synchronize_irq bit
1353 AT_WRITE_REG(hw
, REG_IMR
,
1354 IMR_NORMAL_MASK
& ~ISR_RX_EVENT
);
1356 if (likely(napi_schedule_prep(
1358 __napi_schedule(&adapter
->napi
);
1360 } while (--max_ints
> 0);
1361 /* re-enable Interrupt*/
1362 AT_WRITE_REG(&adapter
->hw
, REG_ISR
, 0);
1367 static inline void atl1e_rx_checksum(struct atl1e_adapter
*adapter
,
1368 struct sk_buff
*skb
, struct atl1e_recv_ret_status
*prrs
)
1370 u8
*packet
= (u8
*)(prrs
+ 1);
1372 u16 head_len
= ETH_HLEN
;
1376 skb_checksum_none_assert(skb
);
1377 pkt_flags
= prrs
->pkt_flag
;
1378 err_flags
= prrs
->err_flag
;
1379 if (((pkt_flags
& RRS_IS_IPV4
) || (pkt_flags
& RRS_IS_IPV6
)) &&
1380 ((pkt_flags
& RRS_IS_TCP
) || (pkt_flags
& RRS_IS_UDP
))) {
1381 if (pkt_flags
& RRS_IS_IPV4
) {
1382 if (pkt_flags
& RRS_IS_802_3
)
1384 iph
= (struct iphdr
*) (packet
+ head_len
);
1385 if (iph
->frag_off
!= 0 && !(pkt_flags
& RRS_IS_IP_DF
))
1388 if (!(err_flags
& (RRS_ERR_IP_CSUM
| RRS_ERR_L4_CSUM
))) {
1389 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
1398 static struct atl1e_rx_page
*atl1e_get_rx_page(struct atl1e_adapter
*adapter
,
1401 struct atl1e_rx_page_desc
*rx_page_desc
=
1402 (struct atl1e_rx_page_desc
*) adapter
->rx_ring
.rx_page_desc
;
1403 u8 rx_using
= rx_page_desc
[que
].rx_using
;
1405 return &(rx_page_desc
[que
].rx_page
[rx_using
]);
1408 static void atl1e_clean_rx_irq(struct atl1e_adapter
*adapter
, u8 que
,
1409 int *work_done
, int work_to_do
)
1411 struct net_device
*netdev
= adapter
->netdev
;
1412 struct atl1e_rx_ring
*rx_ring
= &adapter
->rx_ring
;
1413 struct atl1e_rx_page_desc
*rx_page_desc
=
1414 (struct atl1e_rx_page_desc
*) rx_ring
->rx_page_desc
;
1415 struct sk_buff
*skb
= NULL
;
1416 struct atl1e_rx_page
*rx_page
= atl1e_get_rx_page(adapter
, que
);
1417 u32 packet_size
, write_offset
;
1418 struct atl1e_recv_ret_status
*prrs
;
1420 write_offset
= *(rx_page
->write_offset_addr
);
1421 if (likely(rx_page
->read_offset
< write_offset
)) {
1423 if (*work_done
>= work_to_do
)
1426 /* get new packet's rrs */
1427 prrs
= (struct atl1e_recv_ret_status
*) (rx_page
->addr
+
1428 rx_page
->read_offset
);
1429 /* check sequence number */
1430 if (prrs
->seq_num
!= rx_page_desc
[que
].rx_nxseq
) {
1432 "rx sequence number error (rx=%d) (expect=%d)\n",
1434 rx_page_desc
[que
].rx_nxseq
);
1435 rx_page_desc
[que
].rx_nxseq
++;
1436 /* just for debug use */
1437 AT_WRITE_REG(&adapter
->hw
, REG_DEBUG_DATA0
,
1438 (((u32
)prrs
->seq_num
) << 16) |
1439 rx_page_desc
[que
].rx_nxseq
);
1442 rx_page_desc
[que
].rx_nxseq
++;
1445 if ((prrs
->pkt_flag
& RRS_IS_ERR_FRAME
) &&
1446 !(netdev
->features
& NETIF_F_RXALL
)) {
1447 if (prrs
->err_flag
& (RRS_ERR_BAD_CRC
|
1448 RRS_ERR_DRIBBLE
| RRS_ERR_CODE
|
1450 /* hardware error, discard this packet*/
1452 "rx packet desc error %x\n",
1453 *((u32
*)prrs
+ 1));
1458 packet_size
= ((prrs
->word1
>> RRS_PKT_SIZE_SHIFT
) &
1460 if (likely(!(netdev
->features
& NETIF_F_RXFCS
)))
1461 packet_size
-= 4; /* CRC */
1463 skb
= netdev_alloc_skb_ip_align(netdev
, packet_size
);
1467 memcpy(skb
->data
, (u8
*)(prrs
+ 1), packet_size
);
1468 skb_put(skb
, packet_size
);
1469 skb
->protocol
= eth_type_trans(skb
, netdev
);
1470 atl1e_rx_checksum(adapter
, skb
, prrs
);
1472 if (prrs
->pkt_flag
& RRS_IS_VLAN_TAG
) {
1473 u16 vlan_tag
= (prrs
->vtag
>> 4) |
1474 ((prrs
->vtag
& 7) << 13) |
1475 ((prrs
->vtag
& 8) << 9);
1477 "RXD VLAN TAG<RRD>=0x%04x\n",
1479 __vlan_hwaccel_put_tag(skb
, htons(ETH_P_8021Q
), vlan_tag
);
1481 netif_receive_skb(skb
);
1484 /* skip current packet whether it's ok or not. */
1485 rx_page
->read_offset
+=
1486 (((u32
)((prrs
->word1
>> RRS_PKT_SIZE_SHIFT
) &
1487 RRS_PKT_SIZE_MASK
) +
1488 sizeof(struct atl1e_recv_ret_status
) + 31) &
1491 if (rx_page
->read_offset
>= rx_ring
->page_size
) {
1492 /* mark this page clean */
1496 rx_page
->read_offset
=
1497 *(rx_page
->write_offset_addr
) = 0;
1498 rx_using
= rx_page_desc
[que
].rx_using
;
1500 atl1e_rx_page_vld_regs
[que
][rx_using
];
1501 AT_WRITE_REGB(&adapter
->hw
, reg_addr
, 1);
1502 rx_page_desc
[que
].rx_using
^= 1;
1503 rx_page
= atl1e_get_rx_page(adapter
, que
);
1505 write_offset
= *(rx_page
->write_offset_addr
);
1506 } while (rx_page
->read_offset
< write_offset
);
1512 if (!test_bit(__AT_DOWN
, &adapter
->flags
))
1513 schedule_work(&adapter
->reset_task
);
1517 * atl1e_clean - NAPI Rx polling callback
1519 static int atl1e_clean(struct napi_struct
*napi
, int budget
)
1521 struct atl1e_adapter
*adapter
=
1522 container_of(napi
, struct atl1e_adapter
, napi
);
1526 /* Keep link state information with original netdev */
1527 if (!netif_carrier_ok(adapter
->netdev
))
1530 atl1e_clean_rx_irq(adapter
, 0, &work_done
, budget
);
1532 /* If no Tx and not enough Rx work done, exit the polling mode */
1533 if (work_done
< budget
) {
1535 napi_complete(napi
);
1536 imr_data
= AT_READ_REG(&adapter
->hw
, REG_IMR
);
1537 AT_WRITE_REG(&adapter
->hw
, REG_IMR
, imr_data
| ISR_RX_EVENT
);
1539 if (test_bit(__AT_DOWN
, &adapter
->flags
)) {
1540 atomic_dec(&adapter
->irq_sem
);
1541 netdev_err(adapter
->netdev
,
1542 "atl1e_clean is called when AT_DOWN\n");
1544 /* reenable RX intr */
1545 /*atl1e_irq_enable(adapter); */
1551 #ifdef CONFIG_NET_POLL_CONTROLLER
1554 * Polling 'interrupt' - used by things like netconsole to send skbs
1555 * without having to re-enable interrupts. It's not called while
1556 * the interrupt routine is executing.
1558 static void atl1e_netpoll(struct net_device
*netdev
)
1560 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
1562 disable_irq(adapter
->pdev
->irq
);
1563 atl1e_intr(adapter
->pdev
->irq
, netdev
);
1564 enable_irq(adapter
->pdev
->irq
);
1568 static inline u16
atl1e_tpd_avail(struct atl1e_adapter
*adapter
)
1570 struct atl1e_tx_ring
*tx_ring
= &adapter
->tx_ring
;
1571 u16 next_to_use
= 0;
1572 u16 next_to_clean
= 0;
1574 next_to_clean
= atomic_read(&tx_ring
->next_to_clean
);
1575 next_to_use
= tx_ring
->next_to_use
;
1577 return (u16
)(next_to_clean
> next_to_use
) ?
1578 (next_to_clean
- next_to_use
- 1) :
1579 (tx_ring
->count
+ next_to_clean
- next_to_use
- 1);
1583 * get next usable tpd
1584 * Note: should call atl1e_tdp_avail to make sure
1585 * there is enough tpd to use
1587 static struct atl1e_tpd_desc
*atl1e_get_tpd(struct atl1e_adapter
*adapter
)
1589 struct atl1e_tx_ring
*tx_ring
= &adapter
->tx_ring
;
1590 u16 next_to_use
= 0;
1592 next_to_use
= tx_ring
->next_to_use
;
1593 if (++tx_ring
->next_to_use
== tx_ring
->count
)
1594 tx_ring
->next_to_use
= 0;
1596 memset(&tx_ring
->desc
[next_to_use
], 0, sizeof(struct atl1e_tpd_desc
));
1597 return &tx_ring
->desc
[next_to_use
];
1600 static struct atl1e_tx_buffer
*
1601 atl1e_get_tx_buffer(struct atl1e_adapter
*adapter
, struct atl1e_tpd_desc
*tpd
)
1603 struct atl1e_tx_ring
*tx_ring
= &adapter
->tx_ring
;
1605 return &tx_ring
->tx_buffer
[tpd
- tx_ring
->desc
];
1608 /* Calculate the transmit packet descript needed*/
1609 static u16
atl1e_cal_tdp_req(const struct sk_buff
*skb
)
1614 u16 proto_hdr_len
= 0;
1616 for (i
= 0; i
< skb_shinfo(skb
)->nr_frags
; i
++) {
1617 fg_size
= skb_frag_size(&skb_shinfo(skb
)->frags
[i
]);
1618 tpd_req
+= ((fg_size
+ MAX_TX_BUF_LEN
- 1) >> MAX_TX_BUF_SHIFT
);
1621 if (skb_is_gso(skb
)) {
1622 if (skb
->protocol
== htons(ETH_P_IP
) ||
1623 (skb_shinfo(skb
)->gso_type
== SKB_GSO_TCPV6
)) {
1624 proto_hdr_len
= skb_transport_offset(skb
) +
1626 if (proto_hdr_len
< skb_headlen(skb
)) {
1627 tpd_req
+= ((skb_headlen(skb
) - proto_hdr_len
+
1628 MAX_TX_BUF_LEN
- 1) >>
1637 static int atl1e_tso_csum(struct atl1e_adapter
*adapter
,
1638 struct sk_buff
*skb
, struct atl1e_tpd_desc
*tpd
)
1640 unsigned short offload_type
;
1644 if (skb_is_gso(skb
)) {
1647 err
= skb_cow_head(skb
, 0);
1651 offload_type
= skb_shinfo(skb
)->gso_type
;
1653 if (offload_type
& SKB_GSO_TCPV4
) {
1654 real_len
= (((unsigned char *)ip_hdr(skb
) - skb
->data
)
1655 + ntohs(ip_hdr(skb
)->tot_len
));
1657 if (real_len
< skb
->len
)
1658 pskb_trim(skb
, real_len
);
1660 hdr_len
= (skb_transport_offset(skb
) + tcp_hdrlen(skb
));
1661 if (unlikely(skb
->len
== hdr_len
)) {
1662 /* only xsum need */
1663 netdev_warn(adapter
->netdev
,
1664 "IPV4 tso with zero data??\n");
1667 ip_hdr(skb
)->check
= 0;
1668 ip_hdr(skb
)->tot_len
= 0;
1669 tcp_hdr(skb
)->check
= ~csum_tcpudp_magic(
1673 tpd
->word3
|= (ip_hdr(skb
)->ihl
&
1674 TDP_V4_IPHL_MASK
) <<
1676 tpd
->word3
|= ((tcp_hdrlen(skb
) >> 2) &
1677 TPD_TCPHDRLEN_MASK
) <<
1678 TPD_TCPHDRLEN_SHIFT
;
1679 tpd
->word3
|= ((skb_shinfo(skb
)->gso_size
) &
1680 TPD_MSS_MASK
) << TPD_MSS_SHIFT
;
1681 tpd
->word3
|= 1 << TPD_SEGMENT_EN_SHIFT
;
1688 if (likely(skb
->ip_summed
== CHECKSUM_PARTIAL
)) {
1691 cso
= skb_checksum_start_offset(skb
);
1692 if (unlikely(cso
& 0x1)) {
1693 netdev_err(adapter
->netdev
,
1694 "payload offset should not ant event number\n");
1697 css
= cso
+ skb
->csum_offset
;
1698 tpd
->word3
|= (cso
& TPD_PLOADOFFSET_MASK
) <<
1699 TPD_PLOADOFFSET_SHIFT
;
1700 tpd
->word3
|= (css
& TPD_CCSUMOFFSET_MASK
) <<
1701 TPD_CCSUMOFFSET_SHIFT
;
1702 tpd
->word3
|= 1 << TPD_CC_SEGMENT_EN_SHIFT
;
1709 static int atl1e_tx_map(struct atl1e_adapter
*adapter
,
1710 struct sk_buff
*skb
, struct atl1e_tpd_desc
*tpd
)
1712 struct atl1e_tpd_desc
*use_tpd
= NULL
;
1713 struct atl1e_tx_buffer
*tx_buffer
= NULL
;
1714 u16 buf_len
= skb_headlen(skb
);
1721 int ring_start
= adapter
->tx_ring
.next_to_use
;
1724 nr_frags
= skb_shinfo(skb
)->nr_frags
;
1725 segment
= (tpd
->word3
>> TPD_SEGMENT_EN_SHIFT
) & TPD_SEGMENT_EN_MASK
;
1728 map_len
= hdr_len
= skb_transport_offset(skb
) + tcp_hdrlen(skb
);
1731 tx_buffer
= atl1e_get_tx_buffer(adapter
, use_tpd
);
1732 tx_buffer
->length
= map_len
;
1733 tx_buffer
->dma
= pci_map_single(adapter
->pdev
,
1734 skb
->data
, hdr_len
, PCI_DMA_TODEVICE
);
1735 if (dma_mapping_error(&adapter
->pdev
->dev
, tx_buffer
->dma
))
1738 ATL1E_SET_PCIMAP_TYPE(tx_buffer
, ATL1E_TX_PCIMAP_SINGLE
);
1739 mapped_len
+= map_len
;
1740 use_tpd
->buffer_addr
= cpu_to_le64(tx_buffer
->dma
);
1741 use_tpd
->word2
= (use_tpd
->word2
& (~TPD_BUFLEN_MASK
)) |
1742 ((cpu_to_le32(tx_buffer
->length
) &
1743 TPD_BUFLEN_MASK
) << TPD_BUFLEN_SHIFT
);
1746 while (mapped_len
< buf_len
) {
1747 /* mapped_len == 0, means we should use the first tpd,
1748 which is given by caller */
1749 if (mapped_len
== 0) {
1752 use_tpd
= atl1e_get_tpd(adapter
);
1753 memcpy(use_tpd
, tpd
, sizeof(struct atl1e_tpd_desc
));
1755 tx_buffer
= atl1e_get_tx_buffer(adapter
, use_tpd
);
1756 tx_buffer
->skb
= NULL
;
1758 tx_buffer
->length
= map_len
=
1759 ((buf_len
- mapped_len
) >= MAX_TX_BUF_LEN
) ?
1760 MAX_TX_BUF_LEN
: (buf_len
- mapped_len
);
1762 pci_map_single(adapter
->pdev
, skb
->data
+ mapped_len
,
1763 map_len
, PCI_DMA_TODEVICE
);
1765 if (dma_mapping_error(&adapter
->pdev
->dev
, tx_buffer
->dma
)) {
1766 /* We need to unwind the mappings we've done */
1767 ring_end
= adapter
->tx_ring
.next_to_use
;
1768 adapter
->tx_ring
.next_to_use
= ring_start
;
1769 while (adapter
->tx_ring
.next_to_use
!= ring_end
) {
1770 tpd
= atl1e_get_tpd(adapter
);
1771 tx_buffer
= atl1e_get_tx_buffer(adapter
, tpd
);
1772 pci_unmap_single(adapter
->pdev
, tx_buffer
->dma
,
1773 tx_buffer
->length
, PCI_DMA_TODEVICE
);
1775 /* Reset the tx rings next pointer */
1776 adapter
->tx_ring
.next_to_use
= ring_start
;
1780 ATL1E_SET_PCIMAP_TYPE(tx_buffer
, ATL1E_TX_PCIMAP_SINGLE
);
1781 mapped_len
+= map_len
;
1782 use_tpd
->buffer_addr
= cpu_to_le64(tx_buffer
->dma
);
1783 use_tpd
->word2
= (use_tpd
->word2
& (~TPD_BUFLEN_MASK
)) |
1784 ((cpu_to_le32(tx_buffer
->length
) &
1785 TPD_BUFLEN_MASK
) << TPD_BUFLEN_SHIFT
);
1788 for (f
= 0; f
< nr_frags
; f
++) {
1789 const struct skb_frag_struct
*frag
;
1793 frag
= &skb_shinfo(skb
)->frags
[f
];
1794 buf_len
= skb_frag_size(frag
);
1796 seg_num
= (buf_len
+ MAX_TX_BUF_LEN
- 1) / MAX_TX_BUF_LEN
;
1797 for (i
= 0; i
< seg_num
; i
++) {
1798 use_tpd
= atl1e_get_tpd(adapter
);
1799 memcpy(use_tpd
, tpd
, sizeof(struct atl1e_tpd_desc
));
1801 tx_buffer
= atl1e_get_tx_buffer(adapter
, use_tpd
);
1802 BUG_ON(tx_buffer
->skb
);
1804 tx_buffer
->skb
= NULL
;
1806 (buf_len
> MAX_TX_BUF_LEN
) ?
1807 MAX_TX_BUF_LEN
: buf_len
;
1808 buf_len
-= tx_buffer
->length
;
1810 tx_buffer
->dma
= skb_frag_dma_map(&adapter
->pdev
->dev
,
1812 (i
* MAX_TX_BUF_LEN
),
1816 if (dma_mapping_error(&adapter
->pdev
->dev
, tx_buffer
->dma
)) {
1817 /* We need to unwind the mappings we've done */
1818 ring_end
= adapter
->tx_ring
.next_to_use
;
1819 adapter
->tx_ring
.next_to_use
= ring_start
;
1820 while (adapter
->tx_ring
.next_to_use
!= ring_end
) {
1821 tpd
= atl1e_get_tpd(adapter
);
1822 tx_buffer
= atl1e_get_tx_buffer(adapter
, tpd
);
1823 dma_unmap_page(&adapter
->pdev
->dev
, tx_buffer
->dma
,
1824 tx_buffer
->length
, DMA_TO_DEVICE
);
1827 /* Reset the ring next to use pointer */
1828 adapter
->tx_ring
.next_to_use
= ring_start
;
1832 ATL1E_SET_PCIMAP_TYPE(tx_buffer
, ATL1E_TX_PCIMAP_PAGE
);
1833 use_tpd
->buffer_addr
= cpu_to_le64(tx_buffer
->dma
);
1834 use_tpd
->word2
= (use_tpd
->word2
& (~TPD_BUFLEN_MASK
)) |
1835 ((cpu_to_le32(tx_buffer
->length
) &
1836 TPD_BUFLEN_MASK
) << TPD_BUFLEN_SHIFT
);
1840 if ((tpd
->word3
>> TPD_SEGMENT_EN_SHIFT
) & TPD_SEGMENT_EN_MASK
)
1841 /* note this one is a tcp header */
1842 tpd
->word3
|= 1 << TPD_HDRFLAG_SHIFT
;
1845 use_tpd
->word3
|= 1 << TPD_EOP_SHIFT
;
1846 /* The last buffer info contain the skb address,
1847 so it will be free after unmap */
1848 tx_buffer
->skb
= skb
;
1852 static void atl1e_tx_queue(struct atl1e_adapter
*adapter
, u16 count
,
1853 struct atl1e_tpd_desc
*tpd
)
1855 struct atl1e_tx_ring
*tx_ring
= &adapter
->tx_ring
;
1856 /* Force memory writes to complete before letting h/w
1857 * know there are new descriptors to fetch. (Only
1858 * applicable for weak-ordered memory model archs,
1859 * such as IA-64). */
1861 AT_WRITE_REG(&adapter
->hw
, REG_MB_TPD_PROD_IDX
, tx_ring
->next_to_use
);
1864 static netdev_tx_t
atl1e_xmit_frame(struct sk_buff
*skb
,
1865 struct net_device
*netdev
)
1867 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
1869 struct atl1e_tpd_desc
*tpd
;
1871 if (test_bit(__AT_DOWN
, &adapter
->flags
)) {
1872 dev_kfree_skb_any(skb
);
1873 return NETDEV_TX_OK
;
1876 if (unlikely(skb
->len
<= 0)) {
1877 dev_kfree_skb_any(skb
);
1878 return NETDEV_TX_OK
;
1880 tpd_req
= atl1e_cal_tdp_req(skb
);
1882 if (atl1e_tpd_avail(adapter
) < tpd_req
) {
1883 /* no enough descriptor, just stop queue */
1884 netif_stop_queue(netdev
);
1885 return NETDEV_TX_BUSY
;
1888 tpd
= atl1e_get_tpd(adapter
);
1890 if (skb_vlan_tag_present(skb
)) {
1891 u16 vlan_tag
= skb_vlan_tag_get(skb
);
1894 tpd
->word3
|= 1 << TPD_INS_VL_TAG_SHIFT
;
1895 AT_VLAN_TAG_TO_TPD_TAG(vlan_tag
, atl1e_vlan_tag
);
1896 tpd
->word2
|= (atl1e_vlan_tag
& TPD_VLANTAG_MASK
) <<
1900 if (skb
->protocol
== htons(ETH_P_8021Q
))
1901 tpd
->word3
|= 1 << TPD_VL_TAGGED_SHIFT
;
1903 if (skb_network_offset(skb
) != ETH_HLEN
)
1904 tpd
->word3
|= 1 << TPD_ETHTYPE_SHIFT
; /* 802.3 frame */
1906 /* do TSO and check sum */
1907 if (atl1e_tso_csum(adapter
, skb
, tpd
) != 0) {
1908 dev_kfree_skb_any(skb
);
1909 return NETDEV_TX_OK
;
1912 if (atl1e_tx_map(adapter
, skb
, tpd
)) {
1913 dev_kfree_skb_any(skb
);
1917 atl1e_tx_queue(adapter
, tpd_req
, tpd
);
1919 return NETDEV_TX_OK
;
1922 static void atl1e_free_irq(struct atl1e_adapter
*adapter
)
1924 struct net_device
*netdev
= adapter
->netdev
;
1926 free_irq(adapter
->pdev
->irq
, netdev
);
1929 static int atl1e_request_irq(struct atl1e_adapter
*adapter
)
1931 struct pci_dev
*pdev
= adapter
->pdev
;
1932 struct net_device
*netdev
= adapter
->netdev
;
1935 err
= request_irq(pdev
->irq
, atl1e_intr
, IRQF_SHARED
, netdev
->name
,
1938 netdev_dbg(adapter
->netdev
,
1939 "Unable to allocate interrupt Error: %d\n", err
);
1942 netdev_dbg(netdev
, "atl1e_request_irq OK\n");
1946 int atl1e_up(struct atl1e_adapter
*adapter
)
1948 struct net_device
*netdev
= adapter
->netdev
;
1952 /* hardware has been reset, we need to reload some things */
1953 err
= atl1e_init_hw(&adapter
->hw
);
1958 atl1e_init_ring_ptrs(adapter
);
1959 atl1e_set_multi(netdev
);
1960 atl1e_restore_vlan(adapter
);
1962 if (atl1e_configure(adapter
)) {
1967 clear_bit(__AT_DOWN
, &adapter
->flags
);
1968 napi_enable(&adapter
->napi
);
1969 atl1e_irq_enable(adapter
);
1970 val
= AT_READ_REG(&adapter
->hw
, REG_MASTER_CTRL
);
1971 AT_WRITE_REG(&adapter
->hw
, REG_MASTER_CTRL
,
1972 val
| MASTER_CTRL_MANUAL_INT
);
1978 void atl1e_down(struct atl1e_adapter
*adapter
)
1980 struct net_device
*netdev
= adapter
->netdev
;
1982 /* signal that we're down so the interrupt handler does not
1983 * reschedule our watchdog timer */
1984 set_bit(__AT_DOWN
, &adapter
->flags
);
1986 netif_stop_queue(netdev
);
1988 /* reset MAC to disable all RX/TX */
1989 atl1e_reset_hw(&adapter
->hw
);
1992 napi_disable(&adapter
->napi
);
1993 atl1e_del_timer(adapter
);
1994 atl1e_irq_disable(adapter
);
1996 netif_carrier_off(netdev
);
1997 adapter
->link_speed
= SPEED_0
;
1998 adapter
->link_duplex
= -1;
1999 atl1e_clean_tx_ring(adapter
);
2000 atl1e_clean_rx_ring(adapter
);
2004 * atl1e_open - Called when a network interface is made active
2005 * @netdev: network interface device structure
2007 * Returns 0 on success, negative value on failure
2009 * The open entry point is called when a network interface is made
2010 * active by the system (IFF_UP). At this point all resources needed
2011 * for transmit and receive operations are allocated, the interrupt
2012 * handler is registered with the OS, the watchdog timer is started,
2013 * and the stack is notified that the interface is ready.
2015 static int atl1e_open(struct net_device
*netdev
)
2017 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
2020 /* disallow open during test */
2021 if (test_bit(__AT_TESTING
, &adapter
->flags
))
2024 /* allocate rx/tx dma buffer & descriptors */
2025 atl1e_init_ring_resources(adapter
);
2026 err
= atl1e_setup_ring_resources(adapter
);
2030 err
= atl1e_request_irq(adapter
);
2034 err
= atl1e_up(adapter
);
2041 atl1e_free_irq(adapter
);
2043 atl1e_free_ring_resources(adapter
);
2044 atl1e_reset_hw(&adapter
->hw
);
2050 * atl1e_close - Disables a network interface
2051 * @netdev: network interface device structure
2053 * Returns 0, this is not allowed to fail
2055 * The close entry point is called when an interface is de-activated
2056 * by the OS. The hardware is still under the drivers control, but
2057 * needs to be disabled. A global MAC reset is issued to stop the
2058 * hardware, and all transmit and receive resources are freed.
2060 static int atl1e_close(struct net_device
*netdev
)
2062 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
2064 WARN_ON(test_bit(__AT_RESETTING
, &adapter
->flags
));
2065 atl1e_down(adapter
);
2066 atl1e_free_irq(adapter
);
2067 atl1e_free_ring_resources(adapter
);
2072 static int atl1e_suspend(struct pci_dev
*pdev
, pm_message_t state
)
2074 struct net_device
*netdev
= pci_get_drvdata(pdev
);
2075 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
2076 struct atl1e_hw
*hw
= &adapter
->hw
;
2078 u32 mac_ctrl_data
= 0;
2079 u32 wol_ctrl_data
= 0;
2080 u16 mii_advertise_data
= 0;
2081 u16 mii_bmsr_data
= 0;
2082 u16 mii_intr_status_data
= 0;
2083 u32 wufc
= adapter
->wol
;
2089 if (netif_running(netdev
)) {
2090 WARN_ON(test_bit(__AT_RESETTING
, &adapter
->flags
));
2091 atl1e_down(adapter
);
2093 netif_device_detach(netdev
);
2096 retval
= pci_save_state(pdev
);
2102 /* get link status */
2103 atl1e_read_phy_reg(hw
, MII_BMSR
, &mii_bmsr_data
);
2104 atl1e_read_phy_reg(hw
, MII_BMSR
, &mii_bmsr_data
);
2106 mii_advertise_data
= ADVERTISE_10HALF
;
2108 if ((atl1e_write_phy_reg(hw
, MII_CTRL1000
, 0) != 0) ||
2109 (atl1e_write_phy_reg(hw
,
2110 MII_ADVERTISE
, mii_advertise_data
) != 0) ||
2111 (atl1e_phy_commit(hw
)) != 0) {
2112 netdev_dbg(adapter
->netdev
, "set phy register failed\n");
2116 hw
->phy_configured
= false; /* re-init PHY when resume */
2118 /* turn on magic packet wol */
2119 if (wufc
& AT_WUFC_MAG
)
2120 wol_ctrl_data
|= WOL_MAGIC_EN
| WOL_MAGIC_PME_EN
;
2122 if (wufc
& AT_WUFC_LNKC
) {
2123 /* if orignal link status is link, just wait for retrive link */
2124 if (mii_bmsr_data
& BMSR_LSTATUS
) {
2125 for (i
= 0; i
< AT_SUSPEND_LINK_TIMEOUT
; i
++) {
2127 atl1e_read_phy_reg(hw
, MII_BMSR
,
2129 if (mii_bmsr_data
& BMSR_LSTATUS
)
2133 if ((mii_bmsr_data
& BMSR_LSTATUS
) == 0)
2134 netdev_dbg(adapter
->netdev
,
2135 "Link may change when suspend\n");
2137 wol_ctrl_data
|= WOL_LINK_CHG_EN
| WOL_LINK_CHG_PME_EN
;
2138 /* only link up can wake up */
2139 if (atl1e_write_phy_reg(hw
, MII_INT_CTRL
, 0x400) != 0) {
2140 netdev_dbg(adapter
->netdev
,
2141 "read write phy register failed\n");
2145 /* clear phy interrupt */
2146 atl1e_read_phy_reg(hw
, MII_INT_STATUS
, &mii_intr_status_data
);
2147 /* Config MAC Ctrl register */
2148 mac_ctrl_data
= MAC_CTRL_RX_EN
;
2149 /* set to 10/100M halt duplex */
2150 mac_ctrl_data
|= MAC_CTRL_SPEED_10_100
<< MAC_CTRL_SPEED_SHIFT
;
2151 mac_ctrl_data
|= (((u32
)adapter
->hw
.preamble_len
&
2152 MAC_CTRL_PRMLEN_MASK
) <<
2153 MAC_CTRL_PRMLEN_SHIFT
);
2155 __atl1e_vlan_mode(netdev
->features
, &mac_ctrl_data
);
2157 /* magic packet maybe Broadcast&multicast&Unicast frame */
2158 if (wufc
& AT_WUFC_MAG
)
2159 mac_ctrl_data
|= MAC_CTRL_BC_EN
;
2161 netdev_dbg(adapter
->netdev
, "suspend MAC=0x%x\n",
2164 AT_WRITE_REG(hw
, REG_WOL_CTRL
, wol_ctrl_data
);
2165 AT_WRITE_REG(hw
, REG_MAC_CTRL
, mac_ctrl_data
);
2167 ctrl
= AT_READ_REG(hw
, REG_PCIE_PHYMISC
);
2168 ctrl
|= PCIE_PHYMISC_FORCE_RCV_DET
;
2169 AT_WRITE_REG(hw
, REG_PCIE_PHYMISC
, ctrl
);
2170 pci_enable_wake(pdev
, pci_choose_state(pdev
, state
), 1);
2176 AT_WRITE_REG(hw
, REG_WOL_CTRL
, 0);
2179 ctrl
= AT_READ_REG(hw
, REG_PCIE_PHYMISC
);
2180 ctrl
|= PCIE_PHYMISC_FORCE_RCV_DET
;
2181 AT_WRITE_REG(hw
, REG_PCIE_PHYMISC
, ctrl
);
2184 hw
->phy_configured
= false; /* re-init PHY when resume */
2186 pci_enable_wake(pdev
, pci_choose_state(pdev
, state
), 0);
2190 if (netif_running(netdev
))
2191 atl1e_free_irq(adapter
);
2193 pci_disable_device(pdev
);
2195 pci_set_power_state(pdev
, pci_choose_state(pdev
, state
));
2201 static int atl1e_resume(struct pci_dev
*pdev
)
2203 struct net_device
*netdev
= pci_get_drvdata(pdev
);
2204 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
2207 pci_set_power_state(pdev
, PCI_D0
);
2208 pci_restore_state(pdev
);
2210 err
= pci_enable_device(pdev
);
2212 netdev_err(adapter
->netdev
,
2213 "Cannot enable PCI device from suspend\n");
2217 pci_set_master(pdev
);
2219 AT_READ_REG(&adapter
->hw
, REG_WOL_CTRL
); /* clear WOL status */
2221 pci_enable_wake(pdev
, PCI_D3hot
, 0);
2222 pci_enable_wake(pdev
, PCI_D3cold
, 0);
2224 AT_WRITE_REG(&adapter
->hw
, REG_WOL_CTRL
, 0);
2226 if (netif_running(netdev
)) {
2227 err
= atl1e_request_irq(adapter
);
2232 atl1e_reset_hw(&adapter
->hw
);
2234 if (netif_running(netdev
))
2237 netif_device_attach(netdev
);
2243 static void atl1e_shutdown(struct pci_dev
*pdev
)
2245 atl1e_suspend(pdev
, PMSG_SUSPEND
);
2248 static const struct net_device_ops atl1e_netdev_ops
= {
2249 .ndo_open
= atl1e_open
,
2250 .ndo_stop
= atl1e_close
,
2251 .ndo_start_xmit
= atl1e_xmit_frame
,
2252 .ndo_get_stats
= atl1e_get_stats
,
2253 .ndo_set_rx_mode
= atl1e_set_multi
,
2254 .ndo_validate_addr
= eth_validate_addr
,
2255 .ndo_set_mac_address
= atl1e_set_mac_addr
,
2256 .ndo_fix_features
= atl1e_fix_features
,
2257 .ndo_set_features
= atl1e_set_features
,
2258 .ndo_change_mtu
= atl1e_change_mtu
,
2259 .ndo_do_ioctl
= atl1e_ioctl
,
2260 .ndo_tx_timeout
= atl1e_tx_timeout
,
2261 #ifdef CONFIG_NET_POLL_CONTROLLER
2262 .ndo_poll_controller
= atl1e_netpoll
,
2267 static int atl1e_init_netdev(struct net_device
*netdev
, struct pci_dev
*pdev
)
2269 SET_NETDEV_DEV(netdev
, &pdev
->dev
);
2270 pci_set_drvdata(pdev
, netdev
);
2272 netdev
->netdev_ops
= &atl1e_netdev_ops
;
2274 netdev
->watchdog_timeo
= AT_TX_WATCHDOG
;
2275 atl1e_set_ethtool_ops(netdev
);
2277 netdev
->hw_features
= NETIF_F_SG
| NETIF_F_HW_CSUM
| NETIF_F_TSO
|
2278 NETIF_F_HW_VLAN_CTAG_RX
;
2279 netdev
->features
= netdev
->hw_features
| NETIF_F_HW_VLAN_CTAG_TX
;
2280 /* not enabled by default */
2281 netdev
->hw_features
|= NETIF_F_RXALL
| NETIF_F_RXFCS
;
2286 * atl1e_probe - Device Initialization Routine
2287 * @pdev: PCI device information struct
2288 * @ent: entry in atl1e_pci_tbl
2290 * Returns 0 on success, negative on failure
2292 * atl1e_probe initializes an adapter identified by a pci_dev structure.
2293 * The OS initialization, configuring of the adapter private structure,
2294 * and a hardware reset occur.
2296 static int atl1e_probe(struct pci_dev
*pdev
, const struct pci_device_id
*ent
)
2298 struct net_device
*netdev
;
2299 struct atl1e_adapter
*adapter
= NULL
;
2300 static int cards_found
;
2304 err
= pci_enable_device(pdev
);
2306 dev_err(&pdev
->dev
, "cannot enable PCI device\n");
2311 * The atl1e chip can DMA to 64-bit addresses, but it uses a single
2312 * shared register for the high 32 bits, so only a single, aligned,
2313 * 4 GB physical address range can be used at a time.
2315 * Supporting 64-bit DMA on this hardware is more trouble than it's
2316 * worth. It is far easier to limit to 32-bit DMA than update
2317 * various kernel subsystems to support the mechanics required by a
2318 * fixed-high-32-bit system.
2320 if ((pci_set_dma_mask(pdev
, DMA_BIT_MASK(32)) != 0) ||
2321 (pci_set_consistent_dma_mask(pdev
, DMA_BIT_MASK(32)) != 0)) {
2322 dev_err(&pdev
->dev
, "No usable DMA configuration,aborting\n");
2326 err
= pci_request_regions(pdev
, atl1e_driver_name
);
2328 dev_err(&pdev
->dev
, "cannot obtain PCI resources\n");
2332 pci_set_master(pdev
);
2334 netdev
= alloc_etherdev(sizeof(struct atl1e_adapter
));
2335 if (netdev
== NULL
) {
2337 goto err_alloc_etherdev
;
2340 err
= atl1e_init_netdev(netdev
, pdev
);
2342 netdev_err(netdev
, "init netdevice failed\n");
2343 goto err_init_netdev
;
2345 adapter
= netdev_priv(netdev
);
2346 adapter
->bd_number
= cards_found
;
2347 adapter
->netdev
= netdev
;
2348 adapter
->pdev
= pdev
;
2349 adapter
->hw
.adapter
= adapter
;
2350 adapter
->hw
.hw_addr
= pci_iomap(pdev
, BAR_0
, 0);
2351 if (!adapter
->hw
.hw_addr
) {
2353 netdev_err(netdev
, "cannot map device registers\n");
2358 adapter
->mii
.dev
= netdev
;
2359 adapter
->mii
.mdio_read
= atl1e_mdio_read
;
2360 adapter
->mii
.mdio_write
= atl1e_mdio_write
;
2361 adapter
->mii
.phy_id_mask
= 0x1f;
2362 adapter
->mii
.reg_num_mask
= MDIO_REG_ADDR_MASK
;
2364 netif_napi_add(netdev
, &adapter
->napi
, atl1e_clean
, 64);
2366 setup_timer(&adapter
->phy_config_timer
, atl1e_phy_config
,
2367 (unsigned long)adapter
);
2369 /* get user settings */
2370 atl1e_check_options(adapter
);
2372 * Mark all PCI regions associated with PCI device
2373 * pdev as being reserved by owner atl1e_driver_name
2374 * Enables bus-mastering on the device and calls
2375 * pcibios_set_master to do the needed arch specific settings
2377 atl1e_setup_pcicmd(pdev
);
2378 /* setup the private structure */
2379 err
= atl1e_sw_init(adapter
);
2381 netdev_err(netdev
, "net device private data init failed\n");
2385 /* Init GPHY as early as possible due to power saving issue */
2386 atl1e_phy_init(&adapter
->hw
);
2387 /* reset the controller to
2388 * put the device in a known good starting state */
2389 err
= atl1e_reset_hw(&adapter
->hw
);
2395 if (atl1e_read_mac_addr(&adapter
->hw
) != 0) {
2397 netdev_err(netdev
, "get mac address failed\n");
2401 memcpy(netdev
->dev_addr
, adapter
->hw
.mac_addr
, netdev
->addr_len
);
2402 netdev_dbg(netdev
, "mac address : %pM\n", adapter
->hw
.mac_addr
);
2404 INIT_WORK(&adapter
->reset_task
, atl1e_reset_task
);
2405 INIT_WORK(&adapter
->link_chg_task
, atl1e_link_chg_task
);
2406 netif_set_gso_max_size(netdev
, MAX_TSO_SEG_SIZE
);
2407 err
= register_netdev(netdev
);
2409 netdev_err(netdev
, "register netdevice failed\n");
2413 /* assume we have no link for now */
2414 netif_stop_queue(netdev
);
2415 netif_carrier_off(netdev
);
2425 pci_iounmap(pdev
, adapter
->hw
.hw_addr
);
2428 free_netdev(netdev
);
2430 pci_release_regions(pdev
);
2433 pci_disable_device(pdev
);
2438 * atl1e_remove - Device Removal Routine
2439 * @pdev: PCI device information struct
2441 * atl1e_remove is called by the PCI subsystem to alert the driver
2442 * that it should release a PCI device. The could be caused by a
2443 * Hot-Plug event, or because the driver is going to be removed from
2446 static void atl1e_remove(struct pci_dev
*pdev
)
2448 struct net_device
*netdev
= pci_get_drvdata(pdev
);
2449 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
2452 * flush_scheduled work may reschedule our watchdog task, so
2453 * explicitly disable watchdog tasks from being rescheduled
2455 set_bit(__AT_DOWN
, &adapter
->flags
);
2457 atl1e_del_timer(adapter
);
2458 atl1e_cancel_work(adapter
);
2460 unregister_netdev(netdev
);
2461 atl1e_free_ring_resources(adapter
);
2462 atl1e_force_ps(&adapter
->hw
);
2463 pci_iounmap(pdev
, adapter
->hw
.hw_addr
);
2464 pci_release_regions(pdev
);
2465 free_netdev(netdev
);
2466 pci_disable_device(pdev
);
2470 * atl1e_io_error_detected - called when PCI error is detected
2471 * @pdev: Pointer to PCI device
2472 * @state: The current pci connection state
2474 * This function is called after a PCI bus error affecting
2475 * this device has been detected.
2477 static pci_ers_result_t
2478 atl1e_io_error_detected(struct pci_dev
*pdev
, pci_channel_state_t state
)
2480 struct net_device
*netdev
= pci_get_drvdata(pdev
);
2481 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
2483 netif_device_detach(netdev
);
2485 if (state
== pci_channel_io_perm_failure
)
2486 return PCI_ERS_RESULT_DISCONNECT
;
2488 if (netif_running(netdev
))
2489 atl1e_down(adapter
);
2491 pci_disable_device(pdev
);
2493 /* Request a slot slot reset. */
2494 return PCI_ERS_RESULT_NEED_RESET
;
2498 * atl1e_io_slot_reset - called after the pci bus has been reset.
2499 * @pdev: Pointer to PCI device
2501 * Restart the card from scratch, as if from a cold-boot. Implementation
2502 * resembles the first-half of the e1000_resume routine.
2504 static pci_ers_result_t
atl1e_io_slot_reset(struct pci_dev
*pdev
)
2506 struct net_device
*netdev
= pci_get_drvdata(pdev
);
2507 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
2509 if (pci_enable_device(pdev
)) {
2510 netdev_err(adapter
->netdev
,
2511 "Cannot re-enable PCI device after reset\n");
2512 return PCI_ERS_RESULT_DISCONNECT
;
2514 pci_set_master(pdev
);
2516 pci_enable_wake(pdev
, PCI_D3hot
, 0);
2517 pci_enable_wake(pdev
, PCI_D3cold
, 0);
2519 atl1e_reset_hw(&adapter
->hw
);
2521 return PCI_ERS_RESULT_RECOVERED
;
2525 * atl1e_io_resume - called when traffic can start flowing again.
2526 * @pdev: Pointer to PCI device
2528 * This callback is called when the error recovery driver tells us that
2529 * its OK to resume normal operation. Implementation resembles the
2530 * second-half of the atl1e_resume routine.
2532 static void atl1e_io_resume(struct pci_dev
*pdev
)
2534 struct net_device
*netdev
= pci_get_drvdata(pdev
);
2535 struct atl1e_adapter
*adapter
= netdev_priv(netdev
);
2537 if (netif_running(netdev
)) {
2538 if (atl1e_up(adapter
)) {
2539 netdev_err(adapter
->netdev
,
2540 "can't bring device back up after reset\n");
2545 netif_device_attach(netdev
);
2548 static const struct pci_error_handlers atl1e_err_handler
= {
2549 .error_detected
= atl1e_io_error_detected
,
2550 .slot_reset
= atl1e_io_slot_reset
,
2551 .resume
= atl1e_io_resume
,
2554 static struct pci_driver atl1e_driver
= {
2555 .name
= atl1e_driver_name
,
2556 .id_table
= atl1e_pci_tbl
,
2557 .probe
= atl1e_probe
,
2558 .remove
= atl1e_remove
,
2559 /* Power Management Hooks */
2561 .suspend
= atl1e_suspend
,
2562 .resume
= atl1e_resume
,
2564 .shutdown
= atl1e_shutdown
,
2565 .err_handler
= &atl1e_err_handler
2568 module_pci_driver(atl1e_driver
);