Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux

net: Add Gigabit Ethernet driver of Topcliff PCH

Signed-off-by: Masayuki Ohtake <masa-korg@dsn.okisemi.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

authored by

Masayuki Ohtake and committed by
David S. Miller
77555ee7 59104f06

+4824
+12
drivers/net/Kconfig
··· 2515 2515 2516 2516 source "drivers/net/stmmac/Kconfig" 2517 2517 2518 + config PCH_GBE 2519 + tristate "PCH Gigabit Ethernet" 2520 + depends on PCI 2521 + ---help--- 2522 + This is a gigabit ethernet driver for Topcliff PCH. 2523 + Topcliff PCH is the platform controller hub that is used in Intel's 2524 + general embedded platform. 2525 + Topcliff PCH has Gigabit Ethernet interface. 2526 + Using this interface, it is able to access system devices connected 2527 + to Gigabit Ethernet. 2528 + This driver enables Gigabit Ethernet function. 2529 + 2518 2530 endif # NETDEV_1000 2519 2531 2520 2532 #
+1
drivers/net/Makefile
··· 298 298 obj-$(CONFIG_CAIF) += caif/ 299 299 300 300 obj-$(CONFIG_OCTEON_MGMT_ETHERNET) += octeon/ 301 + obj-$(CONFIG_PCH_GBE) += pch_gbe/
+4
drivers/net/pch_gbe/Makefile
··· 1 + obj-$(CONFIG_PCH_GBE) += pch_gbe.o 2 + 3 + pch_gbe-y := pch_gbe_phy.o pch_gbe_ethtool.o pch_gbe_param.o 4 + pch_gbe-y += pch_gbe_api.o pch_gbe_main.o
+659
drivers/net/pch_gbe/pch_gbe.h
··· 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, write to the Free Software 18 + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA. 19 + */ 20 + 21 + #ifndef _PCH_GBE_H_ 22 + #define _PCH_GBE_H_ 23 + 24 + #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 25 + 26 + #include <linux/mii.h> 27 + #include <linux/delay.h> 28 + #include <linux/pci.h> 29 + #include <linux/netdevice.h> 30 + #include <linux/etherdevice.h> 31 + #include <linux/ethtool.h> 32 + #include <linux/vmalloc.h> 33 + #include <net/ip.h> 34 + 35 + /** 36 + * pch_gbe_regs_mac_adr - Structure holding values of mac address registers 37 + * @high Denotes the 1st to 4th byte from the initial of MAC address 38 + * @low Denotes the 5th to 6th byte from the initial of MAC address 39 + */ 40 + struct pch_gbe_regs_mac_adr { 41 + u32 high; 42 + u32 low; 43 + }; 44 + /** 45 + * pch_udc_regs - Structure holding values of MAC registers 46 + */ 47 + struct pch_gbe_regs { 48 + u32 INT_ST; 49 + u32 INT_EN; 50 + u32 MODE; 51 + u32 RESET; 52 + u32 TCPIP_ACC; 53 + u32 EX_LIST; 54 + u32 INT_ST_HOLD; 55 + u32 PHY_INT_CTRL; 56 + u32 MAC_RX_EN; 57 + u32 RX_FCTRL; 58 + u32 PAUSE_REQ; 59 + u32 RX_MODE; 60 + u32 TX_MODE; 61 + u32 RX_FIFO_ST; 62 + u32 TX_FIFO_ST; 63 + u32 TX_FID; 64 + u32 TX_RESULT; 65 + u32 PAUSE_PKT1; 66 + u32 PAUSE_PKT2; 67 + u32 PAUSE_PKT3; 68 + u32 PAUSE_PKT4; 69 + u32 PAUSE_PKT5; 70 + u32 reserve[2]; 71 + struct pch_gbe_regs_mac_adr mac_adr[16]; 72 + u32 ADDR_MASK; 73 + u32 MIIM; 74 + u32 reserve2; 75 + u32 RGMII_ST; 76 + u32 RGMII_CTRL; 77 + u32 reserve3[3]; 78 + u32 DMA_CTRL; 79 + u32 reserve4[3]; 80 + u32 RX_DSC_BASE; 81 + u32 RX_DSC_SIZE; 82 + u32 RX_DSC_HW_P; 83 + u32 RX_DSC_HW_P_HLD; 84 + u32 RX_DSC_SW_P; 85 + u32 reserve5[3]; 86 + u32 TX_DSC_BASE; 87 + u32 TX_DSC_SIZE; 88 + u32 TX_DSC_HW_P; 89 + u32 TX_DSC_HW_P_HLD; 90 + u32 TX_DSC_SW_P; 91 + u32 reserve6[3]; 92 + u32 RX_DMA_ST; 93 + u32 TX_DMA_ST; 94 + u32 reserve7[2]; 95 + u32 WOL_ST; 96 + u32 WOL_CTRL; 97 + u32 WOL_ADDR_MASK; 98 + }; 99 + 100 + /* Interrupt Status */ 101 + /* Interrupt Status Hold */ 102 + /* Interrupt Enable */ 103 + #define PCH_GBE_INT_RX_DMA_CMPLT 0x00000001 /* Receive DMA Transfer Complete */ 104 + #define PCH_GBE_INT_RX_VALID 0x00000002 /* MAC Normal Receive Complete */ 105 + #define PCH_GBE_INT_RX_FRAME_ERR 0x00000004 /* Receive frame error */ 106 + #define PCH_GBE_INT_RX_FIFO_ERR 0x00000008 /* Receive FIFO Overflow */ 107 + #define PCH_GBE_INT_RX_DMA_ERR 0x00000010 /* Receive DMA Transfer Error */ 108 + #define PCH_GBE_INT_RX_DSC_EMP 0x00000020 /* Receive Descriptor Empty */ 109 + #define PCH_GBE_INT_TX_CMPLT 0x00000100 /* MAC Transmission Complete */ 110 + #define PCH_GBE_INT_TX_DMA_CMPLT 0x00000200 /* DMA Transfer Complete */ 111 + #define PCH_GBE_INT_TX_FIFO_ERR 0x00000400 /* Transmission FIFO underflow. */ 112 + #define PCH_GBE_INT_TX_DMA_ERR 0x00000800 /* Transmission DMA Error */ 113 + #define PCH_GBE_INT_PAUSE_CMPLT 0x00001000 /* Pause Transmission complete */ 114 + #define PCH_GBE_INT_MIIM_CMPLT 0x00010000 /* MIIM I/F Read completion */ 115 + #define PCH_GBE_INT_PHY_INT 0x00100000 /* Interruption from PHY */ 116 + #define PCH_GBE_INT_WOL_DET 0x01000000 /* Wake On LAN Event detection. */ 117 + #define PCH_GBE_INT_TCPIP_ERR 0x10000000 /* TCP/IP Accelerator Error */ 118 + 119 + /* Mode */ 120 + #define PCH_GBE_MODE_MII_ETHER 0x00000000 /* GIGA Ethernet Mode [MII] */ 121 + #define PCH_GBE_MODE_GMII_ETHER 0x80000000 /* GIGA Ethernet Mode [GMII] */ 122 + #define PCH_GBE_MODE_HALF_DUPLEX 0x00000000 /* Duplex Mode [half duplex] */ 123 + #define PCH_GBE_MODE_FULL_DUPLEX 0x40000000 /* Duplex Mode [full duplex] */ 124 + #define PCH_GBE_MODE_FR_BST 0x04000000 /* Frame bursting is done */ 125 + 126 + /* Reset */ 127 + #define PCH_GBE_ALL_RST 0x80000000 /* All reset */ 128 + #define PCH_GBE_TX_RST 0x40000000 /* TX MAC, TX FIFO, TX DMA reset */ 129 + #define PCH_GBE_RX_RST 0x04000000 /* RX MAC, RX FIFO, RX DMA reset */ 130 + 131 + /* TCP/IP Accelerator Control */ 132 + #define PCH_GBE_EX_LIST_EN 0x00000008 /* External List Enable */ 133 + #define PCH_GBE_RX_TCPIPACC_OFF 0x00000004 /* RX TCP/IP ACC Disabled */ 134 + #define PCH_GBE_TX_TCPIPACC_EN 0x00000002 /* TX TCP/IP ACC Enable */ 135 + #define PCH_GBE_RX_TCPIPACC_EN 0x00000001 /* RX TCP/IP ACC Enable */ 136 + 137 + /* MAC RX Enable */ 138 + #define PCH_GBE_MRE_MAC_RX_EN 0x00000001 /* MAC Receive Enable */ 139 + 140 + /* RX Flow Control */ 141 + #define PCH_GBE_FL_CTRL_EN 0x80000000 /* Pause packet is enabled */ 142 + 143 + /* Pause Packet Request */ 144 + #define PCH_GBE_PS_PKT_RQ 0x80000000 /* Pause packet Request */ 145 + 146 + /* RX Mode */ 147 + #define PCH_GBE_ADD_FIL_EN 0x80000000 /* Address Filtering Enable */ 148 + /* Multicast Filtering Enable */ 149 + #define PCH_GBE_MLT_FIL_EN 0x40000000 150 + /* Receive Almost Empty Threshold */ 151 + #define PCH_GBE_RH_ALM_EMP_4 0x00000000 /* 4 words */ 152 + #define PCH_GBE_RH_ALM_EMP_8 0x00004000 /* 8 words */ 153 + #define PCH_GBE_RH_ALM_EMP_16 0x00008000 /* 16 words */ 154 + #define PCH_GBE_RH_ALM_EMP_32 0x0000C000 /* 32 words */ 155 + /* Receive Almost Full Threshold */ 156 + #define PCH_GBE_RH_ALM_FULL_4 0x00000000 /* 4 words */ 157 + #define PCH_GBE_RH_ALM_FULL_8 0x00001000 /* 8 words */ 158 + #define PCH_GBE_RH_ALM_FULL_16 0x00002000 /* 16 words */ 159 + #define PCH_GBE_RH_ALM_FULL_32 0x00003000 /* 32 words */ 160 + /* RX FIFO Read Triger Threshold */ 161 + #define PCH_GBE_RH_RD_TRG_4 0x00000000 /* 4 words */ 162 + #define PCH_GBE_RH_RD_TRG_8 0x00000200 /* 8 words */ 163 + #define PCH_GBE_RH_RD_TRG_16 0x00000400 /* 16 words */ 164 + #define PCH_GBE_RH_RD_TRG_32 0x00000600 /* 32 words */ 165 + #define PCH_GBE_RH_RD_TRG_64 0x00000800 /* 64 words */ 166 + #define PCH_GBE_RH_RD_TRG_128 0x00000A00 /* 128 words */ 167 + #define PCH_GBE_RH_RD_TRG_256 0x00000C00 /* 256 words */ 168 + #define PCH_GBE_RH_RD_TRG_512 0x00000E00 /* 512 words */ 169 + 170 + /* Receive Descriptor bit definitions */ 171 + #define PCH_GBE_RXD_ACC_STAT_BCAST 0x00000400 172 + #define PCH_GBE_RXD_ACC_STAT_MCAST 0x00000200 173 + #define PCH_GBE_RXD_ACC_STAT_UCAST 0x00000100 174 + #define PCH_GBE_RXD_ACC_STAT_TCPIPOK 0x000000C0 175 + #define PCH_GBE_RXD_ACC_STAT_IPOK 0x00000080 176 + #define PCH_GBE_RXD_ACC_STAT_TCPOK 0x00000040 177 + #define PCH_GBE_RXD_ACC_STAT_IP6ERR 0x00000020 178 + #define PCH_GBE_RXD_ACC_STAT_OFLIST 0x00000010 179 + #define PCH_GBE_RXD_ACC_STAT_TYPEIP 0x00000008 180 + #define PCH_GBE_RXD_ACC_STAT_MACL 0x00000004 181 + #define PCH_GBE_RXD_ACC_STAT_PPPOE 0x00000002 182 + #define PCH_GBE_RXD_ACC_STAT_VTAGT 0x00000001 183 + #define PCH_GBE_RXD_GMAC_STAT_PAUSE 0x0200 184 + #define PCH_GBE_RXD_GMAC_STAT_MARBR 0x0100 185 + #define PCH_GBE_RXD_GMAC_STAT_MARMLT 0x0080 186 + #define PCH_GBE_RXD_GMAC_STAT_MARIND 0x0040 187 + #define PCH_GBE_RXD_GMAC_STAT_MARNOTMT 0x0020 188 + #define PCH_GBE_RXD_GMAC_STAT_TLONG 0x0010 189 + #define PCH_GBE_RXD_GMAC_STAT_TSHRT 0x0008 190 + #define PCH_GBE_RXD_GMAC_STAT_NOTOCTAL 0x0004 191 + #define PCH_GBE_RXD_GMAC_STAT_NBLERR 0x0002 192 + #define PCH_GBE_RXD_GMAC_STAT_CRCERR 0x0001 193 + 194 + /* Transmit Descriptor bit definitions */ 195 + #define PCH_GBE_TXD_CTRL_TCPIP_ACC_OFF 0x0008 196 + #define PCH_GBE_TXD_CTRL_ITAG 0x0004 197 + #define PCH_GBE_TXD_CTRL_ICRC 0x0002 198 + #define PCH_GBE_TXD_CTRL_APAD 0x0001 199 + #define PCH_GBE_TXD_WORDS_SHIFT 2 200 + #define PCH_GBE_TXD_GMAC_STAT_CMPLT 0x2000 201 + #define PCH_GBE_TXD_GMAC_STAT_ABT 0x1000 202 + #define PCH_GBE_TXD_GMAC_STAT_EXCOL 0x0800 203 + #define PCH_GBE_TXD_GMAC_STAT_SNGCOL 0x0400 204 + #define PCH_GBE_TXD_GMAC_STAT_MLTCOL 0x0200 205 + #define PCH_GBE_TXD_GMAC_STAT_CRSER 0x0100 206 + #define PCH_GBE_TXD_GMAC_STAT_TLNG 0x0080 207 + #define PCH_GBE_TXD_GMAC_STAT_TSHRT 0x0040 208 + #define PCH_GBE_TXD_GMAC_STAT_LTCOL 0x0020 209 + #define PCH_GBE_TXD_GMAC_STAT_TFUNDFLW 0x0010 210 + #define PCH_GBE_TXD_GMAC_STAT_RTYCNT_MASK 0x000F 211 + 212 + /* TX Mode */ 213 + #define PCH_GBE_TM_NO_RTRY 0x80000000 /* No Retransmission */ 214 + #define PCH_GBE_TM_LONG_PKT 0x40000000 /* Long Packt TX Enable */ 215 + #define PCH_GBE_TM_ST_AND_FD 0x20000000 /* Stare and Forward */ 216 + #define PCH_GBE_TM_SHORT_PKT 0x10000000 /* Short Packet TX Enable */ 217 + #define PCH_GBE_TM_LTCOL_RETX 0x08000000 /* Retransmission at Late Collision */ 218 + /* Frame Start Threshold */ 219 + #define PCH_GBE_TM_TH_TX_STRT_4 0x00000000 /* 4 words */ 220 + #define PCH_GBE_TM_TH_TX_STRT_8 0x00004000 /* 8 words */ 221 + #define PCH_GBE_TM_TH_TX_STRT_16 0x00008000 /* 16 words */ 222 + #define PCH_GBE_TM_TH_TX_STRT_32 0x0000C000 /* 32 words */ 223 + /* Transmit Almost Empty Threshold */ 224 + #define PCH_GBE_TM_TH_ALM_EMP_4 0x00000000 /* 4 words */ 225 + #define PCH_GBE_TM_TH_ALM_EMP_8 0x00000800 /* 8 words */ 226 + #define PCH_GBE_TM_TH_ALM_EMP_16 0x00001000 /* 16 words */ 227 + #define PCH_GBE_TM_TH_ALM_EMP_32 0x00001800 /* 32 words */ 228 + #define PCH_GBE_TM_TH_ALM_EMP_64 0x00002000 /* 64 words */ 229 + #define PCH_GBE_TM_TH_ALM_EMP_128 0x00002800 /* 128 words */ 230 + #define PCH_GBE_TM_TH_ALM_EMP_256 0x00003000 /* 256 words */ 231 + #define PCH_GBE_TM_TH_ALM_EMP_512 0x00003800 /* 512 words */ 232 + /* Transmit Almost Full Threshold */ 233 + #define PCH_GBE_TM_TH_ALM_FULL_4 0x00000000 /* 4 words */ 234 + #define PCH_GBE_TM_TH_ALM_FULL_8 0x00000200 /* 8 words */ 235 + #define PCH_GBE_TM_TH_ALM_FULL_16 0x00000400 /* 16 words */ 236 + #define PCH_GBE_TM_TH_ALM_FULL_32 0x00000600 /* 32 words */ 237 + 238 + /* RX FIFO Status */ 239 + #define PCH_GBE_RF_ALM_FULL 0x80000000 /* RX FIFO is almost full. */ 240 + #define PCH_GBE_RF_ALM_EMP 0x40000000 /* RX FIFO is almost empty. */ 241 + #define PCH_GBE_RF_RD_TRG 0x20000000 /* Become more than RH_RD_TRG. */ 242 + #define PCH_GBE_RF_STRWD 0x1FFE0000 /* The word count of RX FIFO. */ 243 + #define PCH_GBE_RF_RCVING 0x00010000 /* Stored in RX FIFO. */ 244 + 245 + /* MAC Address Mask */ 246 + #define PCH_GBE_BUSY 0x80000000 247 + 248 + /* MIIM */ 249 + #define PCH_GBE_MIIM_OPER_WRITE 0x04000000 250 + #define PCH_GBE_MIIM_OPER_READ 0x00000000 251 + #define PCH_GBE_MIIM_OPER_READY 0x04000000 252 + #define PCH_GBE_MIIM_PHY_ADDR_SHIFT 21 253 + #define PCH_GBE_MIIM_REG_ADDR_SHIFT 16 254 + 255 + /* RGMII Status */ 256 + #define PCH_GBE_LINK_UP 0x80000008 257 + #define PCH_GBE_RXC_SPEED_MSK 0x00000006 258 + #define PCH_GBE_RXC_SPEED_2_5M 0x00000000 /* 2.5MHz */ 259 + #define PCH_GBE_RXC_SPEED_25M 0x00000002 /* 25MHz */ 260 + #define PCH_GBE_RXC_SPEED_125M 0x00000004 /* 100MHz */ 261 + #define PCH_GBE_DUPLEX_FULL 0x00000001 262 + 263 + /* RGMII Control */ 264 + #define PCH_GBE_CRS_SEL 0x00000010 265 + #define PCH_GBE_RGMII_RATE_125M 0x00000000 266 + #define PCH_GBE_RGMII_RATE_25M 0x00000008 267 + #define PCH_GBE_RGMII_RATE_2_5M 0x0000000C 268 + #define PCH_GBE_RGMII_MODE_GMII 0x00000000 269 + #define PCH_GBE_RGMII_MODE_RGMII 0x00000002 270 + #define PCH_GBE_CHIP_TYPE_EXTERNAL 0x00000000 271 + #define PCH_GBE_CHIP_TYPE_INTERNAL 0x00000001 272 + 273 + /* DMA Control */ 274 + #define PCH_GBE_RX_DMA_EN 0x00000002 /* Enables Receive DMA */ 275 + #define PCH_GBE_TX_DMA_EN 0x00000001 /* Enables Transmission DMA */ 276 + 277 + /* Wake On LAN Status */ 278 + #define PCH_GBE_WLS_BR 0x00000008 /* Broadcas Address */ 279 + #define PCH_GBE_WLS_MLT 0x00000004 /* Multicast Address */ 280 + 281 + /* The Frame registered in Address Recognizer */ 282 + #define PCH_GBE_WLS_IND 0x00000002 283 + #define PCH_GBE_WLS_MP 0x00000001 /* Magic packet Address */ 284 + 285 + /* Wake On LAN Control */ 286 + #define PCH_GBE_WLC_WOL_MODE 0x00010000 287 + #define PCH_GBE_WLC_IGN_TLONG 0x00000100 288 + #define PCH_GBE_WLC_IGN_TSHRT 0x00000080 289 + #define PCH_GBE_WLC_IGN_OCTER 0x00000040 290 + #define PCH_GBE_WLC_IGN_NBLER 0x00000020 291 + #define PCH_GBE_WLC_IGN_CRCER 0x00000010 292 + #define PCH_GBE_WLC_BR 0x00000008 293 + #define PCH_GBE_WLC_MLT 0x00000004 294 + #define PCH_GBE_WLC_IND 0x00000002 295 + #define PCH_GBE_WLC_MP 0x00000001 296 + 297 + /* Wake On LAN Address Mask */ 298 + #define PCH_GBE_WLA_BUSY 0x80000000 299 + 300 + 301 + 302 + /* TX/RX descriptor defines */ 303 + #define PCH_GBE_MAX_TXD 4096 304 + #define PCH_GBE_DEFAULT_TXD 256 305 + #define PCH_GBE_MIN_TXD 8 306 + #define PCH_GBE_MAX_RXD 4096 307 + #define PCH_GBE_DEFAULT_RXD 256 308 + #define PCH_GBE_MIN_RXD 8 309 + 310 + /* Number of Transmit and Receive Descriptors must be a multiple of 8 */ 311 + #define PCH_GBE_TX_DESC_MULTIPLE 8 312 + #define PCH_GBE_RX_DESC_MULTIPLE 8 313 + 314 + /* Read/Write operation is done through MII Management IF */ 315 + #define PCH_GBE_HAL_MIIM_READ ((u32)0x00000000) 316 + #define PCH_GBE_HAL_MIIM_WRITE ((u32)0x04000000) 317 + 318 + /* flow control values */ 319 + #define PCH_GBE_FC_NONE 0 320 + #define PCH_GBE_FC_RX_PAUSE 1 321 + #define PCH_GBE_FC_TX_PAUSE 2 322 + #define PCH_GBE_FC_FULL 3 323 + #define PCH_GBE_FC_DEFAULT PCH_GBE_FC_FULL 324 + 325 + 326 + struct pch_gbe_hw; 327 + /** 328 + * struct pch_gbe_functions - HAL APi function pointer 329 + * @get_bus_info: for pch_gbe_hal_get_bus_info 330 + * @init_hw: for pch_gbe_hal_init_hw 331 + * @read_phy_reg: for pch_gbe_hal_read_phy_reg 332 + * @write_phy_reg: for pch_gbe_hal_write_phy_reg 333 + * @reset_phy: for pch_gbe_hal_phy_hw_reset 334 + * @sw_reset_phy: for pch_gbe_hal_phy_sw_reset 335 + * @power_up_phy: for pch_gbe_hal_power_up_phy 336 + * @power_down_phy: for pch_gbe_hal_power_down_phy 337 + * @read_mac_addr: for pch_gbe_hal_read_mac_addr 338 + */ 339 + struct pch_gbe_functions { 340 + void (*get_bus_info) (struct pch_gbe_hw *); 341 + s32 (*init_hw) (struct pch_gbe_hw *); 342 + s32 (*read_phy_reg) (struct pch_gbe_hw *, u32, u16 *); 343 + s32 (*write_phy_reg) (struct pch_gbe_hw *, u32, u16); 344 + void (*reset_phy) (struct pch_gbe_hw *); 345 + void (*sw_reset_phy) (struct pch_gbe_hw *); 346 + void (*power_up_phy) (struct pch_gbe_hw *hw); 347 + void (*power_down_phy) (struct pch_gbe_hw *hw); 348 + s32 (*read_mac_addr) (struct pch_gbe_hw *); 349 + }; 350 + 351 + /** 352 + * struct pch_gbe_mac_info - MAC infomation 353 + * @addr[6]: Store the MAC address 354 + * @fc: Mode of flow control 355 + * @fc_autoneg: Auto negotiation enable for flow control setting 356 + * @tx_fc_enable: Enable flag of Transmit flow control 357 + * @max_frame_size: Max transmit frame size 358 + * @min_frame_size: Min transmit frame size 359 + * @autoneg: Auto negotiation enable 360 + * @link_speed: Link speed 361 + * @link_duplex: Link duplex 362 + */ 363 + struct pch_gbe_mac_info { 364 + u8 addr[6]; 365 + u8 fc; 366 + u8 fc_autoneg; 367 + u8 tx_fc_enable; 368 + u32 max_frame_size; 369 + u32 min_frame_size; 370 + u8 autoneg; 371 + u16 link_speed; 372 + u16 link_duplex; 373 + }; 374 + 375 + /** 376 + * struct pch_gbe_phy_info - PHY infomation 377 + * @addr: PHY address 378 + * @id: PHY's identifier 379 + * @revision: PHY's revision 380 + * @reset_delay_us: HW reset delay time[us] 381 + * @autoneg_advertised: Autoneg advertised 382 + */ 383 + struct pch_gbe_phy_info { 384 + u32 addr; 385 + u32 id; 386 + u32 revision; 387 + u32 reset_delay_us; 388 + u16 autoneg_advertised; 389 + }; 390 + 391 + /*! 392 + * @ingroup Gigabit Ether driver Layer 393 + * @struct pch_gbe_bus_info 394 + * @brief Bus infomation 395 + */ 396 + struct pch_gbe_bus_info { 397 + u8 type; 398 + u8 speed; 399 + u8 width; 400 + }; 401 + 402 + /*! 403 + * @ingroup Gigabit Ether driver Layer 404 + * @struct pch_gbe_hw 405 + * @brief Hardware infomation 406 + */ 407 + struct pch_gbe_hw { 408 + void *back; 409 + 410 + struct pch_gbe_regs __iomem *reg; 411 + spinlock_t miim_lock; 412 + 413 + const struct pch_gbe_functions *func; 414 + struct pch_gbe_mac_info mac; 415 + struct pch_gbe_phy_info phy; 416 + struct pch_gbe_bus_info bus; 417 + }; 418 + 419 + /** 420 + * struct pch_gbe_rx_desc - Receive Descriptor 421 + * @buffer_addr: RX Frame Buffer Address 422 + * @tcp_ip_status: TCP/IP Accelerator Status 423 + * @rx_words_eob: RX word count and Byte position 424 + * @gbec_status: GMAC Status 425 + * @dma_status: DMA Status 426 + * @reserved1: Reserved 427 + * @reserved2: Reserved 428 + */ 429 + struct pch_gbe_rx_desc { 430 + u32 buffer_addr; 431 + u32 tcp_ip_status; 432 + u16 rx_words_eob; 433 + u16 gbec_status; 434 + u8 dma_status; 435 + u8 reserved1; 436 + u16 reserved2; 437 + }; 438 + 439 + /** 440 + * struct pch_gbe_tx_desc - Transmit Descriptor 441 + * @buffer_addr: TX Frame Buffer Address 442 + * @length: Data buffer length 443 + * @reserved1: Reserved 444 + * @tx_words_eob: TX word count and Byte position 445 + * @tx_frame_ctrl: TX Frame Control 446 + * @dma_status: DMA Status 447 + * @reserved2: Reserved 448 + * @gbec_status: GMAC Status 449 + */ 450 + struct pch_gbe_tx_desc { 451 + u32 buffer_addr; 452 + u16 length; 453 + u16 reserved1; 454 + u16 tx_words_eob; 455 + u16 tx_frame_ctrl; 456 + u8 dma_status; 457 + u8 reserved2; 458 + u16 gbec_status; 459 + }; 460 + 461 + 462 + /** 463 + * struct pch_gbe_buffer - Buffer infomation 464 + * @skb: pointer to a socket buffer 465 + * @dma: DMA address 466 + * @time_stamp: time stamp 467 + * @length: data size 468 + */ 469 + struct pch_gbe_buffer { 470 + struct sk_buff *skb; 471 + dma_addr_t dma; 472 + unsigned long time_stamp; 473 + u16 length; 474 + bool mapped; 475 + }; 476 + 477 + /** 478 + * struct pch_gbe_tx_ring - tx ring infomation 479 + * @tx_lock: spinlock structs 480 + * @desc: pointer to the descriptor ring memory 481 + * @dma: physical address of the descriptor ring 482 + * @size: length of descriptor ring in bytes 483 + * @count: number of descriptors in the ring 484 + * @next_to_use: next descriptor to associate a buffer with 485 + * @next_to_clean: next descriptor to check for DD status bit 486 + * @buffer_info: array of buffer information structs 487 + */ 488 + struct pch_gbe_tx_ring { 489 + spinlock_t tx_lock; 490 + struct pch_gbe_tx_desc *desc; 491 + dma_addr_t dma; 492 + unsigned int size; 493 + unsigned int count; 494 + unsigned int next_to_use; 495 + unsigned int next_to_clean; 496 + struct pch_gbe_buffer *buffer_info; 497 + }; 498 + 499 + /** 500 + * struct pch_gbe_rx_ring - rx ring infomation 501 + * @desc: pointer to the descriptor ring memory 502 + * @dma: physical address of the descriptor ring 503 + * @size: length of descriptor ring in bytes 504 + * @count: number of descriptors in the ring 505 + * @next_to_use: next descriptor to associate a buffer with 506 + * @next_to_clean: next descriptor to check for DD status bit 507 + * @buffer_info: array of buffer information structs 508 + */ 509 + struct pch_gbe_rx_ring { 510 + struct pch_gbe_rx_desc *desc; 511 + dma_addr_t dma; 512 + unsigned int size; 513 + unsigned int count; 514 + unsigned int next_to_use; 515 + unsigned int next_to_clean; 516 + struct pch_gbe_buffer *buffer_info; 517 + }; 518 + 519 + /** 520 + * struct pch_gbe_hw_stats - Statistics counters collected by the MAC 521 + * @rx_packets: total packets received 522 + * @tx_packets: total packets transmitted 523 + * @rx_bytes: total bytes received 524 + * @tx_bytes: total bytes transmitted 525 + * @rx_errors: bad packets received 526 + * @tx_errors: packet transmit problems 527 + * @rx_dropped: no space in Linux buffers 528 + * @tx_dropped: no space available in Linux 529 + * @multicast: multicast packets received 530 + * @collisions: collisions 531 + * @rx_crc_errors: received packet with crc error 532 + * @rx_frame_errors: received frame alignment error 533 + * @rx_alloc_buff_failed: allocate failure of a receive buffer 534 + * @tx_length_errors: transmit length error 535 + * @tx_aborted_errors: transmit aborted error 536 + * @tx_carrier_errors: transmit carrier error 537 + * @tx_timeout_count: Number of transmit timeout 538 + * @tx_restart_count: Number of transmit restert 539 + * @intr_rx_dsc_empty_count: Interrupt count of receive descriptor empty 540 + * @intr_rx_frame_err_count: Interrupt count of receive frame error 541 + * @intr_rx_fifo_err_count: Interrupt count of receive FIFO error 542 + * @intr_rx_dma_err_count: Interrupt count of receive DMA error 543 + * @intr_tx_fifo_err_count: Interrupt count of transmit FIFO error 544 + * @intr_tx_dma_err_count: Interrupt count of transmit DMA error 545 + * @intr_tcpip_err_count: Interrupt count of TCP/IP Accelerator 546 + */ 547 + struct pch_gbe_hw_stats { 548 + u32 rx_packets; 549 + u32 tx_packets; 550 + u32 rx_bytes; 551 + u32 tx_bytes; 552 + u32 rx_errors; 553 + u32 tx_errors; 554 + u32 rx_dropped; 555 + u32 tx_dropped; 556 + u32 multicast; 557 + u32 collisions; 558 + u32 rx_crc_errors; 559 + u32 rx_frame_errors; 560 + u32 rx_alloc_buff_failed; 561 + u32 tx_length_errors; 562 + u32 tx_aborted_errors; 563 + u32 tx_carrier_errors; 564 + u32 tx_timeout_count; 565 + u32 tx_restart_count; 566 + u32 intr_rx_dsc_empty_count; 567 + u32 intr_rx_frame_err_count; 568 + u32 intr_rx_fifo_err_count; 569 + u32 intr_rx_dma_err_count; 570 + u32 intr_tx_fifo_err_count; 571 + u32 intr_tx_dma_err_count; 572 + u32 intr_tcpip_err_count; 573 + }; 574 + 575 + /** 576 + * struct pch_gbe_adapter - board specific private data structure 577 + * @stats_lock: Spinlock structure for status 578 + * @tx_queue_lock: Spinlock structure for transmit 579 + * @ethtool_lock: Spinlock structure for ethtool 580 + * @irq_sem: Semaphore for interrupt 581 + * @netdev: Pointer of network device structure 582 + * @pdev: Pointer of pci device structure 583 + * @polling_netdev: Pointer of polling network device structure 584 + * @napi: NAPI structure 585 + * @hw: Pointer of hardware structure 586 + * @stats: Hardware status 587 + * @reset_task: Reset task 588 + * @mii: MII information structure 589 + * @watchdog_timer: Watchdog timer list 590 + * @wake_up_evt: Wake up event 591 + * @config_space: Configuration space 592 + * @msg_enable: Driver message level 593 + * @led_status: LED status 594 + * @tx_ring: Pointer of Tx descriptor ring structure 595 + * @rx_ring: Pointer of Rx descriptor ring structure 596 + * @rx_buffer_len: Receive buffer length 597 + * @tx_queue_len: Transmit queue length 598 + * @rx_csum: Receive TCP/IP checksum enable/disable 599 + * @tx_csum: Transmit TCP/IP checksum enable/disable 600 + * @have_msi: PCI MSI mode flag 601 + */ 602 + 603 + struct pch_gbe_adapter { 604 + spinlock_t stats_lock; 605 + spinlock_t tx_queue_lock; 606 + spinlock_t ethtool_lock; 607 + atomic_t irq_sem; 608 + struct net_device *netdev; 609 + struct pci_dev *pdev; 610 + struct net_device *polling_netdev; 611 + struct napi_struct napi; 612 + struct pch_gbe_hw hw; 613 + struct pch_gbe_hw_stats stats; 614 + struct work_struct reset_task; 615 + struct mii_if_info mii; 616 + struct timer_list watchdog_timer; 617 + u32 wake_up_evt; 618 + u32 *config_space; 619 + unsigned long led_status; 620 + struct pch_gbe_tx_ring *tx_ring; 621 + struct pch_gbe_rx_ring *rx_ring; 622 + unsigned long rx_buffer_len; 623 + unsigned long tx_queue_len; 624 + bool rx_csum; 625 + bool tx_csum; 626 + bool have_msi; 627 + }; 628 + 629 + extern const char pch_driver_version[]; 630 + 631 + /* pch_gbe_main.c */ 632 + extern int pch_gbe_up(struct pch_gbe_adapter *adapter); 633 + extern void pch_gbe_down(struct pch_gbe_adapter *adapter); 634 + extern void pch_gbe_reinit_locked(struct pch_gbe_adapter *adapter); 635 + extern void pch_gbe_reset(struct pch_gbe_adapter *adapter); 636 + extern int pch_gbe_setup_tx_resources(struct pch_gbe_adapter *adapter, 637 + struct pch_gbe_tx_ring *txdr); 638 + extern int pch_gbe_setup_rx_resources(struct pch_gbe_adapter *adapter, 639 + struct pch_gbe_rx_ring *rxdr); 640 + extern void pch_gbe_free_tx_resources(struct pch_gbe_adapter *adapter, 641 + struct pch_gbe_tx_ring *tx_ring); 642 + extern void pch_gbe_free_rx_resources(struct pch_gbe_adapter *adapter, 643 + struct pch_gbe_rx_ring *rx_ring); 644 + extern void pch_gbe_update_stats(struct pch_gbe_adapter *adapter); 645 + extern int pch_gbe_mdio_read(struct net_device *netdev, int addr, int reg); 646 + extern void pch_gbe_mdio_write(struct net_device *netdev, int addr, int reg, 647 + int data); 648 + /* pch_gbe_param.c */ 649 + extern void pch_gbe_check_options(struct pch_gbe_adapter *adapter); 650 + 651 + /* pch_gbe_ethtool.c */ 652 + extern void pch_gbe_set_ethtool_ops(struct net_device *netdev); 653 + 654 + /* pch_gbe_mac.c */ 655 + extern s32 pch_gbe_mac_force_mac_fc(struct pch_gbe_hw *hw); 656 + extern s32 pch_gbe_mac_read_mac_addr(struct pch_gbe_hw *hw); 657 + extern u16 pch_gbe_mac_ctrl_miim(struct pch_gbe_hw *hw, 658 + u32 addr, u32 dir, u32 reg, u16 data); 659 + #endif /* _PCH_GBE_H_ */
+245
drivers/net/pch_gbe/pch_gbe_api.c
··· 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, write to the Free Software 18 + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA. 19 + */ 20 + #include "pch_gbe.h" 21 + #include "pch_gbe_phy.h" 22 + 23 + /* bus type values */ 24 + #define pch_gbe_bus_type_unknown 0 25 + #define pch_gbe_bus_type_pci 1 26 + #define pch_gbe_bus_type_pcix 2 27 + #define pch_gbe_bus_type_pci_express 3 28 + #define pch_gbe_bus_type_reserved 4 29 + 30 + /* bus speed values */ 31 + #define pch_gbe_bus_speed_unknown 0 32 + #define pch_gbe_bus_speed_33 1 33 + #define pch_gbe_bus_speed_66 2 34 + #define pch_gbe_bus_speed_100 3 35 + #define pch_gbe_bus_speed_120 4 36 + #define pch_gbe_bus_speed_133 5 37 + #define pch_gbe_bus_speed_2500 6 38 + #define pch_gbe_bus_speed_reserved 7 39 + 40 + /* bus width values */ 41 + #define pch_gbe_bus_width_unknown 0 42 + #define pch_gbe_bus_width_pcie_x1 1 43 + #define pch_gbe_bus_width_pcie_x2 2 44 + #define pch_gbe_bus_width_pcie_x4 4 45 + #define pch_gbe_bus_width_32 5 46 + #define pch_gbe_bus_width_64 6 47 + #define pch_gbe_bus_width_reserved 7 48 + 49 + /** 50 + * pch_gbe_plat_get_bus_info - Obtain bus information for adapter 51 + * @hw: Pointer to the HW structure 52 + */ 53 + static void pch_gbe_plat_get_bus_info(struct pch_gbe_hw *hw) 54 + { 55 + hw->bus.type = pch_gbe_bus_type_pci_express; 56 + hw->bus.speed = pch_gbe_bus_speed_2500; 57 + hw->bus.width = pch_gbe_bus_width_pcie_x1; 58 + } 59 + 60 + /** 61 + * pch_gbe_plat_init_hw - Initialize hardware 62 + * @hw: Pointer to the HW structure 63 + * Returns 64 + * 0: Successfully 65 + * Negative value: Failed-EBUSY 66 + */ 67 + static s32 pch_gbe_plat_init_hw(struct pch_gbe_hw *hw) 68 + { 69 + s32 ret_val; 70 + 71 + ret_val = pch_gbe_phy_get_id(hw); 72 + if (ret_val) { 73 + pr_err("pch_gbe_phy_get_id error\n"); 74 + return ret_val; 75 + } 76 + pch_gbe_phy_init_setting(hw); 77 + /* Setup Mac interface option RGMII */ 78 + #ifdef PCH_GBE_MAC_IFOP_RGMII 79 + pch_gbe_phy_set_rgmii(hw); 80 + #endif 81 + return ret_val; 82 + } 83 + 84 + static const struct pch_gbe_functions pch_gbe_ops = { 85 + .get_bus_info = pch_gbe_plat_get_bus_info, 86 + .init_hw = pch_gbe_plat_init_hw, 87 + .read_phy_reg = pch_gbe_phy_read_reg_miic, 88 + .write_phy_reg = pch_gbe_phy_write_reg_miic, 89 + .reset_phy = pch_gbe_phy_hw_reset, 90 + .sw_reset_phy = pch_gbe_phy_sw_reset, 91 + .power_up_phy = pch_gbe_phy_power_up, 92 + .power_down_phy = pch_gbe_phy_power_down, 93 + .read_mac_addr = pch_gbe_mac_read_mac_addr 94 + }; 95 + 96 + /** 97 + * pch_gbe_plat_init_function_pointers - Init func ptrs 98 + * @hw: Pointer to the HW structure 99 + */ 100 + void pch_gbe_plat_init_function_pointers(struct pch_gbe_hw *hw) 101 + { 102 + /* Set PHY parameter */ 103 + hw->phy.reset_delay_us = PCH_GBE_PHY_RESET_DELAY_US; 104 + /* Set function pointers */ 105 + hw->func = &pch_gbe_ops; 106 + } 107 + 108 + /** 109 + * pch_gbe_hal_setup_init_funcs - Initializes function pointers 110 + * @hw: Pointer to the HW structure 111 + * Returns 112 + * 0: Successfully 113 + * ENOSYS: Function is not registered 114 + */ 115 + inline s32 pch_gbe_hal_setup_init_funcs(struct pch_gbe_hw *hw) 116 + { 117 + if (!hw->reg) { 118 + pr_err("ERROR: Registers not mapped\n"); 119 + return -ENOSYS; 120 + } 121 + pch_gbe_plat_init_function_pointers(hw); 122 + return 0; 123 + } 124 + 125 + /** 126 + * pch_gbe_hal_get_bus_info - Obtain bus information for adapter 127 + * @hw: Pointer to the HW structure 128 + */ 129 + inline void pch_gbe_hal_get_bus_info(struct pch_gbe_hw *hw) 130 + { 131 + if (!hw->func->get_bus_info) 132 + pr_err("ERROR: configuration\n"); 133 + else 134 + hw->func->get_bus_info(hw); 135 + } 136 + 137 + /** 138 + * pch_gbe_hal_init_hw - Initialize hardware 139 + * @hw: Pointer to the HW structure 140 + * Returns 141 + * 0: Successfully 142 + * ENOSYS: Function is not registered 143 + */ 144 + inline s32 pch_gbe_hal_init_hw(struct pch_gbe_hw *hw) 145 + { 146 + if (!hw->func->init_hw) { 147 + pr_err("ERROR: configuration\n"); 148 + return -ENOSYS; 149 + } 150 + return hw->func->init_hw(hw); 151 + } 152 + 153 + /** 154 + * pch_gbe_hal_read_phy_reg - Reads PHY register 155 + * @hw: Pointer to the HW structure 156 + * @offset: The register to read 157 + * @data: The buffer to store the 16-bit read. 158 + * Returns 159 + * 0: Successfully 160 + * Negative value: Failed 161 + */ 162 + inline s32 pch_gbe_hal_read_phy_reg(struct pch_gbe_hw *hw, u32 offset, 163 + u16 *data) 164 + { 165 + if (!hw->func->read_phy_reg) 166 + return 0; 167 + return hw->func->read_phy_reg(hw, offset, data); 168 + } 169 + 170 + /** 171 + * pch_gbe_hal_write_phy_reg - Writes PHY register 172 + * @hw: Pointer to the HW structure 173 + * @offset: The register to read 174 + * @data: The value to write. 175 + * Returns 176 + * 0: Successfully 177 + * Negative value: Failed 178 + */ 179 + inline s32 pch_gbe_hal_write_phy_reg(struct pch_gbe_hw *hw, u32 offset, 180 + u16 data) 181 + { 182 + if (!hw->func->write_phy_reg) 183 + return 0; 184 + return hw->func->write_phy_reg(hw, offset, data); 185 + } 186 + 187 + /** 188 + * pch_gbe_hal_phy_hw_reset - Hard PHY reset 189 + * @hw: Pointer to the HW structure 190 + */ 191 + inline void pch_gbe_hal_phy_hw_reset(struct pch_gbe_hw *hw) 192 + { 193 + if (!hw->func->reset_phy) 194 + pr_err("ERROR: configuration\n"); 195 + else 196 + hw->func->reset_phy(hw); 197 + } 198 + 199 + /** 200 + * pch_gbe_hal_phy_sw_reset - Soft PHY reset 201 + * @hw: Pointer to the HW structure 202 + */ 203 + inline void pch_gbe_hal_phy_sw_reset(struct pch_gbe_hw *hw) 204 + { 205 + if (!hw->func->sw_reset_phy) 206 + pr_err("ERROR: configuration\n"); 207 + else 208 + hw->func->sw_reset_phy(hw); 209 + } 210 + 211 + /** 212 + * pch_gbe_hal_read_mac_addr - Reads MAC address 213 + * @hw: Pointer to the HW structure 214 + * Returns 215 + * 0: Successfully 216 + * ENOSYS: Function is not registered 217 + */ 218 + inline s32 pch_gbe_hal_read_mac_addr(struct pch_gbe_hw *hw) 219 + { 220 + if (!hw->func->read_mac_addr) { 221 + pr_err("ERROR: configuration\n"); 222 + return -ENOSYS; 223 + } 224 + return hw->func->read_mac_addr(hw); 225 + } 226 + 227 + /** 228 + * pch_gbe_hal_power_up_phy - Power up PHY 229 + * @hw: Pointer to the HW structure 230 + */ 231 + inline void pch_gbe_hal_power_up_phy(struct pch_gbe_hw *hw) 232 + { 233 + if (hw->func->power_up_phy) 234 + hw->func->power_up_phy(hw); 235 + } 236 + 237 + /** 238 + * pch_gbe_hal_power_down_phy - Power down PHY 239 + * @hw: Pointer to the HW structure 240 + */ 241 + inline void pch_gbe_hal_power_down_phy(struct pch_gbe_hw *hw) 242 + { 243 + if (hw->func->power_down_phy) 244 + hw->func->power_down_phy(hw); 245 + }
+36
drivers/net/pch_gbe/pch_gbe_api.h
··· 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, write to the Free Software 18 + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA. 19 + */ 20 + #ifndef _PCH_GBE_API_H_ 21 + #define _PCH_GBE_API_H_ 22 + 23 + #include "pch_gbe_phy.h" 24 + 25 + s32 pch_gbe_hal_setup_init_funcs(struct pch_gbe_hw *hw); 26 + void pch_gbe_hal_get_bus_info(struct pch_gbe_hw *hw); 27 + s32 pch_gbe_hal_init_hw(struct pch_gbe_hw *hw); 28 + s32 pch_gbe_hal_read_phy_reg(struct pch_gbe_hw *hw, u32 offset, u16 *data); 29 + s32 pch_gbe_hal_write_phy_reg(struct pch_gbe_hw *hw, u32 offset, u16 data); 30 + void pch_gbe_hal_phy_hw_reset(struct pch_gbe_hw *hw); 31 + void pch_gbe_hal_phy_sw_reset(struct pch_gbe_hw *hw); 32 + s32 pch_gbe_hal_read_mac_addr(struct pch_gbe_hw *hw); 33 + void pch_gbe_hal_power_up_phy(struct pch_gbe_hw *hw); 34 + void pch_gbe_hal_power_down_phy(struct pch_gbe_hw *hw); 35 + 36 + #endif
+584
drivers/net/pch_gbe/pch_gbe_ethtool.c
··· 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, write to the Free Software 18 + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA. 19 + */ 20 + #include "pch_gbe.h" 21 + #include "pch_gbe_api.h" 22 + 23 + /** 24 + * pch_gbe_stats - Stats item infomation 25 + */ 26 + struct pch_gbe_stats { 27 + char string[ETH_GSTRING_LEN]; 28 + size_t size; 29 + size_t offset; 30 + }; 31 + 32 + #define PCH_GBE_STAT(m) \ 33 + { \ 34 + .string = #m, \ 35 + .size = FIELD_SIZEOF(struct pch_gbe_hw_stats, m), \ 36 + .offset = offsetof(struct pch_gbe_hw_stats, m), \ 37 + } 38 + 39 + /** 40 + * pch_gbe_gstrings_stats - ethtool information status name list 41 + */ 42 + static const struct pch_gbe_stats pch_gbe_gstrings_stats[] = { 43 + PCH_GBE_STAT(rx_packets), 44 + PCH_GBE_STAT(tx_packets), 45 + PCH_GBE_STAT(rx_bytes), 46 + PCH_GBE_STAT(tx_bytes), 47 + PCH_GBE_STAT(rx_errors), 48 + PCH_GBE_STAT(tx_errors), 49 + PCH_GBE_STAT(rx_dropped), 50 + PCH_GBE_STAT(tx_dropped), 51 + PCH_GBE_STAT(multicast), 52 + PCH_GBE_STAT(collisions), 53 + PCH_GBE_STAT(rx_crc_errors), 54 + PCH_GBE_STAT(rx_frame_errors), 55 + PCH_GBE_STAT(rx_alloc_buff_failed), 56 + PCH_GBE_STAT(tx_length_errors), 57 + PCH_GBE_STAT(tx_aborted_errors), 58 + PCH_GBE_STAT(tx_carrier_errors), 59 + PCH_GBE_STAT(tx_timeout_count), 60 + PCH_GBE_STAT(tx_restart_count), 61 + PCH_GBE_STAT(intr_rx_dsc_empty_count), 62 + PCH_GBE_STAT(intr_rx_frame_err_count), 63 + PCH_GBE_STAT(intr_rx_fifo_err_count), 64 + PCH_GBE_STAT(intr_rx_dma_err_count), 65 + PCH_GBE_STAT(intr_tx_fifo_err_count), 66 + PCH_GBE_STAT(intr_tx_dma_err_count), 67 + PCH_GBE_STAT(intr_tcpip_err_count) 68 + }; 69 + 70 + #define PCH_GBE_QUEUE_STATS_LEN 0 71 + #define PCH_GBE_GLOBAL_STATS_LEN ARRAY_SIZE(pch_gbe_gstrings_stats) 72 + #define PCH_GBE_STATS_LEN (PCH_GBE_GLOBAL_STATS_LEN + PCH_GBE_QUEUE_STATS_LEN) 73 + 74 + #define PCH_GBE_MAC_REGS_LEN (sizeof(struct pch_gbe_regs) / 4) 75 + #define PCH_GBE_REGS_LEN (PCH_GBE_MAC_REGS_LEN + PCH_GBE_PHY_REGS_LEN) 76 + /** 77 + * pch_gbe_get_settings - Get device-specific settings 78 + * @netdev: Network interface device structure 79 + * @ecmd: Ethtool command 80 + * Returns 81 + * 0: Successful. 82 + * Negative value: Failed. 83 + */ 84 + static int pch_gbe_get_settings(struct net_device *netdev, 85 + struct ethtool_cmd *ecmd) 86 + { 87 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 88 + int ret; 89 + 90 + ret = mii_ethtool_gset(&adapter->mii, ecmd); 91 + ecmd->supported &= ~(SUPPORTED_TP | SUPPORTED_1000baseT_Half); 92 + ecmd->advertising &= ~(ADVERTISED_TP | ADVERTISED_1000baseT_Half); 93 + 94 + if (!netif_carrier_ok(adapter->netdev)) 95 + ecmd->speed = -1; 96 + return ret; 97 + } 98 + 99 + /** 100 + * pch_gbe_set_settings - Set device-specific settings 101 + * @netdev: Network interface device structure 102 + * @ecmd: Ethtool command 103 + * Returns 104 + * 0: Successful. 105 + * Negative value: Failed. 106 + */ 107 + static int pch_gbe_set_settings(struct net_device *netdev, 108 + struct ethtool_cmd *ecmd) 109 + { 110 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 111 + struct pch_gbe_hw *hw = &adapter->hw; 112 + int ret; 113 + 114 + pch_gbe_hal_write_phy_reg(hw, MII_BMCR, BMCR_RESET); 115 + 116 + if (ecmd->speed == -1) 117 + ecmd->speed = SPEED_1000; 118 + ecmd->duplex = DUPLEX_FULL; 119 + ret = mii_ethtool_sset(&adapter->mii, ecmd); 120 + if (ret) { 121 + pr_err("Error: mii_ethtool_sset\n"); 122 + return ret; 123 + } 124 + hw->mac.link_speed = ecmd->speed; 125 + hw->mac.link_duplex = ecmd->duplex; 126 + hw->phy.autoneg_advertised = ecmd->advertising; 127 + hw->mac.autoneg = ecmd->autoneg; 128 + pch_gbe_hal_phy_sw_reset(hw); 129 + 130 + /* reset the link */ 131 + if (netif_running(adapter->netdev)) { 132 + pch_gbe_down(adapter); 133 + ret = pch_gbe_up(adapter); 134 + } else { 135 + pch_gbe_reset(adapter); 136 + } 137 + return ret; 138 + } 139 + 140 + /** 141 + * pch_gbe_get_regs_len - Report the size of device registers 142 + * @netdev: Network interface device structure 143 + * Returns: the size of device registers. 144 + */ 145 + static int pch_gbe_get_regs_len(struct net_device *netdev) 146 + { 147 + return PCH_GBE_REGS_LEN * (int)sizeof(u32); 148 + } 149 + 150 + /** 151 + * pch_gbe_get_drvinfo - Report driver information 152 + * @netdev: Network interface device structure 153 + * @drvinfo: Driver information structure 154 + */ 155 + static void pch_gbe_get_drvinfo(struct net_device *netdev, 156 + struct ethtool_drvinfo *drvinfo) 157 + { 158 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 159 + 160 + strcpy(drvinfo->driver, KBUILD_MODNAME); 161 + strcpy(drvinfo->version, pch_driver_version); 162 + strcpy(drvinfo->fw_version, "N/A"); 163 + strcpy(drvinfo->bus_info, pci_name(adapter->pdev)); 164 + drvinfo->regdump_len = pch_gbe_get_regs_len(netdev); 165 + } 166 + 167 + /** 168 + * pch_gbe_get_regs - Get device registers 169 + * @netdev: Network interface device structure 170 + * @regs: Ethtool register structure 171 + * @p: Buffer pointer of read device register date 172 + */ 173 + static void pch_gbe_get_regs(struct net_device *netdev, 174 + struct ethtool_regs *regs, void *p) 175 + { 176 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 177 + struct pch_gbe_hw *hw = &adapter->hw; 178 + struct pci_dev *pdev = adapter->pdev; 179 + u32 *regs_buff = p; 180 + u16 i, tmp; 181 + 182 + regs->version = 0x1000000 | (__u32)pdev->revision << 16 | pdev->device; 183 + for (i = 0; i < PCH_GBE_MAC_REGS_LEN; i++) 184 + *regs_buff++ = ioread32(&hw->reg->INT_ST + i); 185 + /* PHY register */ 186 + for (i = 0; i < PCH_GBE_PHY_REGS_LEN; i++) { 187 + pch_gbe_hal_read_phy_reg(&adapter->hw, i, &tmp); 188 + *regs_buff++ = tmp; 189 + } 190 + } 191 + 192 + /** 193 + * pch_gbe_get_wol - Report whether Wake-on-Lan is enabled 194 + * @netdev: Network interface device structure 195 + * @wol: Wake-on-Lan information 196 + */ 197 + static void pch_gbe_get_wol(struct net_device *netdev, 198 + struct ethtool_wolinfo *wol) 199 + { 200 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 201 + 202 + wol->supported = WAKE_UCAST | WAKE_MCAST | WAKE_BCAST | WAKE_MAGIC; 203 + wol->wolopts = 0; 204 + 205 + if ((adapter->wake_up_evt & PCH_GBE_WLC_IND)) 206 + wol->wolopts |= WAKE_UCAST; 207 + if ((adapter->wake_up_evt & PCH_GBE_WLC_MLT)) 208 + wol->wolopts |= WAKE_MCAST; 209 + if ((adapter->wake_up_evt & PCH_GBE_WLC_BR)) 210 + wol->wolopts |= WAKE_BCAST; 211 + if ((adapter->wake_up_evt & PCH_GBE_WLC_MP)) 212 + wol->wolopts |= WAKE_MAGIC; 213 + } 214 + 215 + /** 216 + * pch_gbe_set_wol - Turn Wake-on-Lan on or off 217 + * @netdev: Network interface device structure 218 + * @wol: Pointer of wake-on-Lan information straucture 219 + * Returns 220 + * 0: Successful. 221 + * Negative value: Failed. 222 + */ 223 + static int pch_gbe_set_wol(struct net_device *netdev, 224 + struct ethtool_wolinfo *wol) 225 + { 226 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 227 + 228 + if ((wol->wolopts & (WAKE_PHY | WAKE_ARP | WAKE_MAGICSECURE))) 229 + return -EOPNOTSUPP; 230 + /* these settings will always override what we currently have */ 231 + adapter->wake_up_evt = 0; 232 + 233 + if ((wol->wolopts & WAKE_UCAST)) 234 + adapter->wake_up_evt |= PCH_GBE_WLC_IND; 235 + if ((wol->wolopts & WAKE_MCAST)) 236 + adapter->wake_up_evt |= PCH_GBE_WLC_MLT; 237 + if ((wol->wolopts & WAKE_BCAST)) 238 + adapter->wake_up_evt |= PCH_GBE_WLC_BR; 239 + if ((wol->wolopts & WAKE_MAGIC)) 240 + adapter->wake_up_evt |= PCH_GBE_WLC_MP; 241 + return 0; 242 + } 243 + 244 + /** 245 + * pch_gbe_nway_reset - Restart autonegotiation 246 + * @netdev: Network interface device structure 247 + * Returns 248 + * 0: Successful. 249 + * Negative value: Failed. 250 + */ 251 + static int pch_gbe_nway_reset(struct net_device *netdev) 252 + { 253 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 254 + 255 + return mii_nway_restart(&adapter->mii); 256 + } 257 + 258 + /** 259 + * pch_gbe_get_ringparam - Report ring sizes 260 + * @netdev: Network interface device structure 261 + * @ring: Ring param structure 262 + */ 263 + static void pch_gbe_get_ringparam(struct net_device *netdev, 264 + struct ethtool_ringparam *ring) 265 + { 266 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 267 + struct pch_gbe_tx_ring *txdr = adapter->tx_ring; 268 + struct pch_gbe_rx_ring *rxdr = adapter->rx_ring; 269 + 270 + ring->rx_max_pending = PCH_GBE_MAX_RXD; 271 + ring->tx_max_pending = PCH_GBE_MAX_TXD; 272 + ring->rx_mini_max_pending = 0; 273 + ring->rx_jumbo_max_pending = 0; 274 + ring->rx_pending = rxdr->count; 275 + ring->tx_pending = txdr->count; 276 + ring->rx_mini_pending = 0; 277 + ring->rx_jumbo_pending = 0; 278 + } 279 + 280 + /** 281 + * pch_gbe_set_ringparam - Set ring sizes 282 + * @netdev: Network interface device structure 283 + * @ring: Ring param structure 284 + * Returns 285 + * 0: Successful. 286 + * Negative value: Failed. 287 + */ 288 + static int pch_gbe_set_ringparam(struct net_device *netdev, 289 + struct ethtool_ringparam *ring) 290 + { 291 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 292 + struct pch_gbe_tx_ring *txdr, *tx_old; 293 + struct pch_gbe_rx_ring *rxdr, *rx_old; 294 + int tx_ring_size, rx_ring_size; 295 + int err = 0; 296 + 297 + if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending)) 298 + return -EINVAL; 299 + tx_ring_size = (int)sizeof(struct pch_gbe_tx_ring); 300 + rx_ring_size = (int)sizeof(struct pch_gbe_rx_ring); 301 + 302 + if ((netif_running(adapter->netdev))) 303 + pch_gbe_down(adapter); 304 + tx_old = adapter->tx_ring; 305 + rx_old = adapter->rx_ring; 306 + 307 + txdr = kzalloc(tx_ring_size, GFP_KERNEL); 308 + if (!txdr) { 309 + err = -ENOMEM; 310 + goto err_alloc_tx; 311 + } 312 + rxdr = kzalloc(rx_ring_size, GFP_KERNEL); 313 + if (!rxdr) { 314 + err = -ENOMEM; 315 + goto err_alloc_rx; 316 + } 317 + adapter->tx_ring = txdr; 318 + adapter->rx_ring = rxdr; 319 + 320 + rxdr->count = 321 + clamp_val(ring->rx_pending, PCH_GBE_MIN_RXD, PCH_GBE_MAX_RXD); 322 + rxdr->count = roundup(rxdr->count, PCH_GBE_RX_DESC_MULTIPLE); 323 + 324 + txdr->count = 325 + clamp_val(ring->tx_pending, PCH_GBE_MIN_RXD, PCH_GBE_MAX_RXD); 326 + txdr->count = roundup(txdr->count, PCH_GBE_TX_DESC_MULTIPLE); 327 + 328 + if ((netif_running(adapter->netdev))) { 329 + /* Try to get new resources before deleting old */ 330 + err = pch_gbe_setup_rx_resources(adapter, adapter->rx_ring); 331 + if (err) 332 + goto err_setup_rx; 333 + err = pch_gbe_setup_tx_resources(adapter, adapter->tx_ring); 334 + if (err) 335 + goto err_setup_tx; 336 + /* save the new, restore the old in order to free it, 337 + * then restore the new back again */ 338 + #ifdef RINGFREE 339 + adapter->rx_ring = rx_old; 340 + adapter->tx_ring = tx_old; 341 + pch_gbe_free_rx_resources(adapter, adapter->rx_ring); 342 + pch_gbe_free_tx_resources(adapter, adapter->tx_ring); 343 + kfree(tx_old); 344 + kfree(rx_old); 345 + adapter->rx_ring = rxdr; 346 + adapter->tx_ring = txdr; 347 + #else 348 + pch_gbe_free_rx_resources(adapter, rx_old); 349 + pch_gbe_free_tx_resources(adapter, tx_old); 350 + kfree(tx_old); 351 + kfree(rx_old); 352 + adapter->rx_ring = rxdr; 353 + adapter->tx_ring = txdr; 354 + #endif 355 + err = pch_gbe_up(adapter); 356 + } 357 + return err; 358 + 359 + err_setup_tx: 360 + pch_gbe_free_rx_resources(adapter, adapter->rx_ring); 361 + err_setup_rx: 362 + adapter->rx_ring = rx_old; 363 + adapter->tx_ring = tx_old; 364 + kfree(rxdr); 365 + err_alloc_rx: 366 + kfree(txdr); 367 + err_alloc_tx: 368 + if (netif_running(adapter->netdev)) 369 + pch_gbe_up(adapter); 370 + return err; 371 + } 372 + 373 + /** 374 + * pch_gbe_get_pauseparam - Report pause parameters 375 + * @netdev: Network interface device structure 376 + * @pause: Pause parameters structure 377 + */ 378 + static void pch_gbe_get_pauseparam(struct net_device *netdev, 379 + struct ethtool_pauseparam *pause) 380 + { 381 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 382 + struct pch_gbe_hw *hw = &adapter->hw; 383 + 384 + pause->autoneg = 385 + ((hw->mac.fc_autoneg) ? AUTONEG_ENABLE : AUTONEG_DISABLE); 386 + 387 + if (hw->mac.fc == PCH_GBE_FC_RX_PAUSE) { 388 + pause->rx_pause = 1; 389 + } else if (hw->mac.fc == PCH_GBE_FC_TX_PAUSE) { 390 + pause->tx_pause = 1; 391 + } else if (hw->mac.fc == PCH_GBE_FC_FULL) { 392 + pause->rx_pause = 1; 393 + pause->tx_pause = 1; 394 + } 395 + } 396 + 397 + /** 398 + * pch_gbe_set_pauseparam - Set pause paramters 399 + * @netdev: Network interface device structure 400 + * @pause: Pause parameters structure 401 + * Returns 402 + * 0: Successful. 403 + * Negative value: Failed. 404 + */ 405 + static int pch_gbe_set_pauseparam(struct net_device *netdev, 406 + struct ethtool_pauseparam *pause) 407 + { 408 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 409 + struct pch_gbe_hw *hw = &adapter->hw; 410 + int ret = 0; 411 + 412 + hw->mac.fc_autoneg = pause->autoneg; 413 + if ((pause->rx_pause) && (pause->tx_pause)) 414 + hw->mac.fc = PCH_GBE_FC_FULL; 415 + else if ((pause->rx_pause) && (!pause->tx_pause)) 416 + hw->mac.fc = PCH_GBE_FC_RX_PAUSE; 417 + else if ((!pause->rx_pause) && (pause->tx_pause)) 418 + hw->mac.fc = PCH_GBE_FC_TX_PAUSE; 419 + else if ((!pause->rx_pause) && (!pause->tx_pause)) 420 + hw->mac.fc = PCH_GBE_FC_NONE; 421 + 422 + if (hw->mac.fc_autoneg == AUTONEG_ENABLE) { 423 + if ((netif_running(adapter->netdev))) { 424 + pch_gbe_down(adapter); 425 + ret = pch_gbe_up(adapter); 426 + } else { 427 + pch_gbe_reset(adapter); 428 + } 429 + } else { 430 + ret = pch_gbe_mac_force_mac_fc(hw); 431 + } 432 + return ret; 433 + } 434 + 435 + /** 436 + * pch_gbe_get_rx_csum - Report whether receive checksums are turned on or off 437 + * @netdev: Network interface device structure 438 + * Returns 439 + * true(1): Checksum On 440 + * false(0): Checksum Off 441 + */ 442 + static u32 pch_gbe_get_rx_csum(struct net_device *netdev) 443 + { 444 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 445 + 446 + return adapter->rx_csum; 447 + } 448 + 449 + /** 450 + * pch_gbe_set_rx_csum - Turn receive checksum on or off 451 + * @netdev: Network interface device structure 452 + * @data: Checksum On[true] or Off[false] 453 + * Returns 454 + * 0: Successful. 455 + * Negative value: Failed. 456 + */ 457 + static int pch_gbe_set_rx_csum(struct net_device *netdev, u32 data) 458 + { 459 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 460 + 461 + adapter->rx_csum = data; 462 + if ((netif_running(netdev))) 463 + pch_gbe_reinit_locked(adapter); 464 + else 465 + pch_gbe_reset(adapter); 466 + 467 + return 0; 468 + } 469 + 470 + /** 471 + * pch_gbe_get_tx_csum - Report whether transmit checksums are turned on or off 472 + * @netdev: Network interface device structure 473 + * Returns 474 + * true(1): Checksum On 475 + * false(0): Checksum Off 476 + */ 477 + static u32 pch_gbe_get_tx_csum(struct net_device *netdev) 478 + { 479 + return (netdev->features & NETIF_F_HW_CSUM) != 0; 480 + } 481 + 482 + /** 483 + * pch_gbe_set_tx_csum - Turn transmit checksums on or off 484 + * @netdev: Network interface device structure 485 + * @data: Checksum on[true] or off[false] 486 + * Returns 487 + * 0: Successful. 488 + * Negative value: Failed. 489 + */ 490 + static int pch_gbe_set_tx_csum(struct net_device *netdev, u32 data) 491 + { 492 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 493 + 494 + adapter->tx_csum = data; 495 + if (data) 496 + netdev->features |= NETIF_F_HW_CSUM; 497 + else 498 + netdev->features &= ~NETIF_F_HW_CSUM; 499 + return 0; 500 + } 501 + 502 + /** 503 + * pch_gbe_get_strings - Return a set of strings that describe the requested 504 + * objects 505 + * @netdev: Network interface device structure 506 + * @stringset: Select the stringset. [ETH_SS_TEST] [ETH_SS_STATS] 507 + * @data: Pointer of read string data. 508 + */ 509 + static void pch_gbe_get_strings(struct net_device *netdev, u32 stringset, 510 + u8 *data) 511 + { 512 + u8 *p = data; 513 + int i; 514 + 515 + switch (stringset) { 516 + case (u32) ETH_SS_STATS: 517 + for (i = 0; i < PCH_GBE_GLOBAL_STATS_LEN; i++) { 518 + memcpy(p, pch_gbe_gstrings_stats[i].string, 519 + ETH_GSTRING_LEN); 520 + p += ETH_GSTRING_LEN; 521 + } 522 + break; 523 + } 524 + } 525 + 526 + /** 527 + * pch_gbe_get_ethtool_stats - Return statistics about the device 528 + * @netdev: Network interface device structure 529 + * @stats: Ethtool statue structure 530 + * @data: Pointer of read status area 531 + */ 532 + static void pch_gbe_get_ethtool_stats(struct net_device *netdev, 533 + struct ethtool_stats *stats, u64 *data) 534 + { 535 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 536 + int i; 537 + const struct pch_gbe_stats *gstats = pch_gbe_gstrings_stats; 538 + char *hw_stats = (char *)&adapter->stats; 539 + 540 + pch_gbe_update_stats(adapter); 541 + for (i = 0; i < PCH_GBE_GLOBAL_STATS_LEN; i++) { 542 + char *p = hw_stats + gstats->offset; 543 + data[i] = gstats->size == sizeof(u64) ? *(u64 *)p:(*(u32 *)p); 544 + gstats++; 545 + } 546 + } 547 + 548 + static int pch_gbe_get_sset_count(struct net_device *netdev, int sset) 549 + { 550 + switch (sset) { 551 + case ETH_SS_STATS: 552 + return PCH_GBE_STATS_LEN; 553 + default: 554 + return -EOPNOTSUPP; 555 + } 556 + } 557 + 558 + static const struct ethtool_ops pch_gbe_ethtool_ops = { 559 + .get_settings = pch_gbe_get_settings, 560 + .set_settings = pch_gbe_set_settings, 561 + .get_drvinfo = pch_gbe_get_drvinfo, 562 + .get_regs_len = pch_gbe_get_regs_len, 563 + .get_regs = pch_gbe_get_regs, 564 + .get_wol = pch_gbe_get_wol, 565 + .set_wol = pch_gbe_set_wol, 566 + .nway_reset = pch_gbe_nway_reset, 567 + .get_link = ethtool_op_get_link, 568 + .get_ringparam = pch_gbe_get_ringparam, 569 + .set_ringparam = pch_gbe_set_ringparam, 570 + .get_pauseparam = pch_gbe_get_pauseparam, 571 + .set_pauseparam = pch_gbe_set_pauseparam, 572 + .get_rx_csum = pch_gbe_get_rx_csum, 573 + .set_rx_csum = pch_gbe_set_rx_csum, 574 + .get_tx_csum = pch_gbe_get_tx_csum, 575 + .set_tx_csum = pch_gbe_set_tx_csum, 576 + .get_strings = pch_gbe_get_strings, 577 + .get_ethtool_stats = pch_gbe_get_ethtool_stats, 578 + .get_sset_count = pch_gbe_get_sset_count, 579 + }; 580 + 581 + void pch_gbe_set_ethtool_ops(struct net_device *netdev) 582 + { 583 + SET_ETHTOOL_OPS(netdev, &pch_gbe_ethtool_ops); 584 + }
+2473
drivers/net/pch_gbe/pch_gbe_main.c
··· 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, write to the Free Software 18 + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA. 19 + */ 20 + 21 + #include "pch_gbe.h" 22 + #include "pch_gbe_api.h" 23 + 24 + #define DRV_VERSION "1.00" 25 + const char pch_driver_version[] = DRV_VERSION; 26 + 27 + #define PCI_DEVICE_ID_INTEL_IOH1_GBE 0x8802 /* Pci device ID */ 28 + #define PCH_GBE_MAR_ENTRIES 16 29 + #define PCH_GBE_SHORT_PKT 64 30 + #define DSC_INIT16 0xC000 31 + #define PCH_GBE_DMA_ALIGN 0 32 + #define PCH_GBE_WATCHDOG_PERIOD (1 * HZ) /* watchdog time */ 33 + #define PCH_GBE_COPYBREAK_DEFAULT 256 34 + #define PCH_GBE_PCI_BAR 1 35 + 36 + #define PCH_GBE_TX_WEIGHT 64 37 + #define PCH_GBE_RX_WEIGHT 64 38 + #define PCH_GBE_RX_BUFFER_WRITE 16 39 + 40 + /* Initialize the wake-on-LAN settings */ 41 + #define PCH_GBE_WL_INIT_SETTING (PCH_GBE_WLC_MP) 42 + 43 + #define PCH_GBE_MAC_RGMII_CTRL_SETTING ( \ 44 + PCH_GBE_CHIP_TYPE_INTERNAL | \ 45 + PCH_GBE_RGMII_MODE_RGMII | \ 46 + PCH_GBE_CRS_SEL \ 47 + ) 48 + 49 + /* Ethertype field values */ 50 + #define PCH_GBE_MAX_JUMBO_FRAME_SIZE 10318 51 + #define PCH_GBE_FRAME_SIZE_2048 2048 52 + #define PCH_GBE_FRAME_SIZE_4096 4096 53 + #define PCH_GBE_FRAME_SIZE_8192 8192 54 + 55 + #define PCH_GBE_GET_DESC(R, i, type) (&(((struct type *)((R).desc))[i])) 56 + #define PCH_GBE_RX_DESC(R, i) PCH_GBE_GET_DESC(R, i, pch_gbe_rx_desc) 57 + #define PCH_GBE_TX_DESC(R, i) PCH_GBE_GET_DESC(R, i, pch_gbe_tx_desc) 58 + #define PCH_GBE_DESC_UNUSED(R) \ 59 + ((((R)->next_to_clean > (R)->next_to_use) ? 0 : (R)->count) + \ 60 + (R)->next_to_clean - (R)->next_to_use - 1) 61 + 62 + /* Pause packet value */ 63 + #define PCH_GBE_PAUSE_PKT1_VALUE 0x00C28001 64 + #define PCH_GBE_PAUSE_PKT2_VALUE 0x00000100 65 + #define PCH_GBE_PAUSE_PKT4_VALUE 0x01000888 66 + #define PCH_GBE_PAUSE_PKT5_VALUE 0x0000FFFF 67 + 68 + #define PCH_GBE_ETH_ALEN 6 69 + 70 + /* This defines the bits that are set in the Interrupt Mask 71 + * Set/Read Register. Each bit is documented below: 72 + * o RXT0 = Receiver Timer Interrupt (ring 0) 73 + * o TXDW = Transmit Descriptor Written Back 74 + * o RXDMT0 = Receive Descriptor Minimum Threshold hit (ring 0) 75 + * o RXSEQ = Receive Sequence Error 76 + * o LSC = Link Status Change 77 + */ 78 + #define PCH_GBE_INT_ENABLE_MASK ( \ 79 + PCH_GBE_INT_RX_DMA_CMPLT | \ 80 + PCH_GBE_INT_RX_DSC_EMP | \ 81 + PCH_GBE_INT_WOL_DET | \ 82 + PCH_GBE_INT_TX_CMPLT \ 83 + ) 84 + 85 + 86 + static unsigned int copybreak __read_mostly = PCH_GBE_COPYBREAK_DEFAULT; 87 + 88 + /** 89 + * pch_gbe_mac_read_mac_addr - Read MAC address 90 + * @hw: Pointer to the HW structure 91 + * Returns 92 + * 0: Successful. 93 + */ 94 + s32 pch_gbe_mac_read_mac_addr(struct pch_gbe_hw *hw) 95 + { 96 + u32 adr1a, adr1b; 97 + 98 + adr1a = ioread32(&hw->reg->mac_adr[0].high); 99 + adr1b = ioread32(&hw->reg->mac_adr[0].low); 100 + 101 + hw->mac.addr[0] = (u8)(adr1a & 0xFF); 102 + hw->mac.addr[1] = (u8)((adr1a >> 8) & 0xFF); 103 + hw->mac.addr[2] = (u8)((adr1a >> 16) & 0xFF); 104 + hw->mac.addr[3] = (u8)((adr1a >> 24) & 0xFF); 105 + hw->mac.addr[4] = (u8)(adr1b & 0xFF); 106 + hw->mac.addr[5] = (u8)((adr1b >> 8) & 0xFF); 107 + 108 + pr_debug("hw->mac.addr : %pM\n", hw->mac.addr); 109 + return 0; 110 + } 111 + 112 + /** 113 + * pch_gbe_wait_clr_bit - Wait to clear a bit 114 + * @reg: Pointer of register 115 + * @busy: Busy bit 116 + */ 117 + void pch_gbe_wait_clr_bit(void *reg, u32 bit) 118 + { 119 + u32 tmp; 120 + /* wait busy */ 121 + tmp = 1000; 122 + while ((ioread32(reg) & bit) && --tmp) 123 + cpu_relax(); 124 + if (!tmp) 125 + pr_err("Error: busy bit is not cleared\n"); 126 + } 127 + /** 128 + * pch_gbe_mac_mar_set - Set MAC address register 129 + * @hw: Pointer to the HW structure 130 + * @addr: Pointer to the MAC address 131 + * @index: MAC address array register 132 + */ 133 + void pch_gbe_mac_mar_set(struct pch_gbe_hw *hw, u8 * addr, u32 index) 134 + { 135 + u32 mar_low, mar_high, adrmask; 136 + 137 + pr_debug("index : 0x%x\n", index); 138 + 139 + /* 140 + * HW expects these in little endian so we reverse the byte order 141 + * from network order (big endian) to little endian 142 + */ 143 + mar_high = ((u32) addr[0] | ((u32) addr[1] << 8) | 144 + ((u32) addr[2] << 16) | ((u32) addr[3] << 24)); 145 + mar_low = ((u32) addr[4] | ((u32) addr[5] << 8)); 146 + /* Stop the MAC Address of index. */ 147 + adrmask = ioread32(&hw->reg->ADDR_MASK); 148 + iowrite32((adrmask | (0x0001 << index)), &hw->reg->ADDR_MASK); 149 + /* wait busy */ 150 + pch_gbe_wait_clr_bit(&hw->reg->ADDR_MASK, PCH_GBE_BUSY); 151 + /* Set the MAC address to the MAC address 1A/1B register */ 152 + iowrite32(mar_high, &hw->reg->mac_adr[index].high); 153 + iowrite32(mar_low, &hw->reg->mac_adr[index].low); 154 + /* Start the MAC address of index */ 155 + iowrite32((adrmask & ~(0x0001 << index)), &hw->reg->ADDR_MASK); 156 + /* wait busy */ 157 + pch_gbe_wait_clr_bit(&hw->reg->ADDR_MASK, PCH_GBE_BUSY); 158 + } 159 + 160 + /** 161 + * pch_gbe_mac_reset_hw - Reset hardware 162 + * @hw: Pointer to the HW structure 163 + */ 164 + void pch_gbe_mac_reset_hw(struct pch_gbe_hw *hw) 165 + { 166 + /* Read the MAC address. and store to the private data */ 167 + pch_gbe_mac_read_mac_addr(hw); 168 + iowrite32(PCH_GBE_ALL_RST, &hw->reg->RESET); 169 + #ifdef PCH_GBE_MAC_IFOP_RGMII 170 + iowrite32(PCH_GBE_MODE_GMII_ETHER, &hw->reg->MODE); 171 + #endif 172 + pch_gbe_wait_clr_bit(&hw->reg->RESET, PCH_GBE_ALL_RST); 173 + /* Setup the receive address */ 174 + pch_gbe_mac_mar_set(hw, hw->mac.addr, 0); 175 + return; 176 + } 177 + 178 + /** 179 + * pch_gbe_mac_init_rx_addrs - Initialize receive address's 180 + * @hw: Pointer to the HW structure 181 + * @mar_count: Receive address registers 182 + */ 183 + void pch_gbe_mac_init_rx_addrs(struct pch_gbe_hw *hw, u16 mar_count) 184 + { 185 + u32 i; 186 + 187 + /* Setup the receive address */ 188 + pch_gbe_mac_mar_set(hw, hw->mac.addr, 0); 189 + 190 + /* Zero out the other receive addresses */ 191 + for (i = 1; i < mar_count; i++) { 192 + iowrite32(0, &hw->reg->mac_adr[i].high); 193 + iowrite32(0, &hw->reg->mac_adr[i].low); 194 + } 195 + iowrite32(0xFFFE, &hw->reg->ADDR_MASK); 196 + /* wait busy */ 197 + pch_gbe_wait_clr_bit(&hw->reg->ADDR_MASK, PCH_GBE_BUSY); 198 + } 199 + 200 + 201 + /** 202 + * pch_gbe_mac_mc_addr_list_update - Update Multicast addresses 203 + * @hw: Pointer to the HW structure 204 + * @mc_addr_list: Array of multicast addresses to program 205 + * @mc_addr_count: Number of multicast addresses to program 206 + * @mar_used_count: The first MAC Address register free to program 207 + * @mar_total_num: Total number of supported MAC Address Registers 208 + */ 209 + void pch_gbe_mac_mc_addr_list_update(struct pch_gbe_hw *hw, 210 + u8 *mc_addr_list, u32 mc_addr_count, 211 + u32 mar_used_count, u32 mar_total_num) 212 + { 213 + u32 i, adrmask; 214 + 215 + /* Load the first set of multicast addresses into the exact 216 + * filters (RAR). If there are not enough to fill the RAR 217 + * array, clear the filters. 218 + */ 219 + for (i = mar_used_count; i < mar_total_num; i++) { 220 + if (mc_addr_count) { 221 + pch_gbe_mac_mar_set(hw, mc_addr_list, i); 222 + mc_addr_count--; 223 + mc_addr_list += PCH_GBE_ETH_ALEN; 224 + } else { 225 + /* Clear MAC address mask */ 226 + adrmask = ioread32(&hw->reg->ADDR_MASK); 227 + iowrite32((adrmask | (0x0001 << i)), 228 + &hw->reg->ADDR_MASK); 229 + /* wait busy */ 230 + pch_gbe_wait_clr_bit(&hw->reg->ADDR_MASK, PCH_GBE_BUSY); 231 + /* Clear MAC address */ 232 + iowrite32(0, &hw->reg->mac_adr[i].high); 233 + iowrite32(0, &hw->reg->mac_adr[i].low); 234 + } 235 + } 236 + } 237 + 238 + /** 239 + * pch_gbe_mac_force_mac_fc - Force the MAC's flow control settings 240 + * @hw: Pointer to the HW structure 241 + * Returns 242 + * 0: Successful. 243 + * Negative value: Failed. 244 + */ 245 + s32 pch_gbe_mac_force_mac_fc(struct pch_gbe_hw *hw) 246 + { 247 + struct pch_gbe_mac_info *mac = &hw->mac; 248 + u32 rx_fctrl; 249 + 250 + pr_debug("mac->fc = %u\n", mac->fc); 251 + 252 + rx_fctrl = ioread32(&hw->reg->RX_FCTRL); 253 + 254 + switch (mac->fc) { 255 + case PCH_GBE_FC_NONE: 256 + rx_fctrl &= ~PCH_GBE_FL_CTRL_EN; 257 + mac->tx_fc_enable = false; 258 + break; 259 + case PCH_GBE_FC_RX_PAUSE: 260 + rx_fctrl |= PCH_GBE_FL_CTRL_EN; 261 + mac->tx_fc_enable = false; 262 + break; 263 + case PCH_GBE_FC_TX_PAUSE: 264 + rx_fctrl &= ~PCH_GBE_FL_CTRL_EN; 265 + mac->tx_fc_enable = true; 266 + break; 267 + case PCH_GBE_FC_FULL: 268 + rx_fctrl |= PCH_GBE_FL_CTRL_EN; 269 + mac->tx_fc_enable = true; 270 + break; 271 + default: 272 + pr_err("Flow control param set incorrectly\n"); 273 + return -EINVAL; 274 + } 275 + if (mac->link_duplex == DUPLEX_HALF) 276 + rx_fctrl &= ~PCH_GBE_FL_CTRL_EN; 277 + iowrite32(rx_fctrl, &hw->reg->RX_FCTRL); 278 + pr_debug("RX_FCTRL reg : 0x%08x mac->tx_fc_enable : %d\n", 279 + ioread32(&hw->reg->RX_FCTRL), mac->tx_fc_enable); 280 + return 0; 281 + } 282 + 283 + /** 284 + * pch_gbe_mac_set_wol_event - Set wake-on-lan event 285 + * @hw: Pointer to the HW structure 286 + * @wu_evt: Wake up event 287 + */ 288 + void pch_gbe_mac_set_wol_event(struct pch_gbe_hw *hw, u32 wu_evt) 289 + { 290 + u32 addr_mask; 291 + 292 + pr_debug("wu_evt : 0x%08x ADDR_MASK reg : 0x%08x\n", 293 + wu_evt, ioread32(&hw->reg->ADDR_MASK)); 294 + 295 + if (wu_evt) { 296 + /* Set Wake-On-Lan address mask */ 297 + addr_mask = ioread32(&hw->reg->ADDR_MASK); 298 + iowrite32(addr_mask, &hw->reg->WOL_ADDR_MASK); 299 + /* wait busy */ 300 + pch_gbe_wait_clr_bit(&hw->reg->WOL_ADDR_MASK, PCH_GBE_WLA_BUSY); 301 + iowrite32(0, &hw->reg->WOL_ST); 302 + iowrite32((wu_evt | PCH_GBE_WLC_WOL_MODE), &hw->reg->WOL_CTRL); 303 + iowrite32(0x02, &hw->reg->TCPIP_ACC); 304 + iowrite32(PCH_GBE_INT_ENABLE_MASK, &hw->reg->INT_EN); 305 + } else { 306 + iowrite32(0, &hw->reg->WOL_CTRL); 307 + iowrite32(0, &hw->reg->WOL_ST); 308 + } 309 + return; 310 + } 311 + 312 + /** 313 + * pch_gbe_mac_ctrl_miim - Control MIIM interface 314 + * @hw: Pointer to the HW structure 315 + * @addr: Address of PHY 316 + * @dir: Operetion. (Write or Read) 317 + * @reg: Access register of PHY 318 + * @data: Write data. 319 + * 320 + * Returns: Read date. 321 + */ 322 + u16 pch_gbe_mac_ctrl_miim(struct pch_gbe_hw *hw, u32 addr, u32 dir, u32 reg, 323 + u16 data) 324 + { 325 + u32 data_out = 0; 326 + unsigned int i; 327 + unsigned long flags; 328 + 329 + spin_lock_irqsave(&hw->miim_lock, flags); 330 + 331 + for (i = 100; i; --i) { 332 + if ((ioread32(&hw->reg->MIIM) & PCH_GBE_MIIM_OPER_READY)) 333 + break; 334 + udelay(20); 335 + } 336 + if (i == 0) { 337 + pr_err("pch-gbe.miim won't go Ready\n"); 338 + spin_unlock_irqrestore(&hw->miim_lock, flags); 339 + return 0; /* No way to indicate timeout error */ 340 + } 341 + iowrite32(((reg << PCH_GBE_MIIM_REG_ADDR_SHIFT) | 342 + (addr << PCH_GBE_MIIM_PHY_ADDR_SHIFT) | 343 + dir | data), &hw->reg->MIIM); 344 + for (i = 0; i < 100; i++) { 345 + udelay(20); 346 + data_out = ioread32(&hw->reg->MIIM); 347 + if ((data_out & PCH_GBE_MIIM_OPER_READY)) 348 + break; 349 + } 350 + spin_unlock_irqrestore(&hw->miim_lock, flags); 351 + 352 + pr_debug("PHY %s: reg=%d, data=0x%04X\n", 353 + dir == PCH_GBE_MIIM_OPER_READ ? "READ" : "WRITE", reg, 354 + dir == PCH_GBE_MIIM_OPER_READ ? data_out : data); 355 + return (u16) data_out; 356 + } 357 + 358 + /** 359 + * pch_gbe_mac_set_pause_packet - Set pause packet 360 + * @hw: Pointer to the HW structure 361 + */ 362 + void pch_gbe_mac_set_pause_packet(struct pch_gbe_hw *hw) 363 + { 364 + unsigned long tmp2, tmp3; 365 + 366 + /* Set Pause packet */ 367 + tmp2 = hw->mac.addr[1]; 368 + tmp2 = (tmp2 << 8) | hw->mac.addr[0]; 369 + tmp2 = PCH_GBE_PAUSE_PKT2_VALUE | (tmp2 << 16); 370 + 371 + tmp3 = hw->mac.addr[5]; 372 + tmp3 = (tmp3 << 8) | hw->mac.addr[4]; 373 + tmp3 = (tmp3 << 8) | hw->mac.addr[3]; 374 + tmp3 = (tmp3 << 8) | hw->mac.addr[2]; 375 + 376 + iowrite32(PCH_GBE_PAUSE_PKT1_VALUE, &hw->reg->PAUSE_PKT1); 377 + iowrite32(tmp2, &hw->reg->PAUSE_PKT2); 378 + iowrite32(tmp3, &hw->reg->PAUSE_PKT3); 379 + iowrite32(PCH_GBE_PAUSE_PKT4_VALUE, &hw->reg->PAUSE_PKT4); 380 + iowrite32(PCH_GBE_PAUSE_PKT5_VALUE, &hw->reg->PAUSE_PKT5); 381 + 382 + /* Transmit Pause Packet */ 383 + iowrite32(PCH_GBE_PS_PKT_RQ, &hw->reg->PAUSE_REQ); 384 + 385 + pr_debug("PAUSE_PKT1-5 reg : 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n", 386 + ioread32(&hw->reg->PAUSE_PKT1), ioread32(&hw->reg->PAUSE_PKT2), 387 + ioread32(&hw->reg->PAUSE_PKT3), ioread32(&hw->reg->PAUSE_PKT4), 388 + ioread32(&hw->reg->PAUSE_PKT5)); 389 + 390 + return; 391 + } 392 + 393 + 394 + /** 395 + * pch_gbe_alloc_queues - Allocate memory for all rings 396 + * @adapter: Board private structure to initialize 397 + * Returns 398 + * 0: Successfully 399 + * Negative value: Failed 400 + */ 401 + static int pch_gbe_alloc_queues(struct pch_gbe_adapter *adapter) 402 + { 403 + int size; 404 + 405 + size = (int)sizeof(struct pch_gbe_tx_ring); 406 + adapter->tx_ring = kzalloc(size, GFP_KERNEL); 407 + if (!adapter->tx_ring) 408 + return -ENOMEM; 409 + size = (int)sizeof(struct pch_gbe_rx_ring); 410 + adapter->rx_ring = kzalloc(size, GFP_KERNEL); 411 + if (!adapter->rx_ring) { 412 + kfree(adapter->tx_ring); 413 + return -ENOMEM; 414 + } 415 + return 0; 416 + } 417 + 418 + /** 419 + * pch_gbe_init_stats - Initialize status 420 + * @adapter: Board private structure to initialize 421 + */ 422 + static void pch_gbe_init_stats(struct pch_gbe_adapter *adapter) 423 + { 424 + memset(&adapter->stats, 0, sizeof(adapter->stats)); 425 + return; 426 + } 427 + 428 + /** 429 + * pch_gbe_init_phy - Initialize PHY 430 + * @adapter: Board private structure to initialize 431 + * Returns 432 + * 0: Successfully 433 + * Negative value: Failed 434 + */ 435 + static int pch_gbe_init_phy(struct pch_gbe_adapter *adapter) 436 + { 437 + struct net_device *netdev = adapter->netdev; 438 + u32 addr; 439 + u16 bmcr, stat; 440 + 441 + /* Discover phy addr by searching addrs in order {1,0,2,..., 31} */ 442 + for (addr = 0; addr < PCH_GBE_PHY_REGS_LEN; addr++) { 443 + adapter->mii.phy_id = (addr == 0) ? 1 : (addr == 1) ? 0 : addr; 444 + bmcr = pch_gbe_mdio_read(netdev, adapter->mii.phy_id, MII_BMCR); 445 + stat = pch_gbe_mdio_read(netdev, adapter->mii.phy_id, MII_BMSR); 446 + stat = pch_gbe_mdio_read(netdev, adapter->mii.phy_id, MII_BMSR); 447 + if (!((bmcr == 0xFFFF) || ((stat == 0) && (bmcr == 0)))) 448 + break; 449 + } 450 + adapter->hw.phy.addr = adapter->mii.phy_id; 451 + pr_debug("phy_addr = %d\n", adapter->mii.phy_id); 452 + if (addr == 32) 453 + return -EAGAIN; 454 + /* Selected the phy and isolate the rest */ 455 + for (addr = 0; addr < PCH_GBE_PHY_REGS_LEN; addr++) { 456 + if (addr != adapter->mii.phy_id) { 457 + pch_gbe_mdio_write(netdev, addr, MII_BMCR, 458 + BMCR_ISOLATE); 459 + } else { 460 + bmcr = pch_gbe_mdio_read(netdev, addr, MII_BMCR); 461 + pch_gbe_mdio_write(netdev, addr, MII_BMCR, 462 + bmcr & ~BMCR_ISOLATE); 463 + } 464 + } 465 + 466 + /* MII setup */ 467 + adapter->mii.phy_id_mask = 0x1F; 468 + adapter->mii.reg_num_mask = 0x1F; 469 + adapter->mii.dev = adapter->netdev; 470 + adapter->mii.mdio_read = pch_gbe_mdio_read; 471 + adapter->mii.mdio_write = pch_gbe_mdio_write; 472 + adapter->mii.supports_gmii = mii_check_gmii_support(&adapter->mii); 473 + return 0; 474 + } 475 + 476 + /** 477 + * pch_gbe_mdio_read - The read function for mii 478 + * @netdev: Network interface device structure 479 + * @addr: Phy ID 480 + * @reg: Access location 481 + * Returns 482 + * 0: Successfully 483 + * Negative value: Failed 484 + */ 485 + int pch_gbe_mdio_read(struct net_device *netdev, int addr, int reg) 486 + { 487 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 488 + struct pch_gbe_hw *hw = &adapter->hw; 489 + 490 + return pch_gbe_mac_ctrl_miim(hw, addr, PCH_GBE_HAL_MIIM_READ, reg, 491 + (u16) 0); 492 + } 493 + 494 + /** 495 + * pch_gbe_mdio_write - The write function for mii 496 + * @netdev: Network interface device structure 497 + * @addr: Phy ID (not used) 498 + * @reg: Access location 499 + * @data: Write data 500 + */ 501 + void pch_gbe_mdio_write(struct net_device *netdev, int addr, int reg, int data) 502 + { 503 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 504 + struct pch_gbe_hw *hw = &adapter->hw; 505 + 506 + pch_gbe_mac_ctrl_miim(hw, addr, PCH_GBE_HAL_MIIM_WRITE, reg, data); 507 + } 508 + 509 + /** 510 + * pch_gbe_reset_task - Reset processing at the time of transmission timeout 511 + * @work: Pointer of board private structure 512 + */ 513 + static void pch_gbe_reset_task(struct work_struct *work) 514 + { 515 + struct pch_gbe_adapter *adapter; 516 + adapter = container_of(work, struct pch_gbe_adapter, reset_task); 517 + 518 + pch_gbe_reinit_locked(adapter); 519 + } 520 + 521 + /** 522 + * pch_gbe_reinit_locked- Re-initialization 523 + * @adapter: Board private structure 524 + */ 525 + void pch_gbe_reinit_locked(struct pch_gbe_adapter *adapter) 526 + { 527 + struct net_device *netdev = adapter->netdev; 528 + 529 + rtnl_lock(); 530 + if (netif_running(netdev)) { 531 + pch_gbe_down(adapter); 532 + pch_gbe_up(adapter); 533 + } 534 + rtnl_unlock(); 535 + } 536 + 537 + /** 538 + * pch_gbe_reset - Reset GbE 539 + * @adapter: Board private structure 540 + */ 541 + void pch_gbe_reset(struct pch_gbe_adapter *adapter) 542 + { 543 + pch_gbe_mac_reset_hw(&adapter->hw); 544 + /* Setup the receive address. */ 545 + pch_gbe_mac_init_rx_addrs(&adapter->hw, PCH_GBE_MAR_ENTRIES); 546 + if (pch_gbe_hal_init_hw(&adapter->hw)) 547 + pr_err("Hardware Error\n"); 548 + } 549 + 550 + /** 551 + * pch_gbe_free_irq - Free an interrupt 552 + * @adapter: Board private structure 553 + */ 554 + static void pch_gbe_free_irq(struct pch_gbe_adapter *adapter) 555 + { 556 + struct net_device *netdev = adapter->netdev; 557 + 558 + free_irq(adapter->pdev->irq, netdev); 559 + if (adapter->have_msi) { 560 + pci_disable_msi(adapter->pdev); 561 + pr_debug("call pci_disable_msi\n"); 562 + } 563 + } 564 + 565 + /** 566 + * pch_gbe_irq_disable - Mask off interrupt generation on the NIC 567 + * @adapter: Board private structure 568 + */ 569 + static void pch_gbe_irq_disable(struct pch_gbe_adapter *adapter) 570 + { 571 + struct pch_gbe_hw *hw = &adapter->hw; 572 + 573 + atomic_inc(&adapter->irq_sem); 574 + iowrite32(0, &hw->reg->INT_EN); 575 + ioread32(&hw->reg->INT_ST); 576 + synchronize_irq(adapter->pdev->irq); 577 + 578 + pr_debug("INT_EN reg : 0x%08x\n", ioread32(&hw->reg->INT_EN)); 579 + } 580 + 581 + /** 582 + * pch_gbe_irq_enable - Enable default interrupt generation settings 583 + * @adapter: Board private structure 584 + */ 585 + static void pch_gbe_irq_enable(struct pch_gbe_adapter *adapter) 586 + { 587 + struct pch_gbe_hw *hw = &adapter->hw; 588 + 589 + if (likely(atomic_dec_and_test(&adapter->irq_sem))) 590 + iowrite32(PCH_GBE_INT_ENABLE_MASK, &hw->reg->INT_EN); 591 + ioread32(&hw->reg->INT_ST); 592 + pr_debug("INT_EN reg : 0x%08x\n", ioread32(&hw->reg->INT_EN)); 593 + } 594 + 595 + 596 + 597 + /** 598 + * pch_gbe_setup_tctl - configure the Transmit control registers 599 + * @adapter: Board private structure 600 + */ 601 + static void pch_gbe_setup_tctl(struct pch_gbe_adapter *adapter) 602 + { 603 + struct pch_gbe_hw *hw = &adapter->hw; 604 + u32 tx_mode, tcpip; 605 + 606 + tx_mode = PCH_GBE_TM_LONG_PKT | 607 + PCH_GBE_TM_ST_AND_FD | 608 + PCH_GBE_TM_SHORT_PKT | 609 + PCH_GBE_TM_TH_TX_STRT_8 | 610 + PCH_GBE_TM_TH_ALM_EMP_4 | PCH_GBE_TM_TH_ALM_FULL_8; 611 + 612 + iowrite32(tx_mode, &hw->reg->TX_MODE); 613 + 614 + tcpip = ioread32(&hw->reg->TCPIP_ACC); 615 + tcpip |= PCH_GBE_TX_TCPIPACC_EN; 616 + iowrite32(tcpip, &hw->reg->TCPIP_ACC); 617 + return; 618 + } 619 + 620 + /** 621 + * pch_gbe_configure_tx - Configure Transmit Unit after Reset 622 + * @adapter: Board private structure 623 + */ 624 + static void pch_gbe_configure_tx(struct pch_gbe_adapter *adapter) 625 + { 626 + struct pch_gbe_hw *hw = &adapter->hw; 627 + u32 tdba, tdlen, dctrl; 628 + 629 + pr_debug("dma addr = 0x%08llx size = 0x%08x\n", 630 + (unsigned long long)adapter->tx_ring->dma, 631 + adapter->tx_ring->size); 632 + 633 + /* Setup the HW Tx Head and Tail descriptor pointers */ 634 + tdba = adapter->tx_ring->dma; 635 + tdlen = adapter->tx_ring->size - 0x10; 636 + iowrite32(tdba, &hw->reg->TX_DSC_BASE); 637 + iowrite32(tdlen, &hw->reg->TX_DSC_SIZE); 638 + iowrite32(tdba, &hw->reg->TX_DSC_SW_P); 639 + 640 + /* Enables Transmission DMA */ 641 + dctrl = ioread32(&hw->reg->DMA_CTRL); 642 + dctrl |= PCH_GBE_TX_DMA_EN; 643 + iowrite32(dctrl, &hw->reg->DMA_CTRL); 644 + } 645 + 646 + /** 647 + * pch_gbe_setup_rctl - Configure the receive control registers 648 + * @adapter: Board private structure 649 + */ 650 + static void pch_gbe_setup_rctl(struct pch_gbe_adapter *adapter) 651 + { 652 + struct pch_gbe_hw *hw = &adapter->hw; 653 + u32 rx_mode, tcpip; 654 + 655 + rx_mode = PCH_GBE_ADD_FIL_EN | PCH_GBE_MLT_FIL_EN | 656 + PCH_GBE_RH_ALM_EMP_4 | PCH_GBE_RH_ALM_FULL_4 | PCH_GBE_RH_RD_TRG_8; 657 + 658 + iowrite32(rx_mode, &hw->reg->RX_MODE); 659 + 660 + tcpip = ioread32(&hw->reg->TCPIP_ACC); 661 + 662 + if (adapter->rx_csum) { 663 + tcpip &= ~PCH_GBE_RX_TCPIPACC_OFF; 664 + tcpip |= PCH_GBE_RX_TCPIPACC_EN; 665 + } else { 666 + tcpip |= PCH_GBE_RX_TCPIPACC_OFF; 667 + tcpip &= ~PCH_GBE_RX_TCPIPACC_EN; 668 + } 669 + iowrite32(tcpip, &hw->reg->TCPIP_ACC); 670 + return; 671 + } 672 + 673 + /** 674 + * pch_gbe_configure_rx - Configure Receive Unit after Reset 675 + * @adapter: Board private structure 676 + */ 677 + static void pch_gbe_configure_rx(struct pch_gbe_adapter *adapter) 678 + { 679 + struct pch_gbe_hw *hw = &adapter->hw; 680 + u32 rdba, rdlen, rctl, rxdma; 681 + 682 + pr_debug("dma adr = 0x%08llx size = 0x%08x\n", 683 + (unsigned long long)adapter->rx_ring->dma, 684 + adapter->rx_ring->size); 685 + 686 + pch_gbe_mac_force_mac_fc(hw); 687 + 688 + /* Disables Receive MAC */ 689 + rctl = ioread32(&hw->reg->MAC_RX_EN); 690 + iowrite32((rctl & ~PCH_GBE_MRE_MAC_RX_EN), &hw->reg->MAC_RX_EN); 691 + 692 + /* Disables Receive DMA */ 693 + rxdma = ioread32(&hw->reg->DMA_CTRL); 694 + rxdma &= ~PCH_GBE_RX_DMA_EN; 695 + iowrite32(rxdma, &hw->reg->DMA_CTRL); 696 + 697 + pr_debug("MAC_RX_EN reg = 0x%08x DMA_CTRL reg = 0x%08x\n", 698 + ioread32(&hw->reg->MAC_RX_EN), 699 + ioread32(&hw->reg->DMA_CTRL)); 700 + 701 + /* Setup the HW Rx Head and Tail Descriptor Pointers and 702 + * the Base and Length of the Rx Descriptor Ring */ 703 + rdba = adapter->rx_ring->dma; 704 + rdlen = adapter->rx_ring->size - 0x10; 705 + iowrite32(rdba, &hw->reg->RX_DSC_BASE); 706 + iowrite32(rdlen, &hw->reg->RX_DSC_SIZE); 707 + iowrite32((rdba + rdlen), &hw->reg->RX_DSC_SW_P); 708 + 709 + /* Enables Receive DMA */ 710 + rxdma = ioread32(&hw->reg->DMA_CTRL); 711 + rxdma |= PCH_GBE_RX_DMA_EN; 712 + iowrite32(rxdma, &hw->reg->DMA_CTRL); 713 + /* Enables Receive */ 714 + iowrite32(PCH_GBE_MRE_MAC_RX_EN, &hw->reg->MAC_RX_EN); 715 + } 716 + 717 + /** 718 + * pch_gbe_unmap_and_free_tx_resource - Unmap and free tx socket buffer 719 + * @adapter: Board private structure 720 + * @buffer_info: Buffer information structure 721 + */ 722 + static void pch_gbe_unmap_and_free_tx_resource( 723 + struct pch_gbe_adapter *adapter, struct pch_gbe_buffer *buffer_info) 724 + { 725 + if (buffer_info->mapped) { 726 + dma_unmap_single(&adapter->pdev->dev, buffer_info->dma, 727 + buffer_info->length, DMA_TO_DEVICE); 728 + buffer_info->mapped = false; 729 + } 730 + if (buffer_info->skb) { 731 + dev_kfree_skb_any(buffer_info->skb); 732 + buffer_info->skb = NULL; 733 + } 734 + } 735 + 736 + /** 737 + * pch_gbe_unmap_and_free_rx_resource - Unmap and free rx socket buffer 738 + * @adapter: Board private structure 739 + * @buffer_info: Buffer information structure 740 + */ 741 + static void pch_gbe_unmap_and_free_rx_resource( 742 + struct pch_gbe_adapter *adapter, 743 + struct pch_gbe_buffer *buffer_info) 744 + { 745 + if (buffer_info->mapped) { 746 + dma_unmap_single(&adapter->pdev->dev, buffer_info->dma, 747 + buffer_info->length, DMA_FROM_DEVICE); 748 + buffer_info->mapped = false; 749 + } 750 + if (buffer_info->skb) { 751 + dev_kfree_skb_any(buffer_info->skb); 752 + buffer_info->skb = NULL; 753 + } 754 + } 755 + 756 + /** 757 + * pch_gbe_clean_tx_ring - Free Tx Buffers 758 + * @adapter: Board private structure 759 + * @tx_ring: Ring to be cleaned 760 + */ 761 + static void pch_gbe_clean_tx_ring(struct pch_gbe_adapter *adapter, 762 + struct pch_gbe_tx_ring *tx_ring) 763 + { 764 + struct pch_gbe_hw *hw = &adapter->hw; 765 + struct pch_gbe_buffer *buffer_info; 766 + unsigned long size; 767 + unsigned int i; 768 + 769 + /* Free all the Tx ring sk_buffs */ 770 + for (i = 0; i < tx_ring->count; i++) { 771 + buffer_info = &tx_ring->buffer_info[i]; 772 + pch_gbe_unmap_and_free_tx_resource(adapter, buffer_info); 773 + } 774 + pr_debug("call pch_gbe_unmap_and_free_tx_resource() %d count\n", i); 775 + 776 + size = (unsigned long)sizeof(struct pch_gbe_buffer) * tx_ring->count; 777 + memset(tx_ring->buffer_info, 0, size); 778 + 779 + /* Zero out the descriptor ring */ 780 + memset(tx_ring->desc, 0, tx_ring->size); 781 + tx_ring->next_to_use = 0; 782 + tx_ring->next_to_clean = 0; 783 + iowrite32(tx_ring->dma, &hw->reg->TX_DSC_HW_P); 784 + iowrite32((tx_ring->size - 0x10), &hw->reg->TX_DSC_SIZE); 785 + } 786 + 787 + /** 788 + * pch_gbe_clean_rx_ring - Free Rx Buffers 789 + * @adapter: Board private structure 790 + * @rx_ring: Ring to free buffers from 791 + */ 792 + static void 793 + pch_gbe_clean_rx_ring(struct pch_gbe_adapter *adapter, 794 + struct pch_gbe_rx_ring *rx_ring) 795 + { 796 + struct pch_gbe_hw *hw = &adapter->hw; 797 + struct pch_gbe_buffer *buffer_info; 798 + unsigned long size; 799 + unsigned int i; 800 + 801 + /* Free all the Rx ring sk_buffs */ 802 + for (i = 0; i < rx_ring->count; i++) { 803 + buffer_info = &rx_ring->buffer_info[i]; 804 + pch_gbe_unmap_and_free_rx_resource(adapter, buffer_info); 805 + } 806 + pr_debug("call pch_gbe_unmap_and_free_rx_resource() %d count\n", i); 807 + size = (unsigned long)sizeof(struct pch_gbe_buffer) * rx_ring->count; 808 + memset(rx_ring->buffer_info, 0, size); 809 + 810 + /* Zero out the descriptor ring */ 811 + memset(rx_ring->desc, 0, rx_ring->size); 812 + rx_ring->next_to_clean = 0; 813 + rx_ring->next_to_use = 0; 814 + iowrite32(rx_ring->dma, &hw->reg->RX_DSC_HW_P); 815 + iowrite32((rx_ring->size - 0x10), &hw->reg->RX_DSC_SIZE); 816 + } 817 + 818 + static void pch_gbe_set_rgmii_ctrl(struct pch_gbe_adapter *adapter, u16 speed, 819 + u16 duplex) 820 + { 821 + struct pch_gbe_hw *hw = &adapter->hw; 822 + unsigned long rgmii = 0; 823 + 824 + /* Set the RGMII control. */ 825 + #ifdef PCH_GBE_MAC_IFOP_RGMII 826 + switch (speed) { 827 + case SPEED_10: 828 + rgmii = (PCH_GBE_RGMII_RATE_2_5M | 829 + PCH_GBE_MAC_RGMII_CTRL_SETTING); 830 + break; 831 + case SPEED_100: 832 + rgmii = (PCH_GBE_RGMII_RATE_25M | 833 + PCH_GBE_MAC_RGMII_CTRL_SETTING); 834 + break; 835 + case SPEED_1000: 836 + rgmii = (PCH_GBE_RGMII_RATE_125M | 837 + PCH_GBE_MAC_RGMII_CTRL_SETTING); 838 + break; 839 + } 840 + iowrite32(rgmii, &hw->reg->RGMII_CTRL); 841 + #else /* GMII */ 842 + rgmii = 0; 843 + iowrite32(rgmii, &hw->reg->RGMII_CTRL); 844 + #endif 845 + } 846 + static void pch_gbe_set_mode(struct pch_gbe_adapter *adapter, u16 speed, 847 + u16 duplex) 848 + { 849 + struct net_device *netdev = adapter->netdev; 850 + struct pch_gbe_hw *hw = &adapter->hw; 851 + unsigned long mode = 0; 852 + 853 + /* Set the communication mode */ 854 + switch (speed) { 855 + case SPEED_10: 856 + mode = PCH_GBE_MODE_MII_ETHER; 857 + netdev->tx_queue_len = 10; 858 + break; 859 + case SPEED_100: 860 + mode = PCH_GBE_MODE_MII_ETHER; 861 + netdev->tx_queue_len = 100; 862 + break; 863 + case SPEED_1000: 864 + mode = PCH_GBE_MODE_GMII_ETHER; 865 + break; 866 + } 867 + if (duplex == DUPLEX_FULL) 868 + mode |= PCH_GBE_MODE_FULL_DUPLEX; 869 + else 870 + mode |= PCH_GBE_MODE_HALF_DUPLEX; 871 + iowrite32(mode, &hw->reg->MODE); 872 + } 873 + 874 + /** 875 + * pch_gbe_watchdog - Watchdog process 876 + * @data: Board private structure 877 + */ 878 + static void pch_gbe_watchdog(unsigned long data) 879 + { 880 + struct pch_gbe_adapter *adapter = (struct pch_gbe_adapter *)data; 881 + struct net_device *netdev = adapter->netdev; 882 + struct pch_gbe_hw *hw = &adapter->hw; 883 + struct ethtool_cmd cmd; 884 + 885 + pr_debug("right now = %ld\n", jiffies); 886 + 887 + pch_gbe_update_stats(adapter); 888 + if ((mii_link_ok(&adapter->mii)) && (!netif_carrier_ok(netdev))) { 889 + netdev->tx_queue_len = adapter->tx_queue_len; 890 + /* mii library handles link maintenance tasks */ 891 + if (mii_ethtool_gset(&adapter->mii, &cmd)) { 892 + pr_err("ethtool get setting Error\n"); 893 + mod_timer(&adapter->watchdog_timer, 894 + round_jiffies(jiffies + 895 + PCH_GBE_WATCHDOG_PERIOD)); 896 + return; 897 + } 898 + hw->mac.link_speed = cmd.speed; 899 + hw->mac.link_duplex = cmd.duplex; 900 + /* Set the RGMII control. */ 901 + pch_gbe_set_rgmii_ctrl(adapter, hw->mac.link_speed, 902 + hw->mac.link_duplex); 903 + /* Set the communication mode */ 904 + pch_gbe_set_mode(adapter, hw->mac.link_speed, 905 + hw->mac.link_duplex); 906 + netdev_dbg(netdev, 907 + "Link is Up %d Mbps %s-Duplex\n", 908 + cmd.speed, 909 + cmd.duplex == DUPLEX_FULL ? "Full" : "Half"); 910 + netif_carrier_on(netdev); 911 + netif_wake_queue(netdev); 912 + } else if ((!mii_link_ok(&adapter->mii)) && 913 + (netif_carrier_ok(netdev))) { 914 + netdev_dbg(netdev, "NIC Link is Down\n"); 915 + hw->mac.link_speed = SPEED_10; 916 + hw->mac.link_duplex = DUPLEX_HALF; 917 + netif_carrier_off(netdev); 918 + netif_stop_queue(netdev); 919 + } 920 + mod_timer(&adapter->watchdog_timer, 921 + round_jiffies(jiffies + PCH_GBE_WATCHDOG_PERIOD)); 922 + } 923 + 924 + /** 925 + * pch_gbe_tx_queue - Carry out queuing of the transmission data 926 + * @adapter: Board private structure 927 + * @tx_ring: Tx descriptor ring structure 928 + * @skb: Sockt buffer structure 929 + */ 930 + static void pch_gbe_tx_queue(struct pch_gbe_adapter *adapter, 931 + struct pch_gbe_tx_ring *tx_ring, 932 + struct sk_buff *skb) 933 + { 934 + struct pch_gbe_hw *hw = &adapter->hw; 935 + struct pch_gbe_tx_desc *tx_desc; 936 + struct pch_gbe_buffer *buffer_info; 937 + struct sk_buff *tmp_skb; 938 + unsigned int frame_ctrl; 939 + unsigned int ring_num; 940 + unsigned long flags; 941 + 942 + /*-- Set frame control --*/ 943 + frame_ctrl = 0; 944 + if (unlikely(skb->len < PCH_GBE_SHORT_PKT)) 945 + frame_ctrl |= PCH_GBE_TXD_CTRL_APAD; 946 + if (unlikely(!adapter->tx_csum)) 947 + frame_ctrl |= PCH_GBE_TXD_CTRL_TCPIP_ACC_OFF; 948 + 949 + /* Performs checksum processing */ 950 + /* 951 + * It is because the hardware accelerator does not support a checksum, 952 + * when the received data size is less than 64 bytes. 953 + */ 954 + if ((skb->len < PCH_GBE_SHORT_PKT) && (adapter->tx_csum)) { 955 + frame_ctrl |= PCH_GBE_TXD_CTRL_APAD | 956 + PCH_GBE_TXD_CTRL_TCPIP_ACC_OFF; 957 + if (skb->protocol == htons(ETH_P_IP)) { 958 + struct iphdr *iph = ip_hdr(skb); 959 + unsigned int offset; 960 + iph->check = 0; 961 + iph->check = ip_fast_csum((u8 *) iph, iph->ihl); 962 + offset = skb_transport_offset(skb); 963 + if (iph->protocol == IPPROTO_TCP) { 964 + skb->csum = 0; 965 + tcp_hdr(skb)->check = 0; 966 + skb->csum = skb_checksum(skb, offset, 967 + skb->len - offset, 0); 968 + tcp_hdr(skb)->check = 969 + csum_tcpudp_magic(iph->saddr, 970 + iph->daddr, 971 + skb->len - offset, 972 + IPPROTO_TCP, 973 + skb->csum); 974 + } else if (iph->protocol == IPPROTO_UDP) { 975 + skb->csum = 0; 976 + udp_hdr(skb)->check = 0; 977 + skb->csum = 978 + skb_checksum(skb, offset, 979 + skb->len - offset, 0); 980 + udp_hdr(skb)->check = 981 + csum_tcpudp_magic(iph->saddr, 982 + iph->daddr, 983 + skb->len - offset, 984 + IPPROTO_UDP, 985 + skb->csum); 986 + } 987 + } 988 + } 989 + spin_lock_irqsave(&tx_ring->tx_lock, flags); 990 + ring_num = tx_ring->next_to_use; 991 + if (unlikely((ring_num + 1) == tx_ring->count)) 992 + tx_ring->next_to_use = 0; 993 + else 994 + tx_ring->next_to_use = ring_num + 1; 995 + 996 + spin_unlock_irqrestore(&tx_ring->tx_lock, flags); 997 + buffer_info = &tx_ring->buffer_info[ring_num]; 998 + tmp_skb = buffer_info->skb; 999 + 1000 + /* [Header:14][payload] ---> [Header:14][paddong:2][payload] */ 1001 + memcpy(tmp_skb->data, skb->data, ETH_HLEN); 1002 + tmp_skb->data[ETH_HLEN] = 0x00; 1003 + tmp_skb->data[ETH_HLEN + 1] = 0x00; 1004 + tmp_skb->len = skb->len; 1005 + memcpy(&tmp_skb->data[ETH_HLEN + 2], &skb->data[ETH_HLEN], 1006 + (skb->len - ETH_HLEN)); 1007 + /*-- Set Buffer infomation --*/ 1008 + buffer_info->length = tmp_skb->len; 1009 + buffer_info->dma = dma_map_single(&adapter->pdev->dev, tmp_skb->data, 1010 + buffer_info->length, 1011 + DMA_TO_DEVICE); 1012 + if (dma_mapping_error(&adapter->pdev->dev, buffer_info->dma)) { 1013 + pr_err("TX DMA map failed\n"); 1014 + buffer_info->dma = 0; 1015 + buffer_info->time_stamp = 0; 1016 + tx_ring->next_to_use = ring_num; 1017 + return; 1018 + } 1019 + buffer_info->mapped = true; 1020 + buffer_info->time_stamp = jiffies; 1021 + 1022 + /*-- Set Tx descriptor --*/ 1023 + tx_desc = PCH_GBE_TX_DESC(*tx_ring, ring_num); 1024 + tx_desc->buffer_addr = (buffer_info->dma); 1025 + tx_desc->length = (tmp_skb->len); 1026 + tx_desc->tx_words_eob = ((tmp_skb->len + 3)); 1027 + tx_desc->tx_frame_ctrl = (frame_ctrl); 1028 + tx_desc->gbec_status = (DSC_INIT16); 1029 + 1030 + if (unlikely(++ring_num == tx_ring->count)) 1031 + ring_num = 0; 1032 + 1033 + /* Update software pointer of TX descriptor */ 1034 + iowrite32(tx_ring->dma + 1035 + (int)sizeof(struct pch_gbe_tx_desc) * ring_num, 1036 + &hw->reg->TX_DSC_SW_P); 1037 + dev_kfree_skb_any(skb); 1038 + } 1039 + 1040 + /** 1041 + * pch_gbe_update_stats - Update the board statistics counters 1042 + * @adapter: Board private structure 1043 + */ 1044 + void pch_gbe_update_stats(struct pch_gbe_adapter *adapter) 1045 + { 1046 + struct net_device *netdev = adapter->netdev; 1047 + struct pci_dev *pdev = adapter->pdev; 1048 + struct pch_gbe_hw_stats *stats = &adapter->stats; 1049 + unsigned long flags; 1050 + 1051 + /* 1052 + * Prevent stats update while adapter is being reset, or if the pci 1053 + * connection is down. 1054 + */ 1055 + if ((pdev->error_state) && (pdev->error_state != pci_channel_io_normal)) 1056 + return; 1057 + 1058 + spin_lock_irqsave(&adapter->stats_lock, flags); 1059 + 1060 + /* Update device status "adapter->stats" */ 1061 + stats->rx_errors = stats->rx_crc_errors + stats->rx_frame_errors; 1062 + stats->tx_errors = stats->tx_length_errors + 1063 + stats->tx_aborted_errors + 1064 + stats->tx_carrier_errors + stats->tx_timeout_count; 1065 + 1066 + /* Update network device status "adapter->net_stats" */ 1067 + netdev->stats.rx_packets = stats->rx_packets; 1068 + netdev->stats.rx_bytes = stats->rx_bytes; 1069 + netdev->stats.rx_dropped = stats->rx_dropped; 1070 + netdev->stats.tx_packets = stats->tx_packets; 1071 + netdev->stats.tx_bytes = stats->tx_bytes; 1072 + netdev->stats.tx_dropped = stats->tx_dropped; 1073 + /* Fill out the OS statistics structure */ 1074 + netdev->stats.multicast = stats->multicast; 1075 + netdev->stats.collisions = stats->collisions; 1076 + /* Rx Errors */ 1077 + netdev->stats.rx_errors = stats->rx_errors; 1078 + netdev->stats.rx_crc_errors = stats->rx_crc_errors; 1079 + netdev->stats.rx_frame_errors = stats->rx_frame_errors; 1080 + /* Tx Errors */ 1081 + netdev->stats.tx_errors = stats->tx_errors; 1082 + netdev->stats.tx_aborted_errors = stats->tx_aborted_errors; 1083 + netdev->stats.tx_carrier_errors = stats->tx_carrier_errors; 1084 + 1085 + spin_unlock_irqrestore(&adapter->stats_lock, flags); 1086 + } 1087 + 1088 + /** 1089 + * pch_gbe_intr - Interrupt Handler 1090 + * @irq: Interrupt number 1091 + * @data: Pointer to a network interface device structure 1092 + * Returns 1093 + * - IRQ_HANDLED: Our interrupt 1094 + * - IRQ_NONE: Not our interrupt 1095 + */ 1096 + static irqreturn_t pch_gbe_intr(int irq, void *data) 1097 + { 1098 + struct net_device *netdev = data; 1099 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 1100 + struct pch_gbe_hw *hw = &adapter->hw; 1101 + u32 int_st; 1102 + u32 int_en; 1103 + 1104 + /* Check request status */ 1105 + int_st = ioread32(&hw->reg->INT_ST); 1106 + int_st = int_st & ioread32(&hw->reg->INT_EN); 1107 + /* When request status is no interruption factor */ 1108 + if (unlikely(!int_st)) 1109 + return IRQ_NONE; /* Not our interrupt. End processing. */ 1110 + pr_debug("%s occur int_st = 0x%08x\n", __func__, int_st); 1111 + if (int_st & PCH_GBE_INT_RX_FRAME_ERR) 1112 + adapter->stats.intr_rx_frame_err_count++; 1113 + if (int_st & PCH_GBE_INT_RX_FIFO_ERR) 1114 + adapter->stats.intr_rx_fifo_err_count++; 1115 + if (int_st & PCH_GBE_INT_RX_DMA_ERR) 1116 + adapter->stats.intr_rx_dma_err_count++; 1117 + if (int_st & PCH_GBE_INT_TX_FIFO_ERR) 1118 + adapter->stats.intr_tx_fifo_err_count++; 1119 + if (int_st & PCH_GBE_INT_TX_DMA_ERR) 1120 + adapter->stats.intr_tx_dma_err_count++; 1121 + if (int_st & PCH_GBE_INT_TCPIP_ERR) 1122 + adapter->stats.intr_tcpip_err_count++; 1123 + /* When Rx descriptor is empty */ 1124 + if ((int_st & PCH_GBE_INT_RX_DSC_EMP)) { 1125 + adapter->stats.intr_rx_dsc_empty_count++; 1126 + pr_err("Rx descriptor is empty\n"); 1127 + int_en = ioread32(&hw->reg->INT_EN); 1128 + iowrite32((int_en & ~PCH_GBE_INT_RX_DSC_EMP), &hw->reg->INT_EN); 1129 + if (hw->mac.tx_fc_enable) { 1130 + /* Set Pause packet */ 1131 + pch_gbe_mac_set_pause_packet(hw); 1132 + } 1133 + if ((int_en & (PCH_GBE_INT_RX_DMA_CMPLT | PCH_GBE_INT_TX_CMPLT)) 1134 + == 0) { 1135 + return IRQ_HANDLED; 1136 + } 1137 + } 1138 + 1139 + /* When request status is Receive interruption */ 1140 + if ((int_st & (PCH_GBE_INT_RX_DMA_CMPLT | PCH_GBE_INT_TX_CMPLT))) { 1141 + if (likely(napi_schedule_prep(&adapter->napi))) { 1142 + /* Enable only Rx Descriptor empty */ 1143 + atomic_inc(&adapter->irq_sem); 1144 + int_en = ioread32(&hw->reg->INT_EN); 1145 + int_en &= 1146 + ~(PCH_GBE_INT_RX_DMA_CMPLT | PCH_GBE_INT_TX_CMPLT); 1147 + iowrite32(int_en, &hw->reg->INT_EN); 1148 + /* Start polling for NAPI */ 1149 + __napi_schedule(&adapter->napi); 1150 + } 1151 + } 1152 + pr_debug("return = 0x%08x INT_EN reg = 0x%08x\n", 1153 + IRQ_HANDLED, ioread32(&hw->reg->INT_EN)); 1154 + return IRQ_HANDLED; 1155 + } 1156 + 1157 + /** 1158 + * pch_gbe_alloc_rx_buffers - Replace used receive buffers; legacy & extended 1159 + * @adapter: Board private structure 1160 + * @rx_ring: Rx descriptor ring 1161 + * @cleaned_count: Cleaned count 1162 + */ 1163 + static void 1164 + pch_gbe_alloc_rx_buffers(struct pch_gbe_adapter *adapter, 1165 + struct pch_gbe_rx_ring *rx_ring, int cleaned_count) 1166 + { 1167 + struct net_device *netdev = adapter->netdev; 1168 + struct pci_dev *pdev = adapter->pdev; 1169 + struct pch_gbe_hw *hw = &adapter->hw; 1170 + struct pch_gbe_rx_desc *rx_desc; 1171 + struct pch_gbe_buffer *buffer_info; 1172 + struct sk_buff *skb; 1173 + unsigned int i; 1174 + unsigned int bufsz; 1175 + 1176 + bufsz = adapter->rx_buffer_len + PCH_GBE_DMA_ALIGN; 1177 + i = rx_ring->next_to_use; 1178 + 1179 + while ((cleaned_count--)) { 1180 + buffer_info = &rx_ring->buffer_info[i]; 1181 + skb = buffer_info->skb; 1182 + if (skb) { 1183 + skb_trim(skb, 0); 1184 + } else { 1185 + skb = netdev_alloc_skb(netdev, bufsz); 1186 + if (unlikely(!skb)) { 1187 + /* Better luck next round */ 1188 + adapter->stats.rx_alloc_buff_failed++; 1189 + break; 1190 + } 1191 + /* 64byte align */ 1192 + skb_reserve(skb, PCH_GBE_DMA_ALIGN); 1193 + 1194 + buffer_info->skb = skb; 1195 + buffer_info->length = adapter->rx_buffer_len; 1196 + } 1197 + buffer_info->dma = dma_map_single(&pdev->dev, 1198 + skb->data, 1199 + buffer_info->length, 1200 + DMA_FROM_DEVICE); 1201 + if (dma_mapping_error(&adapter->pdev->dev, buffer_info->dma)) { 1202 + dev_kfree_skb(skb); 1203 + buffer_info->skb = NULL; 1204 + buffer_info->dma = 0; 1205 + adapter->stats.rx_alloc_buff_failed++; 1206 + break; /* while !buffer_info->skb */ 1207 + } 1208 + buffer_info->mapped = true; 1209 + rx_desc = PCH_GBE_RX_DESC(*rx_ring, i); 1210 + rx_desc->buffer_addr = (buffer_info->dma); 1211 + rx_desc->gbec_status = DSC_INIT16; 1212 + 1213 + pr_debug("i = %d buffer_info->dma = 0x08%llx buffer_info->length = 0x%x\n", 1214 + i, (unsigned long long)buffer_info->dma, 1215 + buffer_info->length); 1216 + 1217 + if (unlikely(++i == rx_ring->count)) 1218 + i = 0; 1219 + } 1220 + if (likely(rx_ring->next_to_use != i)) { 1221 + rx_ring->next_to_use = i; 1222 + if (unlikely(i-- == 0)) 1223 + i = (rx_ring->count - 1); 1224 + iowrite32(rx_ring->dma + 1225 + (int)sizeof(struct pch_gbe_rx_desc) * i, 1226 + &hw->reg->RX_DSC_SW_P); 1227 + } 1228 + return; 1229 + } 1230 + 1231 + /** 1232 + * pch_gbe_alloc_tx_buffers - Allocate transmit buffers 1233 + * @adapter: Board private structure 1234 + * @tx_ring: Tx descriptor ring 1235 + */ 1236 + static void pch_gbe_alloc_tx_buffers(struct pch_gbe_adapter *adapter, 1237 + struct pch_gbe_tx_ring *tx_ring) 1238 + { 1239 + struct pch_gbe_buffer *buffer_info; 1240 + struct sk_buff *skb; 1241 + unsigned int i; 1242 + unsigned int bufsz; 1243 + struct pch_gbe_tx_desc *tx_desc; 1244 + 1245 + bufsz = 1246 + adapter->hw.mac.max_frame_size + PCH_GBE_DMA_ALIGN + NET_IP_ALIGN; 1247 + 1248 + for (i = 0; i < tx_ring->count; i++) { 1249 + buffer_info = &tx_ring->buffer_info[i]; 1250 + skb = netdev_alloc_skb(adapter->netdev, bufsz); 1251 + skb_reserve(skb, PCH_GBE_DMA_ALIGN); 1252 + buffer_info->skb = skb; 1253 + tx_desc = PCH_GBE_TX_DESC(*tx_ring, i); 1254 + tx_desc->gbec_status = (DSC_INIT16); 1255 + } 1256 + return; 1257 + } 1258 + 1259 + /** 1260 + * pch_gbe_clean_tx - Reclaim resources after transmit completes 1261 + * @adapter: Board private structure 1262 + * @tx_ring: Tx descriptor ring 1263 + * Returns 1264 + * true: Cleaned the descriptor 1265 + * false: Not cleaned the descriptor 1266 + */ 1267 + static bool 1268 + pch_gbe_clean_tx(struct pch_gbe_adapter *adapter, 1269 + struct pch_gbe_tx_ring *tx_ring) 1270 + { 1271 + struct pch_gbe_tx_desc *tx_desc; 1272 + struct pch_gbe_buffer *buffer_info; 1273 + struct sk_buff *skb; 1274 + unsigned int i; 1275 + unsigned int cleaned_count = 0; 1276 + bool cleaned = false; 1277 + 1278 + pr_debug("next_to_clean : %d\n", tx_ring->next_to_clean); 1279 + 1280 + i = tx_ring->next_to_clean; 1281 + tx_desc = PCH_GBE_TX_DESC(*tx_ring, i); 1282 + pr_debug("gbec_status:0x%04x dma_status:0x%04x\n", 1283 + tx_desc->gbec_status, tx_desc->dma_status); 1284 + 1285 + while ((tx_desc->gbec_status & DSC_INIT16) == 0x0000) { 1286 + pr_debug("gbec_status:0x%04x\n", tx_desc->gbec_status); 1287 + cleaned = true; 1288 + buffer_info = &tx_ring->buffer_info[i]; 1289 + skb = buffer_info->skb; 1290 + 1291 + if ((tx_desc->gbec_status & PCH_GBE_TXD_GMAC_STAT_ABT)) { 1292 + adapter->stats.tx_aborted_errors++; 1293 + pr_err("Transfer Abort Error\n"); 1294 + } else if ((tx_desc->gbec_status & PCH_GBE_TXD_GMAC_STAT_CRSER) 1295 + ) { 1296 + adapter->stats.tx_carrier_errors++; 1297 + pr_err("Transfer Carrier Sense Error\n"); 1298 + } else if ((tx_desc->gbec_status & PCH_GBE_TXD_GMAC_STAT_EXCOL) 1299 + ) { 1300 + adapter->stats.tx_aborted_errors++; 1301 + pr_err("Transfer Collision Abort Error\n"); 1302 + } else if ((tx_desc->gbec_status & 1303 + (PCH_GBE_TXD_GMAC_STAT_SNGCOL | 1304 + PCH_GBE_TXD_GMAC_STAT_MLTCOL))) { 1305 + adapter->stats.collisions++; 1306 + adapter->stats.tx_packets++; 1307 + adapter->stats.tx_bytes += skb->len; 1308 + pr_debug("Transfer Collision\n"); 1309 + } else if ((tx_desc->gbec_status & PCH_GBE_TXD_GMAC_STAT_CMPLT) 1310 + ) { 1311 + adapter->stats.tx_packets++; 1312 + adapter->stats.tx_bytes += skb->len; 1313 + } 1314 + if (buffer_info->mapped) { 1315 + pr_debug("unmap buffer_info->dma : %d\n", i); 1316 + dma_unmap_single(&adapter->pdev->dev, buffer_info->dma, 1317 + buffer_info->length, DMA_TO_DEVICE); 1318 + buffer_info->mapped = false; 1319 + } 1320 + if (buffer_info->skb) { 1321 + pr_debug("trim buffer_info->skb : %d\n", i); 1322 + skb_trim(buffer_info->skb, 0); 1323 + } 1324 + tx_desc->gbec_status = DSC_INIT16; 1325 + if (unlikely(++i == tx_ring->count)) 1326 + i = 0; 1327 + tx_desc = PCH_GBE_TX_DESC(*tx_ring, i); 1328 + 1329 + /* weight of a sort for tx, to avoid endless transmit cleanup */ 1330 + if (cleaned_count++ == PCH_GBE_TX_WEIGHT) 1331 + break; 1332 + } 1333 + pr_debug("called pch_gbe_unmap_and_free_tx_resource() %d count\n", 1334 + cleaned_count); 1335 + /* Recover from running out of Tx resources in xmit_frame */ 1336 + if (unlikely(cleaned && (netif_queue_stopped(adapter->netdev)))) { 1337 + netif_wake_queue(adapter->netdev); 1338 + adapter->stats.tx_restart_count++; 1339 + pr_debug("Tx wake queue\n"); 1340 + } 1341 + spin_lock(&adapter->tx_queue_lock); 1342 + tx_ring->next_to_clean = i; 1343 + spin_unlock(&adapter->tx_queue_lock); 1344 + pr_debug("next_to_clean : %d\n", tx_ring->next_to_clean); 1345 + return cleaned; 1346 + } 1347 + 1348 + /** 1349 + * pch_gbe_clean_rx - Send received data up the network stack; legacy 1350 + * @adapter: Board private structure 1351 + * @rx_ring: Rx descriptor ring 1352 + * @work_done: Completed count 1353 + * @work_to_do: Request count 1354 + * Returns 1355 + * true: Cleaned the descriptor 1356 + * false: Not cleaned the descriptor 1357 + */ 1358 + static bool 1359 + pch_gbe_clean_rx(struct pch_gbe_adapter *adapter, 1360 + struct pch_gbe_rx_ring *rx_ring, 1361 + int *work_done, int work_to_do) 1362 + { 1363 + struct net_device *netdev = adapter->netdev; 1364 + struct pci_dev *pdev = adapter->pdev; 1365 + struct pch_gbe_buffer *buffer_info; 1366 + struct pch_gbe_rx_desc *rx_desc; 1367 + u32 length; 1368 + unsigned char tmp_packet[ETH_HLEN]; 1369 + unsigned int i; 1370 + unsigned int cleaned_count = 0; 1371 + bool cleaned = false; 1372 + struct sk_buff *skb; 1373 + u8 dma_status; 1374 + u16 gbec_status; 1375 + u32 tcp_ip_status; 1376 + u8 skb_copy_flag = 0; 1377 + u8 skb_padding_flag = 0; 1378 + 1379 + i = rx_ring->next_to_clean; 1380 + 1381 + while (*work_done < work_to_do) { 1382 + /* Check Rx descriptor status */ 1383 + rx_desc = PCH_GBE_RX_DESC(*rx_ring, i); 1384 + if (rx_desc->gbec_status == DSC_INIT16) 1385 + break; 1386 + cleaned = true; 1387 + cleaned_count++; 1388 + 1389 + dma_status = rx_desc->dma_status; 1390 + gbec_status = rx_desc->gbec_status; 1391 + tcp_ip_status = rx_desc->tcp_ip_status; 1392 + rx_desc->gbec_status = DSC_INIT16; 1393 + buffer_info = &rx_ring->buffer_info[i]; 1394 + skb = buffer_info->skb; 1395 + 1396 + /* unmap dma */ 1397 + dma_unmap_single(&pdev->dev, buffer_info->dma, 1398 + buffer_info->length, DMA_FROM_DEVICE); 1399 + buffer_info->mapped = false; 1400 + /* Prefetch the packet */ 1401 + prefetch(skb->data); 1402 + 1403 + pr_debug("RxDecNo = 0x%04x Status[DMA:0x%02x GBE:0x%04x " 1404 + "TCP:0x%08x] BufInf = 0x%p\n", 1405 + i, dma_status, gbec_status, tcp_ip_status, 1406 + buffer_info); 1407 + /* Error check */ 1408 + if (unlikely(gbec_status & PCH_GBE_RXD_GMAC_STAT_NOTOCTAL)) { 1409 + adapter->stats.rx_frame_errors++; 1410 + pr_err("Receive Not Octal Error\n"); 1411 + } else if (unlikely(gbec_status & 1412 + PCH_GBE_RXD_GMAC_STAT_NBLERR)) { 1413 + adapter->stats.rx_frame_errors++; 1414 + pr_err("Receive Nibble Error\n"); 1415 + } else if (unlikely(gbec_status & 1416 + PCH_GBE_RXD_GMAC_STAT_CRCERR)) { 1417 + adapter->stats.rx_crc_errors++; 1418 + pr_err("Receive CRC Error\n"); 1419 + } else { 1420 + /* get receive length */ 1421 + /* length convert[-3], padding[-2] */ 1422 + length = (rx_desc->rx_words_eob) - 3 - 2; 1423 + 1424 + /* Decide the data conversion method */ 1425 + if (!adapter->rx_csum) { 1426 + /* [Header:14][payload] */ 1427 + skb_padding_flag = 0; 1428 + skb_copy_flag = 1; 1429 + } else { 1430 + /* [Header:14][padding:2][payload] */ 1431 + skb_padding_flag = 1; 1432 + if (length < copybreak) 1433 + skb_copy_flag = 1; 1434 + else 1435 + skb_copy_flag = 0; 1436 + } 1437 + 1438 + /* Data conversion */ 1439 + if (skb_copy_flag) { /* recycle skb */ 1440 + struct sk_buff *new_skb; 1441 + new_skb = 1442 + netdev_alloc_skb(netdev, 1443 + length + NET_IP_ALIGN); 1444 + if (new_skb) { 1445 + if (!skb_padding_flag) { 1446 + skb_reserve(new_skb, 1447 + NET_IP_ALIGN); 1448 + } 1449 + memcpy(new_skb->data, skb->data, 1450 + length); 1451 + /* save the skb 1452 + * in buffer_info as good */ 1453 + skb = new_skb; 1454 + } else if (!skb_padding_flag) { 1455 + /* dorrop error */ 1456 + pr_err("New skb allocation Error\n"); 1457 + goto dorrop; 1458 + } 1459 + } else { 1460 + buffer_info->skb = NULL; 1461 + } 1462 + if (skb_padding_flag) { 1463 + memcpy(&tmp_packet[0], &skb->data[0], ETH_HLEN); 1464 + memcpy(&skb->data[NET_IP_ALIGN], &tmp_packet[0], 1465 + ETH_HLEN); 1466 + skb_reserve(skb, NET_IP_ALIGN); 1467 + 1468 + } 1469 + 1470 + /* update status of driver */ 1471 + adapter->stats.rx_bytes += length; 1472 + adapter->stats.rx_packets++; 1473 + if ((gbec_status & PCH_GBE_RXD_GMAC_STAT_MARMLT)) 1474 + adapter->stats.multicast++; 1475 + /* Write meta date of skb */ 1476 + skb_put(skb, length); 1477 + skb->protocol = eth_type_trans(skb, netdev); 1478 + if ((tcp_ip_status & PCH_GBE_RXD_ACC_STAT_TCPIPOK) == 1479 + PCH_GBE_RXD_ACC_STAT_TCPIPOK) { 1480 + skb->ip_summed = CHECKSUM_UNNECESSARY; 1481 + } else { 1482 + skb->ip_summed = CHECKSUM_NONE; 1483 + } 1484 + napi_gro_receive(&adapter->napi, skb); 1485 + (*work_done)++; 1486 + pr_debug("Receive skb->ip_summed: %d length: %d\n", 1487 + skb->ip_summed, length); 1488 + } 1489 + dorrop: 1490 + /* return some buffers to hardware, one at a time is too slow */ 1491 + if (unlikely(cleaned_count >= PCH_GBE_RX_BUFFER_WRITE)) { 1492 + pch_gbe_alloc_rx_buffers(adapter, rx_ring, 1493 + cleaned_count); 1494 + cleaned_count = 0; 1495 + } 1496 + if (++i == rx_ring->count) 1497 + i = 0; 1498 + } 1499 + rx_ring->next_to_clean = i; 1500 + if (cleaned_count) 1501 + pch_gbe_alloc_rx_buffers(adapter, rx_ring, cleaned_count); 1502 + return cleaned; 1503 + } 1504 + 1505 + /** 1506 + * pch_gbe_setup_tx_resources - Allocate Tx resources (Descriptors) 1507 + * @adapter: Board private structure 1508 + * @tx_ring: Tx descriptor ring (for a specific queue) to setup 1509 + * Returns 1510 + * 0: Successfully 1511 + * Negative value: Failed 1512 + */ 1513 + int pch_gbe_setup_tx_resources(struct pch_gbe_adapter *adapter, 1514 + struct pch_gbe_tx_ring *tx_ring) 1515 + { 1516 + struct pci_dev *pdev = adapter->pdev; 1517 + struct pch_gbe_tx_desc *tx_desc; 1518 + int size; 1519 + int desNo; 1520 + 1521 + size = (int)sizeof(struct pch_gbe_buffer) * tx_ring->count; 1522 + tx_ring->buffer_info = vmalloc(size); 1523 + if (!tx_ring->buffer_info) { 1524 + pr_err("Unable to allocate memory for the buffer infomation\n"); 1525 + return -ENOMEM; 1526 + } 1527 + memset(tx_ring->buffer_info, 0, size); 1528 + 1529 + tx_ring->size = tx_ring->count * (int)sizeof(struct pch_gbe_tx_desc); 1530 + 1531 + tx_ring->desc = dma_alloc_coherent(&pdev->dev, tx_ring->size, 1532 + &tx_ring->dma, GFP_KERNEL); 1533 + if (!tx_ring->desc) { 1534 + vfree(tx_ring->buffer_info); 1535 + pr_err("Unable to allocate memory for the transmit descriptor ring\n"); 1536 + return -ENOMEM; 1537 + } 1538 + memset(tx_ring->desc, 0, tx_ring->size); 1539 + 1540 + tx_ring->next_to_use = 0; 1541 + tx_ring->next_to_clean = 0; 1542 + spin_lock_init(&tx_ring->tx_lock); 1543 + 1544 + for (desNo = 0; desNo < tx_ring->count; desNo++) { 1545 + tx_desc = PCH_GBE_TX_DESC(*tx_ring, desNo); 1546 + tx_desc->gbec_status = DSC_INIT16; 1547 + } 1548 + pr_debug("tx_ring->desc = 0x%p tx_ring->dma = 0x%08llx\n" 1549 + "next_to_clean = 0x%08x next_to_use = 0x%08x\n", 1550 + tx_ring->desc, (unsigned long long)tx_ring->dma, 1551 + tx_ring->next_to_clean, tx_ring->next_to_use); 1552 + return 0; 1553 + } 1554 + 1555 + /** 1556 + * pch_gbe_setup_rx_resources - Allocate Rx resources (Descriptors) 1557 + * @adapter: Board private structure 1558 + * @rx_ring: Rx descriptor ring (for a specific queue) to setup 1559 + * Returns 1560 + * 0: Successfully 1561 + * Negative value: Failed 1562 + */ 1563 + int pch_gbe_setup_rx_resources(struct pch_gbe_adapter *adapter, 1564 + struct pch_gbe_rx_ring *rx_ring) 1565 + { 1566 + struct pci_dev *pdev = adapter->pdev; 1567 + struct pch_gbe_rx_desc *rx_desc; 1568 + int size; 1569 + int desNo; 1570 + 1571 + size = (int)sizeof(struct pch_gbe_buffer) * rx_ring->count; 1572 + rx_ring->buffer_info = vmalloc(size); 1573 + if (!rx_ring->buffer_info) { 1574 + pr_err("Unable to allocate memory for the receive descriptor ring\n"); 1575 + return -ENOMEM; 1576 + } 1577 + memset(rx_ring->buffer_info, 0, size); 1578 + rx_ring->size = rx_ring->count * (int)sizeof(struct pch_gbe_rx_desc); 1579 + rx_ring->desc = dma_alloc_coherent(&pdev->dev, rx_ring->size, 1580 + &rx_ring->dma, GFP_KERNEL); 1581 + 1582 + if (!rx_ring->desc) { 1583 + pr_err("Unable to allocate memory for the receive descriptor ring\n"); 1584 + vfree(rx_ring->buffer_info); 1585 + return -ENOMEM; 1586 + } 1587 + memset(rx_ring->desc, 0, rx_ring->size); 1588 + rx_ring->next_to_clean = 0; 1589 + rx_ring->next_to_use = 0; 1590 + for (desNo = 0; desNo < rx_ring->count; desNo++) { 1591 + rx_desc = PCH_GBE_RX_DESC(*rx_ring, desNo); 1592 + rx_desc->gbec_status = DSC_INIT16; 1593 + } 1594 + pr_debug("rx_ring->desc = 0x%p rx_ring->dma = 0x%08llx " 1595 + "next_to_clean = 0x%08x next_to_use = 0x%08x\n", 1596 + rx_ring->desc, (unsigned long long)rx_ring->dma, 1597 + rx_ring->next_to_clean, rx_ring->next_to_use); 1598 + return 0; 1599 + } 1600 + 1601 + /** 1602 + * pch_gbe_free_tx_resources - Free Tx Resources 1603 + * @adapter: Board private structure 1604 + * @tx_ring: Tx descriptor ring for a specific queue 1605 + */ 1606 + void pch_gbe_free_tx_resources(struct pch_gbe_adapter *adapter, 1607 + struct pch_gbe_tx_ring *tx_ring) 1608 + { 1609 + struct pci_dev *pdev = adapter->pdev; 1610 + 1611 + pch_gbe_clean_tx_ring(adapter, tx_ring); 1612 + vfree(tx_ring->buffer_info); 1613 + tx_ring->buffer_info = NULL; 1614 + pci_free_consistent(pdev, tx_ring->size, tx_ring->desc, tx_ring->dma); 1615 + tx_ring->desc = NULL; 1616 + } 1617 + 1618 + /** 1619 + * pch_gbe_free_rx_resources - Free Rx Resources 1620 + * @adapter: Board private structure 1621 + * @rx_ring: Ring to clean the resources from 1622 + */ 1623 + void pch_gbe_free_rx_resources(struct pch_gbe_adapter *adapter, 1624 + struct pch_gbe_rx_ring *rx_ring) 1625 + { 1626 + struct pci_dev *pdev = adapter->pdev; 1627 + 1628 + pch_gbe_clean_rx_ring(adapter, rx_ring); 1629 + vfree(rx_ring->buffer_info); 1630 + rx_ring->buffer_info = NULL; 1631 + pci_free_consistent(pdev, rx_ring->size, rx_ring->desc, rx_ring->dma); 1632 + rx_ring->desc = NULL; 1633 + } 1634 + 1635 + /** 1636 + * pch_gbe_request_irq - Allocate an interrupt line 1637 + * @adapter: Board private structure 1638 + * Returns 1639 + * 0: Successfully 1640 + * Negative value: Failed 1641 + */ 1642 + static int pch_gbe_request_irq(struct pch_gbe_adapter *adapter) 1643 + { 1644 + struct net_device *netdev = adapter->netdev; 1645 + int err; 1646 + int flags; 1647 + 1648 + flags = IRQF_SHARED; 1649 + adapter->have_msi = false; 1650 + err = pci_enable_msi(adapter->pdev); 1651 + pr_debug("call pci_enable_msi\n"); 1652 + if (err) { 1653 + pr_debug("call pci_enable_msi - Error: %d\n", err); 1654 + } else { 1655 + flags = 0; 1656 + adapter->have_msi = true; 1657 + } 1658 + err = request_irq(adapter->pdev->irq, &pch_gbe_intr, 1659 + flags, netdev->name, netdev); 1660 + if (err) 1661 + pr_err("Unable to allocate interrupt Error: %d\n", err); 1662 + pr_debug("adapter->have_msi : %d flags : 0x%04x return : 0x%04x\n", 1663 + adapter->have_msi, flags, err); 1664 + return err; 1665 + } 1666 + 1667 + 1668 + static void pch_gbe_set_multi(struct net_device *netdev); 1669 + /** 1670 + * pch_gbe_up - Up GbE network device 1671 + * @adapter: Board private structure 1672 + * Returns 1673 + * 0: Successfully 1674 + * Negative value: Failed 1675 + */ 1676 + int pch_gbe_up(struct pch_gbe_adapter *adapter) 1677 + { 1678 + struct net_device *netdev = adapter->netdev; 1679 + struct pch_gbe_tx_ring *tx_ring = adapter->tx_ring; 1680 + struct pch_gbe_rx_ring *rx_ring = adapter->rx_ring; 1681 + int err; 1682 + 1683 + /* hardware has been reset, we need to reload some things */ 1684 + pch_gbe_set_multi(netdev); 1685 + 1686 + pch_gbe_setup_tctl(adapter); 1687 + pch_gbe_configure_tx(adapter); 1688 + pch_gbe_setup_rctl(adapter); 1689 + pch_gbe_configure_rx(adapter); 1690 + 1691 + err = pch_gbe_request_irq(adapter); 1692 + if (err) { 1693 + pr_err("Error: can't bring device up\n"); 1694 + return err; 1695 + } 1696 + pch_gbe_alloc_tx_buffers(adapter, tx_ring); 1697 + pch_gbe_alloc_rx_buffers(adapter, rx_ring, rx_ring->count); 1698 + adapter->tx_queue_len = netdev->tx_queue_len; 1699 + 1700 + mod_timer(&adapter->watchdog_timer, jiffies); 1701 + 1702 + napi_enable(&adapter->napi); 1703 + pch_gbe_irq_enable(adapter); 1704 + netif_start_queue(adapter->netdev); 1705 + 1706 + return 0; 1707 + } 1708 + 1709 + /** 1710 + * pch_gbe_down - Down GbE network device 1711 + * @adapter: Board private structure 1712 + */ 1713 + void pch_gbe_down(struct pch_gbe_adapter *adapter) 1714 + { 1715 + struct net_device *netdev = adapter->netdev; 1716 + 1717 + /* signal that we're down so the interrupt handler does not 1718 + * reschedule our watchdog timer */ 1719 + napi_disable(&adapter->napi); 1720 + atomic_set(&adapter->irq_sem, 0); 1721 + 1722 + pch_gbe_irq_disable(adapter); 1723 + pch_gbe_free_irq(adapter); 1724 + 1725 + del_timer_sync(&adapter->watchdog_timer); 1726 + 1727 + netdev->tx_queue_len = adapter->tx_queue_len; 1728 + netif_carrier_off(netdev); 1729 + netif_stop_queue(netdev); 1730 + 1731 + pch_gbe_reset(adapter); 1732 + pch_gbe_clean_tx_ring(adapter, adapter->tx_ring); 1733 + pch_gbe_clean_rx_ring(adapter, adapter->rx_ring); 1734 + } 1735 + 1736 + /** 1737 + * pch_gbe_sw_init - Initialize general software structures (struct pch_gbe_adapter) 1738 + * @adapter: Board private structure to initialize 1739 + * Returns 1740 + * 0: Successfully 1741 + * Negative value: Failed 1742 + */ 1743 + static int pch_gbe_sw_init(struct pch_gbe_adapter *adapter) 1744 + { 1745 + struct pch_gbe_hw *hw = &adapter->hw; 1746 + struct net_device *netdev = adapter->netdev; 1747 + 1748 + adapter->rx_buffer_len = PCH_GBE_FRAME_SIZE_2048; 1749 + hw->mac.max_frame_size = netdev->mtu + ETH_HLEN + ETH_FCS_LEN; 1750 + hw->mac.min_frame_size = ETH_ZLEN + ETH_FCS_LEN; 1751 + 1752 + /* Initialize the hardware-specific values */ 1753 + if (pch_gbe_hal_setup_init_funcs(hw)) { 1754 + pr_err("Hardware Initialization Failure\n"); 1755 + return -EIO; 1756 + } 1757 + if (pch_gbe_alloc_queues(adapter)) { 1758 + pr_err("Unable to allocate memory for queues\n"); 1759 + return -ENOMEM; 1760 + } 1761 + spin_lock_init(&adapter->hw.miim_lock); 1762 + spin_lock_init(&adapter->tx_queue_lock); 1763 + spin_lock_init(&adapter->stats_lock); 1764 + spin_lock_init(&adapter->ethtool_lock); 1765 + atomic_set(&adapter->irq_sem, 0); 1766 + pch_gbe_irq_disable(adapter); 1767 + 1768 + pch_gbe_init_stats(adapter); 1769 + 1770 + pr_debug("rx_buffer_len : %d mac.min_frame_size : %d mac.max_frame_size : %d\n", 1771 + (u32) adapter->rx_buffer_len, 1772 + hw->mac.min_frame_size, hw->mac.max_frame_size); 1773 + return 0; 1774 + } 1775 + 1776 + /** 1777 + * pch_gbe_open - Called when a network interface is made active 1778 + * @netdev: Network interface device structure 1779 + * Returns 1780 + * 0: Successfully 1781 + * Negative value: Failed 1782 + */ 1783 + static int pch_gbe_open(struct net_device *netdev) 1784 + { 1785 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 1786 + struct pch_gbe_hw *hw = &adapter->hw; 1787 + int err; 1788 + 1789 + /* allocate transmit descriptors */ 1790 + err = pch_gbe_setup_tx_resources(adapter, adapter->tx_ring); 1791 + if (err) 1792 + goto err_setup_tx; 1793 + /* allocate receive descriptors */ 1794 + err = pch_gbe_setup_rx_resources(adapter, adapter->rx_ring); 1795 + if (err) 1796 + goto err_setup_rx; 1797 + pch_gbe_hal_power_up_phy(hw); 1798 + err = pch_gbe_up(adapter); 1799 + if (err) 1800 + goto err_up; 1801 + pr_debug("Success End\n"); 1802 + return 0; 1803 + 1804 + err_up: 1805 + if (!adapter->wake_up_evt) 1806 + pch_gbe_hal_power_down_phy(hw); 1807 + pch_gbe_free_rx_resources(adapter, adapter->rx_ring); 1808 + err_setup_rx: 1809 + pch_gbe_free_tx_resources(adapter, adapter->tx_ring); 1810 + err_setup_tx: 1811 + pch_gbe_reset(adapter); 1812 + pr_err("Error End\n"); 1813 + return err; 1814 + } 1815 + 1816 + /** 1817 + * pch_gbe_stop - Disables a network interface 1818 + * @netdev: Network interface device structure 1819 + * Returns 1820 + * 0: Successfully 1821 + */ 1822 + static int pch_gbe_stop(struct net_device *netdev) 1823 + { 1824 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 1825 + struct pch_gbe_hw *hw = &adapter->hw; 1826 + 1827 + pch_gbe_down(adapter); 1828 + if (!adapter->wake_up_evt) 1829 + pch_gbe_hal_power_down_phy(hw); 1830 + pch_gbe_free_tx_resources(adapter, adapter->tx_ring); 1831 + pch_gbe_free_rx_resources(adapter, adapter->rx_ring); 1832 + return 0; 1833 + } 1834 + 1835 + /** 1836 + * pch_gbe_xmit_frame - Packet transmitting start 1837 + * @skb: Socket buffer structure 1838 + * @netdev: Network interface device structure 1839 + * Returns 1840 + * - NETDEV_TX_OK: Normal end 1841 + * - NETDEV_TX_BUSY: Error end 1842 + */ 1843 + static int pch_gbe_xmit_frame(struct sk_buff *skb, struct net_device *netdev) 1844 + { 1845 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 1846 + struct pch_gbe_tx_ring *tx_ring = adapter->tx_ring; 1847 + unsigned long flags; 1848 + 1849 + if (unlikely(skb->len > (adapter->hw.mac.max_frame_size - 4))) { 1850 + dev_kfree_skb_any(skb); 1851 + pr_err("Transfer length Error: skb len: %d > max: %d\n", 1852 + skb->len, adapter->hw.mac.max_frame_size); 1853 + adapter->stats.tx_length_errors++; 1854 + return NETDEV_TX_OK; 1855 + } 1856 + if (!spin_trylock_irqsave(&tx_ring->tx_lock, flags)) { 1857 + /* Collision - tell upper layer to requeue */ 1858 + return NETDEV_TX_LOCKED; 1859 + } 1860 + if (unlikely(!PCH_GBE_DESC_UNUSED(tx_ring))) { 1861 + netif_stop_queue(netdev); 1862 + spin_unlock_irqrestore(&tx_ring->tx_lock, flags); 1863 + pr_debug("Return : BUSY next_to use : 0x%08x next_to clean : 0x%08x\n", 1864 + tx_ring->next_to_use, tx_ring->next_to_clean); 1865 + return NETDEV_TX_BUSY; 1866 + } 1867 + spin_unlock_irqrestore(&tx_ring->tx_lock, flags); 1868 + 1869 + /* CRC,ITAG no support */ 1870 + pch_gbe_tx_queue(adapter, tx_ring, skb); 1871 + return NETDEV_TX_OK; 1872 + } 1873 + 1874 + /** 1875 + * pch_gbe_get_stats - Get System Network Statistics 1876 + * @netdev: Network interface device structure 1877 + * Returns: The current stats 1878 + */ 1879 + static struct net_device_stats *pch_gbe_get_stats(struct net_device *netdev) 1880 + { 1881 + /* only return the current stats */ 1882 + return &netdev->stats; 1883 + } 1884 + 1885 + /** 1886 + * pch_gbe_set_multi - Multicast and Promiscuous mode set 1887 + * @netdev: Network interface device structure 1888 + */ 1889 + static void pch_gbe_set_multi(struct net_device *netdev) 1890 + { 1891 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 1892 + struct pch_gbe_hw *hw = &adapter->hw; 1893 + struct netdev_hw_addr *ha; 1894 + u8 *mta_list; 1895 + u32 rctl; 1896 + int i; 1897 + int mc_count; 1898 + 1899 + pr_debug("netdev->flags : 0x%08x\n", netdev->flags); 1900 + 1901 + /* Check for Promiscuous and All Multicast modes */ 1902 + rctl = ioread32(&hw->reg->RX_MODE); 1903 + mc_count = netdev_mc_count(netdev); 1904 + if ((netdev->flags & IFF_PROMISC)) { 1905 + rctl &= ~PCH_GBE_ADD_FIL_EN; 1906 + rctl &= ~PCH_GBE_MLT_FIL_EN; 1907 + } else if ((netdev->flags & IFF_ALLMULTI)) { 1908 + /* all the multicasting receive permissions */ 1909 + rctl |= PCH_GBE_ADD_FIL_EN; 1910 + rctl &= ~PCH_GBE_MLT_FIL_EN; 1911 + } else { 1912 + if (mc_count >= PCH_GBE_MAR_ENTRIES) { 1913 + /* all the multicasting receive permissions */ 1914 + rctl |= PCH_GBE_ADD_FIL_EN; 1915 + rctl &= ~PCH_GBE_MLT_FIL_EN; 1916 + } else { 1917 + rctl |= (PCH_GBE_ADD_FIL_EN | PCH_GBE_MLT_FIL_EN); 1918 + } 1919 + } 1920 + iowrite32(rctl, &hw->reg->RX_MODE); 1921 + 1922 + if (mc_count >= PCH_GBE_MAR_ENTRIES) 1923 + return; 1924 + mta_list = kmalloc(mc_count * ETH_ALEN, GFP_ATOMIC); 1925 + if (!mta_list) 1926 + return; 1927 + 1928 + /* The shared function expects a packed array of only addresses. */ 1929 + i = 0; 1930 + netdev_for_each_mc_addr(ha, netdev) { 1931 + if (i == mc_count) 1932 + break; 1933 + memcpy(mta_list + (i++ * ETH_ALEN), &ha->addr, ETH_ALEN); 1934 + } 1935 + pch_gbe_mac_mc_addr_list_update(hw, mta_list, i, 1, 1936 + PCH_GBE_MAR_ENTRIES); 1937 + kfree(mta_list); 1938 + 1939 + pr_debug("RX_MODE reg(check bit31,30 ADD,MLT) : 0x%08x netdev->mc_count : 0x%08x\n", 1940 + ioread32(&hw->reg->RX_MODE), mc_count); 1941 + } 1942 + 1943 + /** 1944 + * pch_gbe_set_mac - Change the Ethernet Address of the NIC 1945 + * @netdev: Network interface device structure 1946 + * @addr: Pointer to an address structure 1947 + * Returns 1948 + * 0: Successfully 1949 + * -EADDRNOTAVAIL: Failed 1950 + */ 1951 + static int pch_gbe_set_mac(struct net_device *netdev, void *addr) 1952 + { 1953 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 1954 + struct sockaddr *skaddr = addr; 1955 + int ret_val; 1956 + 1957 + if (!is_valid_ether_addr(skaddr->sa_data)) { 1958 + ret_val = -EADDRNOTAVAIL; 1959 + } else { 1960 + memcpy(netdev->dev_addr, skaddr->sa_data, netdev->addr_len); 1961 + memcpy(adapter->hw.mac.addr, skaddr->sa_data, netdev->addr_len); 1962 + pch_gbe_mac_mar_set(&adapter->hw, adapter->hw.mac.addr, 0); 1963 + ret_val = 0; 1964 + } 1965 + pr_debug("ret_val : 0x%08x\n", ret_val); 1966 + pr_debug("dev_addr : %pM\n", netdev->dev_addr); 1967 + pr_debug("mac_addr : %pM\n", adapter->hw.mac.addr); 1968 + pr_debug("MAC_ADR1AB reg : 0x%08x 0x%08x\n", 1969 + ioread32(&adapter->hw.reg->mac_adr[0].high), 1970 + ioread32(&adapter->hw.reg->mac_adr[0].low)); 1971 + return ret_val; 1972 + } 1973 + 1974 + /** 1975 + * pch_gbe_change_mtu - Change the Maximum Transfer Unit 1976 + * @netdev: Network interface device structure 1977 + * @new_mtu: New value for maximum frame size 1978 + * Returns 1979 + * 0: Successfully 1980 + * -EINVAL: Failed 1981 + */ 1982 + static int pch_gbe_change_mtu(struct net_device *netdev, int new_mtu) 1983 + { 1984 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 1985 + int max_frame; 1986 + 1987 + max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN; 1988 + if ((max_frame < ETH_ZLEN + ETH_FCS_LEN) || 1989 + (max_frame > PCH_GBE_MAX_JUMBO_FRAME_SIZE)) { 1990 + pr_err("Invalid MTU setting\n"); 1991 + return -EINVAL; 1992 + } 1993 + if (max_frame <= PCH_GBE_FRAME_SIZE_2048) 1994 + adapter->rx_buffer_len = PCH_GBE_FRAME_SIZE_2048; 1995 + else if (max_frame <= PCH_GBE_FRAME_SIZE_4096) 1996 + adapter->rx_buffer_len = PCH_GBE_FRAME_SIZE_4096; 1997 + else if (max_frame <= PCH_GBE_FRAME_SIZE_8192) 1998 + adapter->rx_buffer_len = PCH_GBE_FRAME_SIZE_8192; 1999 + else 2000 + adapter->rx_buffer_len = PCH_GBE_MAX_JUMBO_FRAME_SIZE; 2001 + netdev->mtu = new_mtu; 2002 + adapter->hw.mac.max_frame_size = max_frame; 2003 + 2004 + if (netif_running(netdev)) 2005 + pch_gbe_reinit_locked(adapter); 2006 + else 2007 + pch_gbe_reset(adapter); 2008 + 2009 + pr_debug("max_frame : %d rx_buffer_len : %d mtu : %d max_frame_size : %d\n", 2010 + max_frame, (u32) adapter->rx_buffer_len, netdev->mtu, 2011 + adapter->hw.mac.max_frame_size); 2012 + return 0; 2013 + } 2014 + 2015 + /** 2016 + * pch_gbe_ioctl - Controls register through a MII interface 2017 + * @netdev: Network interface device structure 2018 + * @ifr: Pointer to ifr structure 2019 + * @cmd: Control command 2020 + * Returns 2021 + * 0: Successfully 2022 + * Negative value: Failed 2023 + */ 2024 + static int pch_gbe_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd) 2025 + { 2026 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 2027 + 2028 + pr_debug("cmd : 0x%04x\n", cmd); 2029 + 2030 + return generic_mii_ioctl(&adapter->mii, if_mii(ifr), cmd, NULL); 2031 + } 2032 + 2033 + /** 2034 + * pch_gbe_tx_timeout - Respond to a Tx Hang 2035 + * @netdev: Network interface device structure 2036 + */ 2037 + static void pch_gbe_tx_timeout(struct net_device *netdev) 2038 + { 2039 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 2040 + 2041 + /* Do the reset outside of interrupt context */ 2042 + adapter->stats.tx_timeout_count++; 2043 + schedule_work(&adapter->reset_task); 2044 + } 2045 + 2046 + /** 2047 + * pch_gbe_napi_poll - NAPI receive and transfer polling callback 2048 + * @napi: Pointer of polling device struct 2049 + * @budget: The maximum number of a packet 2050 + * Returns 2051 + * false: Exit the polling mode 2052 + * true: Continue the polling mode 2053 + */ 2054 + static int pch_gbe_napi_poll(struct napi_struct *napi, int budget) 2055 + { 2056 + struct pch_gbe_adapter *adapter = 2057 + container_of(napi, struct pch_gbe_adapter, napi); 2058 + struct net_device *netdev = adapter->netdev; 2059 + int work_done = 0; 2060 + bool poll_end_flag = false; 2061 + bool cleaned = false; 2062 + 2063 + pr_debug("budget : %d\n", budget); 2064 + 2065 + /* Keep link state information with original netdev */ 2066 + if (!netif_carrier_ok(netdev)) { 2067 + poll_end_flag = true; 2068 + } else { 2069 + cleaned = pch_gbe_clean_tx(adapter, adapter->tx_ring); 2070 + pch_gbe_clean_rx(adapter, adapter->rx_ring, &work_done, budget); 2071 + 2072 + if (cleaned) 2073 + work_done = budget; 2074 + /* If no Tx and not enough Rx work done, 2075 + * exit the polling mode 2076 + */ 2077 + if ((work_done < budget) || !netif_running(netdev)) 2078 + poll_end_flag = true; 2079 + } 2080 + 2081 + if (poll_end_flag) { 2082 + napi_complete(napi); 2083 + pch_gbe_irq_enable(adapter); 2084 + } 2085 + 2086 + pr_debug("poll_end_flag : %d work_done : %d budget : %d\n", 2087 + poll_end_flag, work_done, budget); 2088 + 2089 + return work_done; 2090 + } 2091 + 2092 + #ifdef CONFIG_NET_POLL_CONTROLLER 2093 + /** 2094 + * pch_gbe_netpoll - Used by things like netconsole to send skbs 2095 + * @netdev: Network interface device structure 2096 + */ 2097 + static void pch_gbe_netpoll(struct net_device *netdev) 2098 + { 2099 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 2100 + 2101 + disable_irq(adapter->pdev->irq); 2102 + pch_gbe_intr(adapter->pdev->irq, netdev); 2103 + enable_irq(adapter->pdev->irq); 2104 + } 2105 + #endif 2106 + 2107 + static const struct net_device_ops pch_gbe_netdev_ops = { 2108 + .ndo_open = pch_gbe_open, 2109 + .ndo_stop = pch_gbe_stop, 2110 + .ndo_start_xmit = pch_gbe_xmit_frame, 2111 + .ndo_get_stats = pch_gbe_get_stats, 2112 + .ndo_set_mac_address = pch_gbe_set_mac, 2113 + .ndo_tx_timeout = pch_gbe_tx_timeout, 2114 + .ndo_change_mtu = pch_gbe_change_mtu, 2115 + .ndo_do_ioctl = pch_gbe_ioctl, 2116 + .ndo_set_multicast_list = &pch_gbe_set_multi, 2117 + #ifdef CONFIG_NET_POLL_CONTROLLER 2118 + .ndo_poll_controller = pch_gbe_netpoll, 2119 + #endif 2120 + }; 2121 + 2122 + static pci_ers_result_t pch_gbe_io_error_detected(struct pci_dev *pdev, 2123 + pci_channel_state_t state) 2124 + { 2125 + struct net_device *netdev = pci_get_drvdata(pdev); 2126 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 2127 + 2128 + netif_device_detach(netdev); 2129 + if (netif_running(netdev)) 2130 + pch_gbe_down(adapter); 2131 + pci_disable_device(pdev); 2132 + /* Request a slot slot reset. */ 2133 + return PCI_ERS_RESULT_NEED_RESET; 2134 + } 2135 + 2136 + static pci_ers_result_t pch_gbe_io_slot_reset(struct pci_dev *pdev) 2137 + { 2138 + struct net_device *netdev = pci_get_drvdata(pdev); 2139 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 2140 + struct pch_gbe_hw *hw = &adapter->hw; 2141 + 2142 + if (pci_enable_device(pdev)) { 2143 + pr_err("Cannot re-enable PCI device after reset\n"); 2144 + return PCI_ERS_RESULT_DISCONNECT; 2145 + } 2146 + pci_set_master(pdev); 2147 + pci_enable_wake(pdev, PCI_D0, 0); 2148 + pch_gbe_hal_power_up_phy(hw); 2149 + pch_gbe_reset(adapter); 2150 + /* Clear wake up status */ 2151 + pch_gbe_mac_set_wol_event(hw, 0); 2152 + 2153 + return PCI_ERS_RESULT_RECOVERED; 2154 + } 2155 + 2156 + static void pch_gbe_io_resume(struct pci_dev *pdev) 2157 + { 2158 + struct net_device *netdev = pci_get_drvdata(pdev); 2159 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 2160 + 2161 + if (netif_running(netdev)) { 2162 + if (pch_gbe_up(adapter)) { 2163 + pr_debug("can't bring device back up after reset\n"); 2164 + return; 2165 + } 2166 + } 2167 + netif_device_attach(netdev); 2168 + } 2169 + 2170 + static int __pch_gbe_suspend(struct pci_dev *pdev) 2171 + { 2172 + struct net_device *netdev = pci_get_drvdata(pdev); 2173 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 2174 + struct pch_gbe_hw *hw = &adapter->hw; 2175 + u32 wufc = adapter->wake_up_evt; 2176 + int retval = 0; 2177 + 2178 + netif_device_detach(netdev); 2179 + if (netif_running(netdev)) 2180 + pch_gbe_down(adapter); 2181 + if (wufc) { 2182 + pch_gbe_set_multi(netdev); 2183 + pch_gbe_setup_rctl(adapter); 2184 + pch_gbe_configure_rx(adapter); 2185 + pch_gbe_set_rgmii_ctrl(adapter, hw->mac.link_speed, 2186 + hw->mac.link_duplex); 2187 + pch_gbe_set_mode(adapter, hw->mac.link_speed, 2188 + hw->mac.link_duplex); 2189 + pch_gbe_mac_set_wol_event(hw, wufc); 2190 + pci_disable_device(pdev); 2191 + } else { 2192 + pch_gbe_hal_power_down_phy(hw); 2193 + pch_gbe_mac_set_wol_event(hw, wufc); 2194 + pci_disable_device(pdev); 2195 + } 2196 + return retval; 2197 + } 2198 + 2199 + #ifdef CONFIG_PM 2200 + static int pch_gbe_suspend(struct device *device) 2201 + { 2202 + struct pci_dev *pdev = to_pci_dev(device); 2203 + 2204 + return __pch_gbe_suspend(pdev); 2205 + } 2206 + 2207 + static int pch_gbe_resume(struct device *device) 2208 + { 2209 + struct pci_dev *pdev = to_pci_dev(device); 2210 + struct net_device *netdev = pci_get_drvdata(pdev); 2211 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 2212 + struct pch_gbe_hw *hw = &adapter->hw; 2213 + u32 err; 2214 + 2215 + err = pci_enable_device(pdev); 2216 + if (err) { 2217 + pr_err("Cannot enable PCI device from suspend\n"); 2218 + return err; 2219 + } 2220 + pci_set_master(pdev); 2221 + pch_gbe_hal_power_up_phy(hw); 2222 + pch_gbe_reset(adapter); 2223 + /* Clear wake on lan control and status */ 2224 + pch_gbe_mac_set_wol_event(hw, 0); 2225 + 2226 + if (netif_running(netdev)) 2227 + pch_gbe_up(adapter); 2228 + netif_device_attach(netdev); 2229 + 2230 + return 0; 2231 + } 2232 + #endif /* CONFIG_PM */ 2233 + 2234 + static void pch_gbe_shutdown(struct pci_dev *pdev) 2235 + { 2236 + __pch_gbe_suspend(pdev); 2237 + if (system_state == SYSTEM_POWER_OFF) { 2238 + pci_wake_from_d3(pdev, true); 2239 + pci_set_power_state(pdev, PCI_D3hot); 2240 + } 2241 + } 2242 + 2243 + static void pch_gbe_remove(struct pci_dev *pdev) 2244 + { 2245 + struct net_device *netdev = pci_get_drvdata(pdev); 2246 + struct pch_gbe_adapter *adapter = netdev_priv(netdev); 2247 + 2248 + flush_scheduled_work(); 2249 + unregister_netdev(netdev); 2250 + 2251 + pch_gbe_hal_phy_hw_reset(&adapter->hw); 2252 + 2253 + kfree(adapter->tx_ring); 2254 + kfree(adapter->rx_ring); 2255 + 2256 + iounmap(adapter->hw.reg); 2257 + pci_release_regions(pdev); 2258 + free_netdev(netdev); 2259 + pci_disable_device(pdev); 2260 + } 2261 + 2262 + static int pch_gbe_probe(struct pci_dev *pdev, 2263 + const struct pci_device_id *pci_id) 2264 + { 2265 + struct net_device *netdev; 2266 + struct pch_gbe_adapter *adapter; 2267 + int ret; 2268 + 2269 + ret = pci_enable_device(pdev); 2270 + if (ret) 2271 + return ret; 2272 + 2273 + if (pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) 2274 + || pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64))) { 2275 + ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); 2276 + if (ret) { 2277 + ret = pci_set_consistent_dma_mask(pdev, 2278 + DMA_BIT_MASK(32)); 2279 + if (ret) { 2280 + dev_err(&pdev->dev, "ERR: No usable DMA " 2281 + "configuration, aborting\n"); 2282 + goto err_disable_device; 2283 + } 2284 + } 2285 + } 2286 + 2287 + ret = pci_request_regions(pdev, KBUILD_MODNAME); 2288 + if (ret) { 2289 + dev_err(&pdev->dev, 2290 + "ERR: Can't reserve PCI I/O and memory resources\n"); 2291 + goto err_disable_device; 2292 + } 2293 + pci_set_master(pdev); 2294 + 2295 + netdev = alloc_etherdev((int)sizeof(struct pch_gbe_adapter)); 2296 + if (!netdev) { 2297 + ret = -ENOMEM; 2298 + dev_err(&pdev->dev, 2299 + "ERR: Can't allocate and set up an Ethernet device\n"); 2300 + goto err_release_pci; 2301 + } 2302 + SET_NETDEV_DEV(netdev, &pdev->dev); 2303 + 2304 + pci_set_drvdata(pdev, netdev); 2305 + adapter = netdev_priv(netdev); 2306 + adapter->netdev = netdev; 2307 + adapter->pdev = pdev; 2308 + adapter->hw.back = adapter; 2309 + adapter->hw.reg = pci_iomap(pdev, PCH_GBE_PCI_BAR, 0); 2310 + if (!adapter->hw.reg) { 2311 + ret = -EIO; 2312 + dev_err(&pdev->dev, "Can't ioremap\n"); 2313 + goto err_free_netdev; 2314 + } 2315 + 2316 + netdev->netdev_ops = &pch_gbe_netdev_ops; 2317 + netdev->watchdog_timeo = PCH_GBE_WATCHDOG_PERIOD; 2318 + netif_napi_add(netdev, &adapter->napi, 2319 + pch_gbe_napi_poll, PCH_GBE_RX_WEIGHT); 2320 + netdev->features = NETIF_F_HW_CSUM | NETIF_F_GRO; 2321 + pch_gbe_set_ethtool_ops(netdev); 2322 + 2323 + pch_gbe_mac_reset_hw(&adapter->hw); 2324 + 2325 + /* setup the private structure */ 2326 + ret = pch_gbe_sw_init(adapter); 2327 + if (ret) 2328 + goto err_iounmap; 2329 + 2330 + /* Initialize PHY */ 2331 + ret = pch_gbe_init_phy(adapter); 2332 + if (ret) { 2333 + dev_err(&pdev->dev, "PHY initialize error\n"); 2334 + goto err_free_adapter; 2335 + } 2336 + pch_gbe_hal_get_bus_info(&adapter->hw); 2337 + 2338 + /* Read the MAC address. and store to the private data */ 2339 + ret = pch_gbe_hal_read_mac_addr(&adapter->hw); 2340 + if (ret) { 2341 + dev_err(&pdev->dev, "MAC address Read Error\n"); 2342 + goto err_free_adapter; 2343 + } 2344 + 2345 + memcpy(netdev->dev_addr, adapter->hw.mac.addr, netdev->addr_len); 2346 + if (!is_valid_ether_addr(netdev->dev_addr)) { 2347 + dev_err(&pdev->dev, "Invalid MAC Address\n"); 2348 + ret = -EIO; 2349 + goto err_free_adapter; 2350 + } 2351 + setup_timer(&adapter->watchdog_timer, pch_gbe_watchdog, 2352 + (unsigned long)adapter); 2353 + 2354 + INIT_WORK(&adapter->reset_task, pch_gbe_reset_task); 2355 + 2356 + pch_gbe_check_options(adapter); 2357 + 2358 + if (adapter->tx_csum) 2359 + netdev->features |= NETIF_F_HW_CSUM; 2360 + else 2361 + netdev->features &= ~NETIF_F_HW_CSUM; 2362 + 2363 + /* initialize the wol settings based on the eeprom settings */ 2364 + adapter->wake_up_evt = PCH_GBE_WL_INIT_SETTING; 2365 + dev_info(&pdev->dev, "MAC address : %pM\n", netdev->dev_addr); 2366 + 2367 + /* reset the hardware with the new settings */ 2368 + pch_gbe_reset(adapter); 2369 + 2370 + ret = register_netdev(netdev); 2371 + if (ret) 2372 + goto err_free_adapter; 2373 + /* tell the stack to leave us alone until pch_gbe_open() is called */ 2374 + netif_carrier_off(netdev); 2375 + netif_stop_queue(netdev); 2376 + 2377 + dev_dbg(&pdev->dev, "OKIsemi(R) PCH Network Connection\n"); 2378 + 2379 + device_set_wakeup_enable(&pdev->dev, 1); 2380 + return 0; 2381 + 2382 + err_free_adapter: 2383 + pch_gbe_hal_phy_hw_reset(&adapter->hw); 2384 + kfree(adapter->tx_ring); 2385 + kfree(adapter->rx_ring); 2386 + err_iounmap: 2387 + iounmap(adapter->hw.reg); 2388 + err_free_netdev: 2389 + free_netdev(netdev); 2390 + err_release_pci: 2391 + pci_release_regions(pdev); 2392 + err_disable_device: 2393 + pci_disable_device(pdev); 2394 + return ret; 2395 + } 2396 + 2397 + static const struct pci_device_id pch_gbe_pcidev_id[] = { 2398 + {.vendor = PCI_VENDOR_ID_INTEL, 2399 + .device = PCI_DEVICE_ID_INTEL_IOH1_GBE, 2400 + .subvendor = PCI_ANY_ID, 2401 + .subdevice = PCI_ANY_ID, 2402 + .class = (PCI_CLASS_NETWORK_ETHERNET << 8), 2403 + .class_mask = (0xFFFF00) 2404 + }, 2405 + /* required last entry */ 2406 + {0} 2407 + }; 2408 + 2409 + #ifdef CONFIG_PM 2410 + static const struct dev_pm_ops pch_gbe_pm_ops = { 2411 + .suspend = pch_gbe_suspend, 2412 + .resume = pch_gbe_resume, 2413 + .freeze = pch_gbe_suspend, 2414 + .thaw = pch_gbe_resume, 2415 + .poweroff = pch_gbe_suspend, 2416 + .restore = pch_gbe_resume, 2417 + }; 2418 + #endif 2419 + 2420 + static struct pci_error_handlers pch_gbe_err_handler = { 2421 + .error_detected = pch_gbe_io_error_detected, 2422 + .slot_reset = pch_gbe_io_slot_reset, 2423 + .resume = pch_gbe_io_resume 2424 + }; 2425 + 2426 + static struct pci_driver pch_gbe_pcidev = { 2427 + .name = KBUILD_MODNAME, 2428 + .id_table = pch_gbe_pcidev_id, 2429 + .probe = pch_gbe_probe, 2430 + .remove = pch_gbe_remove, 2431 + #ifdef CONFIG_PM_OPS 2432 + .driver.pm = &pch_gbe_pm_ops, 2433 + #endif 2434 + .shutdown = pch_gbe_shutdown, 2435 + .err_handler = &pch_gbe_err_handler 2436 + }; 2437 + 2438 + 2439 + static int __init pch_gbe_init_module(void) 2440 + { 2441 + int ret; 2442 + 2443 + ret = pci_register_driver(&pch_gbe_pcidev); 2444 + if (copybreak != PCH_GBE_COPYBREAK_DEFAULT) { 2445 + if (copybreak == 0) { 2446 + pr_info("copybreak disabled\n"); 2447 + } else { 2448 + pr_info("copybreak enabled for packets <= %u bytes\n", 2449 + copybreak); 2450 + } 2451 + } 2452 + return ret; 2453 + } 2454 + 2455 + static void __exit pch_gbe_exit_module(void) 2456 + { 2457 + pci_unregister_driver(&pch_gbe_pcidev); 2458 + } 2459 + 2460 + module_init(pch_gbe_init_module); 2461 + module_exit(pch_gbe_exit_module); 2462 + 2463 + MODULE_DESCRIPTION("OKI semiconductor PCH Gigabit ethernet Driver"); 2464 + MODULE_AUTHOR("OKI semiconductor, <masa-korg@dsn.okisemi.com>"); 2465 + MODULE_LICENSE("GPL"); 2466 + MODULE_VERSION(DRV_VERSION); 2467 + MODULE_DEVICE_TABLE(pci, pch_gbe_pcidev_id); 2468 + 2469 + module_param(copybreak, uint, 0644); 2470 + MODULE_PARM_DESC(copybreak, 2471 + "Maximum size of packet that is copied to a new buffer on receive"); 2472 + 2473 + /* pch_gbe_main.c */
+499
drivers/net/pch_gbe/pch_gbe_param.c
··· 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, write to the Free Software 18 + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA. 19 + */ 20 + 21 + #include "pch_gbe.h" 22 + 23 + #define OPTION_UNSET -1 24 + #define OPTION_DISABLED 0 25 + #define OPTION_ENABLED 1 26 + 27 + /** 28 + * TxDescriptors - Transmit Descriptor Count 29 + * @Valid Range: PCH_GBE_MIN_TXD - PCH_GBE_MAX_TXD 30 + * @Default Value: PCH_GBE_DEFAULT_TXD 31 + */ 32 + static int TxDescriptors = OPTION_UNSET; 33 + module_param(TxDescriptors, int, 0); 34 + MODULE_PARM_DESC(TxDescriptors, "Number of transmit descriptors"); 35 + 36 + /** 37 + * RxDescriptors -Receive Descriptor Count 38 + * @Valid Range: PCH_GBE_MIN_RXD - PCH_GBE_MAX_RXD 39 + * @Default Value: PCH_GBE_DEFAULT_RXD 40 + */ 41 + static int RxDescriptors = OPTION_UNSET; 42 + module_param(RxDescriptors, int, 0); 43 + MODULE_PARM_DESC(RxDescriptors, "Number of receive descriptors"); 44 + 45 + /** 46 + * Speed - User Specified Speed Override 47 + * @Valid Range: 0, 10, 100, 1000 48 + * - 0: auto-negotiate at all supported speeds 49 + * - 10: only link at 10 Mbps 50 + * - 100: only link at 100 Mbps 51 + * - 1000: only link at 1000 Mbps 52 + * @Default Value: 0 53 + */ 54 + static int Speed = OPTION_UNSET; 55 + module_param(Speed, int, 0); 56 + MODULE_PARM_DESC(Speed, "Speed setting"); 57 + 58 + /** 59 + * Duplex - User Specified Duplex Override 60 + * @Valid Range: 0-2 61 + * - 0: auto-negotiate for duplex 62 + * - 1: only link at half duplex 63 + * - 2: only link at full duplex 64 + * @Default Value: 0 65 + */ 66 + static int Duplex = OPTION_UNSET; 67 + module_param(Duplex, int, 0); 68 + MODULE_PARM_DESC(Duplex, "Duplex setting"); 69 + 70 + #define HALF_DUPLEX 1 71 + #define FULL_DUPLEX 2 72 + 73 + /** 74 + * AutoNeg - Auto-negotiation Advertisement Override 75 + * @Valid Range: 0x01-0x0F, 0x20-0x2F 76 + * 77 + * The AutoNeg value is a bit mask describing which speed and duplex 78 + * combinations should be advertised during auto-negotiation. 79 + * The supported speed and duplex modes are listed below 80 + * 81 + * Bit 7 6 5 4 3 2 1 0 82 + * Speed (Mbps) N/A N/A 1000 N/A 100 100 10 10 83 + * Duplex Full Full Half Full Half 84 + * 85 + * @Default Value: 0x2F (copper) 86 + */ 87 + static int AutoNeg = OPTION_UNSET; 88 + module_param(AutoNeg, int, 0); 89 + MODULE_PARM_DESC(AutoNeg, "Advertised auto-negotiation setting"); 90 + 91 + #define PHY_ADVERTISE_10_HALF 0x0001 92 + #define PHY_ADVERTISE_10_FULL 0x0002 93 + #define PHY_ADVERTISE_100_HALF 0x0004 94 + #define PHY_ADVERTISE_100_FULL 0x0008 95 + #define PHY_ADVERTISE_1000_HALF 0x0010 /* Not used, just FYI */ 96 + #define PHY_ADVERTISE_1000_FULL 0x0020 97 + #define PCH_AUTONEG_ADVERTISE_DEFAULT 0x2F 98 + 99 + /** 100 + * FlowControl - User Specified Flow Control Override 101 + * @Valid Range: 0-3 102 + * - 0: No Flow Control 103 + * - 1: Rx only, respond to PAUSE frames but do not generate them 104 + * - 2: Tx only, generate PAUSE frames but ignore them on receive 105 + * - 3: Full Flow Control Support 106 + * @Default Value: Read flow control settings from the EEPROM 107 + */ 108 + static int FlowControl = OPTION_UNSET; 109 + module_param(FlowControl, int, 0); 110 + MODULE_PARM_DESC(FlowControl, "Flow Control setting"); 111 + 112 + /* 113 + * XsumRX - Receive Checksum Offload Enable/Disable 114 + * @Valid Range: 0, 1 115 + * - 0: disables all checksum offload 116 + * - 1: enables receive IP/TCP/UDP checksum offload 117 + * @Default Value: PCH_GBE_DEFAULT_RX_CSUM 118 + */ 119 + static int XsumRX = OPTION_UNSET; 120 + module_param(XsumRX, int, 0); 121 + MODULE_PARM_DESC(XsumRX, "Disable or enable Receive Checksum offload"); 122 + 123 + #define PCH_GBE_DEFAULT_RX_CSUM true /* trueorfalse */ 124 + 125 + /* 126 + * XsumTX - Transmit Checksum Offload Enable/Disable 127 + * @Valid Range: 0, 1 128 + * - 0: disables all checksum offload 129 + * - 1: enables transmit IP/TCP/UDP checksum offload 130 + * @Default Value: PCH_GBE_DEFAULT_TX_CSUM 131 + */ 132 + static int XsumTX = OPTION_UNSET; 133 + module_param(XsumTX, int, 0); 134 + MODULE_PARM_DESC(XsumTX, "Disable or enable Transmit Checksum offload"); 135 + 136 + #define PCH_GBE_DEFAULT_TX_CSUM true /* trueorfalse */ 137 + 138 + /** 139 + * pch_gbe_option - Force the MAC's flow control settings 140 + * @hw: Pointer to the HW structure 141 + * Returns 142 + * 0: Successful. 143 + * Negative value: Failed. 144 + */ 145 + struct pch_gbe_option { 146 + enum { enable_option, range_option, list_option } type; 147 + char *name; 148 + char *err; 149 + int def; 150 + union { 151 + struct { /* range_option info */ 152 + int min; 153 + int max; 154 + } r; 155 + struct { /* list_option info */ 156 + int nr; 157 + const struct pch_gbe_opt_list { int i; char *str; } *p; 158 + } l; 159 + } arg; 160 + }; 161 + 162 + static const struct pch_gbe_opt_list speed_list[] = { 163 + { 0, "" }, 164 + { SPEED_10, "" }, 165 + { SPEED_100, "" }, 166 + { SPEED_1000, "" } 167 + }; 168 + 169 + static const struct pch_gbe_opt_list dplx_list[] = { 170 + { 0, "" }, 171 + { HALF_DUPLEX, "" }, 172 + { FULL_DUPLEX, "" } 173 + }; 174 + 175 + static const struct pch_gbe_opt_list an_list[] = 176 + #define AA "AutoNeg advertising " 177 + {{ 0x01, AA "10/HD" }, 178 + { 0x02, AA "10/FD" }, 179 + { 0x03, AA "10/FD, 10/HD" }, 180 + { 0x04, AA "100/HD" }, 181 + { 0x05, AA "100/HD, 10/HD" }, 182 + { 0x06, AA "100/HD, 10/FD" }, 183 + { 0x07, AA "100/HD, 10/FD, 10/HD" }, 184 + { 0x08, AA "100/FD" }, 185 + { 0x09, AA "100/FD, 10/HD" }, 186 + { 0x0a, AA "100/FD, 10/FD" }, 187 + { 0x0b, AA "100/FD, 10/FD, 10/HD" }, 188 + { 0x0c, AA "100/FD, 100/HD" }, 189 + { 0x0d, AA "100/FD, 100/HD, 10/HD" }, 190 + { 0x0e, AA "100/FD, 100/HD, 10/FD" }, 191 + { 0x0f, AA "100/FD, 100/HD, 10/FD, 10/HD" }, 192 + { 0x20, AA "1000/FD" }, 193 + { 0x21, AA "1000/FD, 10/HD" }, 194 + { 0x22, AA "1000/FD, 10/FD" }, 195 + { 0x23, AA "1000/FD, 10/FD, 10/HD" }, 196 + { 0x24, AA "1000/FD, 100/HD" }, 197 + { 0x25, AA "1000/FD, 100/HD, 10/HD" }, 198 + { 0x26, AA "1000/FD, 100/HD, 10/FD" }, 199 + { 0x27, AA "1000/FD, 100/HD, 10/FD, 10/HD" }, 200 + { 0x28, AA "1000/FD, 100/FD" }, 201 + { 0x29, AA "1000/FD, 100/FD, 10/HD" }, 202 + { 0x2a, AA "1000/FD, 100/FD, 10/FD" }, 203 + { 0x2b, AA "1000/FD, 100/FD, 10/FD, 10/HD" }, 204 + { 0x2c, AA "1000/FD, 100/FD, 100/HD" }, 205 + { 0x2d, AA "1000/FD, 100/FD, 100/HD, 10/HD" }, 206 + { 0x2e, AA "1000/FD, 100/FD, 100/HD, 10/FD" }, 207 + { 0x2f, AA "1000/FD, 100/FD, 100/HD, 10/FD, 10/HD" } 208 + }; 209 + 210 + static const struct pch_gbe_opt_list fc_list[] = { 211 + { PCH_GBE_FC_NONE, "Flow Control Disabled" }, 212 + { PCH_GBE_FC_RX_PAUSE, "Flow Control Receive Only" }, 213 + { PCH_GBE_FC_TX_PAUSE, "Flow Control Transmit Only" }, 214 + { PCH_GBE_FC_FULL, "Flow Control Enabled" } 215 + }; 216 + 217 + /** 218 + * pch_gbe_validate_option - Validate option 219 + * @value: value 220 + * @opt: option 221 + * @adapter: Board private structure 222 + * Returns 223 + * 0: Successful. 224 + * Negative value: Failed. 225 + */ 226 + static int pch_gbe_validate_option(int *value, 227 + const struct pch_gbe_option *opt, 228 + struct pch_gbe_adapter *adapter) 229 + { 230 + if (*value == OPTION_UNSET) { 231 + *value = opt->def; 232 + return 0; 233 + } 234 + 235 + switch (opt->type) { 236 + case enable_option: 237 + switch (*value) { 238 + case OPTION_ENABLED: 239 + pr_debug("%s Enabled\n", opt->name); 240 + return 0; 241 + case OPTION_DISABLED: 242 + pr_debug("%s Disabled\n", opt->name); 243 + return 0; 244 + } 245 + break; 246 + case range_option: 247 + if (*value >= opt->arg.r.min && *value <= opt->arg.r.max) { 248 + pr_debug("%s set to %i\n", opt->name, *value); 249 + return 0; 250 + } 251 + break; 252 + case list_option: { 253 + int i; 254 + const struct pch_gbe_opt_list *ent; 255 + 256 + for (i = 0; i < opt->arg.l.nr; i++) { 257 + ent = &opt->arg.l.p[i]; 258 + if (*value == ent->i) { 259 + if (ent->str[0] != '\0') 260 + pr_debug("%s\n", ent->str); 261 + return 0; 262 + } 263 + } 264 + } 265 + break; 266 + default: 267 + BUG(); 268 + } 269 + 270 + pr_debug("Invalid %s value specified (%i) %s\n", 271 + opt->name, *value, opt->err); 272 + *value = opt->def; 273 + return -1; 274 + } 275 + 276 + /** 277 + * pch_gbe_check_copper_options - Range Checking for Link Options, Copper Version 278 + * @adapter: Board private structure 279 + */ 280 + static void pch_gbe_check_copper_options(struct pch_gbe_adapter *adapter) 281 + { 282 + struct pch_gbe_hw *hw = &adapter->hw; 283 + int speed, dplx; 284 + 285 + { /* Speed */ 286 + static const struct pch_gbe_option opt = { 287 + .type = list_option, 288 + .name = "Speed", 289 + .err = "parameter ignored", 290 + .def = 0, 291 + .arg = { .l = { .nr = (int)ARRAY_SIZE(speed_list), 292 + .p = speed_list } } 293 + }; 294 + speed = Speed; 295 + pch_gbe_validate_option(&speed, &opt, adapter); 296 + } 297 + { /* Duplex */ 298 + static const struct pch_gbe_option opt = { 299 + .type = list_option, 300 + .name = "Duplex", 301 + .err = "parameter ignored", 302 + .def = 0, 303 + .arg = { .l = { .nr = (int)ARRAY_SIZE(dplx_list), 304 + .p = dplx_list } } 305 + }; 306 + dplx = Duplex; 307 + pch_gbe_validate_option(&dplx, &opt, adapter); 308 + } 309 + 310 + { /* Autoneg */ 311 + static const struct pch_gbe_option opt = { 312 + .type = list_option, 313 + .name = "AutoNeg", 314 + .err = "parameter ignored", 315 + .def = PCH_AUTONEG_ADVERTISE_DEFAULT, 316 + .arg = { .l = { .nr = (int)ARRAY_SIZE(an_list), 317 + .p = an_list} } 318 + }; 319 + if (speed || dplx) { 320 + pr_debug("AutoNeg specified along with Speed or Duplex, AutoNeg parameter ignored\n"); 321 + hw->phy.autoneg_advertised = opt.def; 322 + } else { 323 + hw->phy.autoneg_advertised = AutoNeg; 324 + pch_gbe_validate_option( 325 + (int *)(&hw->phy.autoneg_advertised), 326 + &opt, adapter); 327 + } 328 + } 329 + 330 + switch (speed + dplx) { 331 + case 0: 332 + hw->mac.autoneg = hw->mac.fc_autoneg = 1; 333 + if ((speed || dplx)) 334 + pr_debug("Speed and duplex autonegotiation enabled\n"); 335 + hw->mac.link_speed = SPEED_10; 336 + hw->mac.link_duplex = DUPLEX_HALF; 337 + break; 338 + case HALF_DUPLEX: 339 + pr_debug("Half Duplex specified without Speed\n"); 340 + pr_debug("Using Autonegotiation at Half Duplex only\n"); 341 + hw->mac.autoneg = hw->mac.fc_autoneg = 1; 342 + hw->phy.autoneg_advertised = PHY_ADVERTISE_10_HALF | 343 + PHY_ADVERTISE_100_HALF; 344 + hw->mac.link_speed = SPEED_10; 345 + hw->mac.link_duplex = DUPLEX_HALF; 346 + break; 347 + case FULL_DUPLEX: 348 + pr_debug("Full Duplex specified without Speed\n"); 349 + pr_debug("Using Autonegotiation at Full Duplex only\n"); 350 + hw->mac.autoneg = hw->mac.fc_autoneg = 1; 351 + hw->phy.autoneg_advertised = PHY_ADVERTISE_10_FULL | 352 + PHY_ADVERTISE_100_FULL | 353 + PHY_ADVERTISE_1000_FULL; 354 + hw->mac.link_speed = SPEED_10; 355 + hw->mac.link_duplex = DUPLEX_FULL; 356 + break; 357 + case SPEED_10: 358 + pr_debug("10 Mbps Speed specified without Duplex\n"); 359 + pr_debug("Using Autonegotiation at 10 Mbps only\n"); 360 + hw->mac.autoneg = hw->mac.fc_autoneg = 1; 361 + hw->phy.autoneg_advertised = PHY_ADVERTISE_10_HALF | 362 + PHY_ADVERTISE_10_FULL; 363 + hw->mac.link_speed = SPEED_10; 364 + hw->mac.link_duplex = DUPLEX_HALF; 365 + break; 366 + case SPEED_10 + HALF_DUPLEX: 367 + pr_debug("Forcing to 10 Mbps Half Duplex\n"); 368 + hw->mac.autoneg = hw->mac.fc_autoneg = 0; 369 + hw->phy.autoneg_advertised = 0; 370 + hw->mac.link_speed = SPEED_10; 371 + hw->mac.link_duplex = DUPLEX_HALF; 372 + break; 373 + case SPEED_10 + FULL_DUPLEX: 374 + pr_debug("Forcing to 10 Mbps Full Duplex\n"); 375 + hw->mac.autoneg = hw->mac.fc_autoneg = 0; 376 + hw->phy.autoneg_advertised = 0; 377 + hw->mac.link_speed = SPEED_10; 378 + hw->mac.link_duplex = DUPLEX_FULL; 379 + break; 380 + case SPEED_100: 381 + pr_debug("100 Mbps Speed specified without Duplex\n"); 382 + pr_debug("Using Autonegotiation at 100 Mbps only\n"); 383 + hw->mac.autoneg = hw->mac.fc_autoneg = 1; 384 + hw->phy.autoneg_advertised = PHY_ADVERTISE_100_HALF | 385 + PHY_ADVERTISE_100_FULL; 386 + hw->mac.link_speed = SPEED_100; 387 + hw->mac.link_duplex = DUPLEX_HALF; 388 + break; 389 + case SPEED_100 + HALF_DUPLEX: 390 + pr_debug("Forcing to 100 Mbps Half Duplex\n"); 391 + hw->mac.autoneg = hw->mac.fc_autoneg = 0; 392 + hw->phy.autoneg_advertised = 0; 393 + hw->mac.link_speed = SPEED_100; 394 + hw->mac.link_duplex = DUPLEX_HALF; 395 + break; 396 + case SPEED_100 + FULL_DUPLEX: 397 + pr_debug("Forcing to 100 Mbps Full Duplex\n"); 398 + hw->mac.autoneg = hw->mac.fc_autoneg = 0; 399 + hw->phy.autoneg_advertised = 0; 400 + hw->mac.link_speed = SPEED_100; 401 + hw->mac.link_duplex = DUPLEX_FULL; 402 + break; 403 + case SPEED_1000: 404 + pr_debug("1000 Mbps Speed specified without Duplex\n"); 405 + goto full_duplex_only; 406 + case SPEED_1000 + HALF_DUPLEX: 407 + pr_debug("Half Duplex is not supported at 1000 Mbps\n"); 408 + /* fall through */ 409 + case SPEED_1000 + FULL_DUPLEX: 410 + full_duplex_only: 411 + pr_debug("Using Autonegotiation at 1000 Mbps Full Duplex only\n"); 412 + hw->mac.autoneg = hw->mac.fc_autoneg = 1; 413 + hw->phy.autoneg_advertised = PHY_ADVERTISE_1000_FULL; 414 + hw->mac.link_speed = SPEED_1000; 415 + hw->mac.link_duplex = DUPLEX_FULL; 416 + break; 417 + default: 418 + BUG(); 419 + } 420 + } 421 + 422 + /** 423 + * pch_gbe_check_options - Range Checking for Command Line Parameters 424 + * @adapter: Board private structure 425 + */ 426 + void pch_gbe_check_options(struct pch_gbe_adapter *adapter) 427 + { 428 + struct pch_gbe_hw *hw = &adapter->hw; 429 + 430 + { /* Transmit Descriptor Count */ 431 + static const struct pch_gbe_option opt = { 432 + .type = range_option, 433 + .name = "Transmit Descriptors", 434 + .err = "using default of " 435 + __MODULE_STRING(PCH_GBE_DEFAULT_TXD), 436 + .def = PCH_GBE_DEFAULT_TXD, 437 + .arg = { .r = { .min = PCH_GBE_MIN_TXD } }, 438 + .arg = { .r = { .max = PCH_GBE_MAX_TXD } } 439 + }; 440 + struct pch_gbe_tx_ring *tx_ring = adapter->tx_ring; 441 + tx_ring->count = TxDescriptors; 442 + pch_gbe_validate_option(&tx_ring->count, &opt, adapter); 443 + tx_ring->count = roundup(tx_ring->count, 444 + PCH_GBE_TX_DESC_MULTIPLE); 445 + } 446 + { /* Receive Descriptor Count */ 447 + static const struct pch_gbe_option opt = { 448 + .type = range_option, 449 + .name = "Receive Descriptors", 450 + .err = "using default of " 451 + __MODULE_STRING(PCH_GBE_DEFAULT_RXD), 452 + .def = PCH_GBE_DEFAULT_RXD, 453 + .arg = { .r = { .min = PCH_GBE_MIN_RXD } }, 454 + .arg = { .r = { .max = PCH_GBE_MAX_RXD } } 455 + }; 456 + struct pch_gbe_rx_ring *rx_ring = adapter->rx_ring; 457 + rx_ring->count = RxDescriptors; 458 + pch_gbe_validate_option(&rx_ring->count, &opt, adapter); 459 + rx_ring->count = roundup(rx_ring->count, 460 + PCH_GBE_RX_DESC_MULTIPLE); 461 + } 462 + { /* Checksum Offload Enable/Disable */ 463 + static const struct pch_gbe_option opt = { 464 + .type = enable_option, 465 + .name = "Checksum Offload", 466 + .err = "defaulting to Enabled", 467 + .def = PCH_GBE_DEFAULT_RX_CSUM 468 + }; 469 + adapter->rx_csum = XsumRX; 470 + pch_gbe_validate_option((int *)(&adapter->rx_csum), 471 + &opt, adapter); 472 + } 473 + { /* Checksum Offload Enable/Disable */ 474 + static const struct pch_gbe_option opt = { 475 + .type = enable_option, 476 + .name = "Checksum Offload", 477 + .err = "defaulting to Enabled", 478 + .def = PCH_GBE_DEFAULT_TX_CSUM 479 + }; 480 + adapter->tx_csum = XsumTX; 481 + pch_gbe_validate_option((int *)(&adapter->tx_csum), 482 + &opt, adapter); 483 + } 484 + { /* Flow Control */ 485 + static const struct pch_gbe_option opt = { 486 + .type = list_option, 487 + .name = "Flow Control", 488 + .err = "reading default settings from EEPROM", 489 + .def = PCH_GBE_FC_DEFAULT, 490 + .arg = { .l = { .nr = (int)ARRAY_SIZE(fc_list), 491 + .p = fc_list } } 492 + }; 493 + hw->mac.fc = FlowControl; 494 + pch_gbe_validate_option((int *)(&hw->mac.fc), 495 + &opt, adapter); 496 + } 497 + 498 + pch_gbe_check_copper_options(adapter); 499 + }
+274
drivers/net/pch_gbe/pch_gbe_phy.c
··· 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, write to the Free Software 18 + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA. 19 + */ 20 + 21 + #include "pch_gbe.h" 22 + #include "pch_gbe_phy.h" 23 + 24 + #define PHY_MAX_REG_ADDRESS 0x1F /* 5 bit address bus (0-0x1F) */ 25 + 26 + /* PHY 1000 MII Register/Bit Definitions */ 27 + /* PHY Registers defined by IEEE */ 28 + #define PHY_CONTROL 0x00 /* Control Register */ 29 + #define PHY_STATUS 0x01 /* Status Regiser */ 30 + #define PHY_ID1 0x02 /* Phy Id Register (word 1) */ 31 + #define PHY_ID2 0x03 /* Phy Id Register (word 2) */ 32 + #define PHY_AUTONEG_ADV 0x04 /* Autoneg Advertisement */ 33 + #define PHY_LP_ABILITY 0x05 /* Link Partner Ability (Base Page) */ 34 + #define PHY_AUTONEG_EXP 0x06 /* Autoneg Expansion Register */ 35 + #define PHY_NEXT_PAGE_TX 0x07 /* Next Page TX */ 36 + #define PHY_LP_NEXT_PAGE 0x08 /* Link Partner Next Page */ 37 + #define PHY_1000T_CTRL 0x09 /* 1000Base-T Control Register */ 38 + #define PHY_1000T_STATUS 0x0A /* 1000Base-T Status Register */ 39 + #define PHY_EXT_STATUS 0x0F /* Extended Status Register */ 40 + #define PHY_PHYSP_CONTROL 0x10 /* PHY Specific Control Register */ 41 + #define PHY_EXT_PHYSP_CONTROL 0x14 /* Extended PHY Specific Control Register */ 42 + #define PHY_LED_CONTROL 0x18 /* LED Control Register */ 43 + #define PHY_EXT_PHYSP_STATUS 0x1B /* Extended PHY Specific Status Register */ 44 + 45 + /* PHY Control Register */ 46 + #define MII_CR_SPEED_SELECT_MSB 0x0040 /* bits 6,13: 10=1000, 01=100, 00=10 */ 47 + #define MII_CR_COLL_TEST_ENABLE 0x0080 /* Collision test enable */ 48 + #define MII_CR_FULL_DUPLEX 0x0100 /* FDX =1, half duplex =0 */ 49 + #define MII_CR_RESTART_AUTO_NEG 0x0200 /* Restart auto negotiation */ 50 + #define MII_CR_ISOLATE 0x0400 /* Isolate PHY from MII */ 51 + #define MII_CR_POWER_DOWN 0x0800 /* Power down */ 52 + #define MII_CR_AUTO_NEG_EN 0x1000 /* Auto Neg Enable */ 53 + #define MII_CR_SPEED_SELECT_LSB 0x2000 /* bits 6,13: 10=1000, 01=100, 00=10 */ 54 + #define MII_CR_LOOPBACK 0x4000 /* 0 = normal, 1 = loopback */ 55 + #define MII_CR_RESET 0x8000 /* 0 = normal, 1 = PHY reset */ 56 + #define MII_CR_SPEED_1000 0x0040 57 + #define MII_CR_SPEED_100 0x2000 58 + #define MII_CR_SPEED_10 0x0000 59 + 60 + /* PHY Status Register */ 61 + #define MII_SR_EXTENDED_CAPS 0x0001 /* Extended register capabilities */ 62 + #define MII_SR_JABBER_DETECT 0x0002 /* Jabber Detected */ 63 + #define MII_SR_LINK_STATUS 0x0004 /* Link Status 1 = link */ 64 + #define MII_SR_AUTONEG_CAPS 0x0008 /* Auto Neg Capable */ 65 + #define MII_SR_REMOTE_FAULT 0x0010 /* Remote Fault Detect */ 66 + #define MII_SR_AUTONEG_COMPLETE 0x0020 /* Auto Neg Complete */ 67 + #define MII_SR_PREAMBLE_SUPPRESS 0x0040 /* Preamble may be suppressed */ 68 + #define MII_SR_EXTENDED_STATUS 0x0100 /* Ext. status info in Reg 0x0F */ 69 + #define MII_SR_100T2_HD_CAPS 0x0200 /* 100T2 Half Duplex Capable */ 70 + #define MII_SR_100T2_FD_CAPS 0x0400 /* 100T2 Full Duplex Capable */ 71 + #define MII_SR_10T_HD_CAPS 0x0800 /* 10T Half Duplex Capable */ 72 + #define MII_SR_10T_FD_CAPS 0x1000 /* 10T Full Duplex Capable */ 73 + #define MII_SR_100X_HD_CAPS 0x2000 /* 100X Half Duplex Capable */ 74 + #define MII_SR_100X_FD_CAPS 0x4000 /* 100X Full Duplex Capable */ 75 + #define MII_SR_100T4_CAPS 0x8000 /* 100T4 Capable */ 76 + 77 + /* Phy Id Register (word 2) */ 78 + #define PHY_REVISION_MASK 0x000F 79 + 80 + /* PHY Specific Control Register */ 81 + #define PHYSP_CTRL_ASSERT_CRS_TX 0x0800 82 + 83 + 84 + /* Default value of PHY register */ 85 + #define PHY_CONTROL_DEFAULT 0x1140 /* Control Register */ 86 + #define PHY_AUTONEG_ADV_DEFAULT 0x01e0 /* Autoneg Advertisement */ 87 + #define PHY_NEXT_PAGE_TX_DEFAULT 0x2001 /* Next Page TX */ 88 + #define PHY_1000T_CTRL_DEFAULT 0x0300 /* 1000Base-T Control Register */ 89 + #define PHY_PHYSP_CONTROL_DEFAULT 0x01EE /* PHY Specific Control Register */ 90 + 91 + /** 92 + * pch_gbe_phy_get_id - Retrieve the PHY ID and revision 93 + * @hw: Pointer to the HW structure 94 + * Returns 95 + * 0: Successful. 96 + * Negative value: Failed. 97 + */ 98 + s32 pch_gbe_phy_get_id(struct pch_gbe_hw *hw) 99 + { 100 + struct pch_gbe_phy_info *phy = &hw->phy; 101 + s32 ret; 102 + u16 phy_id1; 103 + u16 phy_id2; 104 + 105 + ret = pch_gbe_phy_read_reg_miic(hw, PHY_ID1, &phy_id1); 106 + if (ret) 107 + return ret; 108 + ret = pch_gbe_phy_read_reg_miic(hw, PHY_ID2, &phy_id2); 109 + if (ret) 110 + return ret; 111 + /* 112 + * PHY_ID1: [bit15-0:ID(21-6)] 113 + * PHY_ID2: [bit15-10:ID(5-0)][bit9-4:Model][bit3-0:revision] 114 + */ 115 + phy->id = (u32)phy_id1; 116 + phy->id = ((phy->id << 6) | ((phy_id2 & 0xFC00) >> 10)); 117 + phy->revision = (u32) (phy_id2 & 0x000F); 118 + pr_debug("phy->id : 0x%08x phy->revision : 0x%08x\n", 119 + phy->id, phy->revision); 120 + return 0; 121 + } 122 + 123 + /** 124 + * pch_gbe_phy_read_reg_miic - Read MII control register 125 + * @hw: Pointer to the HW structure 126 + * @offset: Register offset to be read 127 + * @data: Pointer to the read data 128 + * Returns 129 + * 0: Successful. 130 + * -EINVAL: Invalid argument. 131 + */ 132 + s32 pch_gbe_phy_read_reg_miic(struct pch_gbe_hw *hw, u32 offset, u16 *data) 133 + { 134 + struct pch_gbe_phy_info *phy = &hw->phy; 135 + 136 + if (offset > PHY_MAX_REG_ADDRESS) { 137 + pr_err("PHY Address %d is out of range\n", offset); 138 + return -EINVAL; 139 + } 140 + *data = pch_gbe_mac_ctrl_miim(hw, phy->addr, PCH_GBE_HAL_MIIM_READ, 141 + offset, (u16)0); 142 + return 0; 143 + } 144 + 145 + /** 146 + * pch_gbe_phy_write_reg_miic - Write MII control register 147 + * @hw: Pointer to the HW structure 148 + * @offset: Register offset to be read 149 + * @data: data to write to register at offset 150 + * Returns 151 + * 0: Successful. 152 + * -EINVAL: Invalid argument. 153 + */ 154 + s32 pch_gbe_phy_write_reg_miic(struct pch_gbe_hw *hw, u32 offset, u16 data) 155 + { 156 + struct pch_gbe_phy_info *phy = &hw->phy; 157 + 158 + if (offset > PHY_MAX_REG_ADDRESS) { 159 + pr_err("PHY Address %d is out of range\n", offset); 160 + return -EINVAL; 161 + } 162 + pch_gbe_mac_ctrl_miim(hw, phy->addr, PCH_GBE_HAL_MIIM_WRITE, 163 + offset, data); 164 + return 0; 165 + } 166 + 167 + /** 168 + * pch_gbe_phy_sw_reset - PHY software reset 169 + * @hw: Pointer to the HW structure 170 + */ 171 + void pch_gbe_phy_sw_reset(struct pch_gbe_hw *hw) 172 + { 173 + u16 phy_ctrl; 174 + 175 + pch_gbe_phy_read_reg_miic(hw, PHY_CONTROL, &phy_ctrl); 176 + phy_ctrl |= MII_CR_RESET; 177 + pch_gbe_phy_write_reg_miic(hw, PHY_CONTROL, phy_ctrl); 178 + udelay(1); 179 + } 180 + 181 + /** 182 + * pch_gbe_phy_hw_reset - PHY hardware reset 183 + * @hw: Pointer to the HW structure 184 + */ 185 + void pch_gbe_phy_hw_reset(struct pch_gbe_hw *hw) 186 + { 187 + pch_gbe_phy_write_reg_miic(hw, PHY_CONTROL, PHY_CONTROL_DEFAULT); 188 + pch_gbe_phy_write_reg_miic(hw, PHY_AUTONEG_ADV, 189 + PHY_AUTONEG_ADV_DEFAULT); 190 + pch_gbe_phy_write_reg_miic(hw, PHY_NEXT_PAGE_TX, 191 + PHY_NEXT_PAGE_TX_DEFAULT); 192 + pch_gbe_phy_write_reg_miic(hw, PHY_1000T_CTRL, PHY_1000T_CTRL_DEFAULT); 193 + pch_gbe_phy_write_reg_miic(hw, PHY_PHYSP_CONTROL, 194 + PHY_PHYSP_CONTROL_DEFAULT); 195 + } 196 + 197 + /** 198 + * pch_gbe_phy_power_up - restore link in case the phy was powered down 199 + * @hw: Pointer to the HW structure 200 + */ 201 + void pch_gbe_phy_power_up(struct pch_gbe_hw *hw) 202 + { 203 + u16 mii_reg; 204 + 205 + mii_reg = 0; 206 + /* Just clear the power down bit to wake the phy back up */ 207 + /* according to the manual, the phy will retain its 208 + * settings across a power-down/up cycle */ 209 + pch_gbe_phy_read_reg_miic(hw, PHY_CONTROL, &mii_reg); 210 + mii_reg &= ~MII_CR_POWER_DOWN; 211 + pch_gbe_phy_write_reg_miic(hw, PHY_CONTROL, mii_reg); 212 + } 213 + 214 + /** 215 + * pch_gbe_phy_power_down - Power down PHY 216 + * @hw: Pointer to the HW structure 217 + */ 218 + void pch_gbe_phy_power_down(struct pch_gbe_hw *hw) 219 + { 220 + u16 mii_reg; 221 + 222 + mii_reg = 0; 223 + /* Power down the PHY so no link is implied when interface is down * 224 + * The PHY cannot be powered down if any of the following is TRUE * 225 + * (a) WoL is enabled 226 + * (b) AMT is active 227 + */ 228 + pch_gbe_phy_read_reg_miic(hw, PHY_CONTROL, &mii_reg); 229 + mii_reg |= MII_CR_POWER_DOWN; 230 + pch_gbe_phy_write_reg_miic(hw, PHY_CONTROL, mii_reg); 231 + mdelay(1); 232 + } 233 + 234 + /** 235 + * pch_gbe_phy_set_rgmii - RGMII interface setting 236 + * @hw: Pointer to the HW structure 237 + */ 238 + inline void pch_gbe_phy_set_rgmii(struct pch_gbe_hw *hw) 239 + { 240 + pch_gbe_phy_sw_reset(hw); 241 + } 242 + 243 + /** 244 + * pch_gbe_phy_init_setting - PHY initial setting 245 + * @hw: Pointer to the HW structure 246 + */ 247 + void pch_gbe_phy_init_setting(struct pch_gbe_hw *hw) 248 + { 249 + struct pch_gbe_adapter *adapter; 250 + struct ethtool_cmd cmd; 251 + int ret; 252 + u16 mii_reg; 253 + 254 + adapter = container_of(hw, struct pch_gbe_adapter, hw); 255 + ret = mii_ethtool_gset(&adapter->mii, &cmd); 256 + if (ret) 257 + pr_err("Error: mii_ethtool_gset\n"); 258 + 259 + cmd.speed = hw->mac.link_speed; 260 + cmd.duplex = hw->mac.link_duplex; 261 + cmd.advertising = hw->phy.autoneg_advertised; 262 + cmd.autoneg = hw->mac.autoneg; 263 + pch_gbe_phy_write_reg_miic(hw, MII_BMCR, BMCR_RESET); 264 + ret = mii_ethtool_sset(&adapter->mii, &cmd); 265 + if (ret) 266 + pr_err("Error: mii_ethtool_sset\n"); 267 + 268 + pch_gbe_phy_sw_reset(hw); 269 + 270 + pch_gbe_phy_read_reg_miic(hw, PHY_PHYSP_CONTROL, &mii_reg); 271 + mii_reg |= PHYSP_CTRL_ASSERT_CRS_TX; 272 + pch_gbe_phy_write_reg_miic(hw, PHY_PHYSP_CONTROL, mii_reg); 273 + 274 + }
+37
drivers/net/pch_gbe/pch_gbe_phy.h
··· 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, write to the Free Software 18 + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA. 19 + */ 20 + #ifndef _PCH_GBE_PHY_H_ 21 + #define _PCH_GBE_PHY_H_ 22 + 23 + #define PCH_GBE_PHY_REGS_LEN 32 24 + #define PCH_GBE_PHY_RESET_DELAY_US 10 25 + #define PCH_GBE_MAC_IFOP_RGMII 26 + 27 + s32 pch_gbe_phy_get_id(struct pch_gbe_hw *hw); 28 + s32 pch_gbe_phy_read_reg_miic(struct pch_gbe_hw *hw, u32 offset, u16 *data); 29 + s32 pch_gbe_phy_write_reg_miic(struct pch_gbe_hw *hw, u32 offset, u16 data); 30 + void pch_gbe_phy_sw_reset(struct pch_gbe_hw *hw); 31 + void pch_gbe_phy_hw_reset(struct pch_gbe_hw *hw); 32 + void pch_gbe_phy_power_up(struct pch_gbe_hw *hw); 33 + void pch_gbe_phy_power_down(struct pch_gbe_hw *hw); 34 + void pch_gbe_phy_set_rgmii(struct pch_gbe_hw *hw); 35 + void pch_gbe_phy_init_setting(struct pch_gbe_hw *hw); 36 + 37 + #endif /* _PCH_GBE_PHY_H_ */