]>
Commit | Line | Data |
---|---|---|
a6a53252 JY |
1 | /* |
2 | * Copyright(c) 2007 Atheros Corporation. All rights reserved. | |
3 | * | |
4 | * Derived from Intel e1000 driver | |
5 | * Copyright(c) 1999 - 2005 Intel Corporation. All rights reserved. | |
6 | * | |
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) | |
10 | * any later version. | |
11 | * | |
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 | |
15 | * more details. | |
16 | * | |
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. | |
20 | * | |
21 | */ | |
22 | ||
23 | #include <linux/netdevice.h> | |
24 | #include <linux/ethtool.h> | |
25 | ||
26 | #include "atl1e.h" | |
27 | ||
28 | static int atl1e_get_settings(struct net_device *netdev, | |
29 | struct ethtool_cmd *ecmd) | |
30 | { | |
31 | struct atl1e_adapter *adapter = netdev_priv(netdev); | |
32 | struct atl1e_hw *hw = &adapter->hw; | |
33 | ||
34 | ecmd->supported = (SUPPORTED_10baseT_Half | | |
35 | SUPPORTED_10baseT_Full | | |
36 | SUPPORTED_100baseT_Half | | |
37 | SUPPORTED_100baseT_Full | | |
38 | SUPPORTED_Autoneg | | |
39 | SUPPORTED_TP); | |
40 | if (hw->nic_type == athr_l1e) | |
41 | ecmd->supported |= SUPPORTED_1000baseT_Full; | |
42 | ||
43 | ecmd->advertising = ADVERTISED_TP; | |
44 | ||
45 | ecmd->advertising |= ADVERTISED_Autoneg; | |
46 | ecmd->advertising |= hw->autoneg_advertised; | |
47 | ||
48 | ecmd->port = PORT_TP; | |
49 | ecmd->phy_address = 0; | |
50 | ecmd->transceiver = XCVR_INTERNAL; | |
51 | ||
52 | if (adapter->link_speed != SPEED_0) { | |
53 | ecmd->speed = adapter->link_speed; | |
54 | if (adapter->link_duplex == FULL_DUPLEX) | |
55 | ecmd->duplex = DUPLEX_FULL; | |
56 | else | |
57 | ecmd->duplex = DUPLEX_HALF; | |
58 | } else { | |
59 | ecmd->speed = -1; | |
60 | ecmd->duplex = -1; | |
61 | } | |
62 | ||
63 | ecmd->autoneg = AUTONEG_ENABLE; | |
64 | return 0; | |
65 | } | |
66 | ||
67 | static int atl1e_set_settings(struct net_device *netdev, | |
68 | struct ethtool_cmd *ecmd) | |
69 | { | |
70 | struct atl1e_adapter *adapter = netdev_priv(netdev); | |
71 | struct atl1e_hw *hw = &adapter->hw; | |
72 | ||
73 | while (test_and_set_bit(__AT_RESETTING, &adapter->flags)) | |
74 | msleep(1); | |
75 | ||
76 | if (ecmd->autoneg == AUTONEG_ENABLE) { | |
77 | u16 adv4, adv9; | |
78 | ||
79 | if ((ecmd->advertising&ADVERTISE_1000_FULL)) { | |
80 | if (hw->nic_type == athr_l1e) { | |
81 | hw->autoneg_advertised = | |
82 | ecmd->advertising & AT_ADV_MASK; | |
83 | } else { | |
84 | clear_bit(__AT_RESETTING, &adapter->flags); | |
85 | return -EINVAL; | |
86 | } | |
87 | } else if (ecmd->advertising&ADVERTISE_1000_HALF) { | |
88 | clear_bit(__AT_RESETTING, &adapter->flags); | |
89 | return -EINVAL; | |
90 | } else { | |
91 | hw->autoneg_advertised = | |
92 | ecmd->advertising & AT_ADV_MASK; | |
93 | } | |
94 | ecmd->advertising = hw->autoneg_advertised | | |
95 | ADVERTISED_TP | ADVERTISED_Autoneg; | |
96 | ||
97 | adv4 = hw->mii_autoneg_adv_reg & ~MII_AR_SPEED_MASK; | |
98 | adv9 = hw->mii_1000t_ctrl_reg & ~MII_AT001_CR_1000T_SPEED_MASK; | |
99 | if (hw->autoneg_advertised & ADVERTISE_10_HALF) | |
100 | adv4 |= MII_AR_10T_HD_CAPS; | |
101 | if (hw->autoneg_advertised & ADVERTISE_10_FULL) | |
102 | adv4 |= MII_AR_10T_FD_CAPS; | |
103 | if (hw->autoneg_advertised & ADVERTISE_100_HALF) | |
104 | adv4 |= MII_AR_100TX_HD_CAPS; | |
105 | if (hw->autoneg_advertised & ADVERTISE_100_FULL) | |
106 | adv4 |= MII_AR_100TX_FD_CAPS; | |
107 | if (hw->autoneg_advertised & ADVERTISE_1000_FULL) | |
108 | adv9 |= MII_AT001_CR_1000T_FD_CAPS; | |
109 | ||
110 | if (adv4 != hw->mii_autoneg_adv_reg || | |
111 | adv9 != hw->mii_1000t_ctrl_reg) { | |
112 | hw->mii_autoneg_adv_reg = adv4; | |
113 | hw->mii_1000t_ctrl_reg = adv9; | |
114 | hw->re_autoneg = true; | |
115 | } | |
116 | ||
117 | } else { | |
118 | clear_bit(__AT_RESETTING, &adapter->flags); | |
119 | return -EINVAL; | |
120 | } | |
121 | ||
122 | /* reset the link */ | |
123 | ||
124 | if (netif_running(adapter->netdev)) { | |
125 | atl1e_down(adapter); | |
126 | atl1e_up(adapter); | |
127 | } else | |
128 | atl1e_reset_hw(&adapter->hw); | |
129 | ||
130 | clear_bit(__AT_RESETTING, &adapter->flags); | |
131 | return 0; | |
132 | } | |
133 | ||
a6a53252 JY |
134 | static u32 atl1e_get_msglevel(struct net_device *netdev) |
135 | { | |
136 | #ifdef DBG | |
137 | return 1; | |
138 | #else | |
139 | return 0; | |
140 | #endif | |
141 | } | |
142 | ||
a6a53252 JY |
143 | static int atl1e_get_regs_len(struct net_device *netdev) |
144 | { | |
145 | return AT_REGS_LEN * sizeof(u32); | |
146 | } | |
147 | ||
148 | static void atl1e_get_regs(struct net_device *netdev, | |
149 | struct ethtool_regs *regs, void *p) | |
150 | { | |
151 | struct atl1e_adapter *adapter = netdev_priv(netdev); | |
152 | struct atl1e_hw *hw = &adapter->hw; | |
153 | u32 *regs_buff = p; | |
154 | u16 phy_data; | |
155 | ||
156 | memset(p, 0, AT_REGS_LEN * sizeof(u32)); | |
157 | ||
158 | regs->version = (1 << 24) | (hw->revision_id << 16) | hw->device_id; | |
159 | ||
160 | regs_buff[0] = AT_READ_REG(hw, REG_VPD_CAP); | |
161 | regs_buff[1] = AT_READ_REG(hw, REG_SPI_FLASH_CTRL); | |
162 | regs_buff[2] = AT_READ_REG(hw, REG_SPI_FLASH_CONFIG); | |
163 | regs_buff[3] = AT_READ_REG(hw, REG_TWSI_CTRL); | |
164 | regs_buff[4] = AT_READ_REG(hw, REG_PCIE_DEV_MISC_CTRL); | |
165 | regs_buff[5] = AT_READ_REG(hw, REG_MASTER_CTRL); | |
166 | regs_buff[6] = AT_READ_REG(hw, REG_MANUAL_TIMER_INIT); | |
167 | regs_buff[7] = AT_READ_REG(hw, REG_IRQ_MODU_TIMER_INIT); | |
168 | regs_buff[8] = AT_READ_REG(hw, REG_GPHY_CTRL); | |
169 | regs_buff[9] = AT_READ_REG(hw, REG_CMBDISDMA_TIMER); | |
170 | regs_buff[10] = AT_READ_REG(hw, REG_IDLE_STATUS); | |
171 | regs_buff[11] = AT_READ_REG(hw, REG_MDIO_CTRL); | |
172 | regs_buff[12] = AT_READ_REG(hw, REG_SERDES_LOCK); | |
173 | regs_buff[13] = AT_READ_REG(hw, REG_MAC_CTRL); | |
174 | regs_buff[14] = AT_READ_REG(hw, REG_MAC_IPG_IFG); | |
175 | regs_buff[15] = AT_READ_REG(hw, REG_MAC_STA_ADDR); | |
176 | regs_buff[16] = AT_READ_REG(hw, REG_MAC_STA_ADDR+4); | |
177 | regs_buff[17] = AT_READ_REG(hw, REG_RX_HASH_TABLE); | |
178 | regs_buff[18] = AT_READ_REG(hw, REG_RX_HASH_TABLE+4); | |
179 | regs_buff[19] = AT_READ_REG(hw, REG_MAC_HALF_DUPLX_CTRL); | |
180 | regs_buff[20] = AT_READ_REG(hw, REG_MTU); | |
181 | regs_buff[21] = AT_READ_REG(hw, REG_WOL_CTRL); | |
182 | regs_buff[22] = AT_READ_REG(hw, REG_SRAM_TRD_ADDR); | |
183 | regs_buff[23] = AT_READ_REG(hw, REG_SRAM_TRD_LEN); | |
184 | regs_buff[24] = AT_READ_REG(hw, REG_SRAM_RXF_ADDR); | |
185 | regs_buff[25] = AT_READ_REG(hw, REG_SRAM_RXF_LEN); | |
186 | regs_buff[26] = AT_READ_REG(hw, REG_SRAM_TXF_ADDR); | |
187 | regs_buff[27] = AT_READ_REG(hw, REG_SRAM_TXF_LEN); | |
188 | regs_buff[28] = AT_READ_REG(hw, REG_SRAM_TCPH_ADDR); | |
189 | regs_buff[29] = AT_READ_REG(hw, REG_SRAM_PKTH_ADDR); | |
190 | ||
191 | atl1e_read_phy_reg(hw, MII_BMCR, &phy_data); | |
192 | regs_buff[73] = (u32)phy_data; | |
193 | atl1e_read_phy_reg(hw, MII_BMSR, &phy_data); | |
194 | regs_buff[74] = (u32)phy_data; | |
195 | } | |
196 | ||
197 | static int atl1e_get_eeprom_len(struct net_device *netdev) | |
198 | { | |
199 | struct atl1e_adapter *adapter = netdev_priv(netdev); | |
200 | ||
201 | if (!atl1e_check_eeprom_exist(&adapter->hw)) | |
202 | return AT_EEPROM_LEN; | |
203 | else | |
204 | return 0; | |
205 | } | |
206 | ||
207 | static int atl1e_get_eeprom(struct net_device *netdev, | |
208 | struct ethtool_eeprom *eeprom, u8 *bytes) | |
209 | { | |
210 | struct atl1e_adapter *adapter = netdev_priv(netdev); | |
211 | struct atl1e_hw *hw = &adapter->hw; | |
212 | u32 *eeprom_buff; | |
213 | int first_dword, last_dword; | |
214 | int ret_val = 0; | |
215 | int i; | |
216 | ||
217 | if (eeprom->len == 0) | |
218 | return -EINVAL; | |
219 | ||
220 | if (atl1e_check_eeprom_exist(hw)) /* not exist */ | |
221 | return -EINVAL; | |
222 | ||
223 | eeprom->magic = hw->vendor_id | (hw->device_id << 16); | |
224 | ||
225 | first_dword = eeprom->offset >> 2; | |
226 | last_dword = (eeprom->offset + eeprom->len - 1) >> 2; | |
227 | ||
228 | eeprom_buff = kmalloc(sizeof(u32) * | |
229 | (last_dword - first_dword + 1), GFP_KERNEL); | |
230 | if (eeprom_buff == NULL) | |
231 | return -ENOMEM; | |
232 | ||
233 | for (i = first_dword; i < last_dword; i++) { | |
234 | if (!atl1e_read_eeprom(hw, i * 4, &(eeprom_buff[i-first_dword]))) { | |
235 | kfree(eeprom_buff); | |
236 | return -EIO; | |
237 | } | |
238 | } | |
239 | ||
240 | memcpy(bytes, (u8 *)eeprom_buff + (eeprom->offset & 3), | |
241 | eeprom->len); | |
242 | kfree(eeprom_buff); | |
243 | ||
244 | return ret_val; | |
245 | } | |
246 | ||
247 | static int atl1e_set_eeprom(struct net_device *netdev, | |
248 | struct ethtool_eeprom *eeprom, u8 *bytes) | |
249 | { | |
250 | struct atl1e_adapter *adapter = netdev_priv(netdev); | |
251 | struct atl1e_hw *hw = &adapter->hw; | |
252 | u32 *eeprom_buff; | |
253 | u32 *ptr; | |
254 | int first_dword, last_dword; | |
255 | int ret_val = 0; | |
256 | int i; | |
257 | ||
258 | if (eeprom->len == 0) | |
259 | return -EOPNOTSUPP; | |
260 | ||
261 | if (eeprom->magic != (hw->vendor_id | (hw->device_id << 16))) | |
262 | return -EINVAL; | |
263 | ||
264 | first_dword = eeprom->offset >> 2; | |
265 | last_dword = (eeprom->offset + eeprom->len - 1) >> 2; | |
266 | eeprom_buff = kmalloc(AT_EEPROM_LEN, GFP_KERNEL); | |
267 | if (eeprom_buff == NULL) | |
268 | return -ENOMEM; | |
269 | ||
270 | ptr = (u32 *)eeprom_buff; | |
271 | ||
272 | if (eeprom->offset & 3) { | |
273 | /* need read/modify/write of first changed EEPROM word */ | |
274 | /* only the second byte of the word is being modified */ | |
275 | if (!atl1e_read_eeprom(hw, first_dword * 4, &(eeprom_buff[0]))) { | |
276 | ret_val = -EIO; | |
277 | goto out; | |
278 | } | |
279 | ptr++; | |
280 | } | |
281 | if (((eeprom->offset + eeprom->len) & 3)) { | |
282 | /* need read/modify/write of last changed EEPROM word */ | |
283 | /* only the first byte of the word is being modified */ | |
284 | ||
285 | if (!atl1e_read_eeprom(hw, last_dword * 4, | |
286 | &(eeprom_buff[last_dword - first_dword]))) { | |
287 | ret_val = -EIO; | |
288 | goto out; | |
289 | } | |
290 | } | |
291 | ||
292 | /* Device's eeprom is always little-endian, word addressable */ | |
293 | memcpy(ptr, bytes, eeprom->len); | |
294 | ||
295 | for (i = 0; i < last_dword - first_dword + 1; i++) { | |
296 | if (!atl1e_write_eeprom(hw, ((first_dword + i) * 4), | |
297 | eeprom_buff[i])) { | |
298 | ret_val = -EIO; | |
299 | goto out; | |
300 | } | |
301 | } | |
302 | out: | |
303 | kfree(eeprom_buff); | |
304 | return ret_val; | |
305 | } | |
306 | ||
307 | static void atl1e_get_drvinfo(struct net_device *netdev, | |
308 | struct ethtool_drvinfo *drvinfo) | |
309 | { | |
310 | struct atl1e_adapter *adapter = netdev_priv(netdev); | |
311 | ||
312 | strncpy(drvinfo->driver, atl1e_driver_name, 32); | |
313 | strncpy(drvinfo->version, atl1e_driver_version, 32); | |
314 | strncpy(drvinfo->fw_version, "L1e", 32); | |
315 | strncpy(drvinfo->bus_info, pci_name(adapter->pdev), 32); | |
316 | drvinfo->n_stats = 0; | |
317 | drvinfo->testinfo_len = 0; | |
318 | drvinfo->regdump_len = atl1e_get_regs_len(netdev); | |
319 | drvinfo->eedump_len = atl1e_get_eeprom_len(netdev); | |
320 | } | |
321 | ||
322 | static void atl1e_get_wol(struct net_device *netdev, | |
323 | struct ethtool_wolinfo *wol) | |
324 | { | |
325 | struct atl1e_adapter *adapter = netdev_priv(netdev); | |
326 | ||
327 | wol->supported = WAKE_MAGIC | WAKE_PHY; | |
328 | wol->wolopts = 0; | |
329 | ||
330 | if (adapter->wol & AT_WUFC_EX) | |
331 | wol->wolopts |= WAKE_UCAST; | |
332 | if (adapter->wol & AT_WUFC_MC) | |
333 | wol->wolopts |= WAKE_MCAST; | |
334 | if (adapter->wol & AT_WUFC_BC) | |
335 | wol->wolopts |= WAKE_BCAST; | |
336 | if (adapter->wol & AT_WUFC_MAG) | |
337 | wol->wolopts |= WAKE_MAGIC; | |
338 | if (adapter->wol & AT_WUFC_LNKC) | |
339 | wol->wolopts |= WAKE_PHY; | |
340 | ||
341 | return; | |
342 | } | |
343 | ||
344 | static int atl1e_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol) | |
345 | { | |
346 | struct atl1e_adapter *adapter = netdev_priv(netdev); | |
347 | ||
348 | if (wol->wolopts & (WAKE_ARP | WAKE_MAGICSECURE | | |
1a3c4bc6 | 349 | WAKE_UCAST | WAKE_MCAST | WAKE_BCAST)) |
a6a53252 JY |
350 | return -EOPNOTSUPP; |
351 | /* these settings will always override what we currently have */ | |
352 | adapter->wol = 0; | |
353 | ||
354 | if (wol->wolopts & WAKE_MAGIC) | |
355 | adapter->wol |= AT_WUFC_MAG; | |
356 | if (wol->wolopts & WAKE_PHY) | |
357 | adapter->wol |= AT_WUFC_LNKC; | |
358 | ||
d8146bb2 BP |
359 | device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol); |
360 | ||
a6a53252 JY |
361 | return 0; |
362 | } | |
363 | ||
364 | static int atl1e_nway_reset(struct net_device *netdev) | |
365 | { | |
366 | struct atl1e_adapter *adapter = netdev_priv(netdev); | |
367 | if (netif_running(netdev)) | |
368 | atl1e_reinit_locked(adapter); | |
369 | return 0; | |
370 | } | |
371 | ||
0fc0b732 | 372 | static const struct ethtool_ops atl1e_ethtool_ops = { |
a6a53252 JY |
373 | .get_settings = atl1e_get_settings, |
374 | .set_settings = atl1e_set_settings, | |
375 | .get_drvinfo = atl1e_get_drvinfo, | |
376 | .get_regs_len = atl1e_get_regs_len, | |
377 | .get_regs = atl1e_get_regs, | |
378 | .get_wol = atl1e_get_wol, | |
379 | .set_wol = atl1e_set_wol, | |
380 | .get_msglevel = atl1e_get_msglevel, | |
a6a53252 JY |
381 | .nway_reset = atl1e_nway_reset, |
382 | .get_link = ethtool_op_get_link, | |
383 | .get_eeprom_len = atl1e_get_eeprom_len, | |
384 | .get_eeprom = atl1e_get_eeprom, | |
385 | .set_eeprom = atl1e_set_eeprom, | |
ac936929 | 386 | .set_tx_csum = ethtool_op_set_tx_hw_csum, |
a6a53252 | 387 | .set_sg = ethtool_op_set_sg, |
ac936929 | 388 | .set_tso = ethtool_op_set_tso, |
a6a53252 JY |
389 | }; |
390 | ||
391 | void atl1e_set_ethtool_ops(struct net_device *netdev) | |
392 | { | |
393 | SET_ETHTOOL_OPS(netdev, &atl1e_ethtool_ops); | |
394 | } |