1 /* 2 * Copyright (C) 1999 - 2010 Intel Corporation. 3 * Copyright (C) 2010 OKI SEMICONDUCTOR Co., LTD. 4 * 5 * This code was derived from the Intel e1000e Linux driver. 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License as published by 9 * the Free Software Foundation; version 2 of the License. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 * 16 * You should have received a copy of the GNU General Public License 17 * along with this program; if not, see <http://www.gnu.org/licenses/>. 18 */ 19 #include "pch_gbe.h" 20 #include "pch_gbe_api.h" 21 22 /** 23 * pch_gbe_stats - Stats item information 24 */ 25 struct pch_gbe_stats { 26 char string[ETH_GSTRING_LEN]; 27 size_t size; 28 size_t offset; 29 }; 30 31 #define PCH_GBE_STAT(m) \ 32 { \ 33 .string = #m, \ 34 .size = FIELD_SIZEOF(struct pch_gbe_hw_stats, m), \ 35 .offset = offsetof(struct pch_gbe_hw_stats, m), \ 36 } 37 38 /** 39 * pch_gbe_gstrings_stats - ethtool information status name list 40 */ 41 static const struct pch_gbe_stats pch_gbe_gstrings_stats[] = { 42 PCH_GBE_STAT(rx_packets), 43 PCH_GBE_STAT(tx_packets), 44 PCH_GBE_STAT(rx_bytes), 45 PCH_GBE_STAT(tx_bytes), 46 PCH_GBE_STAT(rx_errors), 47 PCH_GBE_STAT(tx_errors), 48 PCH_GBE_STAT(rx_dropped), 49 PCH_GBE_STAT(tx_dropped), 50 PCH_GBE_STAT(multicast), 51 PCH_GBE_STAT(collisions), 52 PCH_GBE_STAT(rx_crc_errors), 53 PCH_GBE_STAT(rx_frame_errors), 54 PCH_GBE_STAT(rx_alloc_buff_failed), 55 PCH_GBE_STAT(tx_length_errors), 56 PCH_GBE_STAT(tx_aborted_errors), 57 PCH_GBE_STAT(tx_carrier_errors), 58 PCH_GBE_STAT(tx_timeout_count), 59 PCH_GBE_STAT(tx_restart_count), 60 PCH_GBE_STAT(intr_rx_dsc_empty_count), 61 PCH_GBE_STAT(intr_rx_frame_err_count), 62 PCH_GBE_STAT(intr_rx_fifo_err_count), 63 PCH_GBE_STAT(intr_rx_dma_err_count), 64 PCH_GBE_STAT(intr_tx_fifo_err_count), 65 PCH_GBE_STAT(intr_tx_dma_err_count), 66 PCH_GBE_STAT(intr_tcpip_err_count) 67 }; 68 69 #define PCH_GBE_QUEUE_STATS_LEN 0 70 #define PCH_GBE_GLOBAL_STATS_LEN ARRAY_SIZE(pch_gbe_gstrings_stats) 71 #define PCH_GBE_STATS_LEN (PCH_GBE_GLOBAL_STATS_LEN + PCH_GBE_QUEUE_STATS_LEN) 72 73 #define PCH_GBE_MAC_REGS_LEN (sizeof(struct pch_gbe_regs) / 4) 74 #define PCH_GBE_REGS_LEN (PCH_GBE_MAC_REGS_LEN + PCH_GBE_PHY_REGS_LEN) 75 /** 76 * pch_gbe_get_settings - Get device-specific settings 77 * @netdev: Network interface device structure 78 * @ecmd: Ethtool command 79 * Returns: 80 * 0: Successful. 81 * Negative value: Failed. 82 */ 83 static int pch_gbe_get_settings(struct net_device *netdev, 84 struct ethtool_cmd *ecmd) 85 { 86 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 87 int ret; 88 89 ret = mii_ethtool_gset(&adapter->mii, ecmd); 90 ecmd->supported &= ~(SUPPORTED_TP | SUPPORTED_1000baseT_Half); 91 ecmd->advertising &= ~(ADVERTISED_TP | ADVERTISED_1000baseT_Half); 92 93 if (!netif_carrier_ok(adapter->netdev)) 94 ethtool_cmd_speed_set(ecmd, -1); 95 return ret; 96 } 97 98 /** 99 * pch_gbe_set_settings - Set device-specific settings 100 * @netdev: Network interface device structure 101 * @ecmd: Ethtool command 102 * Returns: 103 * 0: Successful. 104 * Negative value: Failed. 105 */ 106 static int pch_gbe_set_settings(struct net_device *netdev, 107 struct ethtool_cmd *ecmd) 108 { 109 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 110 struct pch_gbe_hw *hw = &adapter->hw; 111 u32 speed = ethtool_cmd_speed(ecmd); 112 int ret; 113 114 pch_gbe_hal_write_phy_reg(hw, MII_BMCR, BMCR_RESET); 115 116 /* when set_settings() is called with a ethtool_cmd previously 117 * filled by get_settings() on a down link, speed is -1: */ 118 if (speed == UINT_MAX) { 119 speed = SPEED_1000; 120 ethtool_cmd_speed_set(ecmd, speed); 121 ecmd->duplex = DUPLEX_FULL; 122 } 123 ret = mii_ethtool_sset(&adapter->mii, ecmd); 124 if (ret) { 125 netdev_err(netdev, "Error: mii_ethtool_sset\n"); 126 return ret; 127 } 128 hw->mac.link_speed = speed; 129 hw->mac.link_duplex = ecmd->duplex; 130 hw->phy.autoneg_advertised = ecmd->advertising; 131 hw->mac.autoneg = ecmd->autoneg; 132 133 /* reset the link */ 134 if (netif_running(adapter->netdev)) { 135 pch_gbe_down(adapter); 136 ret = pch_gbe_up(adapter); 137 } else { 138 pch_gbe_reset(adapter); 139 } 140 return ret; 141 } 142 143 /** 144 * pch_gbe_get_regs_len - Report the size of device registers 145 * @netdev: Network interface device structure 146 * Returns: the size of device registers. 147 */ 148 static int pch_gbe_get_regs_len(struct net_device *netdev) 149 { 150 return PCH_GBE_REGS_LEN * (int)sizeof(u32); 151 } 152 153 /** 154 * pch_gbe_get_drvinfo - Report driver information 155 * @netdev: Network interface device structure 156 * @drvinfo: Driver information structure 157 */ 158 static void pch_gbe_get_drvinfo(struct net_device *netdev, 159 struct ethtool_drvinfo *drvinfo) 160 { 161 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 162 163 strlcpy(drvinfo->driver, KBUILD_MODNAME, sizeof(drvinfo->driver)); 164 strlcpy(drvinfo->version, pch_driver_version, sizeof(drvinfo->version)); 165 strlcpy(drvinfo->bus_info, pci_name(adapter->pdev), 166 sizeof(drvinfo->bus_info)); 167 drvinfo->regdump_len = pch_gbe_get_regs_len(netdev); 168 } 169 170 /** 171 * pch_gbe_get_regs - Get device registers 172 * @netdev: Network interface device structure 173 * @regs: Ethtool register structure 174 * @p: Buffer pointer of read device register date 175 */ 176 static void pch_gbe_get_regs(struct net_device *netdev, 177 struct ethtool_regs *regs, void *p) 178 { 179 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 180 struct pch_gbe_hw *hw = &adapter->hw; 181 struct pci_dev *pdev = adapter->pdev; 182 u32 *regs_buff = p; 183 u16 i, tmp; 184 185 regs->version = 0x1000000 | (__u32)pdev->revision << 16 | pdev->device; 186 for (i = 0; i < PCH_GBE_MAC_REGS_LEN; i++) 187 *regs_buff++ = ioread32(&hw->reg->INT_ST + i); 188 /* PHY register */ 189 for (i = 0; i < PCH_GBE_PHY_REGS_LEN; i++) { 190 pch_gbe_hal_read_phy_reg(&adapter->hw, i, &tmp); 191 *regs_buff++ = tmp; 192 } 193 } 194 195 /** 196 * pch_gbe_get_wol - Report whether Wake-on-Lan is enabled 197 * @netdev: Network interface device structure 198 * @wol: Wake-on-Lan information 199 */ 200 static void pch_gbe_get_wol(struct net_device *netdev, 201 struct ethtool_wolinfo *wol) 202 { 203 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 204 205 wol->supported = WAKE_UCAST | WAKE_MCAST | WAKE_BCAST | WAKE_MAGIC; 206 wol->wolopts = 0; 207 208 if ((adapter->wake_up_evt & PCH_GBE_WLC_IND)) 209 wol->wolopts |= WAKE_UCAST; 210 if ((adapter->wake_up_evt & PCH_GBE_WLC_MLT)) 211 wol->wolopts |= WAKE_MCAST; 212 if ((adapter->wake_up_evt & PCH_GBE_WLC_BR)) 213 wol->wolopts |= WAKE_BCAST; 214 if ((adapter->wake_up_evt & PCH_GBE_WLC_MP)) 215 wol->wolopts |= WAKE_MAGIC; 216 } 217 218 /** 219 * pch_gbe_set_wol - Turn Wake-on-Lan on or off 220 * @netdev: Network interface device structure 221 * @wol: Pointer of wake-on-Lan information straucture 222 * Returns: 223 * 0: Successful. 224 * Negative value: Failed. 225 */ 226 static int pch_gbe_set_wol(struct net_device *netdev, 227 struct ethtool_wolinfo *wol) 228 { 229 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 230 231 if ((wol->wolopts & (WAKE_PHY | WAKE_ARP | WAKE_MAGICSECURE))) 232 return -EOPNOTSUPP; 233 /* these settings will always override what we currently have */ 234 adapter->wake_up_evt = 0; 235 236 if ((wol->wolopts & WAKE_UCAST)) 237 adapter->wake_up_evt |= PCH_GBE_WLC_IND; 238 if ((wol->wolopts & WAKE_MCAST)) 239 adapter->wake_up_evt |= PCH_GBE_WLC_MLT; 240 if ((wol->wolopts & WAKE_BCAST)) 241 adapter->wake_up_evt |= PCH_GBE_WLC_BR; 242 if ((wol->wolopts & WAKE_MAGIC)) 243 adapter->wake_up_evt |= PCH_GBE_WLC_MP; 244 return 0; 245 } 246 247 /** 248 * pch_gbe_nway_reset - Restart autonegotiation 249 * @netdev: Network interface device structure 250 * Returns: 251 * 0: Successful. 252 * Negative value: Failed. 253 */ 254 static int pch_gbe_nway_reset(struct net_device *netdev) 255 { 256 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 257 258 return mii_nway_restart(&adapter->mii); 259 } 260 261 /** 262 * pch_gbe_get_ringparam - Report ring sizes 263 * @netdev: Network interface device structure 264 * @ring: Ring param structure 265 */ 266 static void pch_gbe_get_ringparam(struct net_device *netdev, 267 struct ethtool_ringparam *ring) 268 { 269 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 270 struct pch_gbe_tx_ring *txdr = adapter->tx_ring; 271 struct pch_gbe_rx_ring *rxdr = adapter->rx_ring; 272 273 ring->rx_max_pending = PCH_GBE_MAX_RXD; 274 ring->tx_max_pending = PCH_GBE_MAX_TXD; 275 ring->rx_pending = rxdr->count; 276 ring->tx_pending = txdr->count; 277 } 278 279 /** 280 * pch_gbe_set_ringparam - Set ring sizes 281 * @netdev: Network interface device structure 282 * @ring: Ring param structure 283 * Returns 284 * 0: Successful. 285 * Negative value: Failed. 286 */ 287 static int pch_gbe_set_ringparam(struct net_device *netdev, 288 struct ethtool_ringparam *ring) 289 { 290 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 291 struct pch_gbe_tx_ring *txdr, *tx_old; 292 struct pch_gbe_rx_ring *rxdr, *rx_old; 293 int tx_ring_size, rx_ring_size; 294 int err = 0; 295 296 if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending)) 297 return -EINVAL; 298 tx_ring_size = (int)sizeof(struct pch_gbe_tx_ring); 299 rx_ring_size = (int)sizeof(struct pch_gbe_rx_ring); 300 301 if ((netif_running(adapter->netdev))) 302 pch_gbe_down(adapter); 303 tx_old = adapter->tx_ring; 304 rx_old = adapter->rx_ring; 305 306 txdr = kzalloc(tx_ring_size, GFP_KERNEL); 307 if (!txdr) { 308 err = -ENOMEM; 309 goto err_alloc_tx; 310 } 311 rxdr = kzalloc(rx_ring_size, GFP_KERNEL); 312 if (!rxdr) { 313 err = -ENOMEM; 314 goto err_alloc_rx; 315 } 316 adapter->tx_ring = txdr; 317 adapter->rx_ring = rxdr; 318 319 rxdr->count = 320 clamp_val(ring->rx_pending, PCH_GBE_MIN_RXD, PCH_GBE_MAX_RXD); 321 rxdr->count = roundup(rxdr->count, PCH_GBE_RX_DESC_MULTIPLE); 322 323 txdr->count = 324 clamp_val(ring->tx_pending, PCH_GBE_MIN_RXD, PCH_GBE_MAX_RXD); 325 txdr->count = roundup(txdr->count, PCH_GBE_TX_DESC_MULTIPLE); 326 327 if ((netif_running(adapter->netdev))) { 328 /* Try to get new resources before deleting old */ 329 err = pch_gbe_setup_rx_resources(adapter, adapter->rx_ring); 330 if (err) 331 goto err_setup_rx; 332 err = pch_gbe_setup_tx_resources(adapter, adapter->tx_ring); 333 if (err) 334 goto err_setup_tx; 335 /* save the new, restore the old in order to free it, 336 * then restore the new back again */ 337 #ifdef RINGFREE 338 adapter->rx_ring = rx_old; 339 adapter->tx_ring = tx_old; 340 pch_gbe_free_rx_resources(adapter, adapter->rx_ring); 341 pch_gbe_free_tx_resources(adapter, adapter->tx_ring); 342 kfree(tx_old); 343 kfree(rx_old); 344 adapter->rx_ring = rxdr; 345 adapter->tx_ring = txdr; 346 #else 347 pch_gbe_free_rx_resources(adapter, rx_old); 348 pch_gbe_free_tx_resources(adapter, tx_old); 349 kfree(tx_old); 350 kfree(rx_old); 351 adapter->rx_ring = rxdr; 352 adapter->tx_ring = txdr; 353 #endif 354 err = pch_gbe_up(adapter); 355 } 356 return err; 357 358 err_setup_tx: 359 pch_gbe_free_rx_resources(adapter, adapter->rx_ring); 360 err_setup_rx: 361 adapter->rx_ring = rx_old; 362 adapter->tx_ring = tx_old; 363 kfree(rxdr); 364 err_alloc_rx: 365 kfree(txdr); 366 err_alloc_tx: 367 if (netif_running(adapter->netdev)) 368 pch_gbe_up(adapter); 369 return err; 370 } 371 372 /** 373 * pch_gbe_get_pauseparam - Report pause parameters 374 * @netdev: Network interface device structure 375 * @pause: Pause parameters structure 376 */ 377 static void pch_gbe_get_pauseparam(struct net_device *netdev, 378 struct ethtool_pauseparam *pause) 379 { 380 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 381 struct pch_gbe_hw *hw = &adapter->hw; 382 383 pause->autoneg = 384 ((hw->mac.fc_autoneg) ? AUTONEG_ENABLE : AUTONEG_DISABLE); 385 386 if (hw->mac.fc == PCH_GBE_FC_RX_PAUSE) { 387 pause->rx_pause = 1; 388 } else if (hw->mac.fc == PCH_GBE_FC_TX_PAUSE) { 389 pause->tx_pause = 1; 390 } else if (hw->mac.fc == PCH_GBE_FC_FULL) { 391 pause->rx_pause = 1; 392 pause->tx_pause = 1; 393 } 394 } 395 396 /** 397 * pch_gbe_set_pauseparam - Set pause paramters 398 * @netdev: Network interface device structure 399 * @pause: Pause parameters structure 400 * Returns: 401 * 0: Successful. 402 * Negative value: Failed. 403 */ 404 static int pch_gbe_set_pauseparam(struct net_device *netdev, 405 struct ethtool_pauseparam *pause) 406 { 407 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 408 struct pch_gbe_hw *hw = &adapter->hw; 409 int ret = 0; 410 411 hw->mac.fc_autoneg = pause->autoneg; 412 if ((pause->rx_pause) && (pause->tx_pause)) 413 hw->mac.fc = PCH_GBE_FC_FULL; 414 else if ((pause->rx_pause) && (!pause->tx_pause)) 415 hw->mac.fc = PCH_GBE_FC_RX_PAUSE; 416 else if ((!pause->rx_pause) && (pause->tx_pause)) 417 hw->mac.fc = PCH_GBE_FC_TX_PAUSE; 418 else if ((!pause->rx_pause) && (!pause->tx_pause)) 419 hw->mac.fc = PCH_GBE_FC_NONE; 420 421 if (hw->mac.fc_autoneg == AUTONEG_ENABLE) { 422 if ((netif_running(adapter->netdev))) { 423 pch_gbe_down(adapter); 424 ret = pch_gbe_up(adapter); 425 } else { 426 pch_gbe_reset(adapter); 427 } 428 } else { 429 ret = pch_gbe_mac_force_mac_fc(hw); 430 } 431 return ret; 432 } 433 434 /** 435 * pch_gbe_get_strings - Return a set of strings that describe the requested 436 * objects 437 * @netdev: Network interface device structure 438 * @stringset: Select the stringset. [ETH_SS_TEST] [ETH_SS_STATS] 439 * @data: Pointer of read string data. 440 */ 441 static void pch_gbe_get_strings(struct net_device *netdev, u32 stringset, 442 u8 *data) 443 { 444 u8 *p = data; 445 int i; 446 447 switch (stringset) { 448 case (u32) ETH_SS_STATS: 449 for (i = 0; i < PCH_GBE_GLOBAL_STATS_LEN; i++) { 450 memcpy(p, pch_gbe_gstrings_stats[i].string, 451 ETH_GSTRING_LEN); 452 p += ETH_GSTRING_LEN; 453 } 454 break; 455 } 456 } 457 458 /** 459 * pch_gbe_get_ethtool_stats - Return statistics about the device 460 * @netdev: Network interface device structure 461 * @stats: Ethtool statue structure 462 * @data: Pointer of read status area 463 */ 464 static void pch_gbe_get_ethtool_stats(struct net_device *netdev, 465 struct ethtool_stats *stats, u64 *data) 466 { 467 struct pch_gbe_adapter *adapter = netdev_priv(netdev); 468 int i; 469 const struct pch_gbe_stats *gstats = pch_gbe_gstrings_stats; 470 char *hw_stats = (char *)&adapter->stats; 471 472 pch_gbe_update_stats(adapter); 473 for (i = 0; i < PCH_GBE_GLOBAL_STATS_LEN; i++) { 474 char *p = hw_stats + gstats->offset; 475 data[i] = gstats->size == sizeof(u64) ? *(u64 *)p:(*(u32 *)p); 476 gstats++; 477 } 478 } 479 480 static int pch_gbe_get_sset_count(struct net_device *netdev, int sset) 481 { 482 switch (sset) { 483 case ETH_SS_STATS: 484 return PCH_GBE_STATS_LEN; 485 default: 486 return -EOPNOTSUPP; 487 } 488 } 489 490 static const struct ethtool_ops pch_gbe_ethtool_ops = { 491 .get_settings = pch_gbe_get_settings, 492 .set_settings = pch_gbe_set_settings, 493 .get_drvinfo = pch_gbe_get_drvinfo, 494 .get_regs_len = pch_gbe_get_regs_len, 495 .get_regs = pch_gbe_get_regs, 496 .get_wol = pch_gbe_get_wol, 497 .set_wol = pch_gbe_set_wol, 498 .nway_reset = pch_gbe_nway_reset, 499 .get_link = ethtool_op_get_link, 500 .get_ringparam = pch_gbe_get_ringparam, 501 .set_ringparam = pch_gbe_set_ringparam, 502 .get_pauseparam = pch_gbe_get_pauseparam, 503 .set_pauseparam = pch_gbe_set_pauseparam, 504 .get_strings = pch_gbe_get_strings, 505 .get_ethtool_stats = pch_gbe_get_ethtool_stats, 506 .get_sset_count = pch_gbe_get_sset_count, 507 }; 508 509 void pch_gbe_set_ethtool_ops(struct net_device *netdev) 510 { 511 SET_ETHTOOL_OPS(netdev, &pch_gbe_ethtool_ops); 512 } 513