11802d0beSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2d0ea5cbdSJesse Brandeburg /*
33396c782SPaul Gortmaker * drivers/net/ethernet/micrel/ksx884x.c - Micrel KSZ8841/2 PCI Ethernet driver
4bcc9736cSJeff Kirsher *
5bcc9736cSJeff Kirsher * Copyright (c) 2009-2010 Micrel, Inc.
6bcc9736cSJeff Kirsher * Tristram Ha <Tristram.Ha@micrel.com>
7bcc9736cSJeff Kirsher */
8bcc9736cSJeff Kirsher
9bcc9736cSJeff Kirsher #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
10bcc9736cSJeff Kirsher
11bcc9736cSJeff Kirsher #include <linux/init.h>
12bcc9736cSJeff Kirsher #include <linux/interrupt.h>
13bcc9736cSJeff Kirsher #include <linux/kernel.h>
14bcc9736cSJeff Kirsher #include <linux/module.h>
15bcc9736cSJeff Kirsher #include <linux/ioport.h>
16bcc9736cSJeff Kirsher #include <linux/pci.h>
17bcc9736cSJeff Kirsher #include <linux/proc_fs.h>
18bcc9736cSJeff Kirsher #include <linux/mii.h>
19bcc9736cSJeff Kirsher #include <linux/platform_device.h>
20bcc9736cSJeff Kirsher #include <linux/ethtool.h>
21bcc9736cSJeff Kirsher #include <linux/etherdevice.h>
22bcc9736cSJeff Kirsher #include <linux/in.h>
23bcc9736cSJeff Kirsher #include <linux/ip.h>
24bcc9736cSJeff Kirsher #include <linux/if_vlan.h>
25bcc9736cSJeff Kirsher #include <linux/crc32.h>
26bcc9736cSJeff Kirsher #include <linux/sched.h>
27bcc9736cSJeff Kirsher #include <linux/slab.h>
28ec4b94f9SMichael Grzeschik #include <linux/micrel_phy.h>
29bcc9736cSJeff Kirsher
30bcc9736cSJeff Kirsher
31bcc9736cSJeff Kirsher /* DMA Registers */
32bcc9736cSJeff Kirsher
33bcc9736cSJeff Kirsher #define KS_DMA_TX_CTRL 0x0000
34bcc9736cSJeff Kirsher #define DMA_TX_ENABLE 0x00000001
35bcc9736cSJeff Kirsher #define DMA_TX_CRC_ENABLE 0x00000002
36bcc9736cSJeff Kirsher #define DMA_TX_PAD_ENABLE 0x00000004
37bcc9736cSJeff Kirsher #define DMA_TX_LOOPBACK 0x00000100
38bcc9736cSJeff Kirsher #define DMA_TX_FLOW_ENABLE 0x00000200
39bcc9736cSJeff Kirsher #define DMA_TX_CSUM_IP 0x00010000
40bcc9736cSJeff Kirsher #define DMA_TX_CSUM_TCP 0x00020000
41bcc9736cSJeff Kirsher #define DMA_TX_CSUM_UDP 0x00040000
42bcc9736cSJeff Kirsher #define DMA_TX_BURST_SIZE 0x3F000000
43bcc9736cSJeff Kirsher
44bcc9736cSJeff Kirsher #define KS_DMA_RX_CTRL 0x0004
45bcc9736cSJeff Kirsher #define DMA_RX_ENABLE 0x00000001
46bcc9736cSJeff Kirsher #define KS884X_DMA_RX_MULTICAST 0x00000002
47bcc9736cSJeff Kirsher #define DMA_RX_PROMISCUOUS 0x00000004
48bcc9736cSJeff Kirsher #define DMA_RX_ERROR 0x00000008
49bcc9736cSJeff Kirsher #define DMA_RX_UNICAST 0x00000010
50bcc9736cSJeff Kirsher #define DMA_RX_ALL_MULTICAST 0x00000020
51bcc9736cSJeff Kirsher #define DMA_RX_BROADCAST 0x00000040
52bcc9736cSJeff Kirsher #define DMA_RX_FLOW_ENABLE 0x00000200
53bcc9736cSJeff Kirsher #define DMA_RX_CSUM_IP 0x00010000
54bcc9736cSJeff Kirsher #define DMA_RX_CSUM_TCP 0x00020000
55bcc9736cSJeff Kirsher #define DMA_RX_CSUM_UDP 0x00040000
56bcc9736cSJeff Kirsher #define DMA_RX_BURST_SIZE 0x3F000000
57bcc9736cSJeff Kirsher
58bcc9736cSJeff Kirsher #define DMA_BURST_SHIFT 24
59bcc9736cSJeff Kirsher #define DMA_BURST_DEFAULT 8
60bcc9736cSJeff Kirsher
61bcc9736cSJeff Kirsher #define KS_DMA_TX_START 0x0008
62bcc9736cSJeff Kirsher #define KS_DMA_RX_START 0x000C
63bcc9736cSJeff Kirsher #define DMA_START 0x00000001
64bcc9736cSJeff Kirsher
65bcc9736cSJeff Kirsher #define KS_DMA_TX_ADDR 0x0010
66bcc9736cSJeff Kirsher #define KS_DMA_RX_ADDR 0x0014
67bcc9736cSJeff Kirsher
68bcc9736cSJeff Kirsher #define DMA_ADDR_LIST_MASK 0xFFFFFFFC
69bcc9736cSJeff Kirsher #define DMA_ADDR_LIST_SHIFT 2
70bcc9736cSJeff Kirsher
71bcc9736cSJeff Kirsher /* MTR0 */
72bcc9736cSJeff Kirsher #define KS884X_MULTICAST_0_OFFSET 0x0020
73bcc9736cSJeff Kirsher #define KS884X_MULTICAST_1_OFFSET 0x0021
74bcc9736cSJeff Kirsher #define KS884X_MULTICAST_2_OFFSET 0x0022
75bcc9736cSJeff Kirsher #define KS884x_MULTICAST_3_OFFSET 0x0023
76bcc9736cSJeff Kirsher /* MTR1 */
77bcc9736cSJeff Kirsher #define KS884X_MULTICAST_4_OFFSET 0x0024
78bcc9736cSJeff Kirsher #define KS884X_MULTICAST_5_OFFSET 0x0025
79bcc9736cSJeff Kirsher #define KS884X_MULTICAST_6_OFFSET 0x0026
80bcc9736cSJeff Kirsher #define KS884X_MULTICAST_7_OFFSET 0x0027
81bcc9736cSJeff Kirsher
82bcc9736cSJeff Kirsher /* Interrupt Registers */
83bcc9736cSJeff Kirsher
84bcc9736cSJeff Kirsher /* INTEN */
85bcc9736cSJeff Kirsher #define KS884X_INTERRUPTS_ENABLE 0x0028
86bcc9736cSJeff Kirsher /* INTST */
87bcc9736cSJeff Kirsher #define KS884X_INTERRUPTS_STATUS 0x002C
88bcc9736cSJeff Kirsher
89bcc9736cSJeff Kirsher #define KS884X_INT_RX_STOPPED 0x02000000
90bcc9736cSJeff Kirsher #define KS884X_INT_TX_STOPPED 0x04000000
91bcc9736cSJeff Kirsher #define KS884X_INT_RX_OVERRUN 0x08000000
92bcc9736cSJeff Kirsher #define KS884X_INT_TX_EMPTY 0x10000000
93bcc9736cSJeff Kirsher #define KS884X_INT_RX 0x20000000
94bcc9736cSJeff Kirsher #define KS884X_INT_TX 0x40000000
95bcc9736cSJeff Kirsher #define KS884X_INT_PHY 0x80000000
96bcc9736cSJeff Kirsher
97bcc9736cSJeff Kirsher #define KS884X_INT_RX_MASK \
98bcc9736cSJeff Kirsher (KS884X_INT_RX | KS884X_INT_RX_OVERRUN)
99bcc9736cSJeff Kirsher #define KS884X_INT_TX_MASK \
100bcc9736cSJeff Kirsher (KS884X_INT_TX | KS884X_INT_TX_EMPTY)
101bcc9736cSJeff Kirsher #define KS884X_INT_MASK (KS884X_INT_RX | KS884X_INT_TX | KS884X_INT_PHY)
102bcc9736cSJeff Kirsher
103bcc9736cSJeff Kirsher /* MAC Additional Station Address */
104bcc9736cSJeff Kirsher
105bcc9736cSJeff Kirsher /* MAAL0 */
106bcc9736cSJeff Kirsher #define KS_ADD_ADDR_0_LO 0x0080
107bcc9736cSJeff Kirsher /* MAAH0 */
108bcc9736cSJeff Kirsher #define KS_ADD_ADDR_0_HI 0x0084
109bcc9736cSJeff Kirsher /* MAAL1 */
110bcc9736cSJeff Kirsher #define KS_ADD_ADDR_1_LO 0x0088
111bcc9736cSJeff Kirsher /* MAAH1 */
112bcc9736cSJeff Kirsher #define KS_ADD_ADDR_1_HI 0x008C
113bcc9736cSJeff Kirsher /* MAAL2 */
114bcc9736cSJeff Kirsher #define KS_ADD_ADDR_2_LO 0x0090
115bcc9736cSJeff Kirsher /* MAAH2 */
116bcc9736cSJeff Kirsher #define KS_ADD_ADDR_2_HI 0x0094
117bcc9736cSJeff Kirsher /* MAAL3 */
118bcc9736cSJeff Kirsher #define KS_ADD_ADDR_3_LO 0x0098
119bcc9736cSJeff Kirsher /* MAAH3 */
120bcc9736cSJeff Kirsher #define KS_ADD_ADDR_3_HI 0x009C
121bcc9736cSJeff Kirsher /* MAAL4 */
122bcc9736cSJeff Kirsher #define KS_ADD_ADDR_4_LO 0x00A0
123bcc9736cSJeff Kirsher /* MAAH4 */
124bcc9736cSJeff Kirsher #define KS_ADD_ADDR_4_HI 0x00A4
125bcc9736cSJeff Kirsher /* MAAL5 */
126bcc9736cSJeff Kirsher #define KS_ADD_ADDR_5_LO 0x00A8
127bcc9736cSJeff Kirsher /* MAAH5 */
128bcc9736cSJeff Kirsher #define KS_ADD_ADDR_5_HI 0x00AC
129bcc9736cSJeff Kirsher /* MAAL6 */
130bcc9736cSJeff Kirsher #define KS_ADD_ADDR_6_LO 0x00B0
131bcc9736cSJeff Kirsher /* MAAH6 */
132bcc9736cSJeff Kirsher #define KS_ADD_ADDR_6_HI 0x00B4
133bcc9736cSJeff Kirsher /* MAAL7 */
134bcc9736cSJeff Kirsher #define KS_ADD_ADDR_7_LO 0x00B8
135bcc9736cSJeff Kirsher /* MAAH7 */
136bcc9736cSJeff Kirsher #define KS_ADD_ADDR_7_HI 0x00BC
137bcc9736cSJeff Kirsher /* MAAL8 */
138bcc9736cSJeff Kirsher #define KS_ADD_ADDR_8_LO 0x00C0
139bcc9736cSJeff Kirsher /* MAAH8 */
140bcc9736cSJeff Kirsher #define KS_ADD_ADDR_8_HI 0x00C4
141bcc9736cSJeff Kirsher /* MAAL9 */
142bcc9736cSJeff Kirsher #define KS_ADD_ADDR_9_LO 0x00C8
143bcc9736cSJeff Kirsher /* MAAH9 */
144bcc9736cSJeff Kirsher #define KS_ADD_ADDR_9_HI 0x00CC
145bcc9736cSJeff Kirsher /* MAAL10 */
146bcc9736cSJeff Kirsher #define KS_ADD_ADDR_A_LO 0x00D0
147bcc9736cSJeff Kirsher /* MAAH10 */
148bcc9736cSJeff Kirsher #define KS_ADD_ADDR_A_HI 0x00D4
149bcc9736cSJeff Kirsher /* MAAL11 */
150bcc9736cSJeff Kirsher #define KS_ADD_ADDR_B_LO 0x00D8
151bcc9736cSJeff Kirsher /* MAAH11 */
152bcc9736cSJeff Kirsher #define KS_ADD_ADDR_B_HI 0x00DC
153bcc9736cSJeff Kirsher /* MAAL12 */
154bcc9736cSJeff Kirsher #define KS_ADD_ADDR_C_LO 0x00E0
155bcc9736cSJeff Kirsher /* MAAH12 */
156bcc9736cSJeff Kirsher #define KS_ADD_ADDR_C_HI 0x00E4
157bcc9736cSJeff Kirsher /* MAAL13 */
158bcc9736cSJeff Kirsher #define KS_ADD_ADDR_D_LO 0x00E8
159bcc9736cSJeff Kirsher /* MAAH13 */
160bcc9736cSJeff Kirsher #define KS_ADD_ADDR_D_HI 0x00EC
161bcc9736cSJeff Kirsher /* MAAL14 */
162bcc9736cSJeff Kirsher #define KS_ADD_ADDR_E_LO 0x00F0
163bcc9736cSJeff Kirsher /* MAAH14 */
164bcc9736cSJeff Kirsher #define KS_ADD_ADDR_E_HI 0x00F4
165bcc9736cSJeff Kirsher /* MAAL15 */
166bcc9736cSJeff Kirsher #define KS_ADD_ADDR_F_LO 0x00F8
167bcc9736cSJeff Kirsher /* MAAH15 */
168bcc9736cSJeff Kirsher #define KS_ADD_ADDR_F_HI 0x00FC
169bcc9736cSJeff Kirsher
170bcc9736cSJeff Kirsher #define ADD_ADDR_HI_MASK 0x0000FFFF
171bcc9736cSJeff Kirsher #define ADD_ADDR_ENABLE 0x80000000
172bcc9736cSJeff Kirsher #define ADD_ADDR_INCR 8
173bcc9736cSJeff Kirsher
174bcc9736cSJeff Kirsher /* Miscellaneous Registers */
175bcc9736cSJeff Kirsher
176bcc9736cSJeff Kirsher /* MARL */
177bcc9736cSJeff Kirsher #define KS884X_ADDR_0_OFFSET 0x0200
178bcc9736cSJeff Kirsher #define KS884X_ADDR_1_OFFSET 0x0201
179bcc9736cSJeff Kirsher /* MARM */
180bcc9736cSJeff Kirsher #define KS884X_ADDR_2_OFFSET 0x0202
181bcc9736cSJeff Kirsher #define KS884X_ADDR_3_OFFSET 0x0203
182bcc9736cSJeff Kirsher /* MARH */
183bcc9736cSJeff Kirsher #define KS884X_ADDR_4_OFFSET 0x0204
184bcc9736cSJeff Kirsher #define KS884X_ADDR_5_OFFSET 0x0205
185bcc9736cSJeff Kirsher
186bcc9736cSJeff Kirsher /* OBCR */
187bcc9736cSJeff Kirsher #define KS884X_BUS_CTRL_OFFSET 0x0210
188bcc9736cSJeff Kirsher
189bcc9736cSJeff Kirsher #define BUS_SPEED_125_MHZ 0x0000
190bcc9736cSJeff Kirsher #define BUS_SPEED_62_5_MHZ 0x0001
191bcc9736cSJeff Kirsher #define BUS_SPEED_41_66_MHZ 0x0002
192bcc9736cSJeff Kirsher #define BUS_SPEED_25_MHZ 0x0003
193bcc9736cSJeff Kirsher
194bcc9736cSJeff Kirsher /* EEPCR */
195bcc9736cSJeff Kirsher #define KS884X_EEPROM_CTRL_OFFSET 0x0212
196bcc9736cSJeff Kirsher
197bcc9736cSJeff Kirsher #define EEPROM_CHIP_SELECT 0x0001
198bcc9736cSJeff Kirsher #define EEPROM_SERIAL_CLOCK 0x0002
199bcc9736cSJeff Kirsher #define EEPROM_DATA_OUT 0x0004
200bcc9736cSJeff Kirsher #define EEPROM_DATA_IN 0x0008
201bcc9736cSJeff Kirsher #define EEPROM_ACCESS_ENABLE 0x0010
202bcc9736cSJeff Kirsher
203bcc9736cSJeff Kirsher /* MBIR */
204bcc9736cSJeff Kirsher #define KS884X_MEM_INFO_OFFSET 0x0214
205bcc9736cSJeff Kirsher
206bcc9736cSJeff Kirsher #define RX_MEM_TEST_FAILED 0x0008
207bcc9736cSJeff Kirsher #define RX_MEM_TEST_FINISHED 0x0010
208bcc9736cSJeff Kirsher #define TX_MEM_TEST_FAILED 0x0800
209bcc9736cSJeff Kirsher #define TX_MEM_TEST_FINISHED 0x1000
210bcc9736cSJeff Kirsher
211bcc9736cSJeff Kirsher /* GCR */
212bcc9736cSJeff Kirsher #define KS884X_GLOBAL_CTRL_OFFSET 0x0216
213bcc9736cSJeff Kirsher #define GLOBAL_SOFTWARE_RESET 0x0001
214bcc9736cSJeff Kirsher
215bcc9736cSJeff Kirsher #define KS8841_POWER_MANAGE_OFFSET 0x0218
216bcc9736cSJeff Kirsher
217bcc9736cSJeff Kirsher /* WFCR */
218bcc9736cSJeff Kirsher #define KS8841_WOL_CTRL_OFFSET 0x021A
219bcc9736cSJeff Kirsher #define KS8841_WOL_MAGIC_ENABLE 0x0080
220bcc9736cSJeff Kirsher #define KS8841_WOL_FRAME3_ENABLE 0x0008
221bcc9736cSJeff Kirsher #define KS8841_WOL_FRAME2_ENABLE 0x0004
222bcc9736cSJeff Kirsher #define KS8841_WOL_FRAME1_ENABLE 0x0002
223bcc9736cSJeff Kirsher #define KS8841_WOL_FRAME0_ENABLE 0x0001
224bcc9736cSJeff Kirsher
225bcc9736cSJeff Kirsher /* WF0 */
226bcc9736cSJeff Kirsher #define KS8841_WOL_FRAME_CRC_OFFSET 0x0220
227bcc9736cSJeff Kirsher #define KS8841_WOL_FRAME_BYTE0_OFFSET 0x0224
228bcc9736cSJeff Kirsher #define KS8841_WOL_FRAME_BYTE2_OFFSET 0x0228
229bcc9736cSJeff Kirsher
230bcc9736cSJeff Kirsher /* IACR */
231bcc9736cSJeff Kirsher #define KS884X_IACR_P 0x04A0
232bcc9736cSJeff Kirsher #define KS884X_IACR_OFFSET KS884X_IACR_P
233bcc9736cSJeff Kirsher
234bcc9736cSJeff Kirsher /* IADR1 */
235bcc9736cSJeff Kirsher #define KS884X_IADR1_P 0x04A2
236bcc9736cSJeff Kirsher #define KS884X_IADR2_P 0x04A4
237bcc9736cSJeff Kirsher #define KS884X_IADR3_P 0x04A6
238bcc9736cSJeff Kirsher #define KS884X_IADR4_P 0x04A8
239bcc9736cSJeff Kirsher #define KS884X_IADR5_P 0x04AA
240bcc9736cSJeff Kirsher
241bcc9736cSJeff Kirsher #define KS884X_ACC_CTRL_SEL_OFFSET KS884X_IACR_P
242bcc9736cSJeff Kirsher #define KS884X_ACC_CTRL_INDEX_OFFSET (KS884X_ACC_CTRL_SEL_OFFSET + 1)
243bcc9736cSJeff Kirsher
244bcc9736cSJeff Kirsher #define KS884X_ACC_DATA_0_OFFSET KS884X_IADR4_P
245bcc9736cSJeff Kirsher #define KS884X_ACC_DATA_1_OFFSET (KS884X_ACC_DATA_0_OFFSET + 1)
246bcc9736cSJeff Kirsher #define KS884X_ACC_DATA_2_OFFSET KS884X_IADR5_P
247bcc9736cSJeff Kirsher #define KS884X_ACC_DATA_3_OFFSET (KS884X_ACC_DATA_2_OFFSET + 1)
248bcc9736cSJeff Kirsher #define KS884X_ACC_DATA_4_OFFSET KS884X_IADR2_P
249bcc9736cSJeff Kirsher #define KS884X_ACC_DATA_5_OFFSET (KS884X_ACC_DATA_4_OFFSET + 1)
250bcc9736cSJeff Kirsher #define KS884X_ACC_DATA_6_OFFSET KS884X_IADR3_P
251bcc9736cSJeff Kirsher #define KS884X_ACC_DATA_7_OFFSET (KS884X_ACC_DATA_6_OFFSET + 1)
252bcc9736cSJeff Kirsher #define KS884X_ACC_DATA_8_OFFSET KS884X_IADR1_P
253bcc9736cSJeff Kirsher
254bcc9736cSJeff Kirsher /* P1MBCR */
255bcc9736cSJeff Kirsher #define KS884X_P1MBCR_P 0x04D0
256bcc9736cSJeff Kirsher #define KS884X_P1MBSR_P 0x04D2
257bcc9736cSJeff Kirsher #define KS884X_PHY1ILR_P 0x04D4
258bcc9736cSJeff Kirsher #define KS884X_PHY1IHR_P 0x04D6
259bcc9736cSJeff Kirsher #define KS884X_P1ANAR_P 0x04D8
260bcc9736cSJeff Kirsher #define KS884X_P1ANLPR_P 0x04DA
261bcc9736cSJeff Kirsher
262bcc9736cSJeff Kirsher /* P2MBCR */
263bcc9736cSJeff Kirsher #define KS884X_P2MBCR_P 0x04E0
264bcc9736cSJeff Kirsher #define KS884X_P2MBSR_P 0x04E2
265bcc9736cSJeff Kirsher #define KS884X_PHY2ILR_P 0x04E4
266bcc9736cSJeff Kirsher #define KS884X_PHY2IHR_P 0x04E6
267bcc9736cSJeff Kirsher #define KS884X_P2ANAR_P 0x04E8
268bcc9736cSJeff Kirsher #define KS884X_P2ANLPR_P 0x04EA
269bcc9736cSJeff Kirsher
270bcc9736cSJeff Kirsher #define KS884X_PHY_1_CTRL_OFFSET KS884X_P1MBCR_P
271bcc9736cSJeff Kirsher #define PHY_CTRL_INTERVAL (KS884X_P2MBCR_P - KS884X_P1MBCR_P)
272bcc9736cSJeff Kirsher
273bcc9736cSJeff Kirsher #define KS884X_PHY_CTRL_OFFSET 0x00
274bcc9736cSJeff Kirsher
275bcc9736cSJeff Kirsher #define KS884X_PHY_STATUS_OFFSET 0x02
276bcc9736cSJeff Kirsher
277bcc9736cSJeff Kirsher #define KS884X_PHY_ID_1_OFFSET 0x04
278bcc9736cSJeff Kirsher #define KS884X_PHY_ID_2_OFFSET 0x06
279bcc9736cSJeff Kirsher
280bcc9736cSJeff Kirsher #define KS884X_PHY_AUTO_NEG_OFFSET 0x08
281bcc9736cSJeff Kirsher
282bcc9736cSJeff Kirsher #define KS884X_PHY_REMOTE_CAP_OFFSET 0x0A
283bcc9736cSJeff Kirsher
284bcc9736cSJeff Kirsher /* P1VCT */
285bcc9736cSJeff Kirsher #define KS884X_P1VCT_P 0x04F0
286bcc9736cSJeff Kirsher #define KS884X_P1PHYCTRL_P 0x04F2
287bcc9736cSJeff Kirsher
288bcc9736cSJeff Kirsher /* P2VCT */
289bcc9736cSJeff Kirsher #define KS884X_P2VCT_P 0x04F4
290bcc9736cSJeff Kirsher #define KS884X_P2PHYCTRL_P 0x04F6
291bcc9736cSJeff Kirsher
292bcc9736cSJeff Kirsher #define KS884X_PHY_SPECIAL_OFFSET KS884X_P1VCT_P
293bcc9736cSJeff Kirsher #define PHY_SPECIAL_INTERVAL (KS884X_P2VCT_P - KS884X_P1VCT_P)
294bcc9736cSJeff Kirsher
295bcc9736cSJeff Kirsher #define KS884X_PHY_LINK_MD_OFFSET 0x00
296bcc9736cSJeff Kirsher
297bcc9736cSJeff Kirsher #define PHY_START_CABLE_DIAG 0x8000
298bcc9736cSJeff Kirsher #define PHY_CABLE_DIAG_RESULT 0x6000
299bcc9736cSJeff Kirsher #define PHY_CABLE_STAT_NORMAL 0x0000
300bcc9736cSJeff Kirsher #define PHY_CABLE_STAT_OPEN 0x2000
301bcc9736cSJeff Kirsher #define PHY_CABLE_STAT_SHORT 0x4000
302bcc9736cSJeff Kirsher #define PHY_CABLE_STAT_FAILED 0x6000
303bcc9736cSJeff Kirsher #define PHY_CABLE_10M_SHORT 0x1000
304bcc9736cSJeff Kirsher #define PHY_CABLE_FAULT_COUNTER 0x01FF
305bcc9736cSJeff Kirsher
306bcc9736cSJeff Kirsher #define KS884X_PHY_PHY_CTRL_OFFSET 0x02
307bcc9736cSJeff Kirsher
308bcc9736cSJeff Kirsher #define PHY_STAT_REVERSED_POLARITY 0x0020
309bcc9736cSJeff Kirsher #define PHY_STAT_MDIX 0x0010
310bcc9736cSJeff Kirsher #define PHY_FORCE_LINK 0x0008
311bcc9736cSJeff Kirsher #define PHY_POWER_SAVING_DISABLE 0x0004
312bcc9736cSJeff Kirsher #define PHY_REMOTE_LOOPBACK 0x0002
313bcc9736cSJeff Kirsher
314bcc9736cSJeff Kirsher /* SIDER */
315bcc9736cSJeff Kirsher #define KS884X_SIDER_P 0x0400
316bcc9736cSJeff Kirsher #define KS884X_CHIP_ID_OFFSET KS884X_SIDER_P
317bcc9736cSJeff Kirsher #define KS884X_FAMILY_ID_OFFSET (KS884X_CHIP_ID_OFFSET + 1)
318bcc9736cSJeff Kirsher
319bcc9736cSJeff Kirsher #define REG_FAMILY_ID 0x88
320bcc9736cSJeff Kirsher
321bcc9736cSJeff Kirsher #define REG_CHIP_ID_41 0x8810
322bcc9736cSJeff Kirsher #define REG_CHIP_ID_42 0x8800
323bcc9736cSJeff Kirsher
324bcc9736cSJeff Kirsher #define KS884X_CHIP_ID_MASK_41 0xFF10
325bcc9736cSJeff Kirsher #define KS884X_CHIP_ID_MASK 0xFFF0
326bcc9736cSJeff Kirsher #define KS884X_CHIP_ID_SHIFT 4
327bcc9736cSJeff Kirsher #define KS884X_REVISION_MASK 0x000E
328bcc9736cSJeff Kirsher #define KS884X_REVISION_SHIFT 1
329bcc9736cSJeff Kirsher #define KS8842_START 0x0001
330bcc9736cSJeff Kirsher
331bcc9736cSJeff Kirsher #define CHIP_IP_41_M 0x8810
332bcc9736cSJeff Kirsher #define CHIP_IP_42_M 0x8800
333bcc9736cSJeff Kirsher #define CHIP_IP_61_M 0x8890
334bcc9736cSJeff Kirsher #define CHIP_IP_62_M 0x8880
335bcc9736cSJeff Kirsher
336bcc9736cSJeff Kirsher #define CHIP_IP_41_P 0x8850
337bcc9736cSJeff Kirsher #define CHIP_IP_42_P 0x8840
338bcc9736cSJeff Kirsher #define CHIP_IP_61_P 0x88D0
339bcc9736cSJeff Kirsher #define CHIP_IP_62_P 0x88C0
340bcc9736cSJeff Kirsher
341bcc9736cSJeff Kirsher /* SGCR1 */
342bcc9736cSJeff Kirsher #define KS8842_SGCR1_P 0x0402
343bcc9736cSJeff Kirsher #define KS8842_SWITCH_CTRL_1_OFFSET KS8842_SGCR1_P
344bcc9736cSJeff Kirsher
345bcc9736cSJeff Kirsher #define SWITCH_PASS_ALL 0x8000
346bcc9736cSJeff Kirsher #define SWITCH_TX_FLOW_CTRL 0x2000
347bcc9736cSJeff Kirsher #define SWITCH_RX_FLOW_CTRL 0x1000
348bcc9736cSJeff Kirsher #define SWITCH_CHECK_LENGTH 0x0800
349bcc9736cSJeff Kirsher #define SWITCH_AGING_ENABLE 0x0400
350bcc9736cSJeff Kirsher #define SWITCH_FAST_AGING 0x0200
351bcc9736cSJeff Kirsher #define SWITCH_AGGR_BACKOFF 0x0100
352bcc9736cSJeff Kirsher #define SWITCH_PASS_PAUSE 0x0008
353bcc9736cSJeff Kirsher #define SWITCH_LINK_AUTO_AGING 0x0001
354bcc9736cSJeff Kirsher
355bcc9736cSJeff Kirsher /* SGCR2 */
356bcc9736cSJeff Kirsher #define KS8842_SGCR2_P 0x0404
357bcc9736cSJeff Kirsher #define KS8842_SWITCH_CTRL_2_OFFSET KS8842_SGCR2_P
358bcc9736cSJeff Kirsher
359bcc9736cSJeff Kirsher #define SWITCH_VLAN_ENABLE 0x8000
360bcc9736cSJeff Kirsher #define SWITCH_IGMP_SNOOP 0x4000
361bcc9736cSJeff Kirsher #define IPV6_MLD_SNOOP_ENABLE 0x2000
362bcc9736cSJeff Kirsher #define IPV6_MLD_SNOOP_OPTION 0x1000
363bcc9736cSJeff Kirsher #define PRIORITY_SCHEME_SELECT 0x0800
364bcc9736cSJeff Kirsher #define SWITCH_MIRROR_RX_TX 0x0100
365bcc9736cSJeff Kirsher #define UNICAST_VLAN_BOUNDARY 0x0080
366bcc9736cSJeff Kirsher #define MULTICAST_STORM_DISABLE 0x0040
367bcc9736cSJeff Kirsher #define SWITCH_BACK_PRESSURE 0x0020
368bcc9736cSJeff Kirsher #define FAIR_FLOW_CTRL 0x0010
369bcc9736cSJeff Kirsher #define NO_EXC_COLLISION_DROP 0x0008
370bcc9736cSJeff Kirsher #define SWITCH_HUGE_PACKET 0x0004
371bcc9736cSJeff Kirsher #define SWITCH_LEGAL_PACKET 0x0002
372bcc9736cSJeff Kirsher #define SWITCH_BUF_RESERVE 0x0001
373bcc9736cSJeff Kirsher
374bcc9736cSJeff Kirsher /* SGCR3 */
375bcc9736cSJeff Kirsher #define KS8842_SGCR3_P 0x0406
376bcc9736cSJeff Kirsher #define KS8842_SWITCH_CTRL_3_OFFSET KS8842_SGCR3_P
377bcc9736cSJeff Kirsher
378bcc9736cSJeff Kirsher #define BROADCAST_STORM_RATE_LO 0xFF00
379bcc9736cSJeff Kirsher #define SWITCH_REPEATER 0x0080
380bcc9736cSJeff Kirsher #define SWITCH_HALF_DUPLEX 0x0040
381bcc9736cSJeff Kirsher #define SWITCH_FLOW_CTRL 0x0020
382bcc9736cSJeff Kirsher #define SWITCH_10_MBIT 0x0010
383bcc9736cSJeff Kirsher #define SWITCH_REPLACE_NULL_VID 0x0008
384bcc9736cSJeff Kirsher #define BROADCAST_STORM_RATE_HI 0x0007
385bcc9736cSJeff Kirsher
386bcc9736cSJeff Kirsher #define BROADCAST_STORM_RATE 0x07FF
387bcc9736cSJeff Kirsher
388bcc9736cSJeff Kirsher /* SGCR4 */
389bcc9736cSJeff Kirsher #define KS8842_SGCR4_P 0x0408
390bcc9736cSJeff Kirsher
391bcc9736cSJeff Kirsher /* SGCR5 */
392bcc9736cSJeff Kirsher #define KS8842_SGCR5_P 0x040A
393bcc9736cSJeff Kirsher #define KS8842_SWITCH_CTRL_5_OFFSET KS8842_SGCR5_P
394bcc9736cSJeff Kirsher
395bcc9736cSJeff Kirsher #define LED_MODE 0x8200
396bcc9736cSJeff Kirsher #define LED_SPEED_DUPLEX_ACT 0x0000
397bcc9736cSJeff Kirsher #define LED_SPEED_DUPLEX_LINK_ACT 0x8000
398bcc9736cSJeff Kirsher #define LED_DUPLEX_10_100 0x0200
399bcc9736cSJeff Kirsher
400bcc9736cSJeff Kirsher /* SGCR6 */
401bcc9736cSJeff Kirsher #define KS8842_SGCR6_P 0x0410
402bcc9736cSJeff Kirsher #define KS8842_SWITCH_CTRL_6_OFFSET KS8842_SGCR6_P
403bcc9736cSJeff Kirsher
404bcc9736cSJeff Kirsher #define KS8842_PRIORITY_MASK 3
405bcc9736cSJeff Kirsher #define KS8842_PRIORITY_SHIFT 2
406bcc9736cSJeff Kirsher
407bcc9736cSJeff Kirsher /* SGCR7 */
408bcc9736cSJeff Kirsher #define KS8842_SGCR7_P 0x0412
409bcc9736cSJeff Kirsher #define KS8842_SWITCH_CTRL_7_OFFSET KS8842_SGCR7_P
410bcc9736cSJeff Kirsher
411bcc9736cSJeff Kirsher #define SWITCH_UNK_DEF_PORT_ENABLE 0x0008
412bcc9736cSJeff Kirsher #define SWITCH_UNK_DEF_PORT_3 0x0004
413bcc9736cSJeff Kirsher #define SWITCH_UNK_DEF_PORT_2 0x0002
414bcc9736cSJeff Kirsher #define SWITCH_UNK_DEF_PORT_1 0x0001
415bcc9736cSJeff Kirsher
416bcc9736cSJeff Kirsher /* MACAR1 */
417bcc9736cSJeff Kirsher #define KS8842_MACAR1_P 0x0470
418bcc9736cSJeff Kirsher #define KS8842_MACAR2_P 0x0472
419bcc9736cSJeff Kirsher #define KS8842_MACAR3_P 0x0474
420bcc9736cSJeff Kirsher #define KS8842_MAC_ADDR_1_OFFSET KS8842_MACAR1_P
421bcc9736cSJeff Kirsher #define KS8842_MAC_ADDR_0_OFFSET (KS8842_MAC_ADDR_1_OFFSET + 1)
422bcc9736cSJeff Kirsher #define KS8842_MAC_ADDR_3_OFFSET KS8842_MACAR2_P
423bcc9736cSJeff Kirsher #define KS8842_MAC_ADDR_2_OFFSET (KS8842_MAC_ADDR_3_OFFSET + 1)
424bcc9736cSJeff Kirsher #define KS8842_MAC_ADDR_5_OFFSET KS8842_MACAR3_P
425bcc9736cSJeff Kirsher #define KS8842_MAC_ADDR_4_OFFSET (KS8842_MAC_ADDR_5_OFFSET + 1)
426bcc9736cSJeff Kirsher
427bcc9736cSJeff Kirsher /* TOSR1 */
428bcc9736cSJeff Kirsher #define KS8842_TOSR1_P 0x0480
429bcc9736cSJeff Kirsher #define KS8842_TOSR2_P 0x0482
430bcc9736cSJeff Kirsher #define KS8842_TOSR3_P 0x0484
431bcc9736cSJeff Kirsher #define KS8842_TOSR4_P 0x0486
432bcc9736cSJeff Kirsher #define KS8842_TOSR5_P 0x0488
433bcc9736cSJeff Kirsher #define KS8842_TOSR6_P 0x048A
434bcc9736cSJeff Kirsher #define KS8842_TOSR7_P 0x0490
435bcc9736cSJeff Kirsher #define KS8842_TOSR8_P 0x0492
436bcc9736cSJeff Kirsher #define KS8842_TOS_1_OFFSET KS8842_TOSR1_P
437bcc9736cSJeff Kirsher #define KS8842_TOS_2_OFFSET KS8842_TOSR2_P
438bcc9736cSJeff Kirsher #define KS8842_TOS_3_OFFSET KS8842_TOSR3_P
439bcc9736cSJeff Kirsher #define KS8842_TOS_4_OFFSET KS8842_TOSR4_P
440bcc9736cSJeff Kirsher #define KS8842_TOS_5_OFFSET KS8842_TOSR5_P
441bcc9736cSJeff Kirsher #define KS8842_TOS_6_OFFSET KS8842_TOSR6_P
442bcc9736cSJeff Kirsher
443bcc9736cSJeff Kirsher #define KS8842_TOS_7_OFFSET KS8842_TOSR7_P
444bcc9736cSJeff Kirsher #define KS8842_TOS_8_OFFSET KS8842_TOSR8_P
445bcc9736cSJeff Kirsher
446bcc9736cSJeff Kirsher /* P1CR1 */
447bcc9736cSJeff Kirsher #define KS8842_P1CR1_P 0x0500
448bcc9736cSJeff Kirsher #define KS8842_P1CR2_P 0x0502
449bcc9736cSJeff Kirsher #define KS8842_P1VIDR_P 0x0504
450bcc9736cSJeff Kirsher #define KS8842_P1CR3_P 0x0506
451bcc9736cSJeff Kirsher #define KS8842_P1IRCR_P 0x0508
452bcc9736cSJeff Kirsher #define KS8842_P1ERCR_P 0x050A
453bcc9736cSJeff Kirsher #define KS884X_P1SCSLMD_P 0x0510
454bcc9736cSJeff Kirsher #define KS884X_P1CR4_P 0x0512
455bcc9736cSJeff Kirsher #define KS884X_P1SR_P 0x0514
456bcc9736cSJeff Kirsher
457bcc9736cSJeff Kirsher /* P2CR1 */
458bcc9736cSJeff Kirsher #define KS8842_P2CR1_P 0x0520
459bcc9736cSJeff Kirsher #define KS8842_P2CR2_P 0x0522
460bcc9736cSJeff Kirsher #define KS8842_P2VIDR_P 0x0524
461bcc9736cSJeff Kirsher #define KS8842_P2CR3_P 0x0526
462bcc9736cSJeff Kirsher #define KS8842_P2IRCR_P 0x0528
463bcc9736cSJeff Kirsher #define KS8842_P2ERCR_P 0x052A
464bcc9736cSJeff Kirsher #define KS884X_P2SCSLMD_P 0x0530
465bcc9736cSJeff Kirsher #define KS884X_P2CR4_P 0x0532
466bcc9736cSJeff Kirsher #define KS884X_P2SR_P 0x0534
467bcc9736cSJeff Kirsher
468bcc9736cSJeff Kirsher /* P3CR1 */
469bcc9736cSJeff Kirsher #define KS8842_P3CR1_P 0x0540
470bcc9736cSJeff Kirsher #define KS8842_P3CR2_P 0x0542
471bcc9736cSJeff Kirsher #define KS8842_P3VIDR_P 0x0544
472bcc9736cSJeff Kirsher #define KS8842_P3CR3_P 0x0546
473bcc9736cSJeff Kirsher #define KS8842_P3IRCR_P 0x0548
474bcc9736cSJeff Kirsher #define KS8842_P3ERCR_P 0x054A
475bcc9736cSJeff Kirsher
476bcc9736cSJeff Kirsher #define KS8842_PORT_1_CTRL_1 KS8842_P1CR1_P
477bcc9736cSJeff Kirsher #define KS8842_PORT_2_CTRL_1 KS8842_P2CR1_P
478bcc9736cSJeff Kirsher #define KS8842_PORT_3_CTRL_1 KS8842_P3CR1_P
479bcc9736cSJeff Kirsher
480bcc9736cSJeff Kirsher #define PORT_CTRL_ADDR(port, addr) \
481bcc9736cSJeff Kirsher (addr = KS8842_PORT_1_CTRL_1 + (port) * \
482bcc9736cSJeff Kirsher (KS8842_PORT_2_CTRL_1 - KS8842_PORT_1_CTRL_1))
483bcc9736cSJeff Kirsher
484bcc9736cSJeff Kirsher #define KS8842_PORT_CTRL_1_OFFSET 0x00
485bcc9736cSJeff Kirsher
486bcc9736cSJeff Kirsher #define PORT_BROADCAST_STORM 0x0080
487bcc9736cSJeff Kirsher #define PORT_DIFFSERV_ENABLE 0x0040
488bcc9736cSJeff Kirsher #define PORT_802_1P_ENABLE 0x0020
489bcc9736cSJeff Kirsher #define PORT_BASED_PRIORITY_MASK 0x0018
490bcc9736cSJeff Kirsher #define PORT_BASED_PRIORITY_BASE 0x0003
491bcc9736cSJeff Kirsher #define PORT_BASED_PRIORITY_SHIFT 3
492bcc9736cSJeff Kirsher #define PORT_BASED_PRIORITY_0 0x0000
493bcc9736cSJeff Kirsher #define PORT_BASED_PRIORITY_1 0x0008
494bcc9736cSJeff Kirsher #define PORT_BASED_PRIORITY_2 0x0010
495bcc9736cSJeff Kirsher #define PORT_BASED_PRIORITY_3 0x0018
496bcc9736cSJeff Kirsher #define PORT_INSERT_TAG 0x0004
497bcc9736cSJeff Kirsher #define PORT_REMOVE_TAG 0x0002
498bcc9736cSJeff Kirsher #define PORT_PRIO_QUEUE_ENABLE 0x0001
499bcc9736cSJeff Kirsher
500bcc9736cSJeff Kirsher #define KS8842_PORT_CTRL_2_OFFSET 0x02
501bcc9736cSJeff Kirsher
502bcc9736cSJeff Kirsher #define PORT_INGRESS_VLAN_FILTER 0x4000
503bcc9736cSJeff Kirsher #define PORT_DISCARD_NON_VID 0x2000
504bcc9736cSJeff Kirsher #define PORT_FORCE_FLOW_CTRL 0x1000
505bcc9736cSJeff Kirsher #define PORT_BACK_PRESSURE 0x0800
506bcc9736cSJeff Kirsher #define PORT_TX_ENABLE 0x0400
507bcc9736cSJeff Kirsher #define PORT_RX_ENABLE 0x0200
508bcc9736cSJeff Kirsher #define PORT_LEARN_DISABLE 0x0100
509bcc9736cSJeff Kirsher #define PORT_MIRROR_SNIFFER 0x0080
510bcc9736cSJeff Kirsher #define PORT_MIRROR_RX 0x0040
511bcc9736cSJeff Kirsher #define PORT_MIRROR_TX 0x0020
512bcc9736cSJeff Kirsher #define PORT_USER_PRIORITY_CEILING 0x0008
513bcc9736cSJeff Kirsher #define PORT_VLAN_MEMBERSHIP 0x0007
514bcc9736cSJeff Kirsher
515bcc9736cSJeff Kirsher #define KS8842_PORT_CTRL_VID_OFFSET 0x04
516bcc9736cSJeff Kirsher
517bcc9736cSJeff Kirsher #define PORT_DEFAULT_VID 0x0001
518bcc9736cSJeff Kirsher
519bcc9736cSJeff Kirsher #define KS8842_PORT_CTRL_3_OFFSET 0x06
520bcc9736cSJeff Kirsher
521bcc9736cSJeff Kirsher #define PORT_INGRESS_LIMIT_MODE 0x000C
522bcc9736cSJeff Kirsher #define PORT_INGRESS_ALL 0x0000
523bcc9736cSJeff Kirsher #define PORT_INGRESS_UNICAST 0x0004
524bcc9736cSJeff Kirsher #define PORT_INGRESS_MULTICAST 0x0008
525bcc9736cSJeff Kirsher #define PORT_INGRESS_BROADCAST 0x000C
526bcc9736cSJeff Kirsher #define PORT_COUNT_IFG 0x0002
527bcc9736cSJeff Kirsher #define PORT_COUNT_PREAMBLE 0x0001
528bcc9736cSJeff Kirsher
529bcc9736cSJeff Kirsher #define KS8842_PORT_IN_RATE_OFFSET 0x08
530bcc9736cSJeff Kirsher #define KS8842_PORT_OUT_RATE_OFFSET 0x0A
531bcc9736cSJeff Kirsher
532bcc9736cSJeff Kirsher #define PORT_PRIORITY_RATE 0x0F
533bcc9736cSJeff Kirsher #define PORT_PRIORITY_RATE_SHIFT 4
534bcc9736cSJeff Kirsher
535bcc9736cSJeff Kirsher #define KS884X_PORT_LINK_MD 0x10
536bcc9736cSJeff Kirsher
537bcc9736cSJeff Kirsher #define PORT_CABLE_10M_SHORT 0x8000
538bcc9736cSJeff Kirsher #define PORT_CABLE_DIAG_RESULT 0x6000
539bcc9736cSJeff Kirsher #define PORT_CABLE_STAT_NORMAL 0x0000
540bcc9736cSJeff Kirsher #define PORT_CABLE_STAT_OPEN 0x2000
541bcc9736cSJeff Kirsher #define PORT_CABLE_STAT_SHORT 0x4000
542bcc9736cSJeff Kirsher #define PORT_CABLE_STAT_FAILED 0x6000
543bcc9736cSJeff Kirsher #define PORT_START_CABLE_DIAG 0x1000
544bcc9736cSJeff Kirsher #define PORT_FORCE_LINK 0x0800
545bcc9736cSJeff Kirsher #define PORT_POWER_SAVING_DISABLE 0x0400
546bcc9736cSJeff Kirsher #define PORT_PHY_REMOTE_LOOPBACK 0x0200
547bcc9736cSJeff Kirsher #define PORT_CABLE_FAULT_COUNTER 0x01FF
548bcc9736cSJeff Kirsher
549bcc9736cSJeff Kirsher #define KS884X_PORT_CTRL_4_OFFSET 0x12
550bcc9736cSJeff Kirsher
551bcc9736cSJeff Kirsher #define PORT_LED_OFF 0x8000
552bcc9736cSJeff Kirsher #define PORT_TX_DISABLE 0x4000
553bcc9736cSJeff Kirsher #define PORT_AUTO_NEG_RESTART 0x2000
554bcc9736cSJeff Kirsher #define PORT_REMOTE_FAULT_DISABLE 0x1000
555bcc9736cSJeff Kirsher #define PORT_POWER_DOWN 0x0800
556bcc9736cSJeff Kirsher #define PORT_AUTO_MDIX_DISABLE 0x0400
557bcc9736cSJeff Kirsher #define PORT_FORCE_MDIX 0x0200
558bcc9736cSJeff Kirsher #define PORT_LOOPBACK 0x0100
559bcc9736cSJeff Kirsher #define PORT_AUTO_NEG_ENABLE 0x0080
560bcc9736cSJeff Kirsher #define PORT_FORCE_100_MBIT 0x0040
561bcc9736cSJeff Kirsher #define PORT_FORCE_FULL_DUPLEX 0x0020
562bcc9736cSJeff Kirsher #define PORT_AUTO_NEG_SYM_PAUSE 0x0010
563bcc9736cSJeff Kirsher #define PORT_AUTO_NEG_100BTX_FD 0x0008
564bcc9736cSJeff Kirsher #define PORT_AUTO_NEG_100BTX 0x0004
565bcc9736cSJeff Kirsher #define PORT_AUTO_NEG_10BT_FD 0x0002
566bcc9736cSJeff Kirsher #define PORT_AUTO_NEG_10BT 0x0001
567bcc9736cSJeff Kirsher
568bcc9736cSJeff Kirsher #define KS884X_PORT_STATUS_OFFSET 0x14
569bcc9736cSJeff Kirsher
570bcc9736cSJeff Kirsher #define PORT_HP_MDIX 0x8000
571bcc9736cSJeff Kirsher #define PORT_REVERSED_POLARITY 0x2000
572bcc9736cSJeff Kirsher #define PORT_RX_FLOW_CTRL 0x0800
573bcc9736cSJeff Kirsher #define PORT_TX_FLOW_CTRL 0x1000
574bcc9736cSJeff Kirsher #define PORT_STATUS_SPEED_100MBIT 0x0400
575bcc9736cSJeff Kirsher #define PORT_STATUS_FULL_DUPLEX 0x0200
576bcc9736cSJeff Kirsher #define PORT_REMOTE_FAULT 0x0100
577bcc9736cSJeff Kirsher #define PORT_MDIX_STATUS 0x0080
578bcc9736cSJeff Kirsher #define PORT_AUTO_NEG_COMPLETE 0x0040
579bcc9736cSJeff Kirsher #define PORT_STATUS_LINK_GOOD 0x0020
580bcc9736cSJeff Kirsher #define PORT_REMOTE_SYM_PAUSE 0x0010
581bcc9736cSJeff Kirsher #define PORT_REMOTE_100BTX_FD 0x0008
582bcc9736cSJeff Kirsher #define PORT_REMOTE_100BTX 0x0004
583bcc9736cSJeff Kirsher #define PORT_REMOTE_10BT_FD 0x0002
584bcc9736cSJeff Kirsher #define PORT_REMOTE_10BT 0x0001
585bcc9736cSJeff Kirsher
586bcc9736cSJeff Kirsher /*
587bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_ADDR 00-0000FFFF-FFFFFFFF
588bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_FWD_PORTS 00-00070000-00000000
589bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_VALID 00-00080000-00000000
590bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_OVERRIDE 00-00100000-00000000
591bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_USE_FID 00-00200000-00000000
592bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_FID 00-03C00000-00000000
593bcc9736cSJeff Kirsher */
594bcc9736cSJeff Kirsher
595bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_ADDR 0x0000FFFF
596bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_FWD_PORTS 0x00070000
597bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_VALID 0x00080000
598bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_OVERRIDE 0x00100000
599bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_USE_FID 0x00200000
600bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_FID 0x03C00000
601bcc9736cSJeff Kirsher
602bcc9736cSJeff Kirsher #define STATIC_MAC_FWD_PORTS_SHIFT 16
603bcc9736cSJeff Kirsher #define STATIC_MAC_FID_SHIFT 22
604bcc9736cSJeff Kirsher
605bcc9736cSJeff Kirsher /*
606bcc9736cSJeff Kirsher #define VLAN_TABLE_VID 00-00000000-00000FFF
607bcc9736cSJeff Kirsher #define VLAN_TABLE_FID 00-00000000-0000F000
608bcc9736cSJeff Kirsher #define VLAN_TABLE_MEMBERSHIP 00-00000000-00070000
609bcc9736cSJeff Kirsher #define VLAN_TABLE_VALID 00-00000000-00080000
610bcc9736cSJeff Kirsher */
611bcc9736cSJeff Kirsher
612bcc9736cSJeff Kirsher #define VLAN_TABLE_VID 0x00000FFF
613bcc9736cSJeff Kirsher #define VLAN_TABLE_FID 0x0000F000
614bcc9736cSJeff Kirsher #define VLAN_TABLE_MEMBERSHIP 0x00070000
615bcc9736cSJeff Kirsher #define VLAN_TABLE_VALID 0x00080000
616bcc9736cSJeff Kirsher
617bcc9736cSJeff Kirsher #define VLAN_TABLE_FID_SHIFT 12
618bcc9736cSJeff Kirsher #define VLAN_TABLE_MEMBERSHIP_SHIFT 16
619bcc9736cSJeff Kirsher
620bcc9736cSJeff Kirsher /*
621bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_ADDR 00-0000FFFF-FFFFFFFF
622bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_FID 00-000F0000-00000000
623bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_SRC_PORT 00-00300000-00000000
624bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_TIMESTAMP 00-00C00000-00000000
625bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_ENTRIES 03-FF000000-00000000
626bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_MAC_EMPTY 04-00000000-00000000
627bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_RESERVED 78-00000000-00000000
628bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_NOT_READY 80-00000000-00000000
629bcc9736cSJeff Kirsher */
630bcc9736cSJeff Kirsher
631bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_ADDR 0x0000FFFF
632bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_FID 0x000F0000
633bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_SRC_PORT 0x00300000
634bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_TIMESTAMP 0x00C00000
635bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_ENTRIES 0xFF000000
636bcc9736cSJeff Kirsher
637bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_ENTRIES_H 0x03
638bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_MAC_EMPTY 0x04
639bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_RESERVED 0x78
640bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TABLE_NOT_READY 0x80
641bcc9736cSJeff Kirsher
642bcc9736cSJeff Kirsher #define DYNAMIC_MAC_FID_SHIFT 16
643bcc9736cSJeff Kirsher #define DYNAMIC_MAC_SRC_PORT_SHIFT 20
644bcc9736cSJeff Kirsher #define DYNAMIC_MAC_TIMESTAMP_SHIFT 22
645bcc9736cSJeff Kirsher #define DYNAMIC_MAC_ENTRIES_SHIFT 24
646bcc9736cSJeff Kirsher #define DYNAMIC_MAC_ENTRIES_H_SHIFT 8
647bcc9736cSJeff Kirsher
648bcc9736cSJeff Kirsher /*
649bcc9736cSJeff Kirsher #define MIB_COUNTER_VALUE 00-00000000-3FFFFFFF
650bcc9736cSJeff Kirsher #define MIB_COUNTER_VALID 00-00000000-40000000
651bcc9736cSJeff Kirsher #define MIB_COUNTER_OVERFLOW 00-00000000-80000000
652bcc9736cSJeff Kirsher */
653bcc9736cSJeff Kirsher
654bcc9736cSJeff Kirsher #define MIB_COUNTER_VALUE 0x3FFFFFFF
655bcc9736cSJeff Kirsher #define MIB_COUNTER_VALID 0x40000000
656bcc9736cSJeff Kirsher #define MIB_COUNTER_OVERFLOW 0x80000000
657bcc9736cSJeff Kirsher
658bcc9736cSJeff Kirsher #define MIB_PACKET_DROPPED 0x0000FFFF
659bcc9736cSJeff Kirsher
660bcc9736cSJeff Kirsher #define KS_MIB_PACKET_DROPPED_TX_0 0x100
661bcc9736cSJeff Kirsher #define KS_MIB_PACKET_DROPPED_TX_1 0x101
662bcc9736cSJeff Kirsher #define KS_MIB_PACKET_DROPPED_TX 0x102
663bcc9736cSJeff Kirsher #define KS_MIB_PACKET_DROPPED_RX_0 0x103
664bcc9736cSJeff Kirsher #define KS_MIB_PACKET_DROPPED_RX_1 0x104
665bcc9736cSJeff Kirsher #define KS_MIB_PACKET_DROPPED_RX 0x105
666bcc9736cSJeff Kirsher
667bcc9736cSJeff Kirsher /* Change default LED mode. */
668bcc9736cSJeff Kirsher #define SET_DEFAULT_LED LED_SPEED_DUPLEX_ACT
669bcc9736cSJeff Kirsher
6706a3c910cSJoe Perches #define MAC_ADDR_ORDER(i) (ETH_ALEN - 1 - (i))
671bcc9736cSJeff Kirsher
672bcc9736cSJeff Kirsher #define MAX_ETHERNET_BODY_SIZE 1500
67383636580SDoug Kehn #define ETHERNET_HEADER_SIZE (14 + VLAN_HLEN)
674bcc9736cSJeff Kirsher
675bcc9736cSJeff Kirsher #define MAX_ETHERNET_PACKET_SIZE \
676bcc9736cSJeff Kirsher (MAX_ETHERNET_BODY_SIZE + ETHERNET_HEADER_SIZE)
677bcc9736cSJeff Kirsher
678bcc9736cSJeff Kirsher #define REGULAR_RX_BUF_SIZE (MAX_ETHERNET_PACKET_SIZE + 4)
679bcc9736cSJeff Kirsher #define MAX_RX_BUF_SIZE (1912 + 4)
680bcc9736cSJeff Kirsher
681bcc9736cSJeff Kirsher #define ADDITIONAL_ENTRIES 16
682bcc9736cSJeff Kirsher #define MAX_MULTICAST_LIST 32
683bcc9736cSJeff Kirsher
684bcc9736cSJeff Kirsher #define HW_MULTICAST_SIZE 8
685bcc9736cSJeff Kirsher
686bcc9736cSJeff Kirsher #define HW_TO_DEV_PORT(port) (port - 1)
687bcc9736cSJeff Kirsher
688bcc9736cSJeff Kirsher enum {
689bcc9736cSJeff Kirsher media_connected,
690bcc9736cSJeff Kirsher media_disconnected
691bcc9736cSJeff Kirsher };
692bcc9736cSJeff Kirsher
693bcc9736cSJeff Kirsher enum {
694bcc9736cSJeff Kirsher OID_COUNTER_UNKOWN,
695bcc9736cSJeff Kirsher
696bcc9736cSJeff Kirsher OID_COUNTER_FIRST,
697bcc9736cSJeff Kirsher
698bcc9736cSJeff Kirsher /* total transmit errors */
699bcc9736cSJeff Kirsher OID_COUNTER_XMIT_ERROR,
700bcc9736cSJeff Kirsher
701bcc9736cSJeff Kirsher /* total receive errors */
702bcc9736cSJeff Kirsher OID_COUNTER_RCV_ERROR,
703bcc9736cSJeff Kirsher
704bcc9736cSJeff Kirsher OID_COUNTER_LAST
705bcc9736cSJeff Kirsher };
706bcc9736cSJeff Kirsher
707bcc9736cSJeff Kirsher /*
708bcc9736cSJeff Kirsher * Hardware descriptor definitions
709bcc9736cSJeff Kirsher */
710bcc9736cSJeff Kirsher
711bcc9736cSJeff Kirsher #define DESC_ALIGNMENT 16
712bcc9736cSJeff Kirsher #define BUFFER_ALIGNMENT 8
713bcc9736cSJeff Kirsher
714bcc9736cSJeff Kirsher #define NUM_OF_RX_DESC 64
715bcc9736cSJeff Kirsher #define NUM_OF_TX_DESC 64
716bcc9736cSJeff Kirsher
717bcc9736cSJeff Kirsher #define KS_DESC_RX_FRAME_LEN 0x000007FF
718bcc9736cSJeff Kirsher #define KS_DESC_RX_FRAME_TYPE 0x00008000
719bcc9736cSJeff Kirsher #define KS_DESC_RX_ERROR_CRC 0x00010000
720bcc9736cSJeff Kirsher #define KS_DESC_RX_ERROR_RUNT 0x00020000
721bcc9736cSJeff Kirsher #define KS_DESC_RX_ERROR_TOO_LONG 0x00040000
722bcc9736cSJeff Kirsher #define KS_DESC_RX_ERROR_PHY 0x00080000
723bcc9736cSJeff Kirsher #define KS884X_DESC_RX_PORT_MASK 0x00300000
724bcc9736cSJeff Kirsher #define KS_DESC_RX_MULTICAST 0x01000000
725bcc9736cSJeff Kirsher #define KS_DESC_RX_ERROR 0x02000000
726bcc9736cSJeff Kirsher #define KS_DESC_RX_ERROR_CSUM_UDP 0x04000000
727bcc9736cSJeff Kirsher #define KS_DESC_RX_ERROR_CSUM_TCP 0x08000000
728bcc9736cSJeff Kirsher #define KS_DESC_RX_ERROR_CSUM_IP 0x10000000
729bcc9736cSJeff Kirsher #define KS_DESC_RX_LAST 0x20000000
730bcc9736cSJeff Kirsher #define KS_DESC_RX_FIRST 0x40000000
731bcc9736cSJeff Kirsher #define KS_DESC_RX_ERROR_COND \
732bcc9736cSJeff Kirsher (KS_DESC_RX_ERROR_CRC | \
733bcc9736cSJeff Kirsher KS_DESC_RX_ERROR_RUNT | \
734bcc9736cSJeff Kirsher KS_DESC_RX_ERROR_PHY | \
735bcc9736cSJeff Kirsher KS_DESC_RX_ERROR_TOO_LONG)
736bcc9736cSJeff Kirsher
737bcc9736cSJeff Kirsher #define KS_DESC_HW_OWNED 0x80000000
738bcc9736cSJeff Kirsher
739bcc9736cSJeff Kirsher #define KS_DESC_BUF_SIZE 0x000007FF
740bcc9736cSJeff Kirsher #define KS884X_DESC_TX_PORT_MASK 0x00300000
741bcc9736cSJeff Kirsher #define KS_DESC_END_OF_RING 0x02000000
742bcc9736cSJeff Kirsher #define KS_DESC_TX_CSUM_GEN_UDP 0x04000000
743bcc9736cSJeff Kirsher #define KS_DESC_TX_CSUM_GEN_TCP 0x08000000
744bcc9736cSJeff Kirsher #define KS_DESC_TX_CSUM_GEN_IP 0x10000000
745bcc9736cSJeff Kirsher #define KS_DESC_TX_LAST 0x20000000
746bcc9736cSJeff Kirsher #define KS_DESC_TX_FIRST 0x40000000
747bcc9736cSJeff Kirsher #define KS_DESC_TX_INTERRUPT 0x80000000
748bcc9736cSJeff Kirsher
749bcc9736cSJeff Kirsher #define KS_DESC_PORT_SHIFT 20
750bcc9736cSJeff Kirsher
751bcc9736cSJeff Kirsher #define KS_DESC_RX_MASK (KS_DESC_BUF_SIZE)
752bcc9736cSJeff Kirsher
753bcc9736cSJeff Kirsher #define KS_DESC_TX_MASK \
754bcc9736cSJeff Kirsher (KS_DESC_TX_INTERRUPT | \
755bcc9736cSJeff Kirsher KS_DESC_TX_FIRST | \
756bcc9736cSJeff Kirsher KS_DESC_TX_LAST | \
757bcc9736cSJeff Kirsher KS_DESC_TX_CSUM_GEN_IP | \
758bcc9736cSJeff Kirsher KS_DESC_TX_CSUM_GEN_TCP | \
759bcc9736cSJeff Kirsher KS_DESC_TX_CSUM_GEN_UDP | \
760bcc9736cSJeff Kirsher KS_DESC_BUF_SIZE)
761bcc9736cSJeff Kirsher
762bcc9736cSJeff Kirsher struct ksz_desc_rx_stat {
763bcc9736cSJeff Kirsher #ifdef __BIG_ENDIAN_BITFIELD
764bcc9736cSJeff Kirsher u32 hw_owned:1;
765bcc9736cSJeff Kirsher u32 first_desc:1;
766bcc9736cSJeff Kirsher u32 last_desc:1;
767bcc9736cSJeff Kirsher u32 csum_err_ip:1;
768bcc9736cSJeff Kirsher u32 csum_err_tcp:1;
769bcc9736cSJeff Kirsher u32 csum_err_udp:1;
770bcc9736cSJeff Kirsher u32 error:1;
771bcc9736cSJeff Kirsher u32 multicast:1;
772bcc9736cSJeff Kirsher u32 src_port:4;
773bcc9736cSJeff Kirsher u32 err_phy:1;
774bcc9736cSJeff Kirsher u32 err_too_long:1;
775bcc9736cSJeff Kirsher u32 err_runt:1;
776bcc9736cSJeff Kirsher u32 err_crc:1;
777bcc9736cSJeff Kirsher u32 frame_type:1;
778bcc9736cSJeff Kirsher u32 reserved1:4;
779bcc9736cSJeff Kirsher u32 frame_len:11;
780bcc9736cSJeff Kirsher #else
781bcc9736cSJeff Kirsher u32 frame_len:11;
782bcc9736cSJeff Kirsher u32 reserved1:4;
783bcc9736cSJeff Kirsher u32 frame_type:1;
784bcc9736cSJeff Kirsher u32 err_crc:1;
785bcc9736cSJeff Kirsher u32 err_runt:1;
786bcc9736cSJeff Kirsher u32 err_too_long:1;
787bcc9736cSJeff Kirsher u32 err_phy:1;
788bcc9736cSJeff Kirsher u32 src_port:4;
789bcc9736cSJeff Kirsher u32 multicast:1;
790bcc9736cSJeff Kirsher u32 error:1;
791bcc9736cSJeff Kirsher u32 csum_err_udp:1;
792bcc9736cSJeff Kirsher u32 csum_err_tcp:1;
793bcc9736cSJeff Kirsher u32 csum_err_ip:1;
794bcc9736cSJeff Kirsher u32 last_desc:1;
795bcc9736cSJeff Kirsher u32 first_desc:1;
796bcc9736cSJeff Kirsher u32 hw_owned:1;
797bcc9736cSJeff Kirsher #endif
798bcc9736cSJeff Kirsher };
799bcc9736cSJeff Kirsher
800bcc9736cSJeff Kirsher struct ksz_desc_tx_stat {
801bcc9736cSJeff Kirsher #ifdef __BIG_ENDIAN_BITFIELD
802bcc9736cSJeff Kirsher u32 hw_owned:1;
803bcc9736cSJeff Kirsher u32 reserved1:31;
804bcc9736cSJeff Kirsher #else
805bcc9736cSJeff Kirsher u32 reserved1:31;
806bcc9736cSJeff Kirsher u32 hw_owned:1;
807bcc9736cSJeff Kirsher #endif
808bcc9736cSJeff Kirsher };
809bcc9736cSJeff Kirsher
810bcc9736cSJeff Kirsher struct ksz_desc_rx_buf {
811bcc9736cSJeff Kirsher #ifdef __BIG_ENDIAN_BITFIELD
812bcc9736cSJeff Kirsher u32 reserved4:6;
813bcc9736cSJeff Kirsher u32 end_of_ring:1;
814bcc9736cSJeff Kirsher u32 reserved3:14;
815bcc9736cSJeff Kirsher u32 buf_size:11;
816bcc9736cSJeff Kirsher #else
817bcc9736cSJeff Kirsher u32 buf_size:11;
818bcc9736cSJeff Kirsher u32 reserved3:14;
819bcc9736cSJeff Kirsher u32 end_of_ring:1;
820bcc9736cSJeff Kirsher u32 reserved4:6;
821bcc9736cSJeff Kirsher #endif
822bcc9736cSJeff Kirsher };
823bcc9736cSJeff Kirsher
824bcc9736cSJeff Kirsher struct ksz_desc_tx_buf {
825bcc9736cSJeff Kirsher #ifdef __BIG_ENDIAN_BITFIELD
826bcc9736cSJeff Kirsher u32 intr:1;
827bcc9736cSJeff Kirsher u32 first_seg:1;
828bcc9736cSJeff Kirsher u32 last_seg:1;
829bcc9736cSJeff Kirsher u32 csum_gen_ip:1;
830bcc9736cSJeff Kirsher u32 csum_gen_tcp:1;
831bcc9736cSJeff Kirsher u32 csum_gen_udp:1;
832bcc9736cSJeff Kirsher u32 end_of_ring:1;
833bcc9736cSJeff Kirsher u32 reserved4:1;
834bcc9736cSJeff Kirsher u32 dest_port:4;
835bcc9736cSJeff Kirsher u32 reserved3:9;
836bcc9736cSJeff Kirsher u32 buf_size:11;
837bcc9736cSJeff Kirsher #else
838bcc9736cSJeff Kirsher u32 buf_size:11;
839bcc9736cSJeff Kirsher u32 reserved3:9;
840bcc9736cSJeff Kirsher u32 dest_port:4;
841bcc9736cSJeff Kirsher u32 reserved4:1;
842bcc9736cSJeff Kirsher u32 end_of_ring:1;
843bcc9736cSJeff Kirsher u32 csum_gen_udp:1;
844bcc9736cSJeff Kirsher u32 csum_gen_tcp:1;
845bcc9736cSJeff Kirsher u32 csum_gen_ip:1;
846bcc9736cSJeff Kirsher u32 last_seg:1;
847bcc9736cSJeff Kirsher u32 first_seg:1;
848bcc9736cSJeff Kirsher u32 intr:1;
849bcc9736cSJeff Kirsher #endif
850bcc9736cSJeff Kirsher };
851bcc9736cSJeff Kirsher
852bcc9736cSJeff Kirsher union desc_stat {
853bcc9736cSJeff Kirsher struct ksz_desc_rx_stat rx;
854bcc9736cSJeff Kirsher struct ksz_desc_tx_stat tx;
855bcc9736cSJeff Kirsher u32 data;
856bcc9736cSJeff Kirsher };
857bcc9736cSJeff Kirsher
858bcc9736cSJeff Kirsher union desc_buf {
859bcc9736cSJeff Kirsher struct ksz_desc_rx_buf rx;
860bcc9736cSJeff Kirsher struct ksz_desc_tx_buf tx;
861bcc9736cSJeff Kirsher u32 data;
862bcc9736cSJeff Kirsher };
863bcc9736cSJeff Kirsher
864bcc9736cSJeff Kirsher /**
865bcc9736cSJeff Kirsher * struct ksz_hw_desc - Hardware descriptor data structure
866bcc9736cSJeff Kirsher * @ctrl: Descriptor control value.
867bcc9736cSJeff Kirsher * @buf: Descriptor buffer value.
868bcc9736cSJeff Kirsher * @addr: Physical address of memory buffer.
869bcc9736cSJeff Kirsher * @next: Pointer to next hardware descriptor.
870bcc9736cSJeff Kirsher */
871bcc9736cSJeff Kirsher struct ksz_hw_desc {
872bcc9736cSJeff Kirsher union desc_stat ctrl;
873bcc9736cSJeff Kirsher union desc_buf buf;
874bcc9736cSJeff Kirsher u32 addr;
875bcc9736cSJeff Kirsher u32 next;
876bcc9736cSJeff Kirsher };
877bcc9736cSJeff Kirsher
878bcc9736cSJeff Kirsher /**
879bcc9736cSJeff Kirsher * struct ksz_sw_desc - Software descriptor data structure
880bcc9736cSJeff Kirsher * @ctrl: Descriptor control value.
881bcc9736cSJeff Kirsher * @buf: Descriptor buffer value.
882bcc9736cSJeff Kirsher * @buf_size: Current buffers size value in hardware descriptor.
883bcc9736cSJeff Kirsher */
884bcc9736cSJeff Kirsher struct ksz_sw_desc {
885bcc9736cSJeff Kirsher union desc_stat ctrl;
886bcc9736cSJeff Kirsher union desc_buf buf;
887bcc9736cSJeff Kirsher u32 buf_size;
888bcc9736cSJeff Kirsher };
889bcc9736cSJeff Kirsher
890bcc9736cSJeff Kirsher /**
891bcc9736cSJeff Kirsher * struct ksz_dma_buf - OS dependent DMA buffer data structure
892bcc9736cSJeff Kirsher * @skb: Associated socket buffer.
893bcc9736cSJeff Kirsher * @dma: Associated physical DMA address.
894d0ea5cbdSJesse Brandeburg * @len: Actual len used.
895bcc9736cSJeff Kirsher */
896bcc9736cSJeff Kirsher struct ksz_dma_buf {
897bcc9736cSJeff Kirsher struct sk_buff *skb;
898bcc9736cSJeff Kirsher dma_addr_t dma;
899bcc9736cSJeff Kirsher int len;
900bcc9736cSJeff Kirsher };
901bcc9736cSJeff Kirsher
902bcc9736cSJeff Kirsher /**
903bcc9736cSJeff Kirsher * struct ksz_desc - Descriptor structure
904bcc9736cSJeff Kirsher * @phw: Hardware descriptor pointer to uncached physical memory.
905bcc9736cSJeff Kirsher * @sw: Cached memory to hold hardware descriptor values for
906bcc9736cSJeff Kirsher * manipulation.
907bcc9736cSJeff Kirsher * @dma_buf: Operating system dependent data structure to hold physical
908bcc9736cSJeff Kirsher * memory buffer allocation information.
909bcc9736cSJeff Kirsher */
910bcc9736cSJeff Kirsher struct ksz_desc {
911bcc9736cSJeff Kirsher struct ksz_hw_desc *phw;
912bcc9736cSJeff Kirsher struct ksz_sw_desc sw;
913bcc9736cSJeff Kirsher struct ksz_dma_buf dma_buf;
914bcc9736cSJeff Kirsher };
915bcc9736cSJeff Kirsher
916bcc9736cSJeff Kirsher #define DMA_BUFFER(desc) ((struct ksz_dma_buf *)(&(desc)->dma_buf))
917bcc9736cSJeff Kirsher
918bcc9736cSJeff Kirsher /**
919bcc9736cSJeff Kirsher * struct ksz_desc_info - Descriptor information data structure
920bcc9736cSJeff Kirsher * @ring: First descriptor in the ring.
921bcc9736cSJeff Kirsher * @cur: Current descriptor being manipulated.
922bcc9736cSJeff Kirsher * @ring_virt: First hardware descriptor in the ring.
923bcc9736cSJeff Kirsher * @ring_phys: The physical address of the first descriptor of the ring.
924bcc9736cSJeff Kirsher * @size: Size of hardware descriptor.
925bcc9736cSJeff Kirsher * @alloc: Number of descriptors allocated.
926bcc9736cSJeff Kirsher * @avail: Number of descriptors available for use.
927bcc9736cSJeff Kirsher * @last: Index for last descriptor released to hardware.
928bcc9736cSJeff Kirsher * @next: Index for next descriptor available for use.
929bcc9736cSJeff Kirsher * @mask: Mask for index wrapping.
930bcc9736cSJeff Kirsher */
931bcc9736cSJeff Kirsher struct ksz_desc_info {
932bcc9736cSJeff Kirsher struct ksz_desc *ring;
933bcc9736cSJeff Kirsher struct ksz_desc *cur;
934bcc9736cSJeff Kirsher struct ksz_hw_desc *ring_virt;
935bcc9736cSJeff Kirsher u32 ring_phys;
936bcc9736cSJeff Kirsher int size;
937bcc9736cSJeff Kirsher int alloc;
938bcc9736cSJeff Kirsher int avail;
939bcc9736cSJeff Kirsher int last;
940bcc9736cSJeff Kirsher int next;
941bcc9736cSJeff Kirsher int mask;
942bcc9736cSJeff Kirsher };
943bcc9736cSJeff Kirsher
944bcc9736cSJeff Kirsher /*
945bcc9736cSJeff Kirsher * KSZ8842 switch definitions
946bcc9736cSJeff Kirsher */
947bcc9736cSJeff Kirsher
948bcc9736cSJeff Kirsher enum {
949bcc9736cSJeff Kirsher TABLE_STATIC_MAC = 0,
950bcc9736cSJeff Kirsher TABLE_VLAN,
951bcc9736cSJeff Kirsher TABLE_DYNAMIC_MAC,
952bcc9736cSJeff Kirsher TABLE_MIB
953bcc9736cSJeff Kirsher };
954bcc9736cSJeff Kirsher
955bcc9736cSJeff Kirsher #define LEARNED_MAC_TABLE_ENTRIES 1024
956bcc9736cSJeff Kirsher #define STATIC_MAC_TABLE_ENTRIES 8
957bcc9736cSJeff Kirsher
958bcc9736cSJeff Kirsher /**
959bcc9736cSJeff Kirsher * struct ksz_mac_table - Static MAC table data structure
960bcc9736cSJeff Kirsher * @mac_addr: MAC address to filter.
961bcc9736cSJeff Kirsher * @vid: VID value.
962bcc9736cSJeff Kirsher * @fid: FID value.
963bcc9736cSJeff Kirsher * @ports: Port membership.
964bcc9736cSJeff Kirsher * @override: Override setting.
965bcc9736cSJeff Kirsher * @use_fid: FID use setting.
966bcc9736cSJeff Kirsher * @valid: Valid setting indicating the entry is being used.
967bcc9736cSJeff Kirsher */
968bcc9736cSJeff Kirsher struct ksz_mac_table {
9696a3c910cSJoe Perches u8 mac_addr[ETH_ALEN];
970bcc9736cSJeff Kirsher u16 vid;
971bcc9736cSJeff Kirsher u8 fid;
972bcc9736cSJeff Kirsher u8 ports;
973bcc9736cSJeff Kirsher u8 override:1;
974bcc9736cSJeff Kirsher u8 use_fid:1;
975bcc9736cSJeff Kirsher u8 valid:1;
976bcc9736cSJeff Kirsher };
977bcc9736cSJeff Kirsher
978bcc9736cSJeff Kirsher #define VLAN_TABLE_ENTRIES 16
979bcc9736cSJeff Kirsher
980bcc9736cSJeff Kirsher /**
981bcc9736cSJeff Kirsher * struct ksz_vlan_table - VLAN table data structure
982bcc9736cSJeff Kirsher * @vid: VID value.
983bcc9736cSJeff Kirsher * @fid: FID value.
984bcc9736cSJeff Kirsher * @member: Port membership.
985bcc9736cSJeff Kirsher */
986bcc9736cSJeff Kirsher struct ksz_vlan_table {
987bcc9736cSJeff Kirsher u16 vid;
988bcc9736cSJeff Kirsher u8 fid;
989bcc9736cSJeff Kirsher u8 member;
990bcc9736cSJeff Kirsher };
991bcc9736cSJeff Kirsher
992bcc9736cSJeff Kirsher #define DIFFSERV_ENTRIES 64
993bcc9736cSJeff Kirsher #define PRIO_802_1P_ENTRIES 8
994bcc9736cSJeff Kirsher #define PRIO_QUEUES 4
995bcc9736cSJeff Kirsher
996bcc9736cSJeff Kirsher #define SWITCH_PORT_NUM 2
997bcc9736cSJeff Kirsher #define TOTAL_PORT_NUM (SWITCH_PORT_NUM + 1)
998bcc9736cSJeff Kirsher #define HOST_MASK (1 << SWITCH_PORT_NUM)
999bcc9736cSJeff Kirsher #define PORT_MASK 7
1000bcc9736cSJeff Kirsher
1001bcc9736cSJeff Kirsher #define MAIN_PORT 0
1002bcc9736cSJeff Kirsher #define OTHER_PORT 1
1003bcc9736cSJeff Kirsher #define HOST_PORT SWITCH_PORT_NUM
1004bcc9736cSJeff Kirsher
1005bcc9736cSJeff Kirsher #define PORT_COUNTER_NUM 0x20
1006bcc9736cSJeff Kirsher #define TOTAL_PORT_COUNTER_NUM (PORT_COUNTER_NUM + 2)
1007bcc9736cSJeff Kirsher
1008bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_LO_PRIORITY 0x00
1009bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_HI_PRIORITY 0x01
1010bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_UNDERSIZE 0x02
1011bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_FRAGMENT 0x03
1012bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_OVERSIZE 0x04
1013bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_JABBER 0x05
1014bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_SYMBOL_ERR 0x06
1015bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_CRC_ERR 0x07
1016bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_ALIGNMENT_ERR 0x08
1017bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_CTRL_8808 0x09
1018bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_PAUSE 0x0A
1019bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_BROADCAST 0x0B
1020bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_MULTICAST 0x0C
1021bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_UNICAST 0x0D
1022bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_OCTET_64 0x0E
1023bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_OCTET_65_127 0x0F
1024bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_OCTET_128_255 0x10
1025bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_OCTET_256_511 0x11
1026bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_OCTET_512_1023 0x12
1027bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_OCTET_1024_1522 0x13
1028bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_LO_PRIORITY 0x14
1029bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_HI_PRIORITY 0x15
1030bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_LATE_COLLISION 0x16
1031bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_PAUSE 0x17
1032bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_BROADCAST 0x18
1033bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_MULTICAST 0x19
1034bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_UNICAST 0x1A
1035bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_DEFERRED 0x1B
1036bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_TOTAL_COLLISION 0x1C
1037bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_EXCESS_COLLISION 0x1D
1038bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_SINGLE_COLLISION 0x1E
1039bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_MULTI_COLLISION 0x1F
1040bcc9736cSJeff Kirsher
1041bcc9736cSJeff Kirsher #define MIB_COUNTER_RX_DROPPED_PACKET 0x20
1042bcc9736cSJeff Kirsher #define MIB_COUNTER_TX_DROPPED_PACKET 0x21
1043bcc9736cSJeff Kirsher
1044bcc9736cSJeff Kirsher /**
1045bcc9736cSJeff Kirsher * struct ksz_port_mib - Port MIB data structure
1046bcc9736cSJeff Kirsher * @cnt_ptr: Current pointer to MIB counter index.
1047bcc9736cSJeff Kirsher * @link_down: Indication the link has just gone down.
1048bcc9736cSJeff Kirsher * @state: Connection status of the port.
1049bcc9736cSJeff Kirsher * @mib_start: The starting counter index. Some ports do not start at 0.
1050bcc9736cSJeff Kirsher * @counter: 64-bit MIB counter value.
1051bcc9736cSJeff Kirsher * @dropped: Temporary buffer to remember last read packet dropped values.
1052bcc9736cSJeff Kirsher *
1053bcc9736cSJeff Kirsher * MIB counters needs to be read periodically so that counters do not get
1054bcc9736cSJeff Kirsher * overflowed and give incorrect values. A right balance is needed to
1055bcc9736cSJeff Kirsher * satisfy this condition and not waste too much CPU time.
1056bcc9736cSJeff Kirsher *
1057bcc9736cSJeff Kirsher * It is pointless to read MIB counters when the port is disconnected. The
1058bcc9736cSJeff Kirsher * @state provides the connection status so that MIB counters are read only
1059bcc9736cSJeff Kirsher * when the port is connected. The @link_down indicates the port is just
1060bcc9736cSJeff Kirsher * disconnected so that all MIB counters are read one last time to update the
1061bcc9736cSJeff Kirsher * information.
1062bcc9736cSJeff Kirsher */
1063bcc9736cSJeff Kirsher struct ksz_port_mib {
1064bcc9736cSJeff Kirsher u8 cnt_ptr;
1065bcc9736cSJeff Kirsher u8 link_down;
1066bcc9736cSJeff Kirsher u8 state;
1067bcc9736cSJeff Kirsher u8 mib_start;
1068bcc9736cSJeff Kirsher
1069bcc9736cSJeff Kirsher u64 counter[TOTAL_PORT_COUNTER_NUM];
1070bcc9736cSJeff Kirsher u32 dropped[2];
1071bcc9736cSJeff Kirsher };
1072bcc9736cSJeff Kirsher
1073bcc9736cSJeff Kirsher /**
1074bcc9736cSJeff Kirsher * struct ksz_port_cfg - Port configuration data structure
1075bcc9736cSJeff Kirsher * @vid: VID value.
1076bcc9736cSJeff Kirsher * @member: Port membership.
1077bcc9736cSJeff Kirsher * @port_prio: Port priority.
1078bcc9736cSJeff Kirsher * @rx_rate: Receive priority rate.
1079bcc9736cSJeff Kirsher * @tx_rate: Transmit priority rate.
1080bcc9736cSJeff Kirsher * @stp_state: Current Spanning Tree Protocol state.
1081bcc9736cSJeff Kirsher */
1082bcc9736cSJeff Kirsher struct ksz_port_cfg {
1083bcc9736cSJeff Kirsher u16 vid;
1084bcc9736cSJeff Kirsher u8 member;
1085bcc9736cSJeff Kirsher u8 port_prio;
1086bcc9736cSJeff Kirsher u32 rx_rate[PRIO_QUEUES];
1087bcc9736cSJeff Kirsher u32 tx_rate[PRIO_QUEUES];
1088bcc9736cSJeff Kirsher int stp_state;
1089bcc9736cSJeff Kirsher };
1090bcc9736cSJeff Kirsher
1091bcc9736cSJeff Kirsher /**
1092bcc9736cSJeff Kirsher * struct ksz_switch - KSZ8842 switch data structure
1093bcc9736cSJeff Kirsher * @mac_table: MAC table entries information.
1094bcc9736cSJeff Kirsher * @vlan_table: VLAN table entries information.
1095bcc9736cSJeff Kirsher * @port_cfg: Port configuration information.
1096bcc9736cSJeff Kirsher * @diffserv: DiffServ priority settings. Possible values from 6-bit of ToS
1097bcc9736cSJeff Kirsher * (bit7 ~ bit2) field.
1098bcc9736cSJeff Kirsher * @p_802_1p: 802.1P priority settings. Possible values from 3-bit of 802.1p
1099bcc9736cSJeff Kirsher * Tag priority field.
1100bcc9736cSJeff Kirsher * @br_addr: Bridge address. Used for STP.
1101bcc9736cSJeff Kirsher * @other_addr: Other MAC address. Used for multiple network device mode.
1102bcc9736cSJeff Kirsher * @broad_per: Broadcast storm percentage.
1103bcc9736cSJeff Kirsher * @member: Current port membership. Used for STP.
1104bcc9736cSJeff Kirsher */
1105bcc9736cSJeff Kirsher struct ksz_switch {
1106bcc9736cSJeff Kirsher struct ksz_mac_table mac_table[STATIC_MAC_TABLE_ENTRIES];
1107bcc9736cSJeff Kirsher struct ksz_vlan_table vlan_table[VLAN_TABLE_ENTRIES];
1108bcc9736cSJeff Kirsher struct ksz_port_cfg port_cfg[TOTAL_PORT_NUM];
1109bcc9736cSJeff Kirsher
1110bcc9736cSJeff Kirsher u8 diffserv[DIFFSERV_ENTRIES];
1111bcc9736cSJeff Kirsher u8 p_802_1p[PRIO_802_1P_ENTRIES];
1112bcc9736cSJeff Kirsher
11136a3c910cSJoe Perches u8 br_addr[ETH_ALEN];
11146a3c910cSJoe Perches u8 other_addr[ETH_ALEN];
1115bcc9736cSJeff Kirsher
1116bcc9736cSJeff Kirsher u8 broad_per;
1117bcc9736cSJeff Kirsher u8 member;
1118bcc9736cSJeff Kirsher };
1119bcc9736cSJeff Kirsher
1120bcc9736cSJeff Kirsher #define TX_RATE_UNIT 10000
1121bcc9736cSJeff Kirsher
1122bcc9736cSJeff Kirsher /**
1123bcc9736cSJeff Kirsher * struct ksz_port_info - Port information data structure
1124bcc9736cSJeff Kirsher * @state: Connection status of the port.
1125bcc9736cSJeff Kirsher * @tx_rate: Transmit rate divided by 10000 to get Mbit.
1126bcc9736cSJeff Kirsher * @duplex: Duplex mode.
1127bcc9736cSJeff Kirsher * @advertised: Advertised auto-negotiation setting. Used to determine link.
1128bcc9736cSJeff Kirsher * @partner: Auto-negotiation partner setting. Used to determine link.
1129bcc9736cSJeff Kirsher * @port_id: Port index to access actual hardware register.
1130bcc9736cSJeff Kirsher * @pdev: Pointer to OS dependent network device.
1131bcc9736cSJeff Kirsher */
1132bcc9736cSJeff Kirsher struct ksz_port_info {
1133bcc9736cSJeff Kirsher uint state;
1134bcc9736cSJeff Kirsher uint tx_rate;
1135bcc9736cSJeff Kirsher u8 duplex;
1136bcc9736cSJeff Kirsher u8 advertised;
1137bcc9736cSJeff Kirsher u8 partner;
1138bcc9736cSJeff Kirsher u8 port_id;
1139bcc9736cSJeff Kirsher void *pdev;
1140bcc9736cSJeff Kirsher };
1141bcc9736cSJeff Kirsher
1142bcc9736cSJeff Kirsher #define MAX_TX_HELD_SIZE 52000
1143bcc9736cSJeff Kirsher
1144bcc9736cSJeff Kirsher /* Hardware features and bug fixes. */
1145bcc9736cSJeff Kirsher #define LINK_INT_WORKING (1 << 0)
1146bcc9736cSJeff Kirsher #define SMALL_PACKET_TX_BUG (1 << 1)
1147bcc9736cSJeff Kirsher #define HALF_DUPLEX_SIGNAL_BUG (1 << 2)
1148bcc9736cSJeff Kirsher #define RX_HUGE_FRAME (1 << 4)
1149bcc9736cSJeff Kirsher #define STP_SUPPORT (1 << 8)
1150bcc9736cSJeff Kirsher
1151bcc9736cSJeff Kirsher /* Software overrides. */
1152bcc9736cSJeff Kirsher #define PAUSE_FLOW_CTRL (1 << 0)
1153bcc9736cSJeff Kirsher #define FAST_AGING (1 << 1)
1154bcc9736cSJeff Kirsher
1155bcc9736cSJeff Kirsher /**
1156bcc9736cSJeff Kirsher * struct ksz_hw - KSZ884X hardware data structure
1157bcc9736cSJeff Kirsher * @io: Virtual address assigned.
1158bcc9736cSJeff Kirsher * @ksz_switch: Pointer to KSZ8842 switch.
1159bcc9736cSJeff Kirsher * @port_info: Port information.
1160bcc9736cSJeff Kirsher * @port_mib: Port MIB information.
1161bcc9736cSJeff Kirsher * @dev_count: Number of network devices this hardware supports.
1162bcc9736cSJeff Kirsher * @dst_ports: Destination ports in switch for transmission.
1163bcc9736cSJeff Kirsher * @id: Hardware ID. Used for display only.
1164bcc9736cSJeff Kirsher * @mib_cnt: Number of MIB counters this hardware has.
1165bcc9736cSJeff Kirsher * @mib_port_cnt: Number of ports with MIB counters.
1166bcc9736cSJeff Kirsher * @tx_cfg: Cached transmit control settings.
1167bcc9736cSJeff Kirsher * @rx_cfg: Cached receive control settings.
1168bcc9736cSJeff Kirsher * @intr_mask: Current interrupt mask.
1169bcc9736cSJeff Kirsher * @intr_set: Current interrup set.
1170bcc9736cSJeff Kirsher * @intr_blocked: Interrupt blocked.
1171bcc9736cSJeff Kirsher * @rx_desc_info: Receive descriptor information.
1172bcc9736cSJeff Kirsher * @tx_desc_info: Transmit descriptor information.
1173bcc9736cSJeff Kirsher * @tx_int_cnt: Transmit interrupt count. Used for TX optimization.
1174bcc9736cSJeff Kirsher * @tx_int_mask: Transmit interrupt mask. Used for TX optimization.
1175bcc9736cSJeff Kirsher * @tx_size: Transmit data size. Used for TX optimization.
1176bcc9736cSJeff Kirsher * The maximum is defined by MAX_TX_HELD_SIZE.
1177bcc9736cSJeff Kirsher * @perm_addr: Permanent MAC address.
117803671057SMasahiro Yamada * @override_addr: Overridden MAC address.
1179bcc9736cSJeff Kirsher * @address: Additional MAC address entries.
1180bcc9736cSJeff Kirsher * @addr_list_size: Additional MAC address list size.
118103671057SMasahiro Yamada * @mac_override: Indication of MAC address overridden.
1182bcc9736cSJeff Kirsher * @promiscuous: Counter to keep track of promiscuous mode set.
1183bcc9736cSJeff Kirsher * @all_multi: Counter to keep track of all multicast mode set.
1184bcc9736cSJeff Kirsher * @multi_list: Multicast address entries.
1185bcc9736cSJeff Kirsher * @multi_bits: Cached multicast hash table settings.
1186bcc9736cSJeff Kirsher * @multi_list_size: Multicast address list size.
1187bcc9736cSJeff Kirsher * @enabled: Indication of hardware enabled.
1188bcc9736cSJeff Kirsher * @rx_stop: Indication of receive process stop.
1189d0ea5cbdSJesse Brandeburg * @reserved2: none
1190bcc9736cSJeff Kirsher * @features: Hardware features to enable.
1191bcc9736cSJeff Kirsher * @overrides: Hardware features to override.
1192bcc9736cSJeff Kirsher * @parent: Pointer to parent, network device private structure.
1193bcc9736cSJeff Kirsher */
1194bcc9736cSJeff Kirsher struct ksz_hw {
1195bcc9736cSJeff Kirsher void __iomem *io;
1196bcc9736cSJeff Kirsher
1197bcc9736cSJeff Kirsher struct ksz_switch *ksz_switch;
1198bcc9736cSJeff Kirsher struct ksz_port_info port_info[SWITCH_PORT_NUM];
1199bcc9736cSJeff Kirsher struct ksz_port_mib port_mib[TOTAL_PORT_NUM];
1200bcc9736cSJeff Kirsher int dev_count;
1201bcc9736cSJeff Kirsher int dst_ports;
1202bcc9736cSJeff Kirsher int id;
1203bcc9736cSJeff Kirsher int mib_cnt;
1204bcc9736cSJeff Kirsher int mib_port_cnt;
1205bcc9736cSJeff Kirsher
1206bcc9736cSJeff Kirsher u32 tx_cfg;
1207bcc9736cSJeff Kirsher u32 rx_cfg;
1208bcc9736cSJeff Kirsher u32 intr_mask;
1209bcc9736cSJeff Kirsher u32 intr_set;
1210bcc9736cSJeff Kirsher uint intr_blocked;
1211bcc9736cSJeff Kirsher
1212bcc9736cSJeff Kirsher struct ksz_desc_info rx_desc_info;
1213bcc9736cSJeff Kirsher struct ksz_desc_info tx_desc_info;
1214bcc9736cSJeff Kirsher
1215bcc9736cSJeff Kirsher int tx_int_cnt;
1216bcc9736cSJeff Kirsher int tx_int_mask;
1217bcc9736cSJeff Kirsher int tx_size;
1218bcc9736cSJeff Kirsher
12196a3c910cSJoe Perches u8 perm_addr[ETH_ALEN];
12206a3c910cSJoe Perches u8 override_addr[ETH_ALEN];
12216a3c910cSJoe Perches u8 address[ADDITIONAL_ENTRIES][ETH_ALEN];
1222bcc9736cSJeff Kirsher u8 addr_list_size;
1223bcc9736cSJeff Kirsher u8 mac_override;
1224bcc9736cSJeff Kirsher u8 promiscuous;
1225bcc9736cSJeff Kirsher u8 all_multi;
12266a3c910cSJoe Perches u8 multi_list[MAX_MULTICAST_LIST][ETH_ALEN];
1227bcc9736cSJeff Kirsher u8 multi_bits[HW_MULTICAST_SIZE];
1228bcc9736cSJeff Kirsher u8 multi_list_size;
1229bcc9736cSJeff Kirsher
1230bcc9736cSJeff Kirsher u8 enabled;
1231bcc9736cSJeff Kirsher u8 rx_stop;
1232bcc9736cSJeff Kirsher u8 reserved2[1];
1233bcc9736cSJeff Kirsher
1234bcc9736cSJeff Kirsher uint features;
1235bcc9736cSJeff Kirsher uint overrides;
1236bcc9736cSJeff Kirsher
1237bcc9736cSJeff Kirsher void *parent;
1238bcc9736cSJeff Kirsher };
1239bcc9736cSJeff Kirsher
1240bcc9736cSJeff Kirsher enum {
1241bcc9736cSJeff Kirsher PHY_NO_FLOW_CTRL,
1242bcc9736cSJeff Kirsher PHY_FLOW_CTRL,
1243bcc9736cSJeff Kirsher PHY_TX_ONLY,
1244bcc9736cSJeff Kirsher PHY_RX_ONLY
1245bcc9736cSJeff Kirsher };
1246bcc9736cSJeff Kirsher
1247bcc9736cSJeff Kirsher /**
1248bcc9736cSJeff Kirsher * struct ksz_port - Virtual port data structure
1249bcc9736cSJeff Kirsher * @duplex: Duplex mode setting. 1 for half duplex, 2 for full
1250bcc9736cSJeff Kirsher * duplex, and 0 for auto, which normally results in full
1251bcc9736cSJeff Kirsher * duplex.
1252bcc9736cSJeff Kirsher * @speed: Speed setting. 10 for 10 Mbit, 100 for 100 Mbit, and
1253bcc9736cSJeff Kirsher * 0 for auto, which normally results in 100 Mbit.
1254bcc9736cSJeff Kirsher * @force_link: Force link setting. 0 for auto-negotiation, and 1 for
1255bcc9736cSJeff Kirsher * force.
1256bcc9736cSJeff Kirsher * @flow_ctrl: Flow control setting. PHY_NO_FLOW_CTRL for no flow
1257bcc9736cSJeff Kirsher * control, and PHY_FLOW_CTRL for flow control.
1258bcc9736cSJeff Kirsher * PHY_TX_ONLY and PHY_RX_ONLY are not supported for 100
1259bcc9736cSJeff Kirsher * Mbit PHY.
1260bcc9736cSJeff Kirsher * @first_port: Index of first port this port supports.
1261bcc9736cSJeff Kirsher * @mib_port_cnt: Number of ports with MIB counters.
1262bcc9736cSJeff Kirsher * @port_cnt: Number of ports this port supports.
1263bcc9736cSJeff Kirsher * @counter: Port statistics counter.
1264bcc9736cSJeff Kirsher * @hw: Pointer to hardware structure.
1265bcc9736cSJeff Kirsher * @linked: Pointer to port information linked to this port.
1266bcc9736cSJeff Kirsher */
1267bcc9736cSJeff Kirsher struct ksz_port {
1268bcc9736cSJeff Kirsher u8 duplex;
1269bcc9736cSJeff Kirsher u8 speed;
1270bcc9736cSJeff Kirsher u8 force_link;
1271bcc9736cSJeff Kirsher u8 flow_ctrl;
1272bcc9736cSJeff Kirsher
1273bcc9736cSJeff Kirsher int first_port;
1274bcc9736cSJeff Kirsher int mib_port_cnt;
1275bcc9736cSJeff Kirsher int port_cnt;
1276bcc9736cSJeff Kirsher u64 counter[OID_COUNTER_LAST];
1277bcc9736cSJeff Kirsher
1278bcc9736cSJeff Kirsher struct ksz_hw *hw;
1279bcc9736cSJeff Kirsher struct ksz_port_info *linked;
1280bcc9736cSJeff Kirsher };
1281bcc9736cSJeff Kirsher
1282bcc9736cSJeff Kirsher /**
1283bcc9736cSJeff Kirsher * struct ksz_timer_info - Timer information data structure
1284bcc9736cSJeff Kirsher * @timer: Kernel timer.
1285bcc9736cSJeff Kirsher * @cnt: Running timer counter.
1286bcc9736cSJeff Kirsher * @max: Number of times to run timer; -1 for infinity.
1287bcc9736cSJeff Kirsher * @period: Timer period in jiffies.
1288bcc9736cSJeff Kirsher */
1289bcc9736cSJeff Kirsher struct ksz_timer_info {
1290bcc9736cSJeff Kirsher struct timer_list timer;
1291bcc9736cSJeff Kirsher int cnt;
1292bcc9736cSJeff Kirsher int max;
1293bcc9736cSJeff Kirsher int period;
1294bcc9736cSJeff Kirsher };
1295bcc9736cSJeff Kirsher
1296bcc9736cSJeff Kirsher /**
1297bcc9736cSJeff Kirsher * struct ksz_shared_mem - OS dependent shared memory data structure
1298bcc9736cSJeff Kirsher * @dma_addr: Physical DMA address allocated.
1299bcc9736cSJeff Kirsher * @alloc_size: Allocation size.
1300bcc9736cSJeff Kirsher * @phys: Actual physical address used.
1301bcc9736cSJeff Kirsher * @alloc_virt: Virtual address allocated.
1302bcc9736cSJeff Kirsher * @virt: Actual virtual address used.
1303bcc9736cSJeff Kirsher */
1304bcc9736cSJeff Kirsher struct ksz_shared_mem {
1305bcc9736cSJeff Kirsher dma_addr_t dma_addr;
1306bcc9736cSJeff Kirsher uint alloc_size;
1307bcc9736cSJeff Kirsher uint phys;
1308bcc9736cSJeff Kirsher u8 *alloc_virt;
1309bcc9736cSJeff Kirsher u8 *virt;
1310bcc9736cSJeff Kirsher };
1311bcc9736cSJeff Kirsher
1312bcc9736cSJeff Kirsher /**
1313bcc9736cSJeff Kirsher * struct ksz_counter_info - OS dependent counter information data structure
1314bcc9736cSJeff Kirsher * @counter: Wait queue to wakeup after counters are read.
1315bcc9736cSJeff Kirsher * @time: Next time in jiffies to read counter.
1316bcc9736cSJeff Kirsher * @read: Indication of counters read in full or not.
1317bcc9736cSJeff Kirsher */
1318bcc9736cSJeff Kirsher struct ksz_counter_info {
1319bcc9736cSJeff Kirsher wait_queue_head_t counter;
1320bcc9736cSJeff Kirsher unsigned long time;
1321bcc9736cSJeff Kirsher int read;
1322bcc9736cSJeff Kirsher };
1323bcc9736cSJeff Kirsher
1324bcc9736cSJeff Kirsher /**
1325bcc9736cSJeff Kirsher * struct dev_info - Network device information data structure
1326bcc9736cSJeff Kirsher * @dev: Pointer to network device.
1327bcc9736cSJeff Kirsher * @pdev: Pointer to PCI device.
1328bcc9736cSJeff Kirsher * @hw: Hardware structure.
1329bcc9736cSJeff Kirsher * @desc_pool: Physical memory used for descriptor pool.
1330bcc9736cSJeff Kirsher * @hwlock: Spinlock to prevent hardware from accessing.
1331bcc9736cSJeff Kirsher * @lock: Mutex lock to prevent device from accessing.
1332bcc9736cSJeff Kirsher * @dev_rcv: Receive process function used.
1333bcc9736cSJeff Kirsher * @last_skb: Socket buffer allocated for descriptor rx fragments.
1334bcc9736cSJeff Kirsher * @skb_index: Buffer index for receiving fragments.
1335bcc9736cSJeff Kirsher * @skb_len: Buffer length for receiving fragments.
1336bcc9736cSJeff Kirsher * @mib_read: Workqueue to read MIB counters.
1337bcc9736cSJeff Kirsher * @mib_timer_info: Timer to read MIB counters.
1338bcc9736cSJeff Kirsher * @counter: Used for MIB reading.
1339bcc9736cSJeff Kirsher * @mtu: Current MTU used. The default is REGULAR_RX_BUF_SIZE;
1340bcc9736cSJeff Kirsher * the maximum is MAX_RX_BUF_SIZE.
1341bcc9736cSJeff Kirsher * @opened: Counter to keep track of device open.
1342bcc9736cSJeff Kirsher * @rx_tasklet: Receive processing tasklet.
1343bcc9736cSJeff Kirsher * @tx_tasklet: Transmit processing tasklet.
1344bcc9736cSJeff Kirsher * @wol_enable: Wake-on-LAN enable set by ethtool.
1345bcc9736cSJeff Kirsher * @wol_support: Wake-on-LAN support used by ethtool.
1346bcc9736cSJeff Kirsher * @pme_wait: Used for KSZ8841 power management.
1347bcc9736cSJeff Kirsher */
1348bcc9736cSJeff Kirsher struct dev_info {
1349bcc9736cSJeff Kirsher struct net_device *dev;
1350bcc9736cSJeff Kirsher struct pci_dev *pdev;
1351bcc9736cSJeff Kirsher
1352bcc9736cSJeff Kirsher struct ksz_hw hw;
1353bcc9736cSJeff Kirsher struct ksz_shared_mem desc_pool;
1354bcc9736cSJeff Kirsher
1355bcc9736cSJeff Kirsher spinlock_t hwlock;
1356bcc9736cSJeff Kirsher struct mutex lock;
1357bcc9736cSJeff Kirsher
1358bcc9736cSJeff Kirsher int (*dev_rcv)(struct dev_info *);
1359bcc9736cSJeff Kirsher
1360bcc9736cSJeff Kirsher struct sk_buff *last_skb;
1361bcc9736cSJeff Kirsher int skb_index;
1362bcc9736cSJeff Kirsher int skb_len;
1363bcc9736cSJeff Kirsher
1364bcc9736cSJeff Kirsher struct work_struct mib_read;
1365bcc9736cSJeff Kirsher struct ksz_timer_info mib_timer_info;
1366bcc9736cSJeff Kirsher struct ksz_counter_info counter[TOTAL_PORT_NUM];
1367bcc9736cSJeff Kirsher
1368bcc9736cSJeff Kirsher int mtu;
1369bcc9736cSJeff Kirsher int opened;
1370bcc9736cSJeff Kirsher
1371bcc9736cSJeff Kirsher struct tasklet_struct rx_tasklet;
1372bcc9736cSJeff Kirsher struct tasklet_struct tx_tasklet;
1373bcc9736cSJeff Kirsher
1374bcc9736cSJeff Kirsher int wol_enable;
1375bcc9736cSJeff Kirsher int wol_support;
1376bcc9736cSJeff Kirsher unsigned long pme_wait;
1377bcc9736cSJeff Kirsher };
1378bcc9736cSJeff Kirsher
1379bcc9736cSJeff Kirsher /**
1380bcc9736cSJeff Kirsher * struct dev_priv - Network device private data structure
1381bcc9736cSJeff Kirsher * @adapter: Adapter device information.
1382bcc9736cSJeff Kirsher * @port: Port information.
1383d0ea5cbdSJesse Brandeburg * @monitor_timer_info: Timer to monitor ports.
1384bcc9736cSJeff Kirsher * @proc_sem: Semaphore for proc accessing.
1385bcc9736cSJeff Kirsher * @id: Device ID.
1386bcc9736cSJeff Kirsher * @mii_if: MII interface information.
1387bcc9736cSJeff Kirsher * @advertising: Temporary variable to store advertised settings.
1388bcc9736cSJeff Kirsher * @msg_enable: The message flags controlling driver output.
1389bcc9736cSJeff Kirsher * @media_state: The connection status of the device.
1390bcc9736cSJeff Kirsher * @multicast: The all multicast state of the device.
1391bcc9736cSJeff Kirsher * @promiscuous: The promiscuous state of the device.
1392bcc9736cSJeff Kirsher */
1393bcc9736cSJeff Kirsher struct dev_priv {
1394bcc9736cSJeff Kirsher struct dev_info *adapter;
1395bcc9736cSJeff Kirsher struct ksz_port port;
1396bcc9736cSJeff Kirsher struct ksz_timer_info monitor_timer_info;
1397bcc9736cSJeff Kirsher
1398bcc9736cSJeff Kirsher struct semaphore proc_sem;
1399bcc9736cSJeff Kirsher int id;
1400bcc9736cSJeff Kirsher
1401bcc9736cSJeff Kirsher struct mii_if_info mii_if;
1402bcc9736cSJeff Kirsher u32 advertising;
1403bcc9736cSJeff Kirsher
1404bcc9736cSJeff Kirsher u32 msg_enable;
1405bcc9736cSJeff Kirsher int media_state;
1406bcc9736cSJeff Kirsher int multicast;
1407bcc9736cSJeff Kirsher int promiscuous;
1408bcc9736cSJeff Kirsher };
1409bcc9736cSJeff Kirsher
1410bcc9736cSJeff Kirsher #define DRV_NAME "KSZ884X PCI"
1411bcc9736cSJeff Kirsher #define DEVICE_NAME "KSZ884x PCI"
1412bcc9736cSJeff Kirsher #define DRV_VERSION "1.0.0"
1413bcc9736cSJeff Kirsher #define DRV_RELDATE "Feb 8, 2010"
1414bcc9736cSJeff Kirsher
1415654b8c5cSBill Pemberton static char version[] =
1416bcc9736cSJeff Kirsher "Micrel " DEVICE_NAME " " DRV_VERSION " (" DRV_RELDATE ")";
1417bcc9736cSJeff Kirsher
1418bcc9736cSJeff Kirsher static u8 DEFAULT_MAC_ADDRESS[] = { 0x00, 0x10, 0xA1, 0x88, 0x42, 0x01 };
1419bcc9736cSJeff Kirsher
1420bcc9736cSJeff Kirsher /*
1421bcc9736cSJeff Kirsher * Interrupt processing primary routines
1422bcc9736cSJeff Kirsher */
1423bcc9736cSJeff Kirsher
hw_ack_intr(struct ksz_hw * hw,uint interrupt)1424bcc9736cSJeff Kirsher static inline void hw_ack_intr(struct ksz_hw *hw, uint interrupt)
1425bcc9736cSJeff Kirsher {
1426bcc9736cSJeff Kirsher writel(interrupt, hw->io + KS884X_INTERRUPTS_STATUS);
1427bcc9736cSJeff Kirsher }
1428bcc9736cSJeff Kirsher
hw_dis_intr(struct ksz_hw * hw)1429bcc9736cSJeff Kirsher static inline void hw_dis_intr(struct ksz_hw *hw)
1430bcc9736cSJeff Kirsher {
1431bcc9736cSJeff Kirsher hw->intr_blocked = hw->intr_mask;
1432bcc9736cSJeff Kirsher writel(0, hw->io + KS884X_INTERRUPTS_ENABLE);
1433bcc9736cSJeff Kirsher hw->intr_set = readl(hw->io + KS884X_INTERRUPTS_ENABLE);
1434bcc9736cSJeff Kirsher }
1435bcc9736cSJeff Kirsher
hw_set_intr(struct ksz_hw * hw,uint interrupt)1436bcc9736cSJeff Kirsher static inline void hw_set_intr(struct ksz_hw *hw, uint interrupt)
1437bcc9736cSJeff Kirsher {
1438bcc9736cSJeff Kirsher hw->intr_set = interrupt;
1439bcc9736cSJeff Kirsher writel(interrupt, hw->io + KS884X_INTERRUPTS_ENABLE);
1440bcc9736cSJeff Kirsher }
1441bcc9736cSJeff Kirsher
hw_ena_intr(struct ksz_hw * hw)1442bcc9736cSJeff Kirsher static inline void hw_ena_intr(struct ksz_hw *hw)
1443bcc9736cSJeff Kirsher {
1444bcc9736cSJeff Kirsher hw->intr_blocked = 0;
1445bcc9736cSJeff Kirsher hw_set_intr(hw, hw->intr_mask);
1446bcc9736cSJeff Kirsher }
1447bcc9736cSJeff Kirsher
hw_dis_intr_bit(struct ksz_hw * hw,uint bit)1448bcc9736cSJeff Kirsher static inline void hw_dis_intr_bit(struct ksz_hw *hw, uint bit)
1449bcc9736cSJeff Kirsher {
1450bcc9736cSJeff Kirsher hw->intr_mask &= ~(bit);
1451bcc9736cSJeff Kirsher }
1452bcc9736cSJeff Kirsher
hw_turn_off_intr(struct ksz_hw * hw,uint interrupt)1453bcc9736cSJeff Kirsher static inline void hw_turn_off_intr(struct ksz_hw *hw, uint interrupt)
1454bcc9736cSJeff Kirsher {
1455bcc9736cSJeff Kirsher u32 read_intr;
1456bcc9736cSJeff Kirsher
1457bcc9736cSJeff Kirsher read_intr = readl(hw->io + KS884X_INTERRUPTS_ENABLE);
1458bcc9736cSJeff Kirsher hw->intr_set = read_intr & ~interrupt;
1459bcc9736cSJeff Kirsher writel(hw->intr_set, hw->io + KS884X_INTERRUPTS_ENABLE);
1460bcc9736cSJeff Kirsher hw_dis_intr_bit(hw, interrupt);
1461bcc9736cSJeff Kirsher }
1462bcc9736cSJeff Kirsher
1463bcc9736cSJeff Kirsher /**
1464bcc9736cSJeff Kirsher * hw_turn_on_intr - turn on specified interrupts
1465bcc9736cSJeff Kirsher * @hw: The hardware instance.
1466bcc9736cSJeff Kirsher * @bit: The interrupt bits to be on.
1467bcc9736cSJeff Kirsher *
1468bcc9736cSJeff Kirsher * This routine turns on the specified interrupts in the interrupt mask so that
1469bcc9736cSJeff Kirsher * those interrupts will be enabled.
1470bcc9736cSJeff Kirsher */
hw_turn_on_intr(struct ksz_hw * hw,u32 bit)1471bcc9736cSJeff Kirsher static void hw_turn_on_intr(struct ksz_hw *hw, u32 bit)
1472bcc9736cSJeff Kirsher {
1473bcc9736cSJeff Kirsher hw->intr_mask |= bit;
1474bcc9736cSJeff Kirsher
1475bcc9736cSJeff Kirsher if (!hw->intr_blocked)
1476bcc9736cSJeff Kirsher hw_set_intr(hw, hw->intr_mask);
1477bcc9736cSJeff Kirsher }
1478bcc9736cSJeff Kirsher
hw_read_intr(struct ksz_hw * hw,uint * status)1479bcc9736cSJeff Kirsher static inline void hw_read_intr(struct ksz_hw *hw, uint *status)
1480bcc9736cSJeff Kirsher {
1481bcc9736cSJeff Kirsher *status = readl(hw->io + KS884X_INTERRUPTS_STATUS);
1482bcc9736cSJeff Kirsher *status = *status & hw->intr_set;
1483bcc9736cSJeff Kirsher }
1484bcc9736cSJeff Kirsher
hw_restore_intr(struct ksz_hw * hw,uint interrupt)1485bcc9736cSJeff Kirsher static inline void hw_restore_intr(struct ksz_hw *hw, uint interrupt)
1486bcc9736cSJeff Kirsher {
1487bcc9736cSJeff Kirsher if (interrupt)
1488bcc9736cSJeff Kirsher hw_ena_intr(hw);
1489bcc9736cSJeff Kirsher }
1490bcc9736cSJeff Kirsher
1491bcc9736cSJeff Kirsher /**
1492bcc9736cSJeff Kirsher * hw_block_intr - block hardware interrupts
1493d0ea5cbdSJesse Brandeburg * @hw: The hardware instance.
1494bcc9736cSJeff Kirsher *
1495bcc9736cSJeff Kirsher * This function blocks all interrupts of the hardware and returns the current
1496bcc9736cSJeff Kirsher * interrupt enable mask so that interrupts can be restored later.
1497bcc9736cSJeff Kirsher *
1498bcc9736cSJeff Kirsher * Return the current interrupt enable mask.
1499bcc9736cSJeff Kirsher */
hw_block_intr(struct ksz_hw * hw)1500bcc9736cSJeff Kirsher static uint hw_block_intr(struct ksz_hw *hw)
1501bcc9736cSJeff Kirsher {
1502bcc9736cSJeff Kirsher uint interrupt = 0;
1503bcc9736cSJeff Kirsher
1504bcc9736cSJeff Kirsher if (!hw->intr_blocked) {
1505bcc9736cSJeff Kirsher hw_dis_intr(hw);
1506bcc9736cSJeff Kirsher interrupt = hw->intr_blocked;
1507bcc9736cSJeff Kirsher }
1508bcc9736cSJeff Kirsher return interrupt;
1509bcc9736cSJeff Kirsher }
1510bcc9736cSJeff Kirsher
1511bcc9736cSJeff Kirsher /*
1512bcc9736cSJeff Kirsher * Hardware descriptor routines
1513bcc9736cSJeff Kirsher */
1514bcc9736cSJeff Kirsher
reset_desc(struct ksz_desc * desc,union desc_stat status)1515bcc9736cSJeff Kirsher static inline void reset_desc(struct ksz_desc *desc, union desc_stat status)
1516bcc9736cSJeff Kirsher {
1517bcc9736cSJeff Kirsher status.rx.hw_owned = 0;
1518bcc9736cSJeff Kirsher desc->phw->ctrl.data = cpu_to_le32(status.data);
1519bcc9736cSJeff Kirsher }
1520bcc9736cSJeff Kirsher
release_desc(struct ksz_desc * desc)1521bcc9736cSJeff Kirsher static inline void release_desc(struct ksz_desc *desc)
1522bcc9736cSJeff Kirsher {
1523bcc9736cSJeff Kirsher desc->sw.ctrl.tx.hw_owned = 1;
1524bcc9736cSJeff Kirsher if (desc->sw.buf_size != desc->sw.buf.data) {
1525bcc9736cSJeff Kirsher desc->sw.buf_size = desc->sw.buf.data;
1526bcc9736cSJeff Kirsher desc->phw->buf.data = cpu_to_le32(desc->sw.buf.data);
1527bcc9736cSJeff Kirsher }
1528bcc9736cSJeff Kirsher desc->phw->ctrl.data = cpu_to_le32(desc->sw.ctrl.data);
1529bcc9736cSJeff Kirsher }
1530bcc9736cSJeff Kirsher
get_rx_pkt(struct ksz_desc_info * info,struct ksz_desc ** desc)1531bcc9736cSJeff Kirsher static void get_rx_pkt(struct ksz_desc_info *info, struct ksz_desc **desc)
1532bcc9736cSJeff Kirsher {
1533bcc9736cSJeff Kirsher *desc = &info->ring[info->last];
1534bcc9736cSJeff Kirsher info->last++;
1535bcc9736cSJeff Kirsher info->last &= info->mask;
1536bcc9736cSJeff Kirsher info->avail--;
1537bcc9736cSJeff Kirsher (*desc)->sw.buf.data &= ~KS_DESC_RX_MASK;
1538bcc9736cSJeff Kirsher }
1539bcc9736cSJeff Kirsher
set_rx_buf(struct ksz_desc * desc,u32 addr)1540bcc9736cSJeff Kirsher static inline void set_rx_buf(struct ksz_desc *desc, u32 addr)
1541bcc9736cSJeff Kirsher {
1542bcc9736cSJeff Kirsher desc->phw->addr = cpu_to_le32(addr);
1543bcc9736cSJeff Kirsher }
1544bcc9736cSJeff Kirsher
set_rx_len(struct ksz_desc * desc,u32 len)1545bcc9736cSJeff Kirsher static inline void set_rx_len(struct ksz_desc *desc, u32 len)
1546bcc9736cSJeff Kirsher {
1547bcc9736cSJeff Kirsher desc->sw.buf.rx.buf_size = len;
1548bcc9736cSJeff Kirsher }
1549bcc9736cSJeff Kirsher
get_tx_pkt(struct ksz_desc_info * info,struct ksz_desc ** desc)1550bcc9736cSJeff Kirsher static inline void get_tx_pkt(struct ksz_desc_info *info,
1551bcc9736cSJeff Kirsher struct ksz_desc **desc)
1552bcc9736cSJeff Kirsher {
1553bcc9736cSJeff Kirsher *desc = &info->ring[info->next];
1554bcc9736cSJeff Kirsher info->next++;
1555bcc9736cSJeff Kirsher info->next &= info->mask;
1556bcc9736cSJeff Kirsher info->avail--;
1557bcc9736cSJeff Kirsher (*desc)->sw.buf.data &= ~KS_DESC_TX_MASK;
1558bcc9736cSJeff Kirsher }
1559bcc9736cSJeff Kirsher
set_tx_buf(struct ksz_desc * desc,u32 addr)1560bcc9736cSJeff Kirsher static inline void set_tx_buf(struct ksz_desc *desc, u32 addr)
1561bcc9736cSJeff Kirsher {
1562bcc9736cSJeff Kirsher desc->phw->addr = cpu_to_le32(addr);
1563bcc9736cSJeff Kirsher }
1564bcc9736cSJeff Kirsher
set_tx_len(struct ksz_desc * desc,u32 len)1565bcc9736cSJeff Kirsher static inline void set_tx_len(struct ksz_desc *desc, u32 len)
1566bcc9736cSJeff Kirsher {
1567bcc9736cSJeff Kirsher desc->sw.buf.tx.buf_size = len;
1568bcc9736cSJeff Kirsher }
1569bcc9736cSJeff Kirsher
1570bcc9736cSJeff Kirsher /* Switch functions */
1571bcc9736cSJeff Kirsher
1572bcc9736cSJeff Kirsher #define TABLE_READ 0x10
1573bcc9736cSJeff Kirsher #define TABLE_SEL_SHIFT 2
1574bcc9736cSJeff Kirsher
1575bcc9736cSJeff Kirsher #define HW_DELAY(hw, reg) \
1576bcc9736cSJeff Kirsher do { \
15777c8c0291SJesse Brandeburg readw(hw->io + reg); \
1578bcc9736cSJeff Kirsher } while (0)
1579bcc9736cSJeff Kirsher
1580bcc9736cSJeff Kirsher /**
1581bcc9736cSJeff Kirsher * sw_r_table - read 4 bytes of data from switch table
1582bcc9736cSJeff Kirsher * @hw: The hardware instance.
1583bcc9736cSJeff Kirsher * @table: The table selector.
1584bcc9736cSJeff Kirsher * @addr: The address of the table entry.
1585bcc9736cSJeff Kirsher * @data: Buffer to store the read data.
1586bcc9736cSJeff Kirsher *
1587bcc9736cSJeff Kirsher * This routine reads 4 bytes of data from the table of the switch.
1588bcc9736cSJeff Kirsher * Hardware interrupts are disabled to minimize corruption of read data.
1589bcc9736cSJeff Kirsher */
sw_r_table(struct ksz_hw * hw,int table,u16 addr,u32 * data)1590bcc9736cSJeff Kirsher static void sw_r_table(struct ksz_hw *hw, int table, u16 addr, u32 *data)
1591bcc9736cSJeff Kirsher {
1592bcc9736cSJeff Kirsher u16 ctrl_addr;
1593bcc9736cSJeff Kirsher uint interrupt;
1594bcc9736cSJeff Kirsher
1595bcc9736cSJeff Kirsher ctrl_addr = (((table << TABLE_SEL_SHIFT) | TABLE_READ) << 8) | addr;
1596bcc9736cSJeff Kirsher
1597bcc9736cSJeff Kirsher interrupt = hw_block_intr(hw);
1598bcc9736cSJeff Kirsher
1599bcc9736cSJeff Kirsher writew(ctrl_addr, hw->io + KS884X_IACR_OFFSET);
1600bcc9736cSJeff Kirsher HW_DELAY(hw, KS884X_IACR_OFFSET);
1601bcc9736cSJeff Kirsher *data = readl(hw->io + KS884X_ACC_DATA_0_OFFSET);
1602bcc9736cSJeff Kirsher
1603bcc9736cSJeff Kirsher hw_restore_intr(hw, interrupt);
1604bcc9736cSJeff Kirsher }
1605bcc9736cSJeff Kirsher
1606bcc9736cSJeff Kirsher /**
1607bcc9736cSJeff Kirsher * sw_w_table_64 - write 8 bytes of data to the switch table
1608bcc9736cSJeff Kirsher * @hw: The hardware instance.
1609bcc9736cSJeff Kirsher * @table: The table selector.
1610bcc9736cSJeff Kirsher * @addr: The address of the table entry.
1611bcc9736cSJeff Kirsher * @data_hi: The high part of data to be written (bit63 ~ bit32).
1612bcc9736cSJeff Kirsher * @data_lo: The low part of data to be written (bit31 ~ bit0).
1613bcc9736cSJeff Kirsher *
1614bcc9736cSJeff Kirsher * This routine writes 8 bytes of data to the table of the switch.
1615bcc9736cSJeff Kirsher * Hardware interrupts are disabled to minimize corruption of written data.
1616bcc9736cSJeff Kirsher */
sw_w_table_64(struct ksz_hw * hw,int table,u16 addr,u32 data_hi,u32 data_lo)1617bcc9736cSJeff Kirsher static void sw_w_table_64(struct ksz_hw *hw, int table, u16 addr, u32 data_hi,
1618bcc9736cSJeff Kirsher u32 data_lo)
1619bcc9736cSJeff Kirsher {
1620bcc9736cSJeff Kirsher u16 ctrl_addr;
1621bcc9736cSJeff Kirsher uint interrupt;
1622bcc9736cSJeff Kirsher
1623bcc9736cSJeff Kirsher ctrl_addr = ((table << TABLE_SEL_SHIFT) << 8) | addr;
1624bcc9736cSJeff Kirsher
1625bcc9736cSJeff Kirsher interrupt = hw_block_intr(hw);
1626bcc9736cSJeff Kirsher
1627bcc9736cSJeff Kirsher writel(data_hi, hw->io + KS884X_ACC_DATA_4_OFFSET);
1628bcc9736cSJeff Kirsher writel(data_lo, hw->io + KS884X_ACC_DATA_0_OFFSET);
1629bcc9736cSJeff Kirsher
1630bcc9736cSJeff Kirsher writew(ctrl_addr, hw->io + KS884X_IACR_OFFSET);
1631bcc9736cSJeff Kirsher HW_DELAY(hw, KS884X_IACR_OFFSET);
1632bcc9736cSJeff Kirsher
1633bcc9736cSJeff Kirsher hw_restore_intr(hw, interrupt);
1634bcc9736cSJeff Kirsher }
1635bcc9736cSJeff Kirsher
1636bcc9736cSJeff Kirsher /**
1637bcc9736cSJeff Kirsher * sw_w_sta_mac_table - write to the static MAC table
1638bcc9736cSJeff Kirsher * @hw: The hardware instance.
1639bcc9736cSJeff Kirsher * @addr: The address of the table entry.
1640bcc9736cSJeff Kirsher * @mac_addr: The MAC address.
1641bcc9736cSJeff Kirsher * @ports: The port members.
1642bcc9736cSJeff Kirsher * @override: The flag to override the port receive/transmit settings.
1643bcc9736cSJeff Kirsher * @valid: The flag to indicate entry is valid.
1644bcc9736cSJeff Kirsher * @use_fid: The flag to indicate the FID is valid.
1645bcc9736cSJeff Kirsher * @fid: The FID value.
1646bcc9736cSJeff Kirsher *
1647bcc9736cSJeff Kirsher * This routine writes an entry of the static MAC table of the switch. It
1648bcc9736cSJeff Kirsher * calls sw_w_table_64() to write the data.
1649bcc9736cSJeff Kirsher */
sw_w_sta_mac_table(struct ksz_hw * hw,u16 addr,u8 * mac_addr,u8 ports,int override,int valid,int use_fid,u8 fid)1650bcc9736cSJeff Kirsher static void sw_w_sta_mac_table(struct ksz_hw *hw, u16 addr, u8 *mac_addr,
1651bcc9736cSJeff Kirsher u8 ports, int override, int valid, int use_fid, u8 fid)
1652bcc9736cSJeff Kirsher {
1653bcc9736cSJeff Kirsher u32 data_hi;
1654bcc9736cSJeff Kirsher u32 data_lo;
1655bcc9736cSJeff Kirsher
1656bcc9736cSJeff Kirsher data_lo = ((u32) mac_addr[2] << 24) |
1657bcc9736cSJeff Kirsher ((u32) mac_addr[3] << 16) |
1658bcc9736cSJeff Kirsher ((u32) mac_addr[4] << 8) | mac_addr[5];
1659bcc9736cSJeff Kirsher data_hi = ((u32) mac_addr[0] << 8) | mac_addr[1];
1660bcc9736cSJeff Kirsher data_hi |= (u32) ports << STATIC_MAC_FWD_PORTS_SHIFT;
1661bcc9736cSJeff Kirsher
1662bcc9736cSJeff Kirsher if (override)
1663bcc9736cSJeff Kirsher data_hi |= STATIC_MAC_TABLE_OVERRIDE;
1664bcc9736cSJeff Kirsher if (use_fid) {
1665bcc9736cSJeff Kirsher data_hi |= STATIC_MAC_TABLE_USE_FID;
1666bcc9736cSJeff Kirsher data_hi |= (u32) fid << STATIC_MAC_FID_SHIFT;
1667bcc9736cSJeff Kirsher }
1668bcc9736cSJeff Kirsher if (valid)
1669bcc9736cSJeff Kirsher data_hi |= STATIC_MAC_TABLE_VALID;
1670bcc9736cSJeff Kirsher
1671bcc9736cSJeff Kirsher sw_w_table_64(hw, TABLE_STATIC_MAC, addr, data_hi, data_lo);
1672bcc9736cSJeff Kirsher }
1673bcc9736cSJeff Kirsher
1674bcc9736cSJeff Kirsher /**
1675bcc9736cSJeff Kirsher * sw_r_vlan_table - read from the VLAN table
1676bcc9736cSJeff Kirsher * @hw: The hardware instance.
1677bcc9736cSJeff Kirsher * @addr: The address of the table entry.
1678bcc9736cSJeff Kirsher * @vid: Buffer to store the VID.
1679bcc9736cSJeff Kirsher * @fid: Buffer to store the VID.
1680bcc9736cSJeff Kirsher * @member: Buffer to store the port membership.
1681bcc9736cSJeff Kirsher *
1682bcc9736cSJeff Kirsher * This function reads an entry of the VLAN table of the switch. It calls
1683bcc9736cSJeff Kirsher * sw_r_table() to get the data.
1684bcc9736cSJeff Kirsher *
1685bcc9736cSJeff Kirsher * Return 0 if the entry is valid; otherwise -1.
1686bcc9736cSJeff Kirsher */
sw_r_vlan_table(struct ksz_hw * hw,u16 addr,u16 * vid,u8 * fid,u8 * member)1687bcc9736cSJeff Kirsher static int sw_r_vlan_table(struct ksz_hw *hw, u16 addr, u16 *vid, u8 *fid,
1688bcc9736cSJeff Kirsher u8 *member)
1689bcc9736cSJeff Kirsher {
1690bcc9736cSJeff Kirsher u32 data;
1691bcc9736cSJeff Kirsher
1692bcc9736cSJeff Kirsher sw_r_table(hw, TABLE_VLAN, addr, &data);
1693bcc9736cSJeff Kirsher if (data & VLAN_TABLE_VALID) {
1694bcc9736cSJeff Kirsher *vid = (u16)(data & VLAN_TABLE_VID);
1695bcc9736cSJeff Kirsher *fid = (u8)((data & VLAN_TABLE_FID) >> VLAN_TABLE_FID_SHIFT);
1696bcc9736cSJeff Kirsher *member = (u8)((data & VLAN_TABLE_MEMBERSHIP) >>
1697bcc9736cSJeff Kirsher VLAN_TABLE_MEMBERSHIP_SHIFT);
1698bcc9736cSJeff Kirsher return 0;
1699bcc9736cSJeff Kirsher }
1700bcc9736cSJeff Kirsher return -1;
1701bcc9736cSJeff Kirsher }
1702bcc9736cSJeff Kirsher
1703bcc9736cSJeff Kirsher /**
1704bcc9736cSJeff Kirsher * port_r_mib_cnt - read MIB counter
1705bcc9736cSJeff Kirsher * @hw: The hardware instance.
1706bcc9736cSJeff Kirsher * @port: The port index.
1707bcc9736cSJeff Kirsher * @addr: The address of the counter.
1708bcc9736cSJeff Kirsher * @cnt: Buffer to store the counter.
1709bcc9736cSJeff Kirsher *
1710bcc9736cSJeff Kirsher * This routine reads a MIB counter of the port.
1711bcc9736cSJeff Kirsher * Hardware interrupts are disabled to minimize corruption of read data.
1712bcc9736cSJeff Kirsher */
port_r_mib_cnt(struct ksz_hw * hw,int port,u16 addr,u64 * cnt)1713bcc9736cSJeff Kirsher static void port_r_mib_cnt(struct ksz_hw *hw, int port, u16 addr, u64 *cnt)
1714bcc9736cSJeff Kirsher {
1715bcc9736cSJeff Kirsher u32 data;
1716bcc9736cSJeff Kirsher u16 ctrl_addr;
1717bcc9736cSJeff Kirsher uint interrupt;
1718bcc9736cSJeff Kirsher int timeout;
1719bcc9736cSJeff Kirsher
1720bcc9736cSJeff Kirsher ctrl_addr = addr + PORT_COUNTER_NUM * port;
1721bcc9736cSJeff Kirsher
1722bcc9736cSJeff Kirsher interrupt = hw_block_intr(hw);
1723bcc9736cSJeff Kirsher
1724bcc9736cSJeff Kirsher ctrl_addr |= (((TABLE_MIB << TABLE_SEL_SHIFT) | TABLE_READ) << 8);
1725bcc9736cSJeff Kirsher writew(ctrl_addr, hw->io + KS884X_IACR_OFFSET);
1726bcc9736cSJeff Kirsher HW_DELAY(hw, KS884X_IACR_OFFSET);
1727bcc9736cSJeff Kirsher
1728bcc9736cSJeff Kirsher for (timeout = 100; timeout > 0; timeout--) {
1729bcc9736cSJeff Kirsher data = readl(hw->io + KS884X_ACC_DATA_0_OFFSET);
1730bcc9736cSJeff Kirsher
1731bcc9736cSJeff Kirsher if (data & MIB_COUNTER_VALID) {
1732bcc9736cSJeff Kirsher if (data & MIB_COUNTER_OVERFLOW)
1733bcc9736cSJeff Kirsher *cnt += MIB_COUNTER_VALUE + 1;
1734bcc9736cSJeff Kirsher *cnt += data & MIB_COUNTER_VALUE;
1735bcc9736cSJeff Kirsher break;
1736bcc9736cSJeff Kirsher }
1737bcc9736cSJeff Kirsher }
1738bcc9736cSJeff Kirsher
1739bcc9736cSJeff Kirsher hw_restore_intr(hw, interrupt);
1740bcc9736cSJeff Kirsher }
1741bcc9736cSJeff Kirsher
1742bcc9736cSJeff Kirsher /**
1743bcc9736cSJeff Kirsher * port_r_mib_pkt - read dropped packet counts
1744bcc9736cSJeff Kirsher * @hw: The hardware instance.
1745bcc9736cSJeff Kirsher * @port: The port index.
1746d0ea5cbdSJesse Brandeburg * @last: last one
1747bcc9736cSJeff Kirsher * @cnt: Buffer to store the receive and transmit dropped packet counts.
1748bcc9736cSJeff Kirsher *
1749bcc9736cSJeff Kirsher * This routine reads the dropped packet counts of the port.
1750bcc9736cSJeff Kirsher * Hardware interrupts are disabled to minimize corruption of read data.
1751bcc9736cSJeff Kirsher */
port_r_mib_pkt(struct ksz_hw * hw,int port,u32 * last,u64 * cnt)1752bcc9736cSJeff Kirsher static void port_r_mib_pkt(struct ksz_hw *hw, int port, u32 *last, u64 *cnt)
1753bcc9736cSJeff Kirsher {
1754bcc9736cSJeff Kirsher u32 cur;
1755bcc9736cSJeff Kirsher u32 data;
1756bcc9736cSJeff Kirsher u16 ctrl_addr;
1757bcc9736cSJeff Kirsher uint interrupt;
1758bcc9736cSJeff Kirsher int index;
1759bcc9736cSJeff Kirsher
1760bcc9736cSJeff Kirsher index = KS_MIB_PACKET_DROPPED_RX_0 + port;
1761bcc9736cSJeff Kirsher do {
1762bcc9736cSJeff Kirsher interrupt = hw_block_intr(hw);
1763bcc9736cSJeff Kirsher
1764bcc9736cSJeff Kirsher ctrl_addr = (u16) index;
1765bcc9736cSJeff Kirsher ctrl_addr |= (((TABLE_MIB << TABLE_SEL_SHIFT) | TABLE_READ)
1766bcc9736cSJeff Kirsher << 8);
1767bcc9736cSJeff Kirsher writew(ctrl_addr, hw->io + KS884X_IACR_OFFSET);
1768bcc9736cSJeff Kirsher HW_DELAY(hw, KS884X_IACR_OFFSET);
1769bcc9736cSJeff Kirsher data = readl(hw->io + KS884X_ACC_DATA_0_OFFSET);
1770bcc9736cSJeff Kirsher
1771bcc9736cSJeff Kirsher hw_restore_intr(hw, interrupt);
1772bcc9736cSJeff Kirsher
1773bcc9736cSJeff Kirsher data &= MIB_PACKET_DROPPED;
1774bcc9736cSJeff Kirsher cur = *last;
1775bcc9736cSJeff Kirsher if (data != cur) {
1776bcc9736cSJeff Kirsher *last = data;
1777bcc9736cSJeff Kirsher if (data < cur)
1778bcc9736cSJeff Kirsher data += MIB_PACKET_DROPPED + 1;
1779bcc9736cSJeff Kirsher data -= cur;
1780bcc9736cSJeff Kirsher *cnt += data;
1781bcc9736cSJeff Kirsher }
1782bcc9736cSJeff Kirsher ++last;
1783bcc9736cSJeff Kirsher ++cnt;
1784bcc9736cSJeff Kirsher index -= KS_MIB_PACKET_DROPPED_TX -
1785bcc9736cSJeff Kirsher KS_MIB_PACKET_DROPPED_TX_0 + 1;
1786bcc9736cSJeff Kirsher } while (index >= KS_MIB_PACKET_DROPPED_TX_0 + port);
1787bcc9736cSJeff Kirsher }
1788bcc9736cSJeff Kirsher
1789bcc9736cSJeff Kirsher /**
1790bcc9736cSJeff Kirsher * port_r_cnt - read MIB counters periodically
1791bcc9736cSJeff Kirsher * @hw: The hardware instance.
1792bcc9736cSJeff Kirsher * @port: The port index.
1793bcc9736cSJeff Kirsher *
1794bcc9736cSJeff Kirsher * This routine is used to read the counters of the port periodically to avoid
1795bcc9736cSJeff Kirsher * counter overflow. The hardware should be acquired first before calling this
1796bcc9736cSJeff Kirsher * routine.
1797bcc9736cSJeff Kirsher *
1798bcc9736cSJeff Kirsher * Return non-zero when not all counters not read.
1799bcc9736cSJeff Kirsher */
port_r_cnt(struct ksz_hw * hw,int port)1800bcc9736cSJeff Kirsher static int port_r_cnt(struct ksz_hw *hw, int port)
1801bcc9736cSJeff Kirsher {
1802bcc9736cSJeff Kirsher struct ksz_port_mib *mib = &hw->port_mib[port];
1803bcc9736cSJeff Kirsher
1804bcc9736cSJeff Kirsher if (mib->mib_start < PORT_COUNTER_NUM)
1805bcc9736cSJeff Kirsher while (mib->cnt_ptr < PORT_COUNTER_NUM) {
1806bcc9736cSJeff Kirsher port_r_mib_cnt(hw, port, mib->cnt_ptr,
1807bcc9736cSJeff Kirsher &mib->counter[mib->cnt_ptr]);
1808bcc9736cSJeff Kirsher ++mib->cnt_ptr;
1809bcc9736cSJeff Kirsher }
1810bcc9736cSJeff Kirsher if (hw->mib_cnt > PORT_COUNTER_NUM)
1811bcc9736cSJeff Kirsher port_r_mib_pkt(hw, port, mib->dropped,
1812bcc9736cSJeff Kirsher &mib->counter[PORT_COUNTER_NUM]);
1813bcc9736cSJeff Kirsher mib->cnt_ptr = 0;
1814bcc9736cSJeff Kirsher return 0;
1815bcc9736cSJeff Kirsher }
1816bcc9736cSJeff Kirsher
1817bcc9736cSJeff Kirsher /**
1818bcc9736cSJeff Kirsher * port_init_cnt - initialize MIB counter values
1819bcc9736cSJeff Kirsher * @hw: The hardware instance.
1820bcc9736cSJeff Kirsher * @port: The port index.
1821bcc9736cSJeff Kirsher *
1822bcc9736cSJeff Kirsher * This routine is used to initialize all counters to zero if the hardware
1823bcc9736cSJeff Kirsher * cannot do it after reset.
1824bcc9736cSJeff Kirsher */
port_init_cnt(struct ksz_hw * hw,int port)1825bcc9736cSJeff Kirsher static void port_init_cnt(struct ksz_hw *hw, int port)
1826bcc9736cSJeff Kirsher {
1827bcc9736cSJeff Kirsher struct ksz_port_mib *mib = &hw->port_mib[port];
1828bcc9736cSJeff Kirsher
1829bcc9736cSJeff Kirsher mib->cnt_ptr = 0;
1830bcc9736cSJeff Kirsher if (mib->mib_start < PORT_COUNTER_NUM)
1831bcc9736cSJeff Kirsher do {
1832bcc9736cSJeff Kirsher port_r_mib_cnt(hw, port, mib->cnt_ptr,
1833bcc9736cSJeff Kirsher &mib->counter[mib->cnt_ptr]);
1834bcc9736cSJeff Kirsher ++mib->cnt_ptr;
1835bcc9736cSJeff Kirsher } while (mib->cnt_ptr < PORT_COUNTER_NUM);
1836bcc9736cSJeff Kirsher if (hw->mib_cnt > PORT_COUNTER_NUM)
1837bcc9736cSJeff Kirsher port_r_mib_pkt(hw, port, mib->dropped,
1838bcc9736cSJeff Kirsher &mib->counter[PORT_COUNTER_NUM]);
1839bcc9736cSJeff Kirsher memset((void *) mib->counter, 0, sizeof(u64) * TOTAL_PORT_COUNTER_NUM);
1840bcc9736cSJeff Kirsher mib->cnt_ptr = 0;
1841bcc9736cSJeff Kirsher }
1842bcc9736cSJeff Kirsher
1843bcc9736cSJeff Kirsher /*
1844bcc9736cSJeff Kirsher * Port functions
1845bcc9736cSJeff Kirsher */
1846bcc9736cSJeff Kirsher
1847bcc9736cSJeff Kirsher /**
1848bcc9736cSJeff Kirsher * port_cfg - set port register bits
1849bcc9736cSJeff Kirsher * @hw: The hardware instance.
1850bcc9736cSJeff Kirsher * @port: The port index.
1851bcc9736cSJeff Kirsher * @offset: The offset of the port register.
1852bcc9736cSJeff Kirsher * @bits: The data bits to set.
1853bcc9736cSJeff Kirsher * @set: The flag indicating whether the bits are to be set or not.
1854bcc9736cSJeff Kirsher *
1855bcc9736cSJeff Kirsher * This routine sets or resets the specified bits of the port register.
1856bcc9736cSJeff Kirsher */
port_cfg(struct ksz_hw * hw,int port,int offset,u16 bits,int set)1857bcc9736cSJeff Kirsher static void port_cfg(struct ksz_hw *hw, int port, int offset, u16 bits,
1858bcc9736cSJeff Kirsher int set)
1859bcc9736cSJeff Kirsher {
1860bcc9736cSJeff Kirsher u32 addr;
1861bcc9736cSJeff Kirsher u16 data;
1862bcc9736cSJeff Kirsher
1863bcc9736cSJeff Kirsher PORT_CTRL_ADDR(port, addr);
1864bcc9736cSJeff Kirsher addr += offset;
1865bcc9736cSJeff Kirsher data = readw(hw->io + addr);
1866bcc9736cSJeff Kirsher if (set)
1867bcc9736cSJeff Kirsher data |= bits;
1868bcc9736cSJeff Kirsher else
1869bcc9736cSJeff Kirsher data &= ~bits;
1870bcc9736cSJeff Kirsher writew(data, hw->io + addr);
1871bcc9736cSJeff Kirsher }
1872bcc9736cSJeff Kirsher
1873bcc9736cSJeff Kirsher /**
1874bcc9736cSJeff Kirsher * port_r8 - read byte from port register
1875bcc9736cSJeff Kirsher * @hw: The hardware instance.
1876bcc9736cSJeff Kirsher * @port: The port index.
1877bcc9736cSJeff Kirsher * @offset: The offset of the port register.
1878bcc9736cSJeff Kirsher * @data: Buffer to store the data.
1879bcc9736cSJeff Kirsher *
1880bcc9736cSJeff Kirsher * This routine reads a byte from the port register.
1881bcc9736cSJeff Kirsher */
port_r8(struct ksz_hw * hw,int port,int offset,u8 * data)1882bcc9736cSJeff Kirsher static void port_r8(struct ksz_hw *hw, int port, int offset, u8 *data)
1883bcc9736cSJeff Kirsher {
1884bcc9736cSJeff Kirsher u32 addr;
1885bcc9736cSJeff Kirsher
1886bcc9736cSJeff Kirsher PORT_CTRL_ADDR(port, addr);
1887bcc9736cSJeff Kirsher addr += offset;
1888bcc9736cSJeff Kirsher *data = readb(hw->io + addr);
1889bcc9736cSJeff Kirsher }
1890bcc9736cSJeff Kirsher
1891bcc9736cSJeff Kirsher /**
1892bcc9736cSJeff Kirsher * port_r16 - read word from port register.
1893bcc9736cSJeff Kirsher * @hw: The hardware instance.
1894bcc9736cSJeff Kirsher * @port: The port index.
1895bcc9736cSJeff Kirsher * @offset: The offset of the port register.
1896bcc9736cSJeff Kirsher * @data: Buffer to store the data.
1897bcc9736cSJeff Kirsher *
1898bcc9736cSJeff Kirsher * This routine reads a word from the port register.
1899bcc9736cSJeff Kirsher */
port_r16(struct ksz_hw * hw,int port,int offset,u16 * data)1900bcc9736cSJeff Kirsher static void port_r16(struct ksz_hw *hw, int port, int offset, u16 *data)
1901bcc9736cSJeff Kirsher {
1902bcc9736cSJeff Kirsher u32 addr;
1903bcc9736cSJeff Kirsher
1904bcc9736cSJeff Kirsher PORT_CTRL_ADDR(port, addr);
1905bcc9736cSJeff Kirsher addr += offset;
1906bcc9736cSJeff Kirsher *data = readw(hw->io + addr);
1907bcc9736cSJeff Kirsher }
1908bcc9736cSJeff Kirsher
1909bcc9736cSJeff Kirsher /**
1910bcc9736cSJeff Kirsher * port_w16 - write word to port register.
1911bcc9736cSJeff Kirsher * @hw: The hardware instance.
1912bcc9736cSJeff Kirsher * @port: The port index.
1913bcc9736cSJeff Kirsher * @offset: The offset of the port register.
1914bcc9736cSJeff Kirsher * @data: Data to write.
1915bcc9736cSJeff Kirsher *
1916bcc9736cSJeff Kirsher * This routine writes a word to the port register.
1917bcc9736cSJeff Kirsher */
port_w16(struct ksz_hw * hw,int port,int offset,u16 data)1918bcc9736cSJeff Kirsher static void port_w16(struct ksz_hw *hw, int port, int offset, u16 data)
1919bcc9736cSJeff Kirsher {
1920bcc9736cSJeff Kirsher u32 addr;
1921bcc9736cSJeff Kirsher
1922bcc9736cSJeff Kirsher PORT_CTRL_ADDR(port, addr);
1923bcc9736cSJeff Kirsher addr += offset;
1924bcc9736cSJeff Kirsher writew(data, hw->io + addr);
1925bcc9736cSJeff Kirsher }
1926bcc9736cSJeff Kirsher
1927bcc9736cSJeff Kirsher /**
1928bcc9736cSJeff Kirsher * sw_chk - check switch register bits
1929bcc9736cSJeff Kirsher * @hw: The hardware instance.
1930bcc9736cSJeff Kirsher * @addr: The address of the switch register.
1931bcc9736cSJeff Kirsher * @bits: The data bits to check.
1932bcc9736cSJeff Kirsher *
1933bcc9736cSJeff Kirsher * This function checks whether the specified bits of the switch register are
1934bcc9736cSJeff Kirsher * set or not.
1935bcc9736cSJeff Kirsher *
1936bcc9736cSJeff Kirsher * Return 0 if the bits are not set.
1937bcc9736cSJeff Kirsher */
sw_chk(struct ksz_hw * hw,u32 addr,u16 bits)1938bcc9736cSJeff Kirsher static int sw_chk(struct ksz_hw *hw, u32 addr, u16 bits)
1939bcc9736cSJeff Kirsher {
1940bcc9736cSJeff Kirsher u16 data;
1941bcc9736cSJeff Kirsher
1942bcc9736cSJeff Kirsher data = readw(hw->io + addr);
1943bcc9736cSJeff Kirsher return (data & bits) == bits;
1944bcc9736cSJeff Kirsher }
1945bcc9736cSJeff Kirsher
1946bcc9736cSJeff Kirsher /**
1947bcc9736cSJeff Kirsher * sw_cfg - set switch register bits
1948bcc9736cSJeff Kirsher * @hw: The hardware instance.
1949bcc9736cSJeff Kirsher * @addr: The address of the switch register.
1950bcc9736cSJeff Kirsher * @bits: The data bits to set.
1951bcc9736cSJeff Kirsher * @set: The flag indicating whether the bits are to be set or not.
1952bcc9736cSJeff Kirsher *
1953bcc9736cSJeff Kirsher * This function sets or resets the specified bits of the switch register.
1954bcc9736cSJeff Kirsher */
sw_cfg(struct ksz_hw * hw,u32 addr,u16 bits,int set)1955bcc9736cSJeff Kirsher static void sw_cfg(struct ksz_hw *hw, u32 addr, u16 bits, int set)
1956bcc9736cSJeff Kirsher {
1957bcc9736cSJeff Kirsher u16 data;
1958bcc9736cSJeff Kirsher
1959bcc9736cSJeff Kirsher data = readw(hw->io + addr);
1960bcc9736cSJeff Kirsher if (set)
1961bcc9736cSJeff Kirsher data |= bits;
1962bcc9736cSJeff Kirsher else
1963bcc9736cSJeff Kirsher data &= ~bits;
1964bcc9736cSJeff Kirsher writew(data, hw->io + addr);
1965bcc9736cSJeff Kirsher }
1966bcc9736cSJeff Kirsher
1967bcc9736cSJeff Kirsher /* Bandwidth */
1968bcc9736cSJeff Kirsher
port_cfg_broad_storm(struct ksz_hw * hw,int p,int set)1969bcc9736cSJeff Kirsher static inline void port_cfg_broad_storm(struct ksz_hw *hw, int p, int set)
1970bcc9736cSJeff Kirsher {
1971bcc9736cSJeff Kirsher port_cfg(hw, p,
1972bcc9736cSJeff Kirsher KS8842_PORT_CTRL_1_OFFSET, PORT_BROADCAST_STORM, set);
1973bcc9736cSJeff Kirsher }
1974bcc9736cSJeff Kirsher
1975bcc9736cSJeff Kirsher /* Driver set switch broadcast storm protection at 10% rate. */
1976bcc9736cSJeff Kirsher #define BROADCAST_STORM_PROTECTION_RATE 10
1977bcc9736cSJeff Kirsher
1978bcc9736cSJeff Kirsher /* 148,800 frames * 67 ms / 100 */
1979bcc9736cSJeff Kirsher #define BROADCAST_STORM_VALUE 9969
1980bcc9736cSJeff Kirsher
1981bcc9736cSJeff Kirsher /**
1982bcc9736cSJeff Kirsher * sw_cfg_broad_storm - configure broadcast storm threshold
1983bcc9736cSJeff Kirsher * @hw: The hardware instance.
1984bcc9736cSJeff Kirsher * @percent: Broadcast storm threshold in percent of transmit rate.
1985bcc9736cSJeff Kirsher *
1986bcc9736cSJeff Kirsher * This routine configures the broadcast storm threshold of the switch.
1987bcc9736cSJeff Kirsher */
sw_cfg_broad_storm(struct ksz_hw * hw,u8 percent)1988bcc9736cSJeff Kirsher static void sw_cfg_broad_storm(struct ksz_hw *hw, u8 percent)
1989bcc9736cSJeff Kirsher {
1990bcc9736cSJeff Kirsher u16 data;
1991bcc9736cSJeff Kirsher u32 value = ((u32) BROADCAST_STORM_VALUE * (u32) percent / 100);
1992bcc9736cSJeff Kirsher
1993bcc9736cSJeff Kirsher if (value > BROADCAST_STORM_RATE)
1994bcc9736cSJeff Kirsher value = BROADCAST_STORM_RATE;
1995bcc9736cSJeff Kirsher
1996bcc9736cSJeff Kirsher data = readw(hw->io + KS8842_SWITCH_CTRL_3_OFFSET);
1997bcc9736cSJeff Kirsher data &= ~(BROADCAST_STORM_RATE_LO | BROADCAST_STORM_RATE_HI);
1998bcc9736cSJeff Kirsher data |= ((value & 0x00FF) << 8) | ((value & 0xFF00) >> 8);
1999bcc9736cSJeff Kirsher writew(data, hw->io + KS8842_SWITCH_CTRL_3_OFFSET);
2000bcc9736cSJeff Kirsher }
2001bcc9736cSJeff Kirsher
2002bcc9736cSJeff Kirsher /**
2003229fd41fSYang Shen * sw_get_broad_storm - get broadcast storm threshold
2004bcc9736cSJeff Kirsher * @hw: The hardware instance.
2005bcc9736cSJeff Kirsher * @percent: Buffer to store the broadcast storm threshold percentage.
2006bcc9736cSJeff Kirsher *
2007bcc9736cSJeff Kirsher * This routine retrieves the broadcast storm threshold of the switch.
2008bcc9736cSJeff Kirsher */
sw_get_broad_storm(struct ksz_hw * hw,u8 * percent)2009bcc9736cSJeff Kirsher static void sw_get_broad_storm(struct ksz_hw *hw, u8 *percent)
2010bcc9736cSJeff Kirsher {
2011bcc9736cSJeff Kirsher int num;
2012bcc9736cSJeff Kirsher u16 data;
2013bcc9736cSJeff Kirsher
2014bcc9736cSJeff Kirsher data = readw(hw->io + KS8842_SWITCH_CTRL_3_OFFSET);
2015bcc9736cSJeff Kirsher num = (data & BROADCAST_STORM_RATE_HI);
2016bcc9736cSJeff Kirsher num <<= 8;
2017bcc9736cSJeff Kirsher num |= (data & BROADCAST_STORM_RATE_LO) >> 8;
20189b789f47Szhong jiang num = DIV_ROUND_CLOSEST(num * 100, BROADCAST_STORM_VALUE);
2019bcc9736cSJeff Kirsher *percent = (u8) num;
2020bcc9736cSJeff Kirsher }
2021bcc9736cSJeff Kirsher
2022bcc9736cSJeff Kirsher /**
2023bcc9736cSJeff Kirsher * sw_dis_broad_storm - disable broadstorm
2024bcc9736cSJeff Kirsher * @hw: The hardware instance.
2025bcc9736cSJeff Kirsher * @port: The port index.
2026bcc9736cSJeff Kirsher *
2027bcc9736cSJeff Kirsher * This routine disables the broadcast storm limit function of the switch.
2028bcc9736cSJeff Kirsher */
sw_dis_broad_storm(struct ksz_hw * hw,int port)2029bcc9736cSJeff Kirsher static void sw_dis_broad_storm(struct ksz_hw *hw, int port)
2030bcc9736cSJeff Kirsher {
2031bcc9736cSJeff Kirsher port_cfg_broad_storm(hw, port, 0);
2032bcc9736cSJeff Kirsher }
2033bcc9736cSJeff Kirsher
2034bcc9736cSJeff Kirsher /**
2035bcc9736cSJeff Kirsher * sw_ena_broad_storm - enable broadcast storm
2036bcc9736cSJeff Kirsher * @hw: The hardware instance.
2037bcc9736cSJeff Kirsher * @port: The port index.
2038bcc9736cSJeff Kirsher *
2039bcc9736cSJeff Kirsher * This routine enables the broadcast storm limit function of the switch.
2040bcc9736cSJeff Kirsher */
sw_ena_broad_storm(struct ksz_hw * hw,int port)2041bcc9736cSJeff Kirsher static void sw_ena_broad_storm(struct ksz_hw *hw, int port)
2042bcc9736cSJeff Kirsher {
2043bcc9736cSJeff Kirsher sw_cfg_broad_storm(hw, hw->ksz_switch->broad_per);
2044bcc9736cSJeff Kirsher port_cfg_broad_storm(hw, port, 1);
2045bcc9736cSJeff Kirsher }
2046bcc9736cSJeff Kirsher
2047bcc9736cSJeff Kirsher /**
2048bcc9736cSJeff Kirsher * sw_init_broad_storm - initialize broadcast storm
2049bcc9736cSJeff Kirsher * @hw: The hardware instance.
2050bcc9736cSJeff Kirsher *
2051bcc9736cSJeff Kirsher * This routine initializes the broadcast storm limit function of the switch.
2052bcc9736cSJeff Kirsher */
sw_init_broad_storm(struct ksz_hw * hw)2053bcc9736cSJeff Kirsher static void sw_init_broad_storm(struct ksz_hw *hw)
2054bcc9736cSJeff Kirsher {
2055bcc9736cSJeff Kirsher int port;
2056bcc9736cSJeff Kirsher
2057bcc9736cSJeff Kirsher hw->ksz_switch->broad_per = 1;
2058bcc9736cSJeff Kirsher sw_cfg_broad_storm(hw, hw->ksz_switch->broad_per);
2059bcc9736cSJeff Kirsher for (port = 0; port < TOTAL_PORT_NUM; port++)
2060bcc9736cSJeff Kirsher sw_dis_broad_storm(hw, port);
2061bcc9736cSJeff Kirsher sw_cfg(hw, KS8842_SWITCH_CTRL_2_OFFSET, MULTICAST_STORM_DISABLE, 1);
2062bcc9736cSJeff Kirsher }
2063bcc9736cSJeff Kirsher
2064bcc9736cSJeff Kirsher /**
2065bcc9736cSJeff Kirsher * hw_cfg_broad_storm - configure broadcast storm
2066bcc9736cSJeff Kirsher * @hw: The hardware instance.
2067bcc9736cSJeff Kirsher * @percent: Broadcast storm threshold in percent of transmit rate.
2068bcc9736cSJeff Kirsher *
2069bcc9736cSJeff Kirsher * This routine configures the broadcast storm threshold of the switch.
2070bcc9736cSJeff Kirsher * It is called by user functions. The hardware should be acquired first.
2071bcc9736cSJeff Kirsher */
hw_cfg_broad_storm(struct ksz_hw * hw,u8 percent)2072bcc9736cSJeff Kirsher static void hw_cfg_broad_storm(struct ksz_hw *hw, u8 percent)
2073bcc9736cSJeff Kirsher {
2074bcc9736cSJeff Kirsher if (percent > 100)
2075bcc9736cSJeff Kirsher percent = 100;
2076bcc9736cSJeff Kirsher
2077bcc9736cSJeff Kirsher sw_cfg_broad_storm(hw, percent);
2078bcc9736cSJeff Kirsher sw_get_broad_storm(hw, &percent);
2079bcc9736cSJeff Kirsher hw->ksz_switch->broad_per = percent;
2080bcc9736cSJeff Kirsher }
2081bcc9736cSJeff Kirsher
2082bcc9736cSJeff Kirsher /**
2083bcc9736cSJeff Kirsher * sw_dis_prio_rate - disable switch priority rate
2084bcc9736cSJeff Kirsher * @hw: The hardware instance.
2085bcc9736cSJeff Kirsher * @port: The port index.
2086bcc9736cSJeff Kirsher *
2087bcc9736cSJeff Kirsher * This routine disables the priority rate function of the switch.
2088bcc9736cSJeff Kirsher */
sw_dis_prio_rate(struct ksz_hw * hw,int port)2089bcc9736cSJeff Kirsher static void sw_dis_prio_rate(struct ksz_hw *hw, int port)
2090bcc9736cSJeff Kirsher {
2091bcc9736cSJeff Kirsher u32 addr;
2092bcc9736cSJeff Kirsher
2093bcc9736cSJeff Kirsher PORT_CTRL_ADDR(port, addr);
2094bcc9736cSJeff Kirsher addr += KS8842_PORT_IN_RATE_OFFSET;
2095bcc9736cSJeff Kirsher writel(0, hw->io + addr);
2096bcc9736cSJeff Kirsher }
2097bcc9736cSJeff Kirsher
2098bcc9736cSJeff Kirsher /**
2099bcc9736cSJeff Kirsher * sw_init_prio_rate - initialize switch prioirty rate
2100bcc9736cSJeff Kirsher * @hw: The hardware instance.
2101bcc9736cSJeff Kirsher *
2102bcc9736cSJeff Kirsher * This routine initializes the priority rate function of the switch.
2103bcc9736cSJeff Kirsher */
sw_init_prio_rate(struct ksz_hw * hw)2104bcc9736cSJeff Kirsher static void sw_init_prio_rate(struct ksz_hw *hw)
2105bcc9736cSJeff Kirsher {
2106bcc9736cSJeff Kirsher int port;
2107bcc9736cSJeff Kirsher int prio;
2108bcc9736cSJeff Kirsher struct ksz_switch *sw = hw->ksz_switch;
2109bcc9736cSJeff Kirsher
2110bcc9736cSJeff Kirsher for (port = 0; port < TOTAL_PORT_NUM; port++) {
2111bcc9736cSJeff Kirsher for (prio = 0; prio < PRIO_QUEUES; prio++) {
2112bcc9736cSJeff Kirsher sw->port_cfg[port].rx_rate[prio] =
2113bcc9736cSJeff Kirsher sw->port_cfg[port].tx_rate[prio] = 0;
2114bcc9736cSJeff Kirsher }
2115bcc9736cSJeff Kirsher sw_dis_prio_rate(hw, port);
2116bcc9736cSJeff Kirsher }
2117bcc9736cSJeff Kirsher }
2118bcc9736cSJeff Kirsher
2119bcc9736cSJeff Kirsher /* Communication */
2120bcc9736cSJeff Kirsher
port_cfg_back_pressure(struct ksz_hw * hw,int p,int set)2121bcc9736cSJeff Kirsher static inline void port_cfg_back_pressure(struct ksz_hw *hw, int p, int set)
2122bcc9736cSJeff Kirsher {
2123bcc9736cSJeff Kirsher port_cfg(hw, p,
2124bcc9736cSJeff Kirsher KS8842_PORT_CTRL_2_OFFSET, PORT_BACK_PRESSURE, set);
2125bcc9736cSJeff Kirsher }
2126bcc9736cSJeff Kirsher
2127bcc9736cSJeff Kirsher /* Mirroring */
2128bcc9736cSJeff Kirsher
port_cfg_mirror_sniffer(struct ksz_hw * hw,int p,int set)2129bcc9736cSJeff Kirsher static inline void port_cfg_mirror_sniffer(struct ksz_hw *hw, int p, int set)
2130bcc9736cSJeff Kirsher {
2131bcc9736cSJeff Kirsher port_cfg(hw, p,
2132bcc9736cSJeff Kirsher KS8842_PORT_CTRL_2_OFFSET, PORT_MIRROR_SNIFFER, set);
2133bcc9736cSJeff Kirsher }
2134bcc9736cSJeff Kirsher
port_cfg_mirror_rx(struct ksz_hw * hw,int p,int set)2135bcc9736cSJeff Kirsher static inline void port_cfg_mirror_rx(struct ksz_hw *hw, int p, int set)
2136bcc9736cSJeff Kirsher {
2137bcc9736cSJeff Kirsher port_cfg(hw, p,
2138bcc9736cSJeff Kirsher KS8842_PORT_CTRL_2_OFFSET, PORT_MIRROR_RX, set);
2139bcc9736cSJeff Kirsher }
2140bcc9736cSJeff Kirsher
port_cfg_mirror_tx(struct ksz_hw * hw,int p,int set)2141bcc9736cSJeff Kirsher static inline void port_cfg_mirror_tx(struct ksz_hw *hw, int p, int set)
2142bcc9736cSJeff Kirsher {
2143bcc9736cSJeff Kirsher port_cfg(hw, p,
2144bcc9736cSJeff Kirsher KS8842_PORT_CTRL_2_OFFSET, PORT_MIRROR_TX, set);
2145bcc9736cSJeff Kirsher }
2146bcc9736cSJeff Kirsher
sw_cfg_mirror_rx_tx(struct ksz_hw * hw,int set)2147bcc9736cSJeff Kirsher static inline void sw_cfg_mirror_rx_tx(struct ksz_hw *hw, int set)
2148bcc9736cSJeff Kirsher {
2149bcc9736cSJeff Kirsher sw_cfg(hw, KS8842_SWITCH_CTRL_2_OFFSET, SWITCH_MIRROR_RX_TX, set);
2150bcc9736cSJeff Kirsher }
2151bcc9736cSJeff Kirsher
sw_init_mirror(struct ksz_hw * hw)2152bcc9736cSJeff Kirsher static void sw_init_mirror(struct ksz_hw *hw)
2153bcc9736cSJeff Kirsher {
2154bcc9736cSJeff Kirsher int port;
2155bcc9736cSJeff Kirsher
2156bcc9736cSJeff Kirsher for (port = 0; port < TOTAL_PORT_NUM; port++) {
2157bcc9736cSJeff Kirsher port_cfg_mirror_sniffer(hw, port, 0);
2158bcc9736cSJeff Kirsher port_cfg_mirror_rx(hw, port, 0);
2159bcc9736cSJeff Kirsher port_cfg_mirror_tx(hw, port, 0);
2160bcc9736cSJeff Kirsher }
2161bcc9736cSJeff Kirsher sw_cfg_mirror_rx_tx(hw, 0);
2162bcc9736cSJeff Kirsher }
2163bcc9736cSJeff Kirsher
2164bcc9736cSJeff Kirsher /* Priority */
2165bcc9736cSJeff Kirsher
port_cfg_diffserv(struct ksz_hw * hw,int p,int set)2166bcc9736cSJeff Kirsher static inline void port_cfg_diffserv(struct ksz_hw *hw, int p, int set)
2167bcc9736cSJeff Kirsher {
2168bcc9736cSJeff Kirsher port_cfg(hw, p,
2169bcc9736cSJeff Kirsher KS8842_PORT_CTRL_1_OFFSET, PORT_DIFFSERV_ENABLE, set);
2170bcc9736cSJeff Kirsher }
2171bcc9736cSJeff Kirsher
port_cfg_802_1p(struct ksz_hw * hw,int p,int set)2172bcc9736cSJeff Kirsher static inline void port_cfg_802_1p(struct ksz_hw *hw, int p, int set)
2173bcc9736cSJeff Kirsher {
2174bcc9736cSJeff Kirsher port_cfg(hw, p,
2175bcc9736cSJeff Kirsher KS8842_PORT_CTRL_1_OFFSET, PORT_802_1P_ENABLE, set);
2176bcc9736cSJeff Kirsher }
2177bcc9736cSJeff Kirsher
port_cfg_replace_vid(struct ksz_hw * hw,int p,int set)2178bcc9736cSJeff Kirsher static inline void port_cfg_replace_vid(struct ksz_hw *hw, int p, int set)
2179bcc9736cSJeff Kirsher {
2180bcc9736cSJeff Kirsher port_cfg(hw, p,
2181bcc9736cSJeff Kirsher KS8842_PORT_CTRL_2_OFFSET, PORT_USER_PRIORITY_CEILING, set);
2182bcc9736cSJeff Kirsher }
2183bcc9736cSJeff Kirsher
port_cfg_prio(struct ksz_hw * hw,int p,int set)2184bcc9736cSJeff Kirsher static inline void port_cfg_prio(struct ksz_hw *hw, int p, int set)
2185bcc9736cSJeff Kirsher {
2186bcc9736cSJeff Kirsher port_cfg(hw, p,
2187bcc9736cSJeff Kirsher KS8842_PORT_CTRL_1_OFFSET, PORT_PRIO_QUEUE_ENABLE, set);
2188bcc9736cSJeff Kirsher }
2189bcc9736cSJeff Kirsher
2190bcc9736cSJeff Kirsher /**
2191bcc9736cSJeff Kirsher * sw_dis_diffserv - disable switch DiffServ priority
2192bcc9736cSJeff Kirsher * @hw: The hardware instance.
2193bcc9736cSJeff Kirsher * @port: The port index.
2194bcc9736cSJeff Kirsher *
2195bcc9736cSJeff Kirsher * This routine disables the DiffServ priority function of the switch.
2196bcc9736cSJeff Kirsher */
sw_dis_diffserv(struct ksz_hw * hw,int port)2197bcc9736cSJeff Kirsher static void sw_dis_diffserv(struct ksz_hw *hw, int port)
2198bcc9736cSJeff Kirsher {
2199bcc9736cSJeff Kirsher port_cfg_diffserv(hw, port, 0);
2200bcc9736cSJeff Kirsher }
2201bcc9736cSJeff Kirsher
2202bcc9736cSJeff Kirsher /**
2203bcc9736cSJeff Kirsher * sw_dis_802_1p - disable switch 802.1p priority
2204bcc9736cSJeff Kirsher * @hw: The hardware instance.
2205bcc9736cSJeff Kirsher * @port: The port index.
2206bcc9736cSJeff Kirsher *
2207bcc9736cSJeff Kirsher * This routine disables the 802.1p priority function of the switch.
2208bcc9736cSJeff Kirsher */
sw_dis_802_1p(struct ksz_hw * hw,int port)2209bcc9736cSJeff Kirsher static void sw_dis_802_1p(struct ksz_hw *hw, int port)
2210bcc9736cSJeff Kirsher {
2211bcc9736cSJeff Kirsher port_cfg_802_1p(hw, port, 0);
2212bcc9736cSJeff Kirsher }
2213bcc9736cSJeff Kirsher
2214bcc9736cSJeff Kirsher /**
2215bcc9736cSJeff Kirsher * sw_cfg_replace_null_vid -
2216bcc9736cSJeff Kirsher * @hw: The hardware instance.
2217bcc9736cSJeff Kirsher * @set: The flag to disable or enable.
2218bcc9736cSJeff Kirsher *
2219bcc9736cSJeff Kirsher */
sw_cfg_replace_null_vid(struct ksz_hw * hw,int set)2220bcc9736cSJeff Kirsher static void sw_cfg_replace_null_vid(struct ksz_hw *hw, int set)
2221bcc9736cSJeff Kirsher {
2222bcc9736cSJeff Kirsher sw_cfg(hw, KS8842_SWITCH_CTRL_3_OFFSET, SWITCH_REPLACE_NULL_VID, set);
2223bcc9736cSJeff Kirsher }
2224bcc9736cSJeff Kirsher
2225bcc9736cSJeff Kirsher /**
2226bcc9736cSJeff Kirsher * sw_cfg_replace_vid - enable switch 802.10 priority re-mapping
2227bcc9736cSJeff Kirsher * @hw: The hardware instance.
2228bcc9736cSJeff Kirsher * @port: The port index.
2229bcc9736cSJeff Kirsher * @set: The flag to disable or enable.
2230bcc9736cSJeff Kirsher *
2231bcc9736cSJeff Kirsher * This routine enables the 802.1p priority re-mapping function of the switch.
2232bcc9736cSJeff Kirsher * That allows 802.1p priority field to be replaced with the port's default
2233bcc9736cSJeff Kirsher * tag's priority value if the ingress packet's 802.1p priority has a higher
2234bcc9736cSJeff Kirsher * priority than port's default tag's priority.
2235bcc9736cSJeff Kirsher */
sw_cfg_replace_vid(struct ksz_hw * hw,int port,int set)2236bcc9736cSJeff Kirsher static void sw_cfg_replace_vid(struct ksz_hw *hw, int port, int set)
2237bcc9736cSJeff Kirsher {
2238bcc9736cSJeff Kirsher port_cfg_replace_vid(hw, port, set);
2239bcc9736cSJeff Kirsher }
2240bcc9736cSJeff Kirsher
2241bcc9736cSJeff Kirsher /**
2242bcc9736cSJeff Kirsher * sw_cfg_port_based - configure switch port based priority
2243bcc9736cSJeff Kirsher * @hw: The hardware instance.
2244bcc9736cSJeff Kirsher * @port: The port index.
2245bcc9736cSJeff Kirsher * @prio: The priority to set.
2246bcc9736cSJeff Kirsher *
2247bcc9736cSJeff Kirsher * This routine configures the port based priority of the switch.
2248bcc9736cSJeff Kirsher */
sw_cfg_port_based(struct ksz_hw * hw,int port,u8 prio)2249bcc9736cSJeff Kirsher static void sw_cfg_port_based(struct ksz_hw *hw, int port, u8 prio)
2250bcc9736cSJeff Kirsher {
2251bcc9736cSJeff Kirsher u16 data;
2252bcc9736cSJeff Kirsher
2253bcc9736cSJeff Kirsher if (prio > PORT_BASED_PRIORITY_BASE)
2254bcc9736cSJeff Kirsher prio = PORT_BASED_PRIORITY_BASE;
2255bcc9736cSJeff Kirsher
2256bcc9736cSJeff Kirsher hw->ksz_switch->port_cfg[port].port_prio = prio;
2257bcc9736cSJeff Kirsher
2258bcc9736cSJeff Kirsher port_r16(hw, port, KS8842_PORT_CTRL_1_OFFSET, &data);
2259bcc9736cSJeff Kirsher data &= ~PORT_BASED_PRIORITY_MASK;
2260bcc9736cSJeff Kirsher data |= prio << PORT_BASED_PRIORITY_SHIFT;
2261bcc9736cSJeff Kirsher port_w16(hw, port, KS8842_PORT_CTRL_1_OFFSET, data);
2262bcc9736cSJeff Kirsher }
2263bcc9736cSJeff Kirsher
2264bcc9736cSJeff Kirsher /**
2265bcc9736cSJeff Kirsher * sw_dis_multi_queue - disable transmit multiple queues
2266bcc9736cSJeff Kirsher * @hw: The hardware instance.
2267bcc9736cSJeff Kirsher * @port: The port index.
2268bcc9736cSJeff Kirsher *
2269bcc9736cSJeff Kirsher * This routine disables the transmit multiple queues selection of the switch
2270bcc9736cSJeff Kirsher * port. Only single transmit queue on the port.
2271bcc9736cSJeff Kirsher */
sw_dis_multi_queue(struct ksz_hw * hw,int port)2272bcc9736cSJeff Kirsher static void sw_dis_multi_queue(struct ksz_hw *hw, int port)
2273bcc9736cSJeff Kirsher {
2274bcc9736cSJeff Kirsher port_cfg_prio(hw, port, 0);
2275bcc9736cSJeff Kirsher }
2276bcc9736cSJeff Kirsher
2277bcc9736cSJeff Kirsher /**
2278bcc9736cSJeff Kirsher * sw_init_prio - initialize switch priority
2279bcc9736cSJeff Kirsher * @hw: The hardware instance.
2280bcc9736cSJeff Kirsher *
2281bcc9736cSJeff Kirsher * This routine initializes the switch QoS priority functions.
2282bcc9736cSJeff Kirsher */
sw_init_prio(struct ksz_hw * hw)2283bcc9736cSJeff Kirsher static void sw_init_prio(struct ksz_hw *hw)
2284bcc9736cSJeff Kirsher {
2285bcc9736cSJeff Kirsher int port;
2286bcc9736cSJeff Kirsher int tos;
2287bcc9736cSJeff Kirsher struct ksz_switch *sw = hw->ksz_switch;
2288bcc9736cSJeff Kirsher
2289bcc9736cSJeff Kirsher /*
2290bcc9736cSJeff Kirsher * Init all the 802.1p tag priority value to be assigned to different
2291bcc9736cSJeff Kirsher * priority queue.
2292bcc9736cSJeff Kirsher */
2293bcc9736cSJeff Kirsher sw->p_802_1p[0] = 0;
2294bcc9736cSJeff Kirsher sw->p_802_1p[1] = 0;
2295bcc9736cSJeff Kirsher sw->p_802_1p[2] = 1;
2296bcc9736cSJeff Kirsher sw->p_802_1p[3] = 1;
2297bcc9736cSJeff Kirsher sw->p_802_1p[4] = 2;
2298bcc9736cSJeff Kirsher sw->p_802_1p[5] = 2;
2299bcc9736cSJeff Kirsher sw->p_802_1p[6] = 3;
2300bcc9736cSJeff Kirsher sw->p_802_1p[7] = 3;
2301bcc9736cSJeff Kirsher
2302bcc9736cSJeff Kirsher /*
2303bcc9736cSJeff Kirsher * Init all the DiffServ priority value to be assigned to priority
2304bcc9736cSJeff Kirsher * queue 0.
2305bcc9736cSJeff Kirsher */
2306bcc9736cSJeff Kirsher for (tos = 0; tos < DIFFSERV_ENTRIES; tos++)
2307bcc9736cSJeff Kirsher sw->diffserv[tos] = 0;
2308bcc9736cSJeff Kirsher
2309bcc9736cSJeff Kirsher /* All QoS functions disabled. */
2310bcc9736cSJeff Kirsher for (port = 0; port < TOTAL_PORT_NUM; port++) {
2311bcc9736cSJeff Kirsher sw_dis_multi_queue(hw, port);
2312bcc9736cSJeff Kirsher sw_dis_diffserv(hw, port);
2313bcc9736cSJeff Kirsher sw_dis_802_1p(hw, port);
2314bcc9736cSJeff Kirsher sw_cfg_replace_vid(hw, port, 0);
2315bcc9736cSJeff Kirsher
2316bcc9736cSJeff Kirsher sw->port_cfg[port].port_prio = 0;
2317bcc9736cSJeff Kirsher sw_cfg_port_based(hw, port, sw->port_cfg[port].port_prio);
2318bcc9736cSJeff Kirsher }
2319bcc9736cSJeff Kirsher sw_cfg_replace_null_vid(hw, 0);
2320bcc9736cSJeff Kirsher }
2321bcc9736cSJeff Kirsher
2322bcc9736cSJeff Kirsher /**
2323bcc9736cSJeff Kirsher * port_get_def_vid - get port default VID.
2324bcc9736cSJeff Kirsher * @hw: The hardware instance.
2325bcc9736cSJeff Kirsher * @port: The port index.
2326bcc9736cSJeff Kirsher * @vid: Buffer to store the VID.
2327bcc9736cSJeff Kirsher *
2328bcc9736cSJeff Kirsher * This routine retrieves the default VID of the port.
2329bcc9736cSJeff Kirsher */
port_get_def_vid(struct ksz_hw * hw,int port,u16 * vid)2330bcc9736cSJeff Kirsher static void port_get_def_vid(struct ksz_hw *hw, int port, u16 *vid)
2331bcc9736cSJeff Kirsher {
2332bcc9736cSJeff Kirsher u32 addr;
2333bcc9736cSJeff Kirsher
2334bcc9736cSJeff Kirsher PORT_CTRL_ADDR(port, addr);
2335bcc9736cSJeff Kirsher addr += KS8842_PORT_CTRL_VID_OFFSET;
2336bcc9736cSJeff Kirsher *vid = readw(hw->io + addr);
2337bcc9736cSJeff Kirsher }
2338bcc9736cSJeff Kirsher
2339bcc9736cSJeff Kirsher /**
2340bcc9736cSJeff Kirsher * sw_init_vlan - initialize switch VLAN
2341bcc9736cSJeff Kirsher * @hw: The hardware instance.
2342bcc9736cSJeff Kirsher *
2343bcc9736cSJeff Kirsher * This routine initializes the VLAN function of the switch.
2344bcc9736cSJeff Kirsher */
sw_init_vlan(struct ksz_hw * hw)2345bcc9736cSJeff Kirsher static void sw_init_vlan(struct ksz_hw *hw)
2346bcc9736cSJeff Kirsher {
2347bcc9736cSJeff Kirsher int port;
2348bcc9736cSJeff Kirsher int entry;
2349bcc9736cSJeff Kirsher struct ksz_switch *sw = hw->ksz_switch;
2350bcc9736cSJeff Kirsher
2351bcc9736cSJeff Kirsher /* Read 16 VLAN entries from device's VLAN table. */
2352bcc9736cSJeff Kirsher for (entry = 0; entry < VLAN_TABLE_ENTRIES; entry++) {
2353bcc9736cSJeff Kirsher sw_r_vlan_table(hw, entry,
2354bcc9736cSJeff Kirsher &sw->vlan_table[entry].vid,
2355bcc9736cSJeff Kirsher &sw->vlan_table[entry].fid,
2356bcc9736cSJeff Kirsher &sw->vlan_table[entry].member);
2357bcc9736cSJeff Kirsher }
2358bcc9736cSJeff Kirsher
2359bcc9736cSJeff Kirsher for (port = 0; port < TOTAL_PORT_NUM; port++) {
2360bcc9736cSJeff Kirsher port_get_def_vid(hw, port, &sw->port_cfg[port].vid);
2361bcc9736cSJeff Kirsher sw->port_cfg[port].member = PORT_MASK;
2362bcc9736cSJeff Kirsher }
2363bcc9736cSJeff Kirsher }
2364bcc9736cSJeff Kirsher
2365bcc9736cSJeff Kirsher /**
2366bcc9736cSJeff Kirsher * sw_cfg_port_base_vlan - configure port-based VLAN membership
2367bcc9736cSJeff Kirsher * @hw: The hardware instance.
2368bcc9736cSJeff Kirsher * @port: The port index.
2369bcc9736cSJeff Kirsher * @member: The port-based VLAN membership.
2370bcc9736cSJeff Kirsher *
2371bcc9736cSJeff Kirsher * This routine configures the port-based VLAN membership of the port.
2372bcc9736cSJeff Kirsher */
sw_cfg_port_base_vlan(struct ksz_hw * hw,int port,u8 member)2373bcc9736cSJeff Kirsher static void sw_cfg_port_base_vlan(struct ksz_hw *hw, int port, u8 member)
2374bcc9736cSJeff Kirsher {
2375bcc9736cSJeff Kirsher u32 addr;
2376bcc9736cSJeff Kirsher u8 data;
2377bcc9736cSJeff Kirsher
2378bcc9736cSJeff Kirsher PORT_CTRL_ADDR(port, addr);
2379bcc9736cSJeff Kirsher addr += KS8842_PORT_CTRL_2_OFFSET;
2380bcc9736cSJeff Kirsher
2381bcc9736cSJeff Kirsher data = readb(hw->io + addr);
2382bcc9736cSJeff Kirsher data &= ~PORT_VLAN_MEMBERSHIP;
2383bcc9736cSJeff Kirsher data |= (member & PORT_MASK);
2384bcc9736cSJeff Kirsher writeb(data, hw->io + addr);
2385bcc9736cSJeff Kirsher
2386bcc9736cSJeff Kirsher hw->ksz_switch->port_cfg[port].member = member;
2387bcc9736cSJeff Kirsher }
2388bcc9736cSJeff Kirsher
2389bcc9736cSJeff Kirsher /**
2390bcc9736cSJeff Kirsher * sw_set_addr - configure switch MAC address
2391bcc9736cSJeff Kirsher * @hw: The hardware instance.
2392bcc9736cSJeff Kirsher * @mac_addr: The MAC address.
2393bcc9736cSJeff Kirsher *
2394bcc9736cSJeff Kirsher * This function configures the MAC address of the switch.
2395bcc9736cSJeff Kirsher */
sw_set_addr(struct ksz_hw * hw,u8 * mac_addr)2396bcc9736cSJeff Kirsher static void sw_set_addr(struct ksz_hw *hw, u8 *mac_addr)
2397bcc9736cSJeff Kirsher {
2398bcc9736cSJeff Kirsher int i;
2399bcc9736cSJeff Kirsher
2400bcc9736cSJeff Kirsher for (i = 0; i < 6; i += 2) {
2401bcc9736cSJeff Kirsher writeb(mac_addr[i], hw->io + KS8842_MAC_ADDR_0_OFFSET + i);
2402bcc9736cSJeff Kirsher writeb(mac_addr[1 + i], hw->io + KS8842_MAC_ADDR_1_OFFSET + i);
2403bcc9736cSJeff Kirsher }
2404bcc9736cSJeff Kirsher }
2405bcc9736cSJeff Kirsher
2406bcc9736cSJeff Kirsher /**
2407bcc9736cSJeff Kirsher * sw_set_global_ctrl - set switch global control
2408bcc9736cSJeff Kirsher * @hw: The hardware instance.
2409bcc9736cSJeff Kirsher *
2410bcc9736cSJeff Kirsher * This routine sets the global control of the switch function.
2411bcc9736cSJeff Kirsher */
sw_set_global_ctrl(struct ksz_hw * hw)2412bcc9736cSJeff Kirsher static void sw_set_global_ctrl(struct ksz_hw *hw)
2413bcc9736cSJeff Kirsher {
2414bcc9736cSJeff Kirsher u16 data;
2415bcc9736cSJeff Kirsher
2416bcc9736cSJeff Kirsher /* Enable switch MII flow control. */
2417bcc9736cSJeff Kirsher data = readw(hw->io + KS8842_SWITCH_CTRL_3_OFFSET);
2418bcc9736cSJeff Kirsher data |= SWITCH_FLOW_CTRL;
2419bcc9736cSJeff Kirsher writew(data, hw->io + KS8842_SWITCH_CTRL_3_OFFSET);
2420bcc9736cSJeff Kirsher
2421bcc9736cSJeff Kirsher data = readw(hw->io + KS8842_SWITCH_CTRL_1_OFFSET);
2422bcc9736cSJeff Kirsher
2423bcc9736cSJeff Kirsher /* Enable aggressive back off algorithm in half duplex mode. */
2424bcc9736cSJeff Kirsher data |= SWITCH_AGGR_BACKOFF;
2425bcc9736cSJeff Kirsher
2426bcc9736cSJeff Kirsher /* Enable automatic fast aging when link changed detected. */
2427bcc9736cSJeff Kirsher data |= SWITCH_AGING_ENABLE;
2428bcc9736cSJeff Kirsher data |= SWITCH_LINK_AUTO_AGING;
2429bcc9736cSJeff Kirsher
2430bcc9736cSJeff Kirsher if (hw->overrides & FAST_AGING)
2431bcc9736cSJeff Kirsher data |= SWITCH_FAST_AGING;
2432bcc9736cSJeff Kirsher else
2433bcc9736cSJeff Kirsher data &= ~SWITCH_FAST_AGING;
2434bcc9736cSJeff Kirsher writew(data, hw->io + KS8842_SWITCH_CTRL_1_OFFSET);
2435bcc9736cSJeff Kirsher
2436bcc9736cSJeff Kirsher data = readw(hw->io + KS8842_SWITCH_CTRL_2_OFFSET);
2437bcc9736cSJeff Kirsher
2438bcc9736cSJeff Kirsher /* Enable no excessive collision drop. */
2439bcc9736cSJeff Kirsher data |= NO_EXC_COLLISION_DROP;
2440bcc9736cSJeff Kirsher writew(data, hw->io + KS8842_SWITCH_CTRL_2_OFFSET);
2441bcc9736cSJeff Kirsher }
2442bcc9736cSJeff Kirsher
2443bcc9736cSJeff Kirsher enum {
2444bcc9736cSJeff Kirsher STP_STATE_DISABLED = 0,
2445bcc9736cSJeff Kirsher STP_STATE_LISTENING,
2446bcc9736cSJeff Kirsher STP_STATE_LEARNING,
2447bcc9736cSJeff Kirsher STP_STATE_FORWARDING,
2448bcc9736cSJeff Kirsher STP_STATE_BLOCKED,
2449bcc9736cSJeff Kirsher STP_STATE_SIMPLE
2450bcc9736cSJeff Kirsher };
2451bcc9736cSJeff Kirsher
2452bcc9736cSJeff Kirsher /**
2453bcc9736cSJeff Kirsher * port_set_stp_state - configure port spanning tree state
2454bcc9736cSJeff Kirsher * @hw: The hardware instance.
2455bcc9736cSJeff Kirsher * @port: The port index.
2456bcc9736cSJeff Kirsher * @state: The spanning tree state.
2457bcc9736cSJeff Kirsher *
2458bcc9736cSJeff Kirsher * This routine configures the spanning tree state of the port.
2459bcc9736cSJeff Kirsher */
port_set_stp_state(struct ksz_hw * hw,int port,int state)2460bcc9736cSJeff Kirsher static void port_set_stp_state(struct ksz_hw *hw, int port, int state)
2461bcc9736cSJeff Kirsher {
2462bcc9736cSJeff Kirsher u16 data;
2463bcc9736cSJeff Kirsher
2464bcc9736cSJeff Kirsher port_r16(hw, port, KS8842_PORT_CTRL_2_OFFSET, &data);
2465bcc9736cSJeff Kirsher switch (state) {
2466bcc9736cSJeff Kirsher case STP_STATE_DISABLED:
2467bcc9736cSJeff Kirsher data &= ~(PORT_TX_ENABLE | PORT_RX_ENABLE);
2468bcc9736cSJeff Kirsher data |= PORT_LEARN_DISABLE;
2469bcc9736cSJeff Kirsher break;
2470bcc9736cSJeff Kirsher case STP_STATE_LISTENING:
2471bcc9736cSJeff Kirsher /*
2472bcc9736cSJeff Kirsher * No need to turn on transmit because of port direct mode.
2473bcc9736cSJeff Kirsher * Turning on receive is required if static MAC table is not setup.
2474bcc9736cSJeff Kirsher */
2475bcc9736cSJeff Kirsher data &= ~PORT_TX_ENABLE;
2476bcc9736cSJeff Kirsher data |= PORT_RX_ENABLE;
2477bcc9736cSJeff Kirsher data |= PORT_LEARN_DISABLE;
2478bcc9736cSJeff Kirsher break;
2479bcc9736cSJeff Kirsher case STP_STATE_LEARNING:
2480bcc9736cSJeff Kirsher data &= ~PORT_TX_ENABLE;
2481bcc9736cSJeff Kirsher data |= PORT_RX_ENABLE;
2482bcc9736cSJeff Kirsher data &= ~PORT_LEARN_DISABLE;
2483bcc9736cSJeff Kirsher break;
2484bcc9736cSJeff Kirsher case STP_STATE_FORWARDING:
2485bcc9736cSJeff Kirsher data |= (PORT_TX_ENABLE | PORT_RX_ENABLE);
2486bcc9736cSJeff Kirsher data &= ~PORT_LEARN_DISABLE;
2487bcc9736cSJeff Kirsher break;
2488bcc9736cSJeff Kirsher case STP_STATE_BLOCKED:
2489bcc9736cSJeff Kirsher /*
2490bcc9736cSJeff Kirsher * Need to setup static MAC table with override to keep receiving BPDU
2491bcc9736cSJeff Kirsher * messages. See sw_init_stp routine.
2492bcc9736cSJeff Kirsher */
2493bcc9736cSJeff Kirsher data &= ~(PORT_TX_ENABLE | PORT_RX_ENABLE);
2494bcc9736cSJeff Kirsher data |= PORT_LEARN_DISABLE;
2495bcc9736cSJeff Kirsher break;
2496bcc9736cSJeff Kirsher case STP_STATE_SIMPLE:
2497bcc9736cSJeff Kirsher data |= (PORT_TX_ENABLE | PORT_RX_ENABLE);
2498bcc9736cSJeff Kirsher data |= PORT_LEARN_DISABLE;
2499bcc9736cSJeff Kirsher break;
2500bcc9736cSJeff Kirsher }
2501bcc9736cSJeff Kirsher port_w16(hw, port, KS8842_PORT_CTRL_2_OFFSET, data);
2502bcc9736cSJeff Kirsher hw->ksz_switch->port_cfg[port].stp_state = state;
2503bcc9736cSJeff Kirsher }
2504bcc9736cSJeff Kirsher
2505bcc9736cSJeff Kirsher #define STP_ENTRY 0
2506bcc9736cSJeff Kirsher #define BROADCAST_ENTRY 1
2507bcc9736cSJeff Kirsher #define BRIDGE_ADDR_ENTRY 2
2508bcc9736cSJeff Kirsher #define IPV6_ADDR_ENTRY 3
2509bcc9736cSJeff Kirsher
2510bcc9736cSJeff Kirsher /**
2511bcc9736cSJeff Kirsher * sw_clr_sta_mac_table - clear static MAC table
2512bcc9736cSJeff Kirsher * @hw: The hardware instance.
2513bcc9736cSJeff Kirsher *
2514bcc9736cSJeff Kirsher * This routine clears the static MAC table.
2515bcc9736cSJeff Kirsher */
sw_clr_sta_mac_table(struct ksz_hw * hw)2516bcc9736cSJeff Kirsher static void sw_clr_sta_mac_table(struct ksz_hw *hw)
2517bcc9736cSJeff Kirsher {
2518bcc9736cSJeff Kirsher struct ksz_mac_table *entry;
2519bcc9736cSJeff Kirsher int i;
2520bcc9736cSJeff Kirsher
2521bcc9736cSJeff Kirsher for (i = 0; i < STATIC_MAC_TABLE_ENTRIES; i++) {
2522bcc9736cSJeff Kirsher entry = &hw->ksz_switch->mac_table[i];
2523bcc9736cSJeff Kirsher sw_w_sta_mac_table(hw, i,
2524bcc9736cSJeff Kirsher entry->mac_addr, entry->ports,
2525bcc9736cSJeff Kirsher entry->override, 0,
2526bcc9736cSJeff Kirsher entry->use_fid, entry->fid);
2527bcc9736cSJeff Kirsher }
2528bcc9736cSJeff Kirsher }
2529bcc9736cSJeff Kirsher
2530bcc9736cSJeff Kirsher /**
2531bcc9736cSJeff Kirsher * sw_init_stp - initialize switch spanning tree support
2532bcc9736cSJeff Kirsher * @hw: The hardware instance.
2533bcc9736cSJeff Kirsher *
2534bcc9736cSJeff Kirsher * This routine initializes the spanning tree support of the switch.
2535bcc9736cSJeff Kirsher */
sw_init_stp(struct ksz_hw * hw)2536bcc9736cSJeff Kirsher static void sw_init_stp(struct ksz_hw *hw)
2537bcc9736cSJeff Kirsher {
2538bcc9736cSJeff Kirsher struct ksz_mac_table *entry;
2539bcc9736cSJeff Kirsher
2540bcc9736cSJeff Kirsher entry = &hw->ksz_switch->mac_table[STP_ENTRY];
2541bcc9736cSJeff Kirsher entry->mac_addr[0] = 0x01;
2542bcc9736cSJeff Kirsher entry->mac_addr[1] = 0x80;
2543bcc9736cSJeff Kirsher entry->mac_addr[2] = 0xC2;
2544bcc9736cSJeff Kirsher entry->mac_addr[3] = 0x00;
2545bcc9736cSJeff Kirsher entry->mac_addr[4] = 0x00;
2546bcc9736cSJeff Kirsher entry->mac_addr[5] = 0x00;
2547bcc9736cSJeff Kirsher entry->ports = HOST_MASK;
2548bcc9736cSJeff Kirsher entry->override = 1;
2549bcc9736cSJeff Kirsher entry->valid = 1;
2550bcc9736cSJeff Kirsher sw_w_sta_mac_table(hw, STP_ENTRY,
2551bcc9736cSJeff Kirsher entry->mac_addr, entry->ports,
2552bcc9736cSJeff Kirsher entry->override, entry->valid,
2553bcc9736cSJeff Kirsher entry->use_fid, entry->fid);
2554bcc9736cSJeff Kirsher }
2555bcc9736cSJeff Kirsher
2556bcc9736cSJeff Kirsher /**
2557bcc9736cSJeff Kirsher * sw_block_addr - block certain packets from the host port
2558bcc9736cSJeff Kirsher * @hw: The hardware instance.
2559bcc9736cSJeff Kirsher *
2560bcc9736cSJeff Kirsher * This routine blocks certain packets from reaching to the host port.
2561bcc9736cSJeff Kirsher */
sw_block_addr(struct ksz_hw * hw)2562bcc9736cSJeff Kirsher static void sw_block_addr(struct ksz_hw *hw)
2563bcc9736cSJeff Kirsher {
2564bcc9736cSJeff Kirsher struct ksz_mac_table *entry;
2565bcc9736cSJeff Kirsher int i;
2566bcc9736cSJeff Kirsher
2567bcc9736cSJeff Kirsher for (i = BROADCAST_ENTRY; i <= IPV6_ADDR_ENTRY; i++) {
2568bcc9736cSJeff Kirsher entry = &hw->ksz_switch->mac_table[i];
2569bcc9736cSJeff Kirsher entry->valid = 0;
2570bcc9736cSJeff Kirsher sw_w_sta_mac_table(hw, i,
2571bcc9736cSJeff Kirsher entry->mac_addr, entry->ports,
2572bcc9736cSJeff Kirsher entry->override, entry->valid,
2573bcc9736cSJeff Kirsher entry->use_fid, entry->fid);
2574bcc9736cSJeff Kirsher }
2575bcc9736cSJeff Kirsher }
2576bcc9736cSJeff Kirsher
hw_r_phy_ctrl(struct ksz_hw * hw,int phy,u16 * data)2577bcc9736cSJeff Kirsher static inline void hw_r_phy_ctrl(struct ksz_hw *hw, int phy, u16 *data)
2578bcc9736cSJeff Kirsher {
2579bcc9736cSJeff Kirsher *data = readw(hw->io + phy + KS884X_PHY_CTRL_OFFSET);
2580bcc9736cSJeff Kirsher }
2581bcc9736cSJeff Kirsher
hw_w_phy_ctrl(struct ksz_hw * hw,int phy,u16 data)2582bcc9736cSJeff Kirsher static inline void hw_w_phy_ctrl(struct ksz_hw *hw, int phy, u16 data)
2583bcc9736cSJeff Kirsher {
2584bcc9736cSJeff Kirsher writew(data, hw->io + phy + KS884X_PHY_CTRL_OFFSET);
2585bcc9736cSJeff Kirsher }
2586bcc9736cSJeff Kirsher
2587bcc9736cSJeff Kirsher /**
2588bcc9736cSJeff Kirsher * hw_r_phy - read data from PHY register
2589bcc9736cSJeff Kirsher * @hw: The hardware instance.
2590bcc9736cSJeff Kirsher * @port: Port to read.
2591bcc9736cSJeff Kirsher * @reg: PHY register to read.
2592bcc9736cSJeff Kirsher * @val: Buffer to store the read data.
2593bcc9736cSJeff Kirsher *
2594bcc9736cSJeff Kirsher * This routine reads data from the PHY register.
2595bcc9736cSJeff Kirsher */
hw_r_phy(struct ksz_hw * hw,int port,u16 reg,u16 * val)2596bcc9736cSJeff Kirsher static void hw_r_phy(struct ksz_hw *hw, int port, u16 reg, u16 *val)
2597bcc9736cSJeff Kirsher {
2598bcc9736cSJeff Kirsher int phy;
2599bcc9736cSJeff Kirsher
2600bcc9736cSJeff Kirsher phy = KS884X_PHY_1_CTRL_OFFSET + port * PHY_CTRL_INTERVAL + reg;
2601bcc9736cSJeff Kirsher *val = readw(hw->io + phy);
2602bcc9736cSJeff Kirsher }
2603bcc9736cSJeff Kirsher
2604bcc9736cSJeff Kirsher /**
2605229fd41fSYang Shen * hw_w_phy - write data to PHY register
2606bcc9736cSJeff Kirsher * @hw: The hardware instance.
2607bcc9736cSJeff Kirsher * @port: Port to write.
2608bcc9736cSJeff Kirsher * @reg: PHY register to write.
2609bcc9736cSJeff Kirsher * @val: Word data to write.
2610bcc9736cSJeff Kirsher *
2611bcc9736cSJeff Kirsher * This routine writes data to the PHY register.
2612bcc9736cSJeff Kirsher */
hw_w_phy(struct ksz_hw * hw,int port,u16 reg,u16 val)2613bcc9736cSJeff Kirsher static void hw_w_phy(struct ksz_hw *hw, int port, u16 reg, u16 val)
2614bcc9736cSJeff Kirsher {
2615bcc9736cSJeff Kirsher int phy;
2616bcc9736cSJeff Kirsher
2617bcc9736cSJeff Kirsher phy = KS884X_PHY_1_CTRL_OFFSET + port * PHY_CTRL_INTERVAL + reg;
2618bcc9736cSJeff Kirsher writew(val, hw->io + phy);
2619bcc9736cSJeff Kirsher }
2620bcc9736cSJeff Kirsher
2621bcc9736cSJeff Kirsher /*
2622bcc9736cSJeff Kirsher * EEPROM access functions
2623bcc9736cSJeff Kirsher */
2624bcc9736cSJeff Kirsher
2625bcc9736cSJeff Kirsher #define AT93C_CODE 0
2626bcc9736cSJeff Kirsher #define AT93C_WR_OFF 0x00
2627bcc9736cSJeff Kirsher #define AT93C_WR_ALL 0x10
2628bcc9736cSJeff Kirsher #define AT93C_ER_ALL 0x20
2629bcc9736cSJeff Kirsher #define AT93C_WR_ON 0x30
2630bcc9736cSJeff Kirsher
2631bcc9736cSJeff Kirsher #define AT93C_WRITE 1
2632bcc9736cSJeff Kirsher #define AT93C_READ 2
2633bcc9736cSJeff Kirsher #define AT93C_ERASE 3
2634bcc9736cSJeff Kirsher
2635bcc9736cSJeff Kirsher #define EEPROM_DELAY 4
2636bcc9736cSJeff Kirsher
drop_gpio(struct ksz_hw * hw,u8 gpio)2637bcc9736cSJeff Kirsher static inline void drop_gpio(struct ksz_hw *hw, u8 gpio)
2638bcc9736cSJeff Kirsher {
2639bcc9736cSJeff Kirsher u16 data;
2640bcc9736cSJeff Kirsher
2641bcc9736cSJeff Kirsher data = readw(hw->io + KS884X_EEPROM_CTRL_OFFSET);
2642bcc9736cSJeff Kirsher data &= ~gpio;
2643bcc9736cSJeff Kirsher writew(data, hw->io + KS884X_EEPROM_CTRL_OFFSET);
2644bcc9736cSJeff Kirsher }
2645bcc9736cSJeff Kirsher
raise_gpio(struct ksz_hw * hw,u8 gpio)2646bcc9736cSJeff Kirsher static inline void raise_gpio(struct ksz_hw *hw, u8 gpio)
2647bcc9736cSJeff Kirsher {
2648bcc9736cSJeff Kirsher u16 data;
2649bcc9736cSJeff Kirsher
2650bcc9736cSJeff Kirsher data = readw(hw->io + KS884X_EEPROM_CTRL_OFFSET);
2651bcc9736cSJeff Kirsher data |= gpio;
2652bcc9736cSJeff Kirsher writew(data, hw->io + KS884X_EEPROM_CTRL_OFFSET);
2653bcc9736cSJeff Kirsher }
2654bcc9736cSJeff Kirsher
state_gpio(struct ksz_hw * hw,u8 gpio)2655bcc9736cSJeff Kirsher static inline u8 state_gpio(struct ksz_hw *hw, u8 gpio)
2656bcc9736cSJeff Kirsher {
2657bcc9736cSJeff Kirsher u16 data;
2658bcc9736cSJeff Kirsher
2659bcc9736cSJeff Kirsher data = readw(hw->io + KS884X_EEPROM_CTRL_OFFSET);
2660bcc9736cSJeff Kirsher return (u8)(data & gpio);
2661bcc9736cSJeff Kirsher }
2662bcc9736cSJeff Kirsher
eeprom_clk(struct ksz_hw * hw)2663bcc9736cSJeff Kirsher static void eeprom_clk(struct ksz_hw *hw)
2664bcc9736cSJeff Kirsher {
2665bcc9736cSJeff Kirsher raise_gpio(hw, EEPROM_SERIAL_CLOCK);
2666bcc9736cSJeff Kirsher udelay(EEPROM_DELAY);
2667bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_SERIAL_CLOCK);
2668bcc9736cSJeff Kirsher udelay(EEPROM_DELAY);
2669bcc9736cSJeff Kirsher }
2670bcc9736cSJeff Kirsher
spi_r(struct ksz_hw * hw)2671bcc9736cSJeff Kirsher static u16 spi_r(struct ksz_hw *hw)
2672bcc9736cSJeff Kirsher {
2673bcc9736cSJeff Kirsher int i;
2674bcc9736cSJeff Kirsher u16 temp = 0;
2675bcc9736cSJeff Kirsher
2676bcc9736cSJeff Kirsher for (i = 15; i >= 0; i--) {
2677bcc9736cSJeff Kirsher raise_gpio(hw, EEPROM_SERIAL_CLOCK);
2678bcc9736cSJeff Kirsher udelay(EEPROM_DELAY);
2679bcc9736cSJeff Kirsher
2680bcc9736cSJeff Kirsher temp |= (state_gpio(hw, EEPROM_DATA_IN)) ? 1 << i : 0;
2681bcc9736cSJeff Kirsher
2682bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_SERIAL_CLOCK);
2683bcc9736cSJeff Kirsher udelay(EEPROM_DELAY);
2684bcc9736cSJeff Kirsher }
2685bcc9736cSJeff Kirsher return temp;
2686bcc9736cSJeff Kirsher }
2687bcc9736cSJeff Kirsher
spi_w(struct ksz_hw * hw,u16 data)2688bcc9736cSJeff Kirsher static void spi_w(struct ksz_hw *hw, u16 data)
2689bcc9736cSJeff Kirsher {
2690bcc9736cSJeff Kirsher int i;
2691bcc9736cSJeff Kirsher
2692bcc9736cSJeff Kirsher for (i = 15; i >= 0; i--) {
2693bcc9736cSJeff Kirsher (data & (0x01 << i)) ? raise_gpio(hw, EEPROM_DATA_OUT) :
2694bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_DATA_OUT);
2695bcc9736cSJeff Kirsher eeprom_clk(hw);
2696bcc9736cSJeff Kirsher }
2697bcc9736cSJeff Kirsher }
2698bcc9736cSJeff Kirsher
spi_reg(struct ksz_hw * hw,u8 data,u8 reg)2699bcc9736cSJeff Kirsher static void spi_reg(struct ksz_hw *hw, u8 data, u8 reg)
2700bcc9736cSJeff Kirsher {
2701bcc9736cSJeff Kirsher int i;
2702bcc9736cSJeff Kirsher
2703bcc9736cSJeff Kirsher /* Initial start bit */
2704bcc9736cSJeff Kirsher raise_gpio(hw, EEPROM_DATA_OUT);
2705bcc9736cSJeff Kirsher eeprom_clk(hw);
2706bcc9736cSJeff Kirsher
2707bcc9736cSJeff Kirsher /* AT93C operation */
2708bcc9736cSJeff Kirsher for (i = 1; i >= 0; i--) {
2709bcc9736cSJeff Kirsher (data & (0x01 << i)) ? raise_gpio(hw, EEPROM_DATA_OUT) :
2710bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_DATA_OUT);
2711bcc9736cSJeff Kirsher eeprom_clk(hw);
2712bcc9736cSJeff Kirsher }
2713bcc9736cSJeff Kirsher
2714bcc9736cSJeff Kirsher /* Address location */
2715bcc9736cSJeff Kirsher for (i = 5; i >= 0; i--) {
2716bcc9736cSJeff Kirsher (reg & (0x01 << i)) ? raise_gpio(hw, EEPROM_DATA_OUT) :
2717bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_DATA_OUT);
2718bcc9736cSJeff Kirsher eeprom_clk(hw);
2719bcc9736cSJeff Kirsher }
2720bcc9736cSJeff Kirsher }
2721bcc9736cSJeff Kirsher
2722bcc9736cSJeff Kirsher #define EEPROM_DATA_RESERVED 0
2723bcc9736cSJeff Kirsher #define EEPROM_DATA_MAC_ADDR_0 1
2724bcc9736cSJeff Kirsher #define EEPROM_DATA_MAC_ADDR_1 2
2725bcc9736cSJeff Kirsher #define EEPROM_DATA_MAC_ADDR_2 3
2726bcc9736cSJeff Kirsher #define EEPROM_DATA_SUBSYS_ID 4
2727bcc9736cSJeff Kirsher #define EEPROM_DATA_SUBSYS_VEN_ID 5
2728bcc9736cSJeff Kirsher #define EEPROM_DATA_PM_CAP 6
2729bcc9736cSJeff Kirsher
2730bcc9736cSJeff Kirsher /* User defined EEPROM data */
2731bcc9736cSJeff Kirsher #define EEPROM_DATA_OTHER_MAC_ADDR 9
2732bcc9736cSJeff Kirsher
2733bcc9736cSJeff Kirsher /**
2734bcc9736cSJeff Kirsher * eeprom_read - read from AT93C46 EEPROM
2735bcc9736cSJeff Kirsher * @hw: The hardware instance.
2736bcc9736cSJeff Kirsher * @reg: The register offset.
2737bcc9736cSJeff Kirsher *
2738bcc9736cSJeff Kirsher * This function reads a word from the AT93C46 EEPROM.
2739bcc9736cSJeff Kirsher *
2740bcc9736cSJeff Kirsher * Return the data value.
2741bcc9736cSJeff Kirsher */
eeprom_read(struct ksz_hw * hw,u8 reg)2742bcc9736cSJeff Kirsher static u16 eeprom_read(struct ksz_hw *hw, u8 reg)
2743bcc9736cSJeff Kirsher {
2744bcc9736cSJeff Kirsher u16 data;
2745bcc9736cSJeff Kirsher
2746bcc9736cSJeff Kirsher raise_gpio(hw, EEPROM_ACCESS_ENABLE | EEPROM_CHIP_SELECT);
2747bcc9736cSJeff Kirsher
2748bcc9736cSJeff Kirsher spi_reg(hw, AT93C_READ, reg);
2749bcc9736cSJeff Kirsher data = spi_r(hw);
2750bcc9736cSJeff Kirsher
2751bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_ACCESS_ENABLE | EEPROM_CHIP_SELECT);
2752bcc9736cSJeff Kirsher
2753bcc9736cSJeff Kirsher return data;
2754bcc9736cSJeff Kirsher }
2755bcc9736cSJeff Kirsher
2756bcc9736cSJeff Kirsher /**
2757bcc9736cSJeff Kirsher * eeprom_write - write to AT93C46 EEPROM
2758bcc9736cSJeff Kirsher * @hw: The hardware instance.
2759bcc9736cSJeff Kirsher * @reg: The register offset.
2760bcc9736cSJeff Kirsher * @data: The data value.
2761bcc9736cSJeff Kirsher *
2762bcc9736cSJeff Kirsher * This procedure writes a word to the AT93C46 EEPROM.
2763bcc9736cSJeff Kirsher */
eeprom_write(struct ksz_hw * hw,u8 reg,u16 data)2764bcc9736cSJeff Kirsher static void eeprom_write(struct ksz_hw *hw, u8 reg, u16 data)
2765bcc9736cSJeff Kirsher {
2766bcc9736cSJeff Kirsher int timeout;
2767bcc9736cSJeff Kirsher
2768bcc9736cSJeff Kirsher raise_gpio(hw, EEPROM_ACCESS_ENABLE | EEPROM_CHIP_SELECT);
2769bcc9736cSJeff Kirsher
2770bcc9736cSJeff Kirsher /* Enable write. */
2771bcc9736cSJeff Kirsher spi_reg(hw, AT93C_CODE, AT93C_WR_ON);
2772bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_CHIP_SELECT);
2773bcc9736cSJeff Kirsher udelay(1);
2774bcc9736cSJeff Kirsher
2775bcc9736cSJeff Kirsher /* Erase the register. */
2776bcc9736cSJeff Kirsher raise_gpio(hw, EEPROM_CHIP_SELECT);
2777bcc9736cSJeff Kirsher spi_reg(hw, AT93C_ERASE, reg);
2778bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_CHIP_SELECT);
2779bcc9736cSJeff Kirsher udelay(1);
2780bcc9736cSJeff Kirsher
2781bcc9736cSJeff Kirsher /* Check operation complete. */
2782bcc9736cSJeff Kirsher raise_gpio(hw, EEPROM_CHIP_SELECT);
2783bcc9736cSJeff Kirsher timeout = 8;
2784bcc9736cSJeff Kirsher mdelay(2);
2785bcc9736cSJeff Kirsher do {
2786bcc9736cSJeff Kirsher mdelay(1);
2787bcc9736cSJeff Kirsher } while (!state_gpio(hw, EEPROM_DATA_IN) && --timeout);
2788bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_CHIP_SELECT);
2789bcc9736cSJeff Kirsher udelay(1);
2790bcc9736cSJeff Kirsher
2791bcc9736cSJeff Kirsher /* Write the register. */
2792bcc9736cSJeff Kirsher raise_gpio(hw, EEPROM_CHIP_SELECT);
2793bcc9736cSJeff Kirsher spi_reg(hw, AT93C_WRITE, reg);
2794bcc9736cSJeff Kirsher spi_w(hw, data);
2795bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_CHIP_SELECT);
2796bcc9736cSJeff Kirsher udelay(1);
2797bcc9736cSJeff Kirsher
2798bcc9736cSJeff Kirsher /* Check operation complete. */
2799bcc9736cSJeff Kirsher raise_gpio(hw, EEPROM_CHIP_SELECT);
2800bcc9736cSJeff Kirsher timeout = 8;
2801bcc9736cSJeff Kirsher mdelay(2);
2802bcc9736cSJeff Kirsher do {
2803bcc9736cSJeff Kirsher mdelay(1);
2804bcc9736cSJeff Kirsher } while (!state_gpio(hw, EEPROM_DATA_IN) && --timeout);
2805bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_CHIP_SELECT);
2806bcc9736cSJeff Kirsher udelay(1);
2807bcc9736cSJeff Kirsher
2808bcc9736cSJeff Kirsher /* Disable write. */
2809bcc9736cSJeff Kirsher raise_gpio(hw, EEPROM_CHIP_SELECT);
2810bcc9736cSJeff Kirsher spi_reg(hw, AT93C_CODE, AT93C_WR_OFF);
2811bcc9736cSJeff Kirsher
2812bcc9736cSJeff Kirsher drop_gpio(hw, EEPROM_ACCESS_ENABLE | EEPROM_CHIP_SELECT);
2813bcc9736cSJeff Kirsher }
2814bcc9736cSJeff Kirsher
2815bcc9736cSJeff Kirsher /*
2816bcc9736cSJeff Kirsher * Link detection routines
2817bcc9736cSJeff Kirsher */
2818bcc9736cSJeff Kirsher
advertised_flow_ctrl(struct ksz_port * port,u16 ctrl)2819bcc9736cSJeff Kirsher static u16 advertised_flow_ctrl(struct ksz_port *port, u16 ctrl)
2820bcc9736cSJeff Kirsher {
2821bcc9736cSJeff Kirsher ctrl &= ~PORT_AUTO_NEG_SYM_PAUSE;
2822bcc9736cSJeff Kirsher switch (port->flow_ctrl) {
2823bcc9736cSJeff Kirsher case PHY_FLOW_CTRL:
2824bcc9736cSJeff Kirsher ctrl |= PORT_AUTO_NEG_SYM_PAUSE;
2825bcc9736cSJeff Kirsher break;
2826bcc9736cSJeff Kirsher /* Not supported. */
2827bcc9736cSJeff Kirsher case PHY_TX_ONLY:
2828bcc9736cSJeff Kirsher case PHY_RX_ONLY:
2829bcc9736cSJeff Kirsher default:
2830bcc9736cSJeff Kirsher break;
2831bcc9736cSJeff Kirsher }
2832bcc9736cSJeff Kirsher return ctrl;
2833bcc9736cSJeff Kirsher }
2834bcc9736cSJeff Kirsher
set_flow_ctrl(struct ksz_hw * hw,int rx,int tx)2835bcc9736cSJeff Kirsher static void set_flow_ctrl(struct ksz_hw *hw, int rx, int tx)
2836bcc9736cSJeff Kirsher {
2837bcc9736cSJeff Kirsher u32 rx_cfg;
2838bcc9736cSJeff Kirsher u32 tx_cfg;
2839bcc9736cSJeff Kirsher
2840bcc9736cSJeff Kirsher rx_cfg = hw->rx_cfg;
2841bcc9736cSJeff Kirsher tx_cfg = hw->tx_cfg;
2842bcc9736cSJeff Kirsher if (rx)
2843bcc9736cSJeff Kirsher hw->rx_cfg |= DMA_RX_FLOW_ENABLE;
2844bcc9736cSJeff Kirsher else
2845bcc9736cSJeff Kirsher hw->rx_cfg &= ~DMA_RX_FLOW_ENABLE;
2846bcc9736cSJeff Kirsher if (tx)
2847bcc9736cSJeff Kirsher hw->tx_cfg |= DMA_TX_FLOW_ENABLE;
2848bcc9736cSJeff Kirsher else
2849bcc9736cSJeff Kirsher hw->tx_cfg &= ~DMA_TX_FLOW_ENABLE;
2850bcc9736cSJeff Kirsher if (hw->enabled) {
2851bcc9736cSJeff Kirsher if (rx_cfg != hw->rx_cfg)
2852bcc9736cSJeff Kirsher writel(hw->rx_cfg, hw->io + KS_DMA_RX_CTRL);
2853bcc9736cSJeff Kirsher if (tx_cfg != hw->tx_cfg)
2854bcc9736cSJeff Kirsher writel(hw->tx_cfg, hw->io + KS_DMA_TX_CTRL);
2855bcc9736cSJeff Kirsher }
2856bcc9736cSJeff Kirsher }
2857bcc9736cSJeff Kirsher
determine_flow_ctrl(struct ksz_hw * hw,struct ksz_port * port,u16 local,u16 remote)2858bcc9736cSJeff Kirsher static void determine_flow_ctrl(struct ksz_hw *hw, struct ksz_port *port,
2859bcc9736cSJeff Kirsher u16 local, u16 remote)
2860bcc9736cSJeff Kirsher {
2861bcc9736cSJeff Kirsher int rx;
2862bcc9736cSJeff Kirsher int tx;
2863bcc9736cSJeff Kirsher
2864bcc9736cSJeff Kirsher if (hw->overrides & PAUSE_FLOW_CTRL)
2865bcc9736cSJeff Kirsher return;
2866bcc9736cSJeff Kirsher
2867bcc9736cSJeff Kirsher rx = tx = 0;
2868bcc9736cSJeff Kirsher if (port->force_link)
2869bcc9736cSJeff Kirsher rx = tx = 1;
2870ec4b94f9SMichael Grzeschik if (remote & LPA_PAUSE_CAP) {
2871ec4b94f9SMichael Grzeschik if (local & ADVERTISE_PAUSE_CAP) {
2872bcc9736cSJeff Kirsher rx = tx = 1;
2873ec4b94f9SMichael Grzeschik } else if ((remote & LPA_PAUSE_ASYM) &&
2874ec4b94f9SMichael Grzeschik (local &
2875ec4b94f9SMichael Grzeschik (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM)) ==
2876ec4b94f9SMichael Grzeschik ADVERTISE_PAUSE_ASYM) {
2877bcc9736cSJeff Kirsher tx = 1;
2878bcc9736cSJeff Kirsher }
2879ec4b94f9SMichael Grzeschik } else if (remote & LPA_PAUSE_ASYM) {
2880ec4b94f9SMichael Grzeschik if ((local & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM))
2881ec4b94f9SMichael Grzeschik == (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM))
2882bcc9736cSJeff Kirsher rx = 1;
2883bcc9736cSJeff Kirsher }
2884bcc9736cSJeff Kirsher if (!hw->ksz_switch)
2885bcc9736cSJeff Kirsher set_flow_ctrl(hw, rx, tx);
2886bcc9736cSJeff Kirsher }
2887bcc9736cSJeff Kirsher
port_cfg_change(struct ksz_hw * hw,struct ksz_port * port,struct ksz_port_info * info,u16 link_status)2888bcc9736cSJeff Kirsher static inline void port_cfg_change(struct ksz_hw *hw, struct ksz_port *port,
2889bcc9736cSJeff Kirsher struct ksz_port_info *info, u16 link_status)
2890bcc9736cSJeff Kirsher {
2891bcc9736cSJeff Kirsher if ((hw->features & HALF_DUPLEX_SIGNAL_BUG) &&
2892bcc9736cSJeff Kirsher !(hw->overrides & PAUSE_FLOW_CTRL)) {
2893bcc9736cSJeff Kirsher u32 cfg = hw->tx_cfg;
2894bcc9736cSJeff Kirsher
2895bcc9736cSJeff Kirsher /* Disable flow control in the half duplex mode. */
2896bcc9736cSJeff Kirsher if (1 == info->duplex)
2897bcc9736cSJeff Kirsher hw->tx_cfg &= ~DMA_TX_FLOW_ENABLE;
2898bcc9736cSJeff Kirsher if (hw->enabled && cfg != hw->tx_cfg)
2899bcc9736cSJeff Kirsher writel(hw->tx_cfg, hw->io + KS_DMA_TX_CTRL);
2900bcc9736cSJeff Kirsher }
2901bcc9736cSJeff Kirsher }
2902bcc9736cSJeff Kirsher
2903bcc9736cSJeff Kirsher /**
2904bcc9736cSJeff Kirsher * port_get_link_speed - get current link status
2905bcc9736cSJeff Kirsher * @port: The port instance.
2906bcc9736cSJeff Kirsher *
2907bcc9736cSJeff Kirsher * This routine reads PHY registers to determine the current link status of the
2908bcc9736cSJeff Kirsher * switch ports.
2909bcc9736cSJeff Kirsher */
port_get_link_speed(struct ksz_port * port)2910bcc9736cSJeff Kirsher static void port_get_link_speed(struct ksz_port *port)
2911bcc9736cSJeff Kirsher {
2912bcc9736cSJeff Kirsher uint interrupt;
2913bcc9736cSJeff Kirsher struct ksz_port_info *info;
2914bcc9736cSJeff Kirsher struct ksz_port_info *linked = NULL;
2915bcc9736cSJeff Kirsher struct ksz_hw *hw = port->hw;
2916bcc9736cSJeff Kirsher u16 data;
2917bcc9736cSJeff Kirsher u16 status;
2918bcc9736cSJeff Kirsher u8 local;
2919bcc9736cSJeff Kirsher u8 remote;
2920bcc9736cSJeff Kirsher int i;
2921bcc9736cSJeff Kirsher int p;
2922bcc9736cSJeff Kirsher
2923bcc9736cSJeff Kirsher interrupt = hw_block_intr(hw);
2924bcc9736cSJeff Kirsher
2925bcc9736cSJeff Kirsher for (i = 0, p = port->first_port; i < port->port_cnt; i++, p++) {
2926bcc9736cSJeff Kirsher info = &hw->port_info[p];
2927bcc9736cSJeff Kirsher port_r16(hw, p, KS884X_PORT_CTRL_4_OFFSET, &data);
2928bcc9736cSJeff Kirsher port_r16(hw, p, KS884X_PORT_STATUS_OFFSET, &status);
2929bcc9736cSJeff Kirsher
2930bcc9736cSJeff Kirsher /*
2931bcc9736cSJeff Kirsher * Link status is changing all the time even when there is no
2932bcc9736cSJeff Kirsher * cable connection!
2933bcc9736cSJeff Kirsher */
2934bcc9736cSJeff Kirsher remote = status & (PORT_AUTO_NEG_COMPLETE |
2935bcc9736cSJeff Kirsher PORT_STATUS_LINK_GOOD);
2936bcc9736cSJeff Kirsher local = (u8) data;
2937bcc9736cSJeff Kirsher
2938bcc9736cSJeff Kirsher /* No change to status. */
2939bcc9736cSJeff Kirsher if (local == info->advertised && remote == info->partner)
2940bcc9736cSJeff Kirsher continue;
2941bcc9736cSJeff Kirsher
2942bcc9736cSJeff Kirsher info->advertised = local;
2943bcc9736cSJeff Kirsher info->partner = remote;
2944bcc9736cSJeff Kirsher if (status & PORT_STATUS_LINK_GOOD) {
2945bcc9736cSJeff Kirsher
2946bcc9736cSJeff Kirsher /* Remember the first linked port. */
2947bcc9736cSJeff Kirsher if (!linked)
2948bcc9736cSJeff Kirsher linked = info;
2949bcc9736cSJeff Kirsher
2950bcc9736cSJeff Kirsher info->tx_rate = 10 * TX_RATE_UNIT;
2951bcc9736cSJeff Kirsher if (status & PORT_STATUS_SPEED_100MBIT)
2952bcc9736cSJeff Kirsher info->tx_rate = 100 * TX_RATE_UNIT;
2953bcc9736cSJeff Kirsher
2954bcc9736cSJeff Kirsher info->duplex = 1;
2955bcc9736cSJeff Kirsher if (status & PORT_STATUS_FULL_DUPLEX)
2956bcc9736cSJeff Kirsher info->duplex = 2;
2957bcc9736cSJeff Kirsher
2958bcc9736cSJeff Kirsher if (media_connected != info->state) {
2959bcc9736cSJeff Kirsher hw_r_phy(hw, p, KS884X_PHY_AUTO_NEG_OFFSET,
2960bcc9736cSJeff Kirsher &data);
2961bcc9736cSJeff Kirsher hw_r_phy(hw, p, KS884X_PHY_REMOTE_CAP_OFFSET,
2962bcc9736cSJeff Kirsher &status);
2963bcc9736cSJeff Kirsher determine_flow_ctrl(hw, port, data, status);
2964bcc9736cSJeff Kirsher if (hw->ksz_switch) {
2965bcc9736cSJeff Kirsher port_cfg_back_pressure(hw, p,
2966bcc9736cSJeff Kirsher (1 == info->duplex));
2967bcc9736cSJeff Kirsher }
2968bcc9736cSJeff Kirsher port_cfg_change(hw, port, info, status);
2969bcc9736cSJeff Kirsher }
2970bcc9736cSJeff Kirsher info->state = media_connected;
2971bcc9736cSJeff Kirsher } else {
2972bcc9736cSJeff Kirsher /* Indicate the link just goes down. */
2973*9a865a98STom Rix if (media_disconnected != info->state)
2974bcc9736cSJeff Kirsher hw->port_mib[p].link_down = 1;
2975*9a865a98STom Rix
2976bcc9736cSJeff Kirsher info->state = media_disconnected;
2977bcc9736cSJeff Kirsher }
2978bcc9736cSJeff Kirsher hw->port_mib[p].state = (u8) info->state;
2979bcc9736cSJeff Kirsher }
2980bcc9736cSJeff Kirsher
2981bcc9736cSJeff Kirsher if (linked && media_disconnected == port->linked->state)
2982bcc9736cSJeff Kirsher port->linked = linked;
2983bcc9736cSJeff Kirsher
2984bcc9736cSJeff Kirsher hw_restore_intr(hw, interrupt);
2985bcc9736cSJeff Kirsher }
2986bcc9736cSJeff Kirsher
2987bcc9736cSJeff Kirsher #define PHY_RESET_TIMEOUT 10
2988bcc9736cSJeff Kirsher
2989bcc9736cSJeff Kirsher /**
2990bcc9736cSJeff Kirsher * port_set_link_speed - set port speed
2991bcc9736cSJeff Kirsher * @port: The port instance.
2992bcc9736cSJeff Kirsher *
2993bcc9736cSJeff Kirsher * This routine sets the link speed of the switch ports.
2994bcc9736cSJeff Kirsher */
port_set_link_speed(struct ksz_port * port)2995bcc9736cSJeff Kirsher static void port_set_link_speed(struct ksz_port *port)
2996bcc9736cSJeff Kirsher {
2997bcc9736cSJeff Kirsher struct ksz_hw *hw = port->hw;
2998bcc9736cSJeff Kirsher u16 data;
2999bcc9736cSJeff Kirsher u16 cfg;
3000bcc9736cSJeff Kirsher u8 status;
3001bcc9736cSJeff Kirsher int i;
3002bcc9736cSJeff Kirsher int p;
3003bcc9736cSJeff Kirsher
3004bcc9736cSJeff Kirsher for (i = 0, p = port->first_port; i < port->port_cnt; i++, p++) {
3005bcc9736cSJeff Kirsher port_r16(hw, p, KS884X_PORT_CTRL_4_OFFSET, &data);
3006bcc9736cSJeff Kirsher port_r8(hw, p, KS884X_PORT_STATUS_OFFSET, &status);
3007bcc9736cSJeff Kirsher
3008bcc9736cSJeff Kirsher cfg = 0;
3009bcc9736cSJeff Kirsher if (status & PORT_STATUS_LINK_GOOD)
3010bcc9736cSJeff Kirsher cfg = data;
3011bcc9736cSJeff Kirsher
3012bcc9736cSJeff Kirsher data |= PORT_AUTO_NEG_ENABLE;
3013bcc9736cSJeff Kirsher data = advertised_flow_ctrl(port, data);
3014bcc9736cSJeff Kirsher
3015bcc9736cSJeff Kirsher data |= PORT_AUTO_NEG_100BTX_FD | PORT_AUTO_NEG_100BTX |
3016bcc9736cSJeff Kirsher PORT_AUTO_NEG_10BT_FD | PORT_AUTO_NEG_10BT;
3017bcc9736cSJeff Kirsher
3018bcc9736cSJeff Kirsher /* Check if manual configuration is specified by the user. */
3019bcc9736cSJeff Kirsher if (port->speed || port->duplex) {
3020bcc9736cSJeff Kirsher if (10 == port->speed)
3021bcc9736cSJeff Kirsher data &= ~(PORT_AUTO_NEG_100BTX_FD |
3022bcc9736cSJeff Kirsher PORT_AUTO_NEG_100BTX);
3023bcc9736cSJeff Kirsher else if (100 == port->speed)
3024bcc9736cSJeff Kirsher data &= ~(PORT_AUTO_NEG_10BT_FD |
3025bcc9736cSJeff Kirsher PORT_AUTO_NEG_10BT);
3026bcc9736cSJeff Kirsher if (1 == port->duplex)
3027bcc9736cSJeff Kirsher data &= ~(PORT_AUTO_NEG_100BTX_FD |
3028bcc9736cSJeff Kirsher PORT_AUTO_NEG_10BT_FD);
3029bcc9736cSJeff Kirsher else if (2 == port->duplex)
3030bcc9736cSJeff Kirsher data &= ~(PORT_AUTO_NEG_100BTX |
3031bcc9736cSJeff Kirsher PORT_AUTO_NEG_10BT);
3032bcc9736cSJeff Kirsher }
3033bcc9736cSJeff Kirsher if (data != cfg) {
3034bcc9736cSJeff Kirsher data |= PORT_AUTO_NEG_RESTART;
3035bcc9736cSJeff Kirsher port_w16(hw, p, KS884X_PORT_CTRL_4_OFFSET, data);
3036bcc9736cSJeff Kirsher }
3037bcc9736cSJeff Kirsher }
3038bcc9736cSJeff Kirsher }
3039bcc9736cSJeff Kirsher
3040bcc9736cSJeff Kirsher /**
3041bcc9736cSJeff Kirsher * port_force_link_speed - force port speed
3042bcc9736cSJeff Kirsher * @port: The port instance.
3043bcc9736cSJeff Kirsher *
3044bcc9736cSJeff Kirsher * This routine forces the link speed of the switch ports.
3045bcc9736cSJeff Kirsher */
port_force_link_speed(struct ksz_port * port)3046bcc9736cSJeff Kirsher static void port_force_link_speed(struct ksz_port *port)
3047bcc9736cSJeff Kirsher {
3048bcc9736cSJeff Kirsher struct ksz_hw *hw = port->hw;
3049bcc9736cSJeff Kirsher u16 data;
3050bcc9736cSJeff Kirsher int i;
3051bcc9736cSJeff Kirsher int phy;
3052bcc9736cSJeff Kirsher int p;
3053bcc9736cSJeff Kirsher
3054bcc9736cSJeff Kirsher for (i = 0, p = port->first_port; i < port->port_cnt; i++, p++) {
3055bcc9736cSJeff Kirsher phy = KS884X_PHY_1_CTRL_OFFSET + p * PHY_CTRL_INTERVAL;
3056bcc9736cSJeff Kirsher hw_r_phy_ctrl(hw, phy, &data);
3057bcc9736cSJeff Kirsher
3058ec4b94f9SMichael Grzeschik data &= ~BMCR_ANENABLE;
3059bcc9736cSJeff Kirsher
3060bcc9736cSJeff Kirsher if (10 == port->speed)
3061ec4b94f9SMichael Grzeschik data &= ~BMCR_SPEED100;
3062bcc9736cSJeff Kirsher else if (100 == port->speed)
3063ec4b94f9SMichael Grzeschik data |= BMCR_SPEED100;
3064bcc9736cSJeff Kirsher if (1 == port->duplex)
3065ec4b94f9SMichael Grzeschik data &= ~BMCR_FULLDPLX;
3066bcc9736cSJeff Kirsher else if (2 == port->duplex)
3067ec4b94f9SMichael Grzeschik data |= BMCR_FULLDPLX;
3068bcc9736cSJeff Kirsher hw_w_phy_ctrl(hw, phy, data);
3069bcc9736cSJeff Kirsher }
3070bcc9736cSJeff Kirsher }
3071bcc9736cSJeff Kirsher
port_set_power_saving(struct ksz_port * port,int enable)3072bcc9736cSJeff Kirsher static void port_set_power_saving(struct ksz_port *port, int enable)
3073bcc9736cSJeff Kirsher {
3074bcc9736cSJeff Kirsher struct ksz_hw *hw = port->hw;
3075bcc9736cSJeff Kirsher int i;
3076bcc9736cSJeff Kirsher int p;
3077bcc9736cSJeff Kirsher
3078bcc9736cSJeff Kirsher for (i = 0, p = port->first_port; i < port->port_cnt; i++, p++)
3079bcc9736cSJeff Kirsher port_cfg(hw, p,
3080bcc9736cSJeff Kirsher KS884X_PORT_CTRL_4_OFFSET, PORT_POWER_DOWN, enable);
3081bcc9736cSJeff Kirsher }
3082bcc9736cSJeff Kirsher
3083bcc9736cSJeff Kirsher /*
3084bcc9736cSJeff Kirsher * KSZ8841 power management functions
3085bcc9736cSJeff Kirsher */
3086bcc9736cSJeff Kirsher
3087bcc9736cSJeff Kirsher /**
3088bcc9736cSJeff Kirsher * hw_chk_wol_pme_status - check PMEN pin
3089bcc9736cSJeff Kirsher * @hw: The hardware instance.
3090bcc9736cSJeff Kirsher *
3091bcc9736cSJeff Kirsher * This function is used to check PMEN pin is asserted.
3092bcc9736cSJeff Kirsher *
3093bcc9736cSJeff Kirsher * Return 1 if PMEN pin is asserted; otherwise, 0.
3094bcc9736cSJeff Kirsher */
hw_chk_wol_pme_status(struct ksz_hw * hw)3095bcc9736cSJeff Kirsher static int hw_chk_wol_pme_status(struct ksz_hw *hw)
3096bcc9736cSJeff Kirsher {
3097bcc9736cSJeff Kirsher struct dev_info *hw_priv = container_of(hw, struct dev_info, hw);
3098bcc9736cSJeff Kirsher struct pci_dev *pdev = hw_priv->pdev;
3099bcc9736cSJeff Kirsher u16 data;
3100bcc9736cSJeff Kirsher
3101bcc9736cSJeff Kirsher if (!pdev->pm_cap)
3102bcc9736cSJeff Kirsher return 0;
3103bcc9736cSJeff Kirsher pci_read_config_word(pdev, pdev->pm_cap + PCI_PM_CTRL, &data);
3104bcc9736cSJeff Kirsher return (data & PCI_PM_CTRL_PME_STATUS) == PCI_PM_CTRL_PME_STATUS;
3105bcc9736cSJeff Kirsher }
3106bcc9736cSJeff Kirsher
3107bcc9736cSJeff Kirsher /**
3108bcc9736cSJeff Kirsher * hw_clr_wol_pme_status - clear PMEN pin
3109bcc9736cSJeff Kirsher * @hw: The hardware instance.
3110bcc9736cSJeff Kirsher *
3111bcc9736cSJeff Kirsher * This routine is used to clear PME_Status to deassert PMEN pin.
3112bcc9736cSJeff Kirsher */
hw_clr_wol_pme_status(struct ksz_hw * hw)3113bcc9736cSJeff Kirsher static void hw_clr_wol_pme_status(struct ksz_hw *hw)
3114bcc9736cSJeff Kirsher {
3115bcc9736cSJeff Kirsher struct dev_info *hw_priv = container_of(hw, struct dev_info, hw);
3116bcc9736cSJeff Kirsher struct pci_dev *pdev = hw_priv->pdev;
3117bcc9736cSJeff Kirsher u16 data;
3118bcc9736cSJeff Kirsher
3119bcc9736cSJeff Kirsher if (!pdev->pm_cap)
3120bcc9736cSJeff Kirsher return;
3121bcc9736cSJeff Kirsher
3122bcc9736cSJeff Kirsher /* Clear PME_Status to deassert PMEN pin. */
3123bcc9736cSJeff Kirsher pci_read_config_word(pdev, pdev->pm_cap + PCI_PM_CTRL, &data);
3124bcc9736cSJeff Kirsher data |= PCI_PM_CTRL_PME_STATUS;
3125bcc9736cSJeff Kirsher pci_write_config_word(pdev, pdev->pm_cap + PCI_PM_CTRL, data);
3126bcc9736cSJeff Kirsher }
3127bcc9736cSJeff Kirsher
3128bcc9736cSJeff Kirsher /**
3129bcc9736cSJeff Kirsher * hw_cfg_wol_pme - enable or disable Wake-on-LAN
3130bcc9736cSJeff Kirsher * @hw: The hardware instance.
3131bcc9736cSJeff Kirsher * @set: The flag indicating whether to enable or disable.
3132bcc9736cSJeff Kirsher *
3133bcc9736cSJeff Kirsher * This routine is used to enable or disable Wake-on-LAN.
3134bcc9736cSJeff Kirsher */
hw_cfg_wol_pme(struct ksz_hw * hw,int set)3135bcc9736cSJeff Kirsher static void hw_cfg_wol_pme(struct ksz_hw *hw, int set)
3136bcc9736cSJeff Kirsher {
3137bcc9736cSJeff Kirsher struct dev_info *hw_priv = container_of(hw, struct dev_info, hw);
3138bcc9736cSJeff Kirsher struct pci_dev *pdev = hw_priv->pdev;
3139bcc9736cSJeff Kirsher u16 data;
3140bcc9736cSJeff Kirsher
3141bcc9736cSJeff Kirsher if (!pdev->pm_cap)
3142bcc9736cSJeff Kirsher return;
3143bcc9736cSJeff Kirsher pci_read_config_word(pdev, pdev->pm_cap + PCI_PM_CTRL, &data);
3144bcc9736cSJeff Kirsher data &= ~PCI_PM_CTRL_STATE_MASK;
3145bcc9736cSJeff Kirsher if (set)
3146bcc9736cSJeff Kirsher data |= PCI_PM_CTRL_PME_ENABLE | PCI_D3hot;
3147bcc9736cSJeff Kirsher else
3148bcc9736cSJeff Kirsher data &= ~PCI_PM_CTRL_PME_ENABLE;
3149bcc9736cSJeff Kirsher pci_write_config_word(pdev, pdev->pm_cap + PCI_PM_CTRL, data);
3150bcc9736cSJeff Kirsher }
3151bcc9736cSJeff Kirsher
3152bcc9736cSJeff Kirsher /**
3153bcc9736cSJeff Kirsher * hw_cfg_wol - configure Wake-on-LAN features
3154bcc9736cSJeff Kirsher * @hw: The hardware instance.
3155bcc9736cSJeff Kirsher * @frame: The pattern frame bit.
3156bcc9736cSJeff Kirsher * @set: The flag indicating whether to enable or disable.
3157bcc9736cSJeff Kirsher *
3158bcc9736cSJeff Kirsher * This routine is used to enable or disable certain Wake-on-LAN features.
3159bcc9736cSJeff Kirsher */
hw_cfg_wol(struct ksz_hw * hw,u16 frame,int set)3160bcc9736cSJeff Kirsher static void hw_cfg_wol(struct ksz_hw *hw, u16 frame, int set)
3161bcc9736cSJeff Kirsher {
3162bcc9736cSJeff Kirsher u16 data;
3163bcc9736cSJeff Kirsher
3164bcc9736cSJeff Kirsher data = readw(hw->io + KS8841_WOL_CTRL_OFFSET);
3165bcc9736cSJeff Kirsher if (set)
3166bcc9736cSJeff Kirsher data |= frame;
3167bcc9736cSJeff Kirsher else
3168bcc9736cSJeff Kirsher data &= ~frame;
3169bcc9736cSJeff Kirsher writew(data, hw->io + KS8841_WOL_CTRL_OFFSET);
3170bcc9736cSJeff Kirsher }
3171bcc9736cSJeff Kirsher
3172bcc9736cSJeff Kirsher /**
3173bcc9736cSJeff Kirsher * hw_set_wol_frame - program Wake-on-LAN pattern
3174bcc9736cSJeff Kirsher * @hw: The hardware instance.
3175bcc9736cSJeff Kirsher * @i: The frame index.
3176bcc9736cSJeff Kirsher * @mask_size: The size of the mask.
3177bcc9736cSJeff Kirsher * @mask: Mask to ignore certain bytes in the pattern.
3178bcc9736cSJeff Kirsher * @frame_size: The size of the frame.
3179bcc9736cSJeff Kirsher * @pattern: The frame data.
3180bcc9736cSJeff Kirsher *
3181bcc9736cSJeff Kirsher * This routine is used to program Wake-on-LAN pattern.
3182bcc9736cSJeff Kirsher */
hw_set_wol_frame(struct ksz_hw * hw,int i,uint mask_size,const u8 * mask,uint frame_size,const u8 * pattern)3183bcc9736cSJeff Kirsher static void hw_set_wol_frame(struct ksz_hw *hw, int i, uint mask_size,
3184bcc9736cSJeff Kirsher const u8 *mask, uint frame_size, const u8 *pattern)
3185bcc9736cSJeff Kirsher {
3186bcc9736cSJeff Kirsher int bits;
3187bcc9736cSJeff Kirsher int from;
3188bcc9736cSJeff Kirsher int len;
3189bcc9736cSJeff Kirsher int to;
3190bcc9736cSJeff Kirsher u32 crc;
3191bcc9736cSJeff Kirsher u8 data[64];
3192bcc9736cSJeff Kirsher u8 val = 0;
3193bcc9736cSJeff Kirsher
3194bcc9736cSJeff Kirsher if (frame_size > mask_size * 8)
3195bcc9736cSJeff Kirsher frame_size = mask_size * 8;
3196bcc9736cSJeff Kirsher if (frame_size > 64)
3197bcc9736cSJeff Kirsher frame_size = 64;
3198bcc9736cSJeff Kirsher
3199bcc9736cSJeff Kirsher i *= 0x10;
3200bcc9736cSJeff Kirsher writel(0, hw->io + KS8841_WOL_FRAME_BYTE0_OFFSET + i);
3201bcc9736cSJeff Kirsher writel(0, hw->io + KS8841_WOL_FRAME_BYTE2_OFFSET + i);
3202bcc9736cSJeff Kirsher
3203bcc9736cSJeff Kirsher bits = len = from = to = 0;
3204bcc9736cSJeff Kirsher do {
3205bcc9736cSJeff Kirsher if (bits) {
3206bcc9736cSJeff Kirsher if ((val & 1))
3207bcc9736cSJeff Kirsher data[to++] = pattern[from];
3208bcc9736cSJeff Kirsher val >>= 1;
3209bcc9736cSJeff Kirsher ++from;
3210bcc9736cSJeff Kirsher --bits;
3211bcc9736cSJeff Kirsher } else {
3212bcc9736cSJeff Kirsher val = mask[len];
3213bcc9736cSJeff Kirsher writeb(val, hw->io + KS8841_WOL_FRAME_BYTE0_OFFSET + i
3214bcc9736cSJeff Kirsher + len);
3215bcc9736cSJeff Kirsher ++len;
3216bcc9736cSJeff Kirsher if (val)
3217bcc9736cSJeff Kirsher bits = 8;
3218bcc9736cSJeff Kirsher else
3219bcc9736cSJeff Kirsher from += 8;
3220bcc9736cSJeff Kirsher }
3221bcc9736cSJeff Kirsher } while (from < (int) frame_size);
3222bcc9736cSJeff Kirsher if (val) {
3223bcc9736cSJeff Kirsher bits = mask[len - 1];
3224bcc9736cSJeff Kirsher val <<= (from % 8);
3225bcc9736cSJeff Kirsher bits &= ~val;
3226bcc9736cSJeff Kirsher writeb(bits, hw->io + KS8841_WOL_FRAME_BYTE0_OFFSET + i + len -
3227bcc9736cSJeff Kirsher 1);
3228bcc9736cSJeff Kirsher }
3229bcc9736cSJeff Kirsher crc = ether_crc(to, data);
3230bcc9736cSJeff Kirsher writel(crc, hw->io + KS8841_WOL_FRAME_CRC_OFFSET + i);
3231bcc9736cSJeff Kirsher }
3232bcc9736cSJeff Kirsher
3233bcc9736cSJeff Kirsher /**
3234bcc9736cSJeff Kirsher * hw_add_wol_arp - add ARP pattern
3235bcc9736cSJeff Kirsher * @hw: The hardware instance.
3236bcc9736cSJeff Kirsher * @ip_addr: The IPv4 address assigned to the device.
3237bcc9736cSJeff Kirsher *
3238bcc9736cSJeff Kirsher * This routine is used to add ARP pattern for waking up the host.
3239bcc9736cSJeff Kirsher */
hw_add_wol_arp(struct ksz_hw * hw,const u8 * ip_addr)3240bcc9736cSJeff Kirsher static void hw_add_wol_arp(struct ksz_hw *hw, const u8 *ip_addr)
3241bcc9736cSJeff Kirsher {
3242bcc9736cSJeff Kirsher static const u8 mask[6] = { 0x3F, 0xF0, 0x3F, 0x00, 0xC0, 0x03 };
3243bcc9736cSJeff Kirsher u8 pattern[42] = {
3244bcc9736cSJeff Kirsher 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
3245bcc9736cSJeff Kirsher 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
3246bcc9736cSJeff Kirsher 0x08, 0x06,
3247bcc9736cSJeff Kirsher 0x00, 0x01, 0x08, 0x00, 0x06, 0x04, 0x00, 0x01,
3248bcc9736cSJeff Kirsher 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
3249bcc9736cSJeff Kirsher 0x00, 0x00, 0x00, 0x00,
3250bcc9736cSJeff Kirsher 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
3251bcc9736cSJeff Kirsher 0x00, 0x00, 0x00, 0x00 };
3252bcc9736cSJeff Kirsher
3253bcc9736cSJeff Kirsher memcpy(&pattern[38], ip_addr, 4);
3254bcc9736cSJeff Kirsher hw_set_wol_frame(hw, 3, 6, mask, 42, pattern);
3255bcc9736cSJeff Kirsher }
3256bcc9736cSJeff Kirsher
3257bcc9736cSJeff Kirsher /**
3258bcc9736cSJeff Kirsher * hw_add_wol_bcast - add broadcast pattern
3259bcc9736cSJeff Kirsher * @hw: The hardware instance.
3260bcc9736cSJeff Kirsher *
3261bcc9736cSJeff Kirsher * This routine is used to add broadcast pattern for waking up the host.
3262bcc9736cSJeff Kirsher */
hw_add_wol_bcast(struct ksz_hw * hw)3263bcc9736cSJeff Kirsher static void hw_add_wol_bcast(struct ksz_hw *hw)
3264bcc9736cSJeff Kirsher {
3265bcc9736cSJeff Kirsher static const u8 mask[] = { 0x3F };
3266bcc9736cSJeff Kirsher static const u8 pattern[] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
3267bcc9736cSJeff Kirsher
32686a3c910cSJoe Perches hw_set_wol_frame(hw, 2, 1, mask, ETH_ALEN, pattern);
3269bcc9736cSJeff Kirsher }
3270bcc9736cSJeff Kirsher
3271bcc9736cSJeff Kirsher /**
3272bcc9736cSJeff Kirsher * hw_add_wol_mcast - add multicast pattern
3273bcc9736cSJeff Kirsher * @hw: The hardware instance.
3274bcc9736cSJeff Kirsher *
3275bcc9736cSJeff Kirsher * This routine is used to add multicast pattern for waking up the host.
3276bcc9736cSJeff Kirsher *
3277bcc9736cSJeff Kirsher * It is assumed the multicast packet is the ICMPv6 neighbor solicitation used
3278bcc9736cSJeff Kirsher * by IPv6 ping command. Note that multicast packets are filtred through the
3279bcc9736cSJeff Kirsher * multicast hash table, so not all multicast packets can wake up the host.
3280bcc9736cSJeff Kirsher */
hw_add_wol_mcast(struct ksz_hw * hw)3281bcc9736cSJeff Kirsher static void hw_add_wol_mcast(struct ksz_hw *hw)
3282bcc9736cSJeff Kirsher {
3283bcc9736cSJeff Kirsher static const u8 mask[] = { 0x3F };
3284bcc9736cSJeff Kirsher u8 pattern[] = { 0x33, 0x33, 0xFF, 0x00, 0x00, 0x00 };
3285bcc9736cSJeff Kirsher
3286bcc9736cSJeff Kirsher memcpy(&pattern[3], &hw->override_addr[3], 3);
3287bcc9736cSJeff Kirsher hw_set_wol_frame(hw, 1, 1, mask, 6, pattern);
3288bcc9736cSJeff Kirsher }
3289bcc9736cSJeff Kirsher
3290bcc9736cSJeff Kirsher /**
3291bcc9736cSJeff Kirsher * hw_add_wol_ucast - add unicast pattern
3292bcc9736cSJeff Kirsher * @hw: The hardware instance.
3293bcc9736cSJeff Kirsher *
3294bcc9736cSJeff Kirsher * This routine is used to add unicast pattern to wakeup the host.
3295bcc9736cSJeff Kirsher *
3296bcc9736cSJeff Kirsher * It is assumed the unicast packet is directed to the device, as the hardware
3297bcc9736cSJeff Kirsher * can only receive them in normal case.
3298bcc9736cSJeff Kirsher */
hw_add_wol_ucast(struct ksz_hw * hw)3299bcc9736cSJeff Kirsher static void hw_add_wol_ucast(struct ksz_hw *hw)
3300bcc9736cSJeff Kirsher {
3301bcc9736cSJeff Kirsher static const u8 mask[] = { 0x3F };
3302bcc9736cSJeff Kirsher
33036a3c910cSJoe Perches hw_set_wol_frame(hw, 0, 1, mask, ETH_ALEN, hw->override_addr);
3304bcc9736cSJeff Kirsher }
3305bcc9736cSJeff Kirsher
3306bcc9736cSJeff Kirsher /**
3307bcc9736cSJeff Kirsher * hw_enable_wol - enable Wake-on-LAN
3308bcc9736cSJeff Kirsher * @hw: The hardware instance.
3309bcc9736cSJeff Kirsher * @wol_enable: The Wake-on-LAN settings.
3310bcc9736cSJeff Kirsher * @net_addr: The IPv4 address assigned to the device.
3311bcc9736cSJeff Kirsher *
3312bcc9736cSJeff Kirsher * This routine is used to enable Wake-on-LAN depending on driver settings.
3313bcc9736cSJeff Kirsher */
hw_enable_wol(struct ksz_hw * hw,u32 wol_enable,const u8 * net_addr)3314bcc9736cSJeff Kirsher static void hw_enable_wol(struct ksz_hw *hw, u32 wol_enable, const u8 *net_addr)
3315bcc9736cSJeff Kirsher {
3316bcc9736cSJeff Kirsher hw_cfg_wol(hw, KS8841_WOL_MAGIC_ENABLE, (wol_enable & WAKE_MAGIC));
3317bcc9736cSJeff Kirsher hw_cfg_wol(hw, KS8841_WOL_FRAME0_ENABLE, (wol_enable & WAKE_UCAST));
3318bcc9736cSJeff Kirsher hw_add_wol_ucast(hw);
3319bcc9736cSJeff Kirsher hw_cfg_wol(hw, KS8841_WOL_FRAME1_ENABLE, (wol_enable & WAKE_MCAST));
3320bcc9736cSJeff Kirsher hw_add_wol_mcast(hw);
3321bcc9736cSJeff Kirsher hw_cfg_wol(hw, KS8841_WOL_FRAME2_ENABLE, (wol_enable & WAKE_BCAST));
3322bcc9736cSJeff Kirsher hw_cfg_wol(hw, KS8841_WOL_FRAME3_ENABLE, (wol_enable & WAKE_ARP));
3323bcc9736cSJeff Kirsher hw_add_wol_arp(hw, net_addr);
3324bcc9736cSJeff Kirsher }
3325bcc9736cSJeff Kirsher
3326bcc9736cSJeff Kirsher /**
3327bcc9736cSJeff Kirsher * hw_init - check driver is correct for the hardware
3328bcc9736cSJeff Kirsher * @hw: The hardware instance.
3329bcc9736cSJeff Kirsher *
3330bcc9736cSJeff Kirsher * This function checks the hardware is correct for this driver and sets the
3331bcc9736cSJeff Kirsher * hardware up for proper initialization.
3332bcc9736cSJeff Kirsher *
3333bcc9736cSJeff Kirsher * Return number of ports or 0 if not right.
3334bcc9736cSJeff Kirsher */
hw_init(struct ksz_hw * hw)3335bcc9736cSJeff Kirsher static int hw_init(struct ksz_hw *hw)
3336bcc9736cSJeff Kirsher {
3337bcc9736cSJeff Kirsher int rc = 0;
3338bcc9736cSJeff Kirsher u16 data;
3339bcc9736cSJeff Kirsher u16 revision;
3340bcc9736cSJeff Kirsher
3341bcc9736cSJeff Kirsher /* Set bus speed to 125MHz. */
3342bcc9736cSJeff Kirsher writew(BUS_SPEED_125_MHZ, hw->io + KS884X_BUS_CTRL_OFFSET);
3343bcc9736cSJeff Kirsher
3344bcc9736cSJeff Kirsher /* Check KSZ884x chip ID. */
3345bcc9736cSJeff Kirsher data = readw(hw->io + KS884X_CHIP_ID_OFFSET);
3346bcc9736cSJeff Kirsher
3347bcc9736cSJeff Kirsher revision = (data & KS884X_REVISION_MASK) >> KS884X_REVISION_SHIFT;
3348bcc9736cSJeff Kirsher data &= KS884X_CHIP_ID_MASK_41;
3349bcc9736cSJeff Kirsher if (REG_CHIP_ID_41 == data)
3350bcc9736cSJeff Kirsher rc = 1;
3351bcc9736cSJeff Kirsher else if (REG_CHIP_ID_42 == data)
3352bcc9736cSJeff Kirsher rc = 2;
3353bcc9736cSJeff Kirsher else
3354bcc9736cSJeff Kirsher return 0;
3355bcc9736cSJeff Kirsher
3356bcc9736cSJeff Kirsher /* Setup hardware features or bug workarounds. */
3357bcc9736cSJeff Kirsher if (revision <= 1) {
3358bcc9736cSJeff Kirsher hw->features |= SMALL_PACKET_TX_BUG;
3359bcc9736cSJeff Kirsher if (1 == rc)
3360bcc9736cSJeff Kirsher hw->features |= HALF_DUPLEX_SIGNAL_BUG;
3361bcc9736cSJeff Kirsher }
3362bcc9736cSJeff Kirsher return rc;
3363bcc9736cSJeff Kirsher }
3364bcc9736cSJeff Kirsher
3365bcc9736cSJeff Kirsher /**
3366bcc9736cSJeff Kirsher * hw_reset - reset the hardware
3367bcc9736cSJeff Kirsher * @hw: The hardware instance.
3368bcc9736cSJeff Kirsher *
3369bcc9736cSJeff Kirsher * This routine resets the hardware.
3370bcc9736cSJeff Kirsher */
hw_reset(struct ksz_hw * hw)3371bcc9736cSJeff Kirsher static void hw_reset(struct ksz_hw *hw)
3372bcc9736cSJeff Kirsher {
3373bcc9736cSJeff Kirsher writew(GLOBAL_SOFTWARE_RESET, hw->io + KS884X_GLOBAL_CTRL_OFFSET);
3374bcc9736cSJeff Kirsher
3375bcc9736cSJeff Kirsher /* Wait for device to reset. */
3376bcc9736cSJeff Kirsher mdelay(10);
3377bcc9736cSJeff Kirsher
3378bcc9736cSJeff Kirsher /* Write 0 to clear device reset. */
3379bcc9736cSJeff Kirsher writew(0, hw->io + KS884X_GLOBAL_CTRL_OFFSET);
3380bcc9736cSJeff Kirsher }
3381bcc9736cSJeff Kirsher
3382bcc9736cSJeff Kirsher /**
3383bcc9736cSJeff Kirsher * hw_setup - setup the hardware
3384bcc9736cSJeff Kirsher * @hw: The hardware instance.
3385bcc9736cSJeff Kirsher *
3386bcc9736cSJeff Kirsher * This routine setup the hardware for proper operation.
3387bcc9736cSJeff Kirsher */
hw_setup(struct ksz_hw * hw)3388bcc9736cSJeff Kirsher static void hw_setup(struct ksz_hw *hw)
3389bcc9736cSJeff Kirsher {
3390bcc9736cSJeff Kirsher #if SET_DEFAULT_LED
3391bcc9736cSJeff Kirsher u16 data;
3392bcc9736cSJeff Kirsher
3393bcc9736cSJeff Kirsher /* Change default LED mode. */
3394bcc9736cSJeff Kirsher data = readw(hw->io + KS8842_SWITCH_CTRL_5_OFFSET);
3395bcc9736cSJeff Kirsher data &= ~LED_MODE;
3396bcc9736cSJeff Kirsher data |= SET_DEFAULT_LED;
3397bcc9736cSJeff Kirsher writew(data, hw->io + KS8842_SWITCH_CTRL_5_OFFSET);
3398bcc9736cSJeff Kirsher #endif
3399bcc9736cSJeff Kirsher
3400bcc9736cSJeff Kirsher /* Setup transmit control. */
3401bcc9736cSJeff Kirsher hw->tx_cfg = (DMA_TX_PAD_ENABLE | DMA_TX_CRC_ENABLE |
3402bcc9736cSJeff Kirsher (DMA_BURST_DEFAULT << DMA_BURST_SHIFT) | DMA_TX_ENABLE);
3403bcc9736cSJeff Kirsher
3404bcc9736cSJeff Kirsher /* Setup receive control. */
3405bcc9736cSJeff Kirsher hw->rx_cfg = (DMA_RX_BROADCAST | DMA_RX_UNICAST |
3406bcc9736cSJeff Kirsher (DMA_BURST_DEFAULT << DMA_BURST_SHIFT) | DMA_RX_ENABLE);
3407bcc9736cSJeff Kirsher hw->rx_cfg |= KS884X_DMA_RX_MULTICAST;
3408bcc9736cSJeff Kirsher
3409bcc9736cSJeff Kirsher /* Hardware cannot handle UDP packet in IP fragments. */
3410bcc9736cSJeff Kirsher hw->rx_cfg |= (DMA_RX_CSUM_TCP | DMA_RX_CSUM_IP);
3411bcc9736cSJeff Kirsher
3412bcc9736cSJeff Kirsher if (hw->all_multi)
3413bcc9736cSJeff Kirsher hw->rx_cfg |= DMA_RX_ALL_MULTICAST;
3414bcc9736cSJeff Kirsher if (hw->promiscuous)
3415bcc9736cSJeff Kirsher hw->rx_cfg |= DMA_RX_PROMISCUOUS;
3416bcc9736cSJeff Kirsher }
3417bcc9736cSJeff Kirsher
3418bcc9736cSJeff Kirsher /**
3419bcc9736cSJeff Kirsher * hw_setup_intr - setup interrupt mask
3420bcc9736cSJeff Kirsher * @hw: The hardware instance.
3421bcc9736cSJeff Kirsher *
3422bcc9736cSJeff Kirsher * This routine setup the interrupt mask for proper operation.
3423bcc9736cSJeff Kirsher */
hw_setup_intr(struct ksz_hw * hw)3424bcc9736cSJeff Kirsher static void hw_setup_intr(struct ksz_hw *hw)
3425bcc9736cSJeff Kirsher {
3426bcc9736cSJeff Kirsher hw->intr_mask = KS884X_INT_MASK | KS884X_INT_RX_OVERRUN;
3427bcc9736cSJeff Kirsher }
3428bcc9736cSJeff Kirsher
ksz_check_desc_num(struct ksz_desc_info * info)3429bcc9736cSJeff Kirsher static void ksz_check_desc_num(struct ksz_desc_info *info)
3430bcc9736cSJeff Kirsher {
3431bcc9736cSJeff Kirsher #define MIN_DESC_SHIFT 2
3432bcc9736cSJeff Kirsher
3433bcc9736cSJeff Kirsher int alloc = info->alloc;
3434bcc9736cSJeff Kirsher int shift;
3435bcc9736cSJeff Kirsher
3436bcc9736cSJeff Kirsher shift = 0;
3437bcc9736cSJeff Kirsher while (!(alloc & 1)) {
3438bcc9736cSJeff Kirsher shift++;
3439bcc9736cSJeff Kirsher alloc >>= 1;
3440bcc9736cSJeff Kirsher }
3441bcc9736cSJeff Kirsher if (alloc != 1 || shift < MIN_DESC_SHIFT) {
3442bcc9736cSJeff Kirsher pr_alert("Hardware descriptor numbers not right!\n");
3443bcc9736cSJeff Kirsher while (alloc) {
3444bcc9736cSJeff Kirsher shift++;
3445bcc9736cSJeff Kirsher alloc >>= 1;
3446bcc9736cSJeff Kirsher }
3447bcc9736cSJeff Kirsher if (shift < MIN_DESC_SHIFT)
3448bcc9736cSJeff Kirsher shift = MIN_DESC_SHIFT;
3449bcc9736cSJeff Kirsher alloc = 1 << shift;
3450bcc9736cSJeff Kirsher info->alloc = alloc;
3451bcc9736cSJeff Kirsher }
3452bcc9736cSJeff Kirsher info->mask = info->alloc - 1;
3453bcc9736cSJeff Kirsher }
3454bcc9736cSJeff Kirsher
hw_init_desc(struct ksz_desc_info * desc_info,int transmit)3455bcc9736cSJeff Kirsher static void hw_init_desc(struct ksz_desc_info *desc_info, int transmit)
3456bcc9736cSJeff Kirsher {
3457bcc9736cSJeff Kirsher int i;
3458bcc9736cSJeff Kirsher u32 phys = desc_info->ring_phys;
3459bcc9736cSJeff Kirsher struct ksz_hw_desc *desc = desc_info->ring_virt;
3460bcc9736cSJeff Kirsher struct ksz_desc *cur = desc_info->ring;
3461bcc9736cSJeff Kirsher struct ksz_desc *previous = NULL;
3462bcc9736cSJeff Kirsher
3463bcc9736cSJeff Kirsher for (i = 0; i < desc_info->alloc; i++) {
3464bcc9736cSJeff Kirsher cur->phw = desc++;
3465bcc9736cSJeff Kirsher phys += desc_info->size;
3466bcc9736cSJeff Kirsher previous = cur++;
3467bcc9736cSJeff Kirsher previous->phw->next = cpu_to_le32(phys);
3468bcc9736cSJeff Kirsher }
3469bcc9736cSJeff Kirsher previous->phw->next = cpu_to_le32(desc_info->ring_phys);
3470bcc9736cSJeff Kirsher previous->sw.buf.rx.end_of_ring = 1;
3471bcc9736cSJeff Kirsher previous->phw->buf.data = cpu_to_le32(previous->sw.buf.data);
3472bcc9736cSJeff Kirsher
3473bcc9736cSJeff Kirsher desc_info->avail = desc_info->alloc;
3474bcc9736cSJeff Kirsher desc_info->last = desc_info->next = 0;
3475bcc9736cSJeff Kirsher
3476bcc9736cSJeff Kirsher desc_info->cur = desc_info->ring;
3477bcc9736cSJeff Kirsher }
3478bcc9736cSJeff Kirsher
3479bcc9736cSJeff Kirsher /**
3480bcc9736cSJeff Kirsher * hw_set_desc_base - set descriptor base addresses
3481bcc9736cSJeff Kirsher * @hw: The hardware instance.
3482bcc9736cSJeff Kirsher * @tx_addr: The transmit descriptor base.
3483bcc9736cSJeff Kirsher * @rx_addr: The receive descriptor base.
3484bcc9736cSJeff Kirsher *
3485bcc9736cSJeff Kirsher * This routine programs the descriptor base addresses after reset.
3486bcc9736cSJeff Kirsher */
hw_set_desc_base(struct ksz_hw * hw,u32 tx_addr,u32 rx_addr)3487bcc9736cSJeff Kirsher static void hw_set_desc_base(struct ksz_hw *hw, u32 tx_addr, u32 rx_addr)
3488bcc9736cSJeff Kirsher {
3489bcc9736cSJeff Kirsher /* Set base address of Tx/Rx descriptors. */
3490bcc9736cSJeff Kirsher writel(tx_addr, hw->io + KS_DMA_TX_ADDR);
3491bcc9736cSJeff Kirsher writel(rx_addr, hw->io + KS_DMA_RX_ADDR);
3492bcc9736cSJeff Kirsher }
3493bcc9736cSJeff Kirsher
hw_reset_pkts(struct ksz_desc_info * info)3494bcc9736cSJeff Kirsher static void hw_reset_pkts(struct ksz_desc_info *info)
3495bcc9736cSJeff Kirsher {
3496bcc9736cSJeff Kirsher info->cur = info->ring;
3497bcc9736cSJeff Kirsher info->avail = info->alloc;
3498bcc9736cSJeff Kirsher info->last = info->next = 0;
3499bcc9736cSJeff Kirsher }
3500bcc9736cSJeff Kirsher
hw_resume_rx(struct ksz_hw * hw)3501bcc9736cSJeff Kirsher static inline void hw_resume_rx(struct ksz_hw *hw)
3502bcc9736cSJeff Kirsher {
3503bcc9736cSJeff Kirsher writel(DMA_START, hw->io + KS_DMA_RX_START);
3504bcc9736cSJeff Kirsher }
3505bcc9736cSJeff Kirsher
3506bcc9736cSJeff Kirsher /**
3507bcc9736cSJeff Kirsher * hw_start_rx - start receiving
3508bcc9736cSJeff Kirsher * @hw: The hardware instance.
3509bcc9736cSJeff Kirsher *
3510bcc9736cSJeff Kirsher * This routine starts the receive function of the hardware.
3511bcc9736cSJeff Kirsher */
hw_start_rx(struct ksz_hw * hw)3512bcc9736cSJeff Kirsher static void hw_start_rx(struct ksz_hw *hw)
3513bcc9736cSJeff Kirsher {
3514bcc9736cSJeff Kirsher writel(hw->rx_cfg, hw->io + KS_DMA_RX_CTRL);
3515bcc9736cSJeff Kirsher
3516bcc9736cSJeff Kirsher /* Notify when the receive stops. */
3517bcc9736cSJeff Kirsher hw->intr_mask |= KS884X_INT_RX_STOPPED;
3518bcc9736cSJeff Kirsher
3519bcc9736cSJeff Kirsher writel(DMA_START, hw->io + KS_DMA_RX_START);
3520bcc9736cSJeff Kirsher hw_ack_intr(hw, KS884X_INT_RX_STOPPED);
3521bcc9736cSJeff Kirsher hw->rx_stop++;
3522bcc9736cSJeff Kirsher
3523bcc9736cSJeff Kirsher /* Variable overflows. */
3524bcc9736cSJeff Kirsher if (0 == hw->rx_stop)
3525bcc9736cSJeff Kirsher hw->rx_stop = 2;
3526bcc9736cSJeff Kirsher }
3527bcc9736cSJeff Kirsher
352849ce9c2cSBen Hutchings /**
3529bcc9736cSJeff Kirsher * hw_stop_rx - stop receiving
3530bcc9736cSJeff Kirsher * @hw: The hardware instance.
3531bcc9736cSJeff Kirsher *
3532bcc9736cSJeff Kirsher * This routine stops the receive function of the hardware.
3533bcc9736cSJeff Kirsher */
hw_stop_rx(struct ksz_hw * hw)3534bcc9736cSJeff Kirsher static void hw_stop_rx(struct ksz_hw *hw)
3535bcc9736cSJeff Kirsher {
3536bcc9736cSJeff Kirsher hw->rx_stop = 0;
3537bcc9736cSJeff Kirsher hw_turn_off_intr(hw, KS884X_INT_RX_STOPPED);
3538bcc9736cSJeff Kirsher writel((hw->rx_cfg & ~DMA_RX_ENABLE), hw->io + KS_DMA_RX_CTRL);
3539bcc9736cSJeff Kirsher }
3540bcc9736cSJeff Kirsher
3541bcc9736cSJeff Kirsher /**
3542bcc9736cSJeff Kirsher * hw_start_tx - start transmitting
3543bcc9736cSJeff Kirsher * @hw: The hardware instance.
3544bcc9736cSJeff Kirsher *
3545bcc9736cSJeff Kirsher * This routine starts the transmit function of the hardware.
3546bcc9736cSJeff Kirsher */
hw_start_tx(struct ksz_hw * hw)3547bcc9736cSJeff Kirsher static void hw_start_tx(struct ksz_hw *hw)
3548bcc9736cSJeff Kirsher {
3549bcc9736cSJeff Kirsher writel(hw->tx_cfg, hw->io + KS_DMA_TX_CTRL);
3550bcc9736cSJeff Kirsher }
3551bcc9736cSJeff Kirsher
3552bcc9736cSJeff Kirsher /**
3553bcc9736cSJeff Kirsher * hw_stop_tx - stop transmitting
3554bcc9736cSJeff Kirsher * @hw: The hardware instance.
3555bcc9736cSJeff Kirsher *
3556bcc9736cSJeff Kirsher * This routine stops the transmit function of the hardware.
3557bcc9736cSJeff Kirsher */
hw_stop_tx(struct ksz_hw * hw)3558bcc9736cSJeff Kirsher static void hw_stop_tx(struct ksz_hw *hw)
3559bcc9736cSJeff Kirsher {
3560bcc9736cSJeff Kirsher writel((hw->tx_cfg & ~DMA_TX_ENABLE), hw->io + KS_DMA_TX_CTRL);
3561bcc9736cSJeff Kirsher }
3562bcc9736cSJeff Kirsher
3563bcc9736cSJeff Kirsher /**
3564bcc9736cSJeff Kirsher * hw_disable - disable hardware
3565bcc9736cSJeff Kirsher * @hw: The hardware instance.
3566bcc9736cSJeff Kirsher *
3567bcc9736cSJeff Kirsher * This routine disables the hardware.
3568bcc9736cSJeff Kirsher */
hw_disable(struct ksz_hw * hw)3569bcc9736cSJeff Kirsher static void hw_disable(struct ksz_hw *hw)
3570bcc9736cSJeff Kirsher {
3571bcc9736cSJeff Kirsher hw_stop_rx(hw);
3572bcc9736cSJeff Kirsher hw_stop_tx(hw);
3573bcc9736cSJeff Kirsher hw->enabled = 0;
3574bcc9736cSJeff Kirsher }
3575bcc9736cSJeff Kirsher
3576bcc9736cSJeff Kirsher /**
3577bcc9736cSJeff Kirsher * hw_enable - enable hardware
3578bcc9736cSJeff Kirsher * @hw: The hardware instance.
3579bcc9736cSJeff Kirsher *
3580bcc9736cSJeff Kirsher * This routine enables the hardware.
3581bcc9736cSJeff Kirsher */
hw_enable(struct ksz_hw * hw)3582bcc9736cSJeff Kirsher static void hw_enable(struct ksz_hw *hw)
3583bcc9736cSJeff Kirsher {
3584bcc9736cSJeff Kirsher hw_start_tx(hw);
3585bcc9736cSJeff Kirsher hw_start_rx(hw);
3586bcc9736cSJeff Kirsher hw->enabled = 1;
3587bcc9736cSJeff Kirsher }
3588bcc9736cSJeff Kirsher
3589bcc9736cSJeff Kirsher /**
3590bcc9736cSJeff Kirsher * hw_alloc_pkt - allocate enough descriptors for transmission
3591bcc9736cSJeff Kirsher * @hw: The hardware instance.
3592bcc9736cSJeff Kirsher * @length: The length of the packet.
3593bcc9736cSJeff Kirsher * @physical: Number of descriptors required.
3594bcc9736cSJeff Kirsher *
3595bcc9736cSJeff Kirsher * This function allocates descriptors for transmission.
3596bcc9736cSJeff Kirsher *
3597bcc9736cSJeff Kirsher * Return 0 if not successful; 1 for buffer copy; or number of descriptors.
3598bcc9736cSJeff Kirsher */
hw_alloc_pkt(struct ksz_hw * hw,int length,int physical)3599bcc9736cSJeff Kirsher static int hw_alloc_pkt(struct ksz_hw *hw, int length, int physical)
3600bcc9736cSJeff Kirsher {
3601bcc9736cSJeff Kirsher /* Always leave one descriptor free. */
3602bcc9736cSJeff Kirsher if (hw->tx_desc_info.avail <= 1)
3603bcc9736cSJeff Kirsher return 0;
3604bcc9736cSJeff Kirsher
3605bcc9736cSJeff Kirsher /* Allocate a descriptor for transmission and mark it current. */
3606bcc9736cSJeff Kirsher get_tx_pkt(&hw->tx_desc_info, &hw->tx_desc_info.cur);
3607bcc9736cSJeff Kirsher hw->tx_desc_info.cur->sw.buf.tx.first_seg = 1;
3608bcc9736cSJeff Kirsher
3609bcc9736cSJeff Kirsher /* Keep track of number of transmit descriptors used so far. */
3610bcc9736cSJeff Kirsher ++hw->tx_int_cnt;
3611bcc9736cSJeff Kirsher hw->tx_size += length;
3612bcc9736cSJeff Kirsher
3613bcc9736cSJeff Kirsher /* Cannot hold on too much data. */
3614bcc9736cSJeff Kirsher if (hw->tx_size >= MAX_TX_HELD_SIZE)
3615bcc9736cSJeff Kirsher hw->tx_int_cnt = hw->tx_int_mask + 1;
3616bcc9736cSJeff Kirsher
3617bcc9736cSJeff Kirsher if (physical > hw->tx_desc_info.avail)
3618bcc9736cSJeff Kirsher return 1;
3619bcc9736cSJeff Kirsher
3620bcc9736cSJeff Kirsher return hw->tx_desc_info.avail;
3621bcc9736cSJeff Kirsher }
3622bcc9736cSJeff Kirsher
3623bcc9736cSJeff Kirsher /**
3624bcc9736cSJeff Kirsher * hw_send_pkt - mark packet for transmission
3625bcc9736cSJeff Kirsher * @hw: The hardware instance.
3626bcc9736cSJeff Kirsher *
3627bcc9736cSJeff Kirsher * This routine marks the packet for transmission in PCI version.
3628bcc9736cSJeff Kirsher */
hw_send_pkt(struct ksz_hw * hw)3629bcc9736cSJeff Kirsher static void hw_send_pkt(struct ksz_hw *hw)
3630bcc9736cSJeff Kirsher {
3631bcc9736cSJeff Kirsher struct ksz_desc *cur = hw->tx_desc_info.cur;
3632bcc9736cSJeff Kirsher
3633bcc9736cSJeff Kirsher cur->sw.buf.tx.last_seg = 1;
3634bcc9736cSJeff Kirsher
3635bcc9736cSJeff Kirsher /* Interrupt only after specified number of descriptors used. */
3636bcc9736cSJeff Kirsher if (hw->tx_int_cnt > hw->tx_int_mask) {
3637bcc9736cSJeff Kirsher cur->sw.buf.tx.intr = 1;
3638bcc9736cSJeff Kirsher hw->tx_int_cnt = 0;
3639bcc9736cSJeff Kirsher hw->tx_size = 0;
3640bcc9736cSJeff Kirsher }
3641bcc9736cSJeff Kirsher
3642bcc9736cSJeff Kirsher /* KSZ8842 supports port directed transmission. */
3643bcc9736cSJeff Kirsher cur->sw.buf.tx.dest_port = hw->dst_ports;
3644bcc9736cSJeff Kirsher
3645bcc9736cSJeff Kirsher release_desc(cur);
3646bcc9736cSJeff Kirsher
3647bcc9736cSJeff Kirsher writel(0, hw->io + KS_DMA_TX_START);
3648bcc9736cSJeff Kirsher }
3649bcc9736cSJeff Kirsher
empty_addr(u8 * addr)3650bcc9736cSJeff Kirsher static int empty_addr(u8 *addr)
3651bcc9736cSJeff Kirsher {
3652bcc9736cSJeff Kirsher u32 *addr1 = (u32 *) addr;
3653bcc9736cSJeff Kirsher u16 *addr2 = (u16 *) &addr[4];
3654bcc9736cSJeff Kirsher
3655bcc9736cSJeff Kirsher return 0 == *addr1 && 0 == *addr2;
3656bcc9736cSJeff Kirsher }
3657bcc9736cSJeff Kirsher
3658bcc9736cSJeff Kirsher /**
3659bcc9736cSJeff Kirsher * hw_set_addr - set MAC address
3660bcc9736cSJeff Kirsher * @hw: The hardware instance.
3661bcc9736cSJeff Kirsher *
3662bcc9736cSJeff Kirsher * This routine programs the MAC address of the hardware when the address is
366303671057SMasahiro Yamada * overridden.
3664bcc9736cSJeff Kirsher */
hw_set_addr(struct ksz_hw * hw)3665bcc9736cSJeff Kirsher static void hw_set_addr(struct ksz_hw *hw)
3666bcc9736cSJeff Kirsher {
3667bcc9736cSJeff Kirsher int i;
3668bcc9736cSJeff Kirsher
36696a3c910cSJoe Perches for (i = 0; i < ETH_ALEN; i++)
3670bcc9736cSJeff Kirsher writeb(hw->override_addr[MAC_ADDR_ORDER(i)],
3671bcc9736cSJeff Kirsher hw->io + KS884X_ADDR_0_OFFSET + i);
3672bcc9736cSJeff Kirsher
3673bcc9736cSJeff Kirsher sw_set_addr(hw, hw->override_addr);
3674bcc9736cSJeff Kirsher }
3675bcc9736cSJeff Kirsher
3676bcc9736cSJeff Kirsher /**
3677bcc9736cSJeff Kirsher * hw_read_addr - read MAC address
3678bcc9736cSJeff Kirsher * @hw: The hardware instance.
3679bcc9736cSJeff Kirsher *
3680bcc9736cSJeff Kirsher * This routine retrieves the MAC address of the hardware.
3681bcc9736cSJeff Kirsher */
hw_read_addr(struct ksz_hw * hw)3682bcc9736cSJeff Kirsher static void hw_read_addr(struct ksz_hw *hw)
3683bcc9736cSJeff Kirsher {
3684bcc9736cSJeff Kirsher int i;
3685bcc9736cSJeff Kirsher
36866a3c910cSJoe Perches for (i = 0; i < ETH_ALEN; i++)
3687bcc9736cSJeff Kirsher hw->perm_addr[MAC_ADDR_ORDER(i)] = readb(hw->io +
3688bcc9736cSJeff Kirsher KS884X_ADDR_0_OFFSET + i);
3689bcc9736cSJeff Kirsher
3690bcc9736cSJeff Kirsher if (!hw->mac_override) {
36916a3c910cSJoe Perches memcpy(hw->override_addr, hw->perm_addr, ETH_ALEN);
3692bcc9736cSJeff Kirsher if (empty_addr(hw->override_addr)) {
36936a3c910cSJoe Perches memcpy(hw->perm_addr, DEFAULT_MAC_ADDRESS, ETH_ALEN);
3694bcc9736cSJeff Kirsher memcpy(hw->override_addr, DEFAULT_MAC_ADDRESS,
36956a3c910cSJoe Perches ETH_ALEN);
3696bcc9736cSJeff Kirsher hw->override_addr[5] += hw->id;
3697bcc9736cSJeff Kirsher hw_set_addr(hw);
3698bcc9736cSJeff Kirsher }
3699bcc9736cSJeff Kirsher }
3700bcc9736cSJeff Kirsher }
3701bcc9736cSJeff Kirsher
hw_ena_add_addr(struct ksz_hw * hw,int index,u8 * mac_addr)3702bcc9736cSJeff Kirsher static void hw_ena_add_addr(struct ksz_hw *hw, int index, u8 *mac_addr)
3703bcc9736cSJeff Kirsher {
3704bcc9736cSJeff Kirsher int i;
3705bcc9736cSJeff Kirsher u32 mac_addr_lo;
3706bcc9736cSJeff Kirsher u32 mac_addr_hi;
3707bcc9736cSJeff Kirsher
3708bcc9736cSJeff Kirsher mac_addr_hi = 0;
3709bcc9736cSJeff Kirsher for (i = 0; i < 2; i++) {
3710bcc9736cSJeff Kirsher mac_addr_hi <<= 8;
3711bcc9736cSJeff Kirsher mac_addr_hi |= mac_addr[i];
3712bcc9736cSJeff Kirsher }
3713bcc9736cSJeff Kirsher mac_addr_hi |= ADD_ADDR_ENABLE;
3714bcc9736cSJeff Kirsher mac_addr_lo = 0;
3715bcc9736cSJeff Kirsher for (i = 2; i < 6; i++) {
3716bcc9736cSJeff Kirsher mac_addr_lo <<= 8;
3717bcc9736cSJeff Kirsher mac_addr_lo |= mac_addr[i];
3718bcc9736cSJeff Kirsher }
3719bcc9736cSJeff Kirsher index *= ADD_ADDR_INCR;
3720bcc9736cSJeff Kirsher
3721bcc9736cSJeff Kirsher writel(mac_addr_lo, hw->io + index + KS_ADD_ADDR_0_LO);
3722bcc9736cSJeff Kirsher writel(mac_addr_hi, hw->io + index + KS_ADD_ADDR_0_HI);
3723bcc9736cSJeff Kirsher }
3724bcc9736cSJeff Kirsher
hw_set_add_addr(struct ksz_hw * hw)3725bcc9736cSJeff Kirsher static void hw_set_add_addr(struct ksz_hw *hw)
3726bcc9736cSJeff Kirsher {
3727bcc9736cSJeff Kirsher int i;
3728bcc9736cSJeff Kirsher
3729bcc9736cSJeff Kirsher for (i = 0; i < ADDITIONAL_ENTRIES; i++) {
3730bcc9736cSJeff Kirsher if (empty_addr(hw->address[i]))
3731bcc9736cSJeff Kirsher writel(0, hw->io + ADD_ADDR_INCR * i +
3732bcc9736cSJeff Kirsher KS_ADD_ADDR_0_HI);
3733bcc9736cSJeff Kirsher else
3734bcc9736cSJeff Kirsher hw_ena_add_addr(hw, i, hw->address[i]);
3735bcc9736cSJeff Kirsher }
3736bcc9736cSJeff Kirsher }
3737bcc9736cSJeff Kirsher
hw_add_addr(struct ksz_hw * hw,const u8 * mac_addr)373876660757SJakub Kicinski static int hw_add_addr(struct ksz_hw *hw, const u8 *mac_addr)
3739bcc9736cSJeff Kirsher {
3740bcc9736cSJeff Kirsher int i;
3741bcc9736cSJeff Kirsher int j = ADDITIONAL_ENTRIES;
3742bcc9736cSJeff Kirsher
37437ced5440Sdingtianhong if (ether_addr_equal(hw->override_addr, mac_addr))
3744bcc9736cSJeff Kirsher return 0;
3745bcc9736cSJeff Kirsher for (i = 0; i < hw->addr_list_size; i++) {
37467ced5440Sdingtianhong if (ether_addr_equal(hw->address[i], mac_addr))
3747bcc9736cSJeff Kirsher return 0;
3748bcc9736cSJeff Kirsher if (ADDITIONAL_ENTRIES == j && empty_addr(hw->address[i]))
3749bcc9736cSJeff Kirsher j = i;
3750bcc9736cSJeff Kirsher }
3751bcc9736cSJeff Kirsher if (j < ADDITIONAL_ENTRIES) {
37526a3c910cSJoe Perches memcpy(hw->address[j], mac_addr, ETH_ALEN);
3753bcc9736cSJeff Kirsher hw_ena_add_addr(hw, j, hw->address[j]);
3754bcc9736cSJeff Kirsher return 0;
3755bcc9736cSJeff Kirsher }
3756bcc9736cSJeff Kirsher return -1;
3757bcc9736cSJeff Kirsher }
3758bcc9736cSJeff Kirsher
hw_del_addr(struct ksz_hw * hw,const u8 * mac_addr)375976660757SJakub Kicinski static int hw_del_addr(struct ksz_hw *hw, const u8 *mac_addr)
3760bcc9736cSJeff Kirsher {
3761bcc9736cSJeff Kirsher int i;
3762bcc9736cSJeff Kirsher
3763bcc9736cSJeff Kirsher for (i = 0; i < hw->addr_list_size; i++) {
37647ced5440Sdingtianhong if (ether_addr_equal(hw->address[i], mac_addr)) {
3765c7bf7169SJoe Perches eth_zero_addr(hw->address[i]);
3766bcc9736cSJeff Kirsher writel(0, hw->io + ADD_ADDR_INCR * i +
3767bcc9736cSJeff Kirsher KS_ADD_ADDR_0_HI);
3768bcc9736cSJeff Kirsher return 0;
3769bcc9736cSJeff Kirsher }
3770bcc9736cSJeff Kirsher }
3771bcc9736cSJeff Kirsher return -1;
3772bcc9736cSJeff Kirsher }
3773bcc9736cSJeff Kirsher
3774bcc9736cSJeff Kirsher /**
3775bcc9736cSJeff Kirsher * hw_clr_multicast - clear multicast addresses
3776bcc9736cSJeff Kirsher * @hw: The hardware instance.
3777bcc9736cSJeff Kirsher *
3778bcc9736cSJeff Kirsher * This routine removes all multicast addresses set in the hardware.
3779bcc9736cSJeff Kirsher */
hw_clr_multicast(struct ksz_hw * hw)3780bcc9736cSJeff Kirsher static void hw_clr_multicast(struct ksz_hw *hw)
3781bcc9736cSJeff Kirsher {
3782bcc9736cSJeff Kirsher int i;
3783bcc9736cSJeff Kirsher
3784bcc9736cSJeff Kirsher for (i = 0; i < HW_MULTICAST_SIZE; i++) {
3785bcc9736cSJeff Kirsher hw->multi_bits[i] = 0;
3786bcc9736cSJeff Kirsher
3787bcc9736cSJeff Kirsher writeb(0, hw->io + KS884X_MULTICAST_0_OFFSET + i);
3788bcc9736cSJeff Kirsher }
3789bcc9736cSJeff Kirsher }
3790bcc9736cSJeff Kirsher
3791bcc9736cSJeff Kirsher /**
3792bcc9736cSJeff Kirsher * hw_set_grp_addr - set multicast addresses
3793bcc9736cSJeff Kirsher * @hw: The hardware instance.
3794bcc9736cSJeff Kirsher *
3795bcc9736cSJeff Kirsher * This routine programs multicast addresses for the hardware to accept those
3796bcc9736cSJeff Kirsher * addresses.
3797bcc9736cSJeff Kirsher */
hw_set_grp_addr(struct ksz_hw * hw)3798bcc9736cSJeff Kirsher static void hw_set_grp_addr(struct ksz_hw *hw)
3799bcc9736cSJeff Kirsher {
3800bcc9736cSJeff Kirsher int i;
3801bcc9736cSJeff Kirsher int index;
3802bcc9736cSJeff Kirsher int position;
3803bcc9736cSJeff Kirsher int value;
3804bcc9736cSJeff Kirsher
3805bcc9736cSJeff Kirsher memset(hw->multi_bits, 0, sizeof(u8) * HW_MULTICAST_SIZE);
3806bcc9736cSJeff Kirsher
3807bcc9736cSJeff Kirsher for (i = 0; i < hw->multi_list_size; i++) {
3808bcc9736cSJeff Kirsher position = (ether_crc(6, hw->multi_list[i]) >> 26) & 0x3f;
3809bcc9736cSJeff Kirsher index = position >> 3;
3810bcc9736cSJeff Kirsher value = 1 << (position & 7);
3811bcc9736cSJeff Kirsher hw->multi_bits[index] |= (u8) value;
3812bcc9736cSJeff Kirsher }
3813bcc9736cSJeff Kirsher
3814bcc9736cSJeff Kirsher for (i = 0; i < HW_MULTICAST_SIZE; i++)
3815bcc9736cSJeff Kirsher writeb(hw->multi_bits[i], hw->io + KS884X_MULTICAST_0_OFFSET +
3816bcc9736cSJeff Kirsher i);
3817bcc9736cSJeff Kirsher }
3818bcc9736cSJeff Kirsher
3819bcc9736cSJeff Kirsher /**
3820bcc9736cSJeff Kirsher * hw_set_multicast - enable or disable all multicast receiving
3821bcc9736cSJeff Kirsher * @hw: The hardware instance.
3822bcc9736cSJeff Kirsher * @multicast: To turn on or off the all multicast feature.
3823bcc9736cSJeff Kirsher *
3824bcc9736cSJeff Kirsher * This routine enables/disables the hardware to accept all multicast packets.
3825bcc9736cSJeff Kirsher */
hw_set_multicast(struct ksz_hw * hw,u8 multicast)3826bcc9736cSJeff Kirsher static void hw_set_multicast(struct ksz_hw *hw, u8 multicast)
3827bcc9736cSJeff Kirsher {
3828bcc9736cSJeff Kirsher /* Stop receiving for reconfiguration. */
3829bcc9736cSJeff Kirsher hw_stop_rx(hw);
3830bcc9736cSJeff Kirsher
3831bcc9736cSJeff Kirsher if (multicast)
3832bcc9736cSJeff Kirsher hw->rx_cfg |= DMA_RX_ALL_MULTICAST;
3833bcc9736cSJeff Kirsher else
3834bcc9736cSJeff Kirsher hw->rx_cfg &= ~DMA_RX_ALL_MULTICAST;
3835bcc9736cSJeff Kirsher
3836bcc9736cSJeff Kirsher if (hw->enabled)
3837bcc9736cSJeff Kirsher hw_start_rx(hw);
3838bcc9736cSJeff Kirsher }
3839bcc9736cSJeff Kirsher
3840bcc9736cSJeff Kirsher /**
3841bcc9736cSJeff Kirsher * hw_set_promiscuous - enable or disable promiscuous receiving
3842bcc9736cSJeff Kirsher * @hw: The hardware instance.
3843bcc9736cSJeff Kirsher * @prom: To turn on or off the promiscuous feature.
3844bcc9736cSJeff Kirsher *
3845bcc9736cSJeff Kirsher * This routine enables/disables the hardware to accept all packets.
3846bcc9736cSJeff Kirsher */
hw_set_promiscuous(struct ksz_hw * hw,u8 prom)3847bcc9736cSJeff Kirsher static void hw_set_promiscuous(struct ksz_hw *hw, u8 prom)
3848bcc9736cSJeff Kirsher {
3849bcc9736cSJeff Kirsher /* Stop receiving for reconfiguration. */
3850bcc9736cSJeff Kirsher hw_stop_rx(hw);
3851bcc9736cSJeff Kirsher
3852bcc9736cSJeff Kirsher if (prom)
3853bcc9736cSJeff Kirsher hw->rx_cfg |= DMA_RX_PROMISCUOUS;
3854bcc9736cSJeff Kirsher else
3855bcc9736cSJeff Kirsher hw->rx_cfg &= ~DMA_RX_PROMISCUOUS;
3856bcc9736cSJeff Kirsher
3857bcc9736cSJeff Kirsher if (hw->enabled)
3858bcc9736cSJeff Kirsher hw_start_rx(hw);
3859bcc9736cSJeff Kirsher }
3860bcc9736cSJeff Kirsher
3861bcc9736cSJeff Kirsher /**
3862bcc9736cSJeff Kirsher * sw_enable - enable the switch
3863bcc9736cSJeff Kirsher * @hw: The hardware instance.
3864bcc9736cSJeff Kirsher * @enable: The flag to enable or disable the switch
3865bcc9736cSJeff Kirsher *
3866bcc9736cSJeff Kirsher * This routine is used to enable/disable the switch in KSZ8842.
3867bcc9736cSJeff Kirsher */
sw_enable(struct ksz_hw * hw,int enable)3868bcc9736cSJeff Kirsher static void sw_enable(struct ksz_hw *hw, int enable)
3869bcc9736cSJeff Kirsher {
3870bcc9736cSJeff Kirsher int port;
3871bcc9736cSJeff Kirsher
3872bcc9736cSJeff Kirsher for (port = 0; port < SWITCH_PORT_NUM; port++) {
3873bcc9736cSJeff Kirsher if (hw->dev_count > 1) {
3874bcc9736cSJeff Kirsher /* Set port-base vlan membership with host port. */
3875bcc9736cSJeff Kirsher sw_cfg_port_base_vlan(hw, port,
3876bcc9736cSJeff Kirsher HOST_MASK | (1 << port));
3877bcc9736cSJeff Kirsher port_set_stp_state(hw, port, STP_STATE_DISABLED);
3878bcc9736cSJeff Kirsher } else {
3879bcc9736cSJeff Kirsher sw_cfg_port_base_vlan(hw, port, PORT_MASK);
3880bcc9736cSJeff Kirsher port_set_stp_state(hw, port, STP_STATE_FORWARDING);
3881bcc9736cSJeff Kirsher }
3882bcc9736cSJeff Kirsher }
3883bcc9736cSJeff Kirsher if (hw->dev_count > 1)
3884bcc9736cSJeff Kirsher port_set_stp_state(hw, SWITCH_PORT_NUM, STP_STATE_SIMPLE);
3885bcc9736cSJeff Kirsher else
3886bcc9736cSJeff Kirsher port_set_stp_state(hw, SWITCH_PORT_NUM, STP_STATE_FORWARDING);
3887bcc9736cSJeff Kirsher
3888bcc9736cSJeff Kirsher if (enable)
3889bcc9736cSJeff Kirsher enable = KS8842_START;
3890bcc9736cSJeff Kirsher writew(enable, hw->io + KS884X_CHIP_ID_OFFSET);
3891bcc9736cSJeff Kirsher }
3892bcc9736cSJeff Kirsher
3893bcc9736cSJeff Kirsher /**
3894bcc9736cSJeff Kirsher * sw_setup - setup the switch
3895bcc9736cSJeff Kirsher * @hw: The hardware instance.
3896bcc9736cSJeff Kirsher *
3897bcc9736cSJeff Kirsher * This routine setup the hardware switch engine for default operation.
3898bcc9736cSJeff Kirsher */
sw_setup(struct ksz_hw * hw)3899bcc9736cSJeff Kirsher static void sw_setup(struct ksz_hw *hw)
3900bcc9736cSJeff Kirsher {
3901bcc9736cSJeff Kirsher int port;
3902bcc9736cSJeff Kirsher
3903bcc9736cSJeff Kirsher sw_set_global_ctrl(hw);
3904bcc9736cSJeff Kirsher
3905bcc9736cSJeff Kirsher /* Enable switch broadcast storm protection at 10% percent rate. */
3906bcc9736cSJeff Kirsher sw_init_broad_storm(hw);
3907bcc9736cSJeff Kirsher hw_cfg_broad_storm(hw, BROADCAST_STORM_PROTECTION_RATE);
3908bcc9736cSJeff Kirsher for (port = 0; port < SWITCH_PORT_NUM; port++)
3909bcc9736cSJeff Kirsher sw_ena_broad_storm(hw, port);
3910bcc9736cSJeff Kirsher
3911bcc9736cSJeff Kirsher sw_init_prio(hw);
3912bcc9736cSJeff Kirsher
3913bcc9736cSJeff Kirsher sw_init_mirror(hw);
3914bcc9736cSJeff Kirsher
3915bcc9736cSJeff Kirsher sw_init_prio_rate(hw);
3916bcc9736cSJeff Kirsher
3917bcc9736cSJeff Kirsher sw_init_vlan(hw);
3918bcc9736cSJeff Kirsher
3919bcc9736cSJeff Kirsher if (hw->features & STP_SUPPORT)
3920bcc9736cSJeff Kirsher sw_init_stp(hw);
3921bcc9736cSJeff Kirsher if (!sw_chk(hw, KS8842_SWITCH_CTRL_1_OFFSET,
3922bcc9736cSJeff Kirsher SWITCH_TX_FLOW_CTRL | SWITCH_RX_FLOW_CTRL))
3923bcc9736cSJeff Kirsher hw->overrides |= PAUSE_FLOW_CTRL;
3924bcc9736cSJeff Kirsher sw_enable(hw, 1);
3925bcc9736cSJeff Kirsher }
3926bcc9736cSJeff Kirsher
3927bcc9736cSJeff Kirsher /**
3928bcc9736cSJeff Kirsher * ksz_start_timer - start kernel timer
3929bcc9736cSJeff Kirsher * @info: Kernel timer information.
3930bcc9736cSJeff Kirsher * @time: The time tick.
3931bcc9736cSJeff Kirsher *
3932bcc9736cSJeff Kirsher * This routine starts the kernel timer after the specified time tick.
3933bcc9736cSJeff Kirsher */
ksz_start_timer(struct ksz_timer_info * info,int time)3934bcc9736cSJeff Kirsher static void ksz_start_timer(struct ksz_timer_info *info, int time)
3935bcc9736cSJeff Kirsher {
3936bcc9736cSJeff Kirsher info->cnt = 0;
3937bcc9736cSJeff Kirsher info->timer.expires = jiffies + time;
3938bcc9736cSJeff Kirsher add_timer(&info->timer);
3939bcc9736cSJeff Kirsher
3940bcc9736cSJeff Kirsher /* infinity */
3941bcc9736cSJeff Kirsher info->max = -1;
3942bcc9736cSJeff Kirsher }
3943bcc9736cSJeff Kirsher
3944bcc9736cSJeff Kirsher /**
3945bcc9736cSJeff Kirsher * ksz_stop_timer - stop kernel timer
3946bcc9736cSJeff Kirsher * @info: Kernel timer information.
3947bcc9736cSJeff Kirsher *
3948bcc9736cSJeff Kirsher * This routine stops the kernel timer.
3949bcc9736cSJeff Kirsher */
ksz_stop_timer(struct ksz_timer_info * info)3950bcc9736cSJeff Kirsher static void ksz_stop_timer(struct ksz_timer_info *info)
3951bcc9736cSJeff Kirsher {
3952bcc9736cSJeff Kirsher if (info->max) {
3953bcc9736cSJeff Kirsher info->max = 0;
3954bcc9736cSJeff Kirsher del_timer_sync(&info->timer);
3955bcc9736cSJeff Kirsher }
3956bcc9736cSJeff Kirsher }
3957bcc9736cSJeff Kirsher
ksz_init_timer(struct ksz_timer_info * info,int period,void (* function)(struct timer_list *))3958bcc9736cSJeff Kirsher static void ksz_init_timer(struct ksz_timer_info *info, int period,
395911dd894eSKees Cook void (*function)(struct timer_list *))
3960bcc9736cSJeff Kirsher {
3961bcc9736cSJeff Kirsher info->max = 0;
3962bcc9736cSJeff Kirsher info->period = period;
396311dd894eSKees Cook timer_setup(&info->timer, function, 0);
3964bcc9736cSJeff Kirsher }
3965bcc9736cSJeff Kirsher
ksz_update_timer(struct ksz_timer_info * info)3966bcc9736cSJeff Kirsher static void ksz_update_timer(struct ksz_timer_info *info)
3967bcc9736cSJeff Kirsher {
3968bcc9736cSJeff Kirsher ++info->cnt;
3969bcc9736cSJeff Kirsher if (info->max > 0) {
3970bcc9736cSJeff Kirsher if (info->cnt < info->max) {
3971bcc9736cSJeff Kirsher info->timer.expires = jiffies + info->period;
3972bcc9736cSJeff Kirsher add_timer(&info->timer);
3973bcc9736cSJeff Kirsher } else
3974bcc9736cSJeff Kirsher info->max = 0;
3975bcc9736cSJeff Kirsher } else if (info->max < 0) {
3976bcc9736cSJeff Kirsher info->timer.expires = jiffies + info->period;
3977bcc9736cSJeff Kirsher add_timer(&info->timer);
3978bcc9736cSJeff Kirsher }
3979bcc9736cSJeff Kirsher }
3980bcc9736cSJeff Kirsher
3981bcc9736cSJeff Kirsher /**
3982bcc9736cSJeff Kirsher * ksz_alloc_soft_desc - allocate software descriptors
3983bcc9736cSJeff Kirsher * @desc_info: Descriptor information structure.
3984bcc9736cSJeff Kirsher * @transmit: Indication that descriptors are for transmit.
3985bcc9736cSJeff Kirsher *
3986bcc9736cSJeff Kirsher * This local function allocates software descriptors for manipulation in
3987bcc9736cSJeff Kirsher * memory.
3988bcc9736cSJeff Kirsher *
3989bcc9736cSJeff Kirsher * Return 0 if successful.
3990bcc9736cSJeff Kirsher */
ksz_alloc_soft_desc(struct ksz_desc_info * desc_info,int transmit)3991bcc9736cSJeff Kirsher static int ksz_alloc_soft_desc(struct ksz_desc_info *desc_info, int transmit)
3992bcc9736cSJeff Kirsher {
39936396bb22SKees Cook desc_info->ring = kcalloc(desc_info->alloc, sizeof(struct ksz_desc),
3994bcc9736cSJeff Kirsher GFP_KERNEL);
3995bcc9736cSJeff Kirsher if (!desc_info->ring)
3996bcc9736cSJeff Kirsher return 1;
3997bcc9736cSJeff Kirsher hw_init_desc(desc_info, transmit);
3998bcc9736cSJeff Kirsher return 0;
3999bcc9736cSJeff Kirsher }
4000bcc9736cSJeff Kirsher
4001bcc9736cSJeff Kirsher /**
4002bcc9736cSJeff Kirsher * ksz_alloc_desc - allocate hardware descriptors
4003bcc9736cSJeff Kirsher * @adapter: Adapter information structure.
4004bcc9736cSJeff Kirsher *
4005bcc9736cSJeff Kirsher * This local function allocates hardware descriptors for receiving and
4006bcc9736cSJeff Kirsher * transmitting.
4007bcc9736cSJeff Kirsher *
4008bcc9736cSJeff Kirsher * Return 0 if successful.
4009bcc9736cSJeff Kirsher */
ksz_alloc_desc(struct dev_info * adapter)4010bcc9736cSJeff Kirsher static int ksz_alloc_desc(struct dev_info *adapter)
4011bcc9736cSJeff Kirsher {
4012bcc9736cSJeff Kirsher struct ksz_hw *hw = &adapter->hw;
4013bcc9736cSJeff Kirsher int offset;
4014bcc9736cSJeff Kirsher
4015bcc9736cSJeff Kirsher /* Allocate memory for RX & TX descriptors. */
4016bcc9736cSJeff Kirsher adapter->desc_pool.alloc_size =
4017bcc9736cSJeff Kirsher hw->rx_desc_info.size * hw->rx_desc_info.alloc +
4018bcc9736cSJeff Kirsher hw->tx_desc_info.size * hw->tx_desc_info.alloc +
4019bcc9736cSJeff Kirsher DESC_ALIGNMENT;
4020bcc9736cSJeff Kirsher
4021bcc9736cSJeff Kirsher adapter->desc_pool.alloc_virt =
402281adcd65SChristophe JAILLET dma_alloc_coherent(&adapter->pdev->dev,
4023a2d0abc6SJoe Perches adapter->desc_pool.alloc_size,
402481adcd65SChristophe JAILLET &adapter->desc_pool.dma_addr, GFP_KERNEL);
4025bcc9736cSJeff Kirsher if (adapter->desc_pool.alloc_virt == NULL) {
4026bcc9736cSJeff Kirsher adapter->desc_pool.alloc_size = 0;
4027bcc9736cSJeff Kirsher return 1;
4028bcc9736cSJeff Kirsher }
4029bcc9736cSJeff Kirsher
4030bcc9736cSJeff Kirsher /* Align to the next cache line boundary. */
4031bcc9736cSJeff Kirsher offset = (((ulong) adapter->desc_pool.alloc_virt % DESC_ALIGNMENT) ?
4032bcc9736cSJeff Kirsher (DESC_ALIGNMENT -
4033bcc9736cSJeff Kirsher ((ulong) adapter->desc_pool.alloc_virt % DESC_ALIGNMENT)) : 0);
4034bcc9736cSJeff Kirsher adapter->desc_pool.virt = adapter->desc_pool.alloc_virt + offset;
4035bcc9736cSJeff Kirsher adapter->desc_pool.phys = adapter->desc_pool.dma_addr + offset;
4036bcc9736cSJeff Kirsher
4037bcc9736cSJeff Kirsher /* Allocate receive/transmit descriptors. */
4038bcc9736cSJeff Kirsher hw->rx_desc_info.ring_virt = (struct ksz_hw_desc *)
4039bcc9736cSJeff Kirsher adapter->desc_pool.virt;
4040bcc9736cSJeff Kirsher hw->rx_desc_info.ring_phys = adapter->desc_pool.phys;
4041bcc9736cSJeff Kirsher offset = hw->rx_desc_info.alloc * hw->rx_desc_info.size;
4042bcc9736cSJeff Kirsher hw->tx_desc_info.ring_virt = (struct ksz_hw_desc *)
4043bcc9736cSJeff Kirsher (adapter->desc_pool.virt + offset);
4044bcc9736cSJeff Kirsher hw->tx_desc_info.ring_phys = adapter->desc_pool.phys + offset;
4045bcc9736cSJeff Kirsher
4046bcc9736cSJeff Kirsher if (ksz_alloc_soft_desc(&hw->rx_desc_info, 0))
4047bcc9736cSJeff Kirsher return 1;
4048bcc9736cSJeff Kirsher if (ksz_alloc_soft_desc(&hw->tx_desc_info, 1))
4049bcc9736cSJeff Kirsher return 1;
4050bcc9736cSJeff Kirsher
4051bcc9736cSJeff Kirsher return 0;
4052bcc9736cSJeff Kirsher }
4053bcc9736cSJeff Kirsher
4054bcc9736cSJeff Kirsher /**
4055bcc9736cSJeff Kirsher * free_dma_buf - release DMA buffer resources
4056bcc9736cSJeff Kirsher * @adapter: Adapter information structure.
4057d0ea5cbdSJesse Brandeburg * @dma_buf: pointer to buf
4058d0ea5cbdSJesse Brandeburg * @direction: to or from device
4059bcc9736cSJeff Kirsher *
4060bcc9736cSJeff Kirsher * This routine is just a helper function to release the DMA buffer resources.
4061bcc9736cSJeff Kirsher */
free_dma_buf(struct dev_info * adapter,struct ksz_dma_buf * dma_buf,int direction)4062bcc9736cSJeff Kirsher static void free_dma_buf(struct dev_info *adapter, struct ksz_dma_buf *dma_buf,
4063bcc9736cSJeff Kirsher int direction)
4064bcc9736cSJeff Kirsher {
406581adcd65SChristophe JAILLET dma_unmap_single(&adapter->pdev->dev, dma_buf->dma, dma_buf->len,
406681adcd65SChristophe JAILLET direction);
4067bcc9736cSJeff Kirsher dev_kfree_skb(dma_buf->skb);
4068bcc9736cSJeff Kirsher dma_buf->skb = NULL;
4069bcc9736cSJeff Kirsher dma_buf->dma = 0;
4070bcc9736cSJeff Kirsher }
4071bcc9736cSJeff Kirsher
4072bcc9736cSJeff Kirsher /**
4073bcc9736cSJeff Kirsher * ksz_init_rx_buffers - initialize receive descriptors
4074bcc9736cSJeff Kirsher * @adapter: Adapter information structure.
4075bcc9736cSJeff Kirsher *
4076bcc9736cSJeff Kirsher * This routine initializes DMA buffers for receiving.
4077bcc9736cSJeff Kirsher */
ksz_init_rx_buffers(struct dev_info * adapter)4078bcc9736cSJeff Kirsher static void ksz_init_rx_buffers(struct dev_info *adapter)
4079bcc9736cSJeff Kirsher {
4080bcc9736cSJeff Kirsher int i;
4081bcc9736cSJeff Kirsher struct ksz_desc *desc;
4082bcc9736cSJeff Kirsher struct ksz_dma_buf *dma_buf;
4083bcc9736cSJeff Kirsher struct ksz_hw *hw = &adapter->hw;
4084bcc9736cSJeff Kirsher struct ksz_desc_info *info = &hw->rx_desc_info;
4085bcc9736cSJeff Kirsher
4086bcc9736cSJeff Kirsher for (i = 0; i < hw->rx_desc_info.alloc; i++) {
4087bcc9736cSJeff Kirsher get_rx_pkt(info, &desc);
4088bcc9736cSJeff Kirsher
4089bcc9736cSJeff Kirsher dma_buf = DMA_BUFFER(desc);
4090bcc9736cSJeff Kirsher if (dma_buf->skb && dma_buf->len != adapter->mtu)
409181adcd65SChristophe JAILLET free_dma_buf(adapter, dma_buf, DMA_FROM_DEVICE);
4092bcc9736cSJeff Kirsher dma_buf->len = adapter->mtu;
4093bcc9736cSJeff Kirsher if (!dma_buf->skb)
4094bcc9736cSJeff Kirsher dma_buf->skb = alloc_skb(dma_buf->len, GFP_ATOMIC);
4095b06b66c0SJon Mason if (dma_buf->skb && !dma_buf->dma)
409681adcd65SChristophe JAILLET dma_buf->dma = dma_map_single(&adapter->pdev->dev,
4097bcc9736cSJeff Kirsher skb_tail_pointer(dma_buf->skb),
4098bcc9736cSJeff Kirsher dma_buf->len,
409981adcd65SChristophe JAILLET DMA_FROM_DEVICE);
4100bcc9736cSJeff Kirsher
4101bcc9736cSJeff Kirsher /* Set descriptor. */
4102bcc9736cSJeff Kirsher set_rx_buf(desc, dma_buf->dma);
4103bcc9736cSJeff Kirsher set_rx_len(desc, dma_buf->len);
4104bcc9736cSJeff Kirsher release_desc(desc);
4105bcc9736cSJeff Kirsher }
4106bcc9736cSJeff Kirsher }
4107bcc9736cSJeff Kirsher
4108bcc9736cSJeff Kirsher /**
4109bcc9736cSJeff Kirsher * ksz_alloc_mem - allocate memory for hardware descriptors
4110bcc9736cSJeff Kirsher * @adapter: Adapter information structure.
4111bcc9736cSJeff Kirsher *
4112bcc9736cSJeff Kirsher * This function allocates memory for use by hardware descriptors for receiving
4113bcc9736cSJeff Kirsher * and transmitting.
4114bcc9736cSJeff Kirsher *
4115bcc9736cSJeff Kirsher * Return 0 if successful.
4116bcc9736cSJeff Kirsher */
ksz_alloc_mem(struct dev_info * adapter)4117bcc9736cSJeff Kirsher static int ksz_alloc_mem(struct dev_info *adapter)
4118bcc9736cSJeff Kirsher {
4119bcc9736cSJeff Kirsher struct ksz_hw *hw = &adapter->hw;
4120bcc9736cSJeff Kirsher
4121bcc9736cSJeff Kirsher /* Determine the number of receive and transmit descriptors. */
4122bcc9736cSJeff Kirsher hw->rx_desc_info.alloc = NUM_OF_RX_DESC;
4123bcc9736cSJeff Kirsher hw->tx_desc_info.alloc = NUM_OF_TX_DESC;
4124bcc9736cSJeff Kirsher
4125bcc9736cSJeff Kirsher /* Determine how many descriptors to skip transmit interrupt. */
4126bcc9736cSJeff Kirsher hw->tx_int_cnt = 0;
4127bcc9736cSJeff Kirsher hw->tx_int_mask = NUM_OF_TX_DESC / 4;
4128bcc9736cSJeff Kirsher if (hw->tx_int_mask > 8)
4129bcc9736cSJeff Kirsher hw->tx_int_mask = 8;
4130bcc9736cSJeff Kirsher while (hw->tx_int_mask) {
4131bcc9736cSJeff Kirsher hw->tx_int_cnt++;
4132bcc9736cSJeff Kirsher hw->tx_int_mask >>= 1;
4133bcc9736cSJeff Kirsher }
4134bcc9736cSJeff Kirsher if (hw->tx_int_cnt) {
4135bcc9736cSJeff Kirsher hw->tx_int_mask = (1 << (hw->tx_int_cnt - 1)) - 1;
4136bcc9736cSJeff Kirsher hw->tx_int_cnt = 0;
4137bcc9736cSJeff Kirsher }
4138bcc9736cSJeff Kirsher
4139bcc9736cSJeff Kirsher /* Determine the descriptor size. */
4140bcc9736cSJeff Kirsher hw->rx_desc_info.size =
4141bcc9736cSJeff Kirsher (((sizeof(struct ksz_hw_desc) + DESC_ALIGNMENT - 1) /
4142bcc9736cSJeff Kirsher DESC_ALIGNMENT) * DESC_ALIGNMENT);
4143bcc9736cSJeff Kirsher hw->tx_desc_info.size =
4144bcc9736cSJeff Kirsher (((sizeof(struct ksz_hw_desc) + DESC_ALIGNMENT - 1) /
4145bcc9736cSJeff Kirsher DESC_ALIGNMENT) * DESC_ALIGNMENT);
4146bcc9736cSJeff Kirsher if (hw->rx_desc_info.size != sizeof(struct ksz_hw_desc))
4147bcc9736cSJeff Kirsher pr_alert("Hardware descriptor size not right!\n");
4148bcc9736cSJeff Kirsher ksz_check_desc_num(&hw->rx_desc_info);
4149bcc9736cSJeff Kirsher ksz_check_desc_num(&hw->tx_desc_info);
4150bcc9736cSJeff Kirsher
4151bcc9736cSJeff Kirsher /* Allocate descriptors. */
4152bcc9736cSJeff Kirsher if (ksz_alloc_desc(adapter))
4153bcc9736cSJeff Kirsher return 1;
4154bcc9736cSJeff Kirsher
4155bcc9736cSJeff Kirsher return 0;
4156bcc9736cSJeff Kirsher }
4157bcc9736cSJeff Kirsher
4158bcc9736cSJeff Kirsher /**
4159bcc9736cSJeff Kirsher * ksz_free_desc - free software and hardware descriptors
4160bcc9736cSJeff Kirsher * @adapter: Adapter information structure.
4161bcc9736cSJeff Kirsher *
4162bcc9736cSJeff Kirsher * This local routine frees the software and hardware descriptors allocated by
4163bcc9736cSJeff Kirsher * ksz_alloc_desc().
4164bcc9736cSJeff Kirsher */
ksz_free_desc(struct dev_info * adapter)4165bcc9736cSJeff Kirsher static void ksz_free_desc(struct dev_info *adapter)
4166bcc9736cSJeff Kirsher {
4167bcc9736cSJeff Kirsher struct ksz_hw *hw = &adapter->hw;
4168bcc9736cSJeff Kirsher
4169bcc9736cSJeff Kirsher /* Reset descriptor. */
4170bcc9736cSJeff Kirsher hw->rx_desc_info.ring_virt = NULL;
4171bcc9736cSJeff Kirsher hw->tx_desc_info.ring_virt = NULL;
4172bcc9736cSJeff Kirsher hw->rx_desc_info.ring_phys = 0;
4173bcc9736cSJeff Kirsher hw->tx_desc_info.ring_phys = 0;
4174bcc9736cSJeff Kirsher
4175bcc9736cSJeff Kirsher /* Free memory. */
4176bcc9736cSJeff Kirsher if (adapter->desc_pool.alloc_virt)
417781adcd65SChristophe JAILLET dma_free_coherent(&adapter->pdev->dev,
4178bcc9736cSJeff Kirsher adapter->desc_pool.alloc_size,
4179bcc9736cSJeff Kirsher adapter->desc_pool.alloc_virt,
4180bcc9736cSJeff Kirsher adapter->desc_pool.dma_addr);
4181bcc9736cSJeff Kirsher
4182bcc9736cSJeff Kirsher /* Reset resource pool. */
4183bcc9736cSJeff Kirsher adapter->desc_pool.alloc_size = 0;
4184bcc9736cSJeff Kirsher adapter->desc_pool.alloc_virt = NULL;
4185bcc9736cSJeff Kirsher
4186bcc9736cSJeff Kirsher kfree(hw->rx_desc_info.ring);
4187bcc9736cSJeff Kirsher hw->rx_desc_info.ring = NULL;
4188bcc9736cSJeff Kirsher kfree(hw->tx_desc_info.ring);
4189bcc9736cSJeff Kirsher hw->tx_desc_info.ring = NULL;
4190bcc9736cSJeff Kirsher }
4191bcc9736cSJeff Kirsher
4192bcc9736cSJeff Kirsher /**
4193bcc9736cSJeff Kirsher * ksz_free_buffers - free buffers used in the descriptors
4194bcc9736cSJeff Kirsher * @adapter: Adapter information structure.
4195bcc9736cSJeff Kirsher * @desc_info: Descriptor information structure.
4196d0ea5cbdSJesse Brandeburg * @direction: to or from device
4197bcc9736cSJeff Kirsher *
4198bcc9736cSJeff Kirsher * This local routine frees buffers used in the DMA buffers.
4199bcc9736cSJeff Kirsher */
ksz_free_buffers(struct dev_info * adapter,struct ksz_desc_info * desc_info,int direction)4200bcc9736cSJeff Kirsher static void ksz_free_buffers(struct dev_info *adapter,
4201bcc9736cSJeff Kirsher struct ksz_desc_info *desc_info, int direction)
4202bcc9736cSJeff Kirsher {
4203bcc9736cSJeff Kirsher int i;
4204bcc9736cSJeff Kirsher struct ksz_dma_buf *dma_buf;
4205bcc9736cSJeff Kirsher struct ksz_desc *desc = desc_info->ring;
4206bcc9736cSJeff Kirsher
4207bcc9736cSJeff Kirsher for (i = 0; i < desc_info->alloc; i++) {
4208bcc9736cSJeff Kirsher dma_buf = DMA_BUFFER(desc);
4209bcc9736cSJeff Kirsher if (dma_buf->skb)
4210bcc9736cSJeff Kirsher free_dma_buf(adapter, dma_buf, direction);
4211bcc9736cSJeff Kirsher desc++;
4212bcc9736cSJeff Kirsher }
4213bcc9736cSJeff Kirsher }
4214bcc9736cSJeff Kirsher
4215bcc9736cSJeff Kirsher /**
4216bcc9736cSJeff Kirsher * ksz_free_mem - free all resources used by descriptors
4217bcc9736cSJeff Kirsher * @adapter: Adapter information structure.
4218bcc9736cSJeff Kirsher *
4219bcc9736cSJeff Kirsher * This local routine frees all the resources allocated by ksz_alloc_mem().
4220bcc9736cSJeff Kirsher */
ksz_free_mem(struct dev_info * adapter)4221bcc9736cSJeff Kirsher static void ksz_free_mem(struct dev_info *adapter)
4222bcc9736cSJeff Kirsher {
4223bcc9736cSJeff Kirsher /* Free transmit buffers. */
422481adcd65SChristophe JAILLET ksz_free_buffers(adapter, &adapter->hw.tx_desc_info, DMA_TO_DEVICE);
4225bcc9736cSJeff Kirsher
4226bcc9736cSJeff Kirsher /* Free receive buffers. */
422781adcd65SChristophe JAILLET ksz_free_buffers(adapter, &adapter->hw.rx_desc_info, DMA_FROM_DEVICE);
4228bcc9736cSJeff Kirsher
4229bcc9736cSJeff Kirsher /* Free descriptors. */
4230bcc9736cSJeff Kirsher ksz_free_desc(adapter);
4231bcc9736cSJeff Kirsher }
4232bcc9736cSJeff Kirsher
get_mib_counters(struct ksz_hw * hw,int first,int cnt,u64 * counter)4233bcc9736cSJeff Kirsher static void get_mib_counters(struct ksz_hw *hw, int first, int cnt,
4234bcc9736cSJeff Kirsher u64 *counter)
4235bcc9736cSJeff Kirsher {
4236bcc9736cSJeff Kirsher int i;
4237bcc9736cSJeff Kirsher int mib;
4238bcc9736cSJeff Kirsher int port;
4239bcc9736cSJeff Kirsher struct ksz_port_mib *port_mib;
4240bcc9736cSJeff Kirsher
4241bcc9736cSJeff Kirsher memset(counter, 0, sizeof(u64) * TOTAL_PORT_COUNTER_NUM);
4242bcc9736cSJeff Kirsher for (i = 0, port = first; i < cnt; i++, port++) {
4243bcc9736cSJeff Kirsher port_mib = &hw->port_mib[port];
4244bcc9736cSJeff Kirsher for (mib = port_mib->mib_start; mib < hw->mib_cnt; mib++)
4245bcc9736cSJeff Kirsher counter[mib] += port_mib->counter[mib];
4246bcc9736cSJeff Kirsher }
4247bcc9736cSJeff Kirsher }
4248bcc9736cSJeff Kirsher
4249bcc9736cSJeff Kirsher /**
4250bcc9736cSJeff Kirsher * send_packet - send packet
4251bcc9736cSJeff Kirsher * @skb: Socket buffer.
4252bcc9736cSJeff Kirsher * @dev: Network device.
4253bcc9736cSJeff Kirsher *
4254bcc9736cSJeff Kirsher * This routine is used to send a packet out to the network.
4255bcc9736cSJeff Kirsher */
send_packet(struct sk_buff * skb,struct net_device * dev)4256bcc9736cSJeff Kirsher static void send_packet(struct sk_buff *skb, struct net_device *dev)
4257bcc9736cSJeff Kirsher {
4258bcc9736cSJeff Kirsher struct ksz_desc *desc;
4259bcc9736cSJeff Kirsher struct ksz_desc *first;
4260bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
4261bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
4262bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4263bcc9736cSJeff Kirsher struct ksz_desc_info *info = &hw->tx_desc_info;
4264bcc9736cSJeff Kirsher struct ksz_dma_buf *dma_buf;
4265bcc9736cSJeff Kirsher int len;
4266bcc9736cSJeff Kirsher int last_frag = skb_shinfo(skb)->nr_frags;
4267bcc9736cSJeff Kirsher
4268bcc9736cSJeff Kirsher /*
4269bcc9736cSJeff Kirsher * KSZ8842 with multiple device interfaces needs to be told which port
4270bcc9736cSJeff Kirsher * to send.
4271bcc9736cSJeff Kirsher */
4272bcc9736cSJeff Kirsher if (hw->dev_count > 1)
4273bcc9736cSJeff Kirsher hw->dst_ports = 1 << priv->port.first_port;
4274bcc9736cSJeff Kirsher
4275bcc9736cSJeff Kirsher /* Hardware will pad the length to 60. */
4276bcc9736cSJeff Kirsher len = skb->len;
4277bcc9736cSJeff Kirsher
4278bcc9736cSJeff Kirsher /* Remember the very first descriptor. */
4279bcc9736cSJeff Kirsher first = info->cur;
4280bcc9736cSJeff Kirsher desc = first;
4281bcc9736cSJeff Kirsher
4282bcc9736cSJeff Kirsher dma_buf = DMA_BUFFER(desc);
4283bcc9736cSJeff Kirsher if (last_frag) {
4284bcc9736cSJeff Kirsher int frag;
4285bcc9736cSJeff Kirsher skb_frag_t *this_frag;
4286bcc9736cSJeff Kirsher
4287bcc9736cSJeff Kirsher dma_buf->len = skb_headlen(skb);
4288bcc9736cSJeff Kirsher
428981adcd65SChristophe JAILLET dma_buf->dma = dma_map_single(&hw_priv->pdev->dev, skb->data,
429081adcd65SChristophe JAILLET dma_buf->len, DMA_TO_DEVICE);
4291bcc9736cSJeff Kirsher set_tx_buf(desc, dma_buf->dma);
4292bcc9736cSJeff Kirsher set_tx_len(desc, dma_buf->len);
4293bcc9736cSJeff Kirsher
4294bcc9736cSJeff Kirsher frag = 0;
4295bcc9736cSJeff Kirsher do {
4296bcc9736cSJeff Kirsher this_frag = &skb_shinfo(skb)->frags[frag];
4297bcc9736cSJeff Kirsher
4298bcc9736cSJeff Kirsher /* Get a new descriptor. */
4299bcc9736cSJeff Kirsher get_tx_pkt(info, &desc);
4300bcc9736cSJeff Kirsher
4301bcc9736cSJeff Kirsher /* Keep track of descriptors used so far. */
4302bcc9736cSJeff Kirsher ++hw->tx_int_cnt;
4303bcc9736cSJeff Kirsher
4304bcc9736cSJeff Kirsher dma_buf = DMA_BUFFER(desc);
43059e903e08SEric Dumazet dma_buf->len = skb_frag_size(this_frag);
4306bcc9736cSJeff Kirsher
430781adcd65SChristophe JAILLET dma_buf->dma = dma_map_single(&hw_priv->pdev->dev,
4308787343adSIan Campbell skb_frag_address(this_frag),
4309bcc9736cSJeff Kirsher dma_buf->len,
431081adcd65SChristophe JAILLET DMA_TO_DEVICE);
4311bcc9736cSJeff Kirsher set_tx_buf(desc, dma_buf->dma);
4312bcc9736cSJeff Kirsher set_tx_len(desc, dma_buf->len);
4313bcc9736cSJeff Kirsher
4314bcc9736cSJeff Kirsher frag++;
4315bcc9736cSJeff Kirsher if (frag == last_frag)
4316bcc9736cSJeff Kirsher break;
4317bcc9736cSJeff Kirsher
4318bcc9736cSJeff Kirsher /* Do not release the last descriptor here. */
4319bcc9736cSJeff Kirsher release_desc(desc);
4320bcc9736cSJeff Kirsher } while (1);
4321bcc9736cSJeff Kirsher
4322bcc9736cSJeff Kirsher /* current points to the last descriptor. */
4323bcc9736cSJeff Kirsher info->cur = desc;
4324bcc9736cSJeff Kirsher
4325bcc9736cSJeff Kirsher /* Release the first descriptor. */
4326bcc9736cSJeff Kirsher release_desc(first);
4327bcc9736cSJeff Kirsher } else {
4328bcc9736cSJeff Kirsher dma_buf->len = len;
4329bcc9736cSJeff Kirsher
433081adcd65SChristophe JAILLET dma_buf->dma = dma_map_single(&hw_priv->pdev->dev, skb->data,
433181adcd65SChristophe JAILLET dma_buf->len, DMA_TO_DEVICE);
4332bcc9736cSJeff Kirsher set_tx_buf(desc, dma_buf->dma);
4333bcc9736cSJeff Kirsher set_tx_len(desc, dma_buf->len);
4334bcc9736cSJeff Kirsher }
4335bcc9736cSJeff Kirsher
4336bcc9736cSJeff Kirsher if (skb->ip_summed == CHECKSUM_PARTIAL) {
4337bcc9736cSJeff Kirsher (desc)->sw.buf.tx.csum_gen_tcp = 1;
4338bcc9736cSJeff Kirsher (desc)->sw.buf.tx.csum_gen_udp = 1;
4339bcc9736cSJeff Kirsher }
4340bcc9736cSJeff Kirsher
4341bcc9736cSJeff Kirsher /*
4342bcc9736cSJeff Kirsher * The last descriptor holds the packet so that it can be returned to
4343bcc9736cSJeff Kirsher * network subsystem after all descriptors are transmitted.
4344bcc9736cSJeff Kirsher */
4345bcc9736cSJeff Kirsher dma_buf->skb = skb;
4346bcc9736cSJeff Kirsher
4347bcc9736cSJeff Kirsher hw_send_pkt(hw);
4348bcc9736cSJeff Kirsher
4349bcc9736cSJeff Kirsher /* Update transmit statistics. */
4350bcc9736cSJeff Kirsher dev->stats.tx_packets++;
4351bcc9736cSJeff Kirsher dev->stats.tx_bytes += len;
4352bcc9736cSJeff Kirsher }
4353bcc9736cSJeff Kirsher
4354bcc9736cSJeff Kirsher /**
4355bcc9736cSJeff Kirsher * transmit_cleanup - clean up transmit descriptors
4356d0ea5cbdSJesse Brandeburg * @hw_priv: Network device.
4357d0ea5cbdSJesse Brandeburg * @normal: break if owned
4358bcc9736cSJeff Kirsher *
4359bcc9736cSJeff Kirsher * This routine is called to clean up the transmitted buffers.
4360bcc9736cSJeff Kirsher */
transmit_cleanup(struct dev_info * hw_priv,int normal)4361bcc9736cSJeff Kirsher static void transmit_cleanup(struct dev_info *hw_priv, int normal)
4362bcc9736cSJeff Kirsher {
4363bcc9736cSJeff Kirsher int last;
4364bcc9736cSJeff Kirsher union desc_stat status;
4365bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4366bcc9736cSJeff Kirsher struct ksz_desc_info *info = &hw->tx_desc_info;
4367bcc9736cSJeff Kirsher struct ksz_desc *desc;
4368bcc9736cSJeff Kirsher struct ksz_dma_buf *dma_buf;
4369bcc9736cSJeff Kirsher struct net_device *dev = NULL;
4370bcc9736cSJeff Kirsher
43714945106dSLennert Buytenhek spin_lock_irq(&hw_priv->hwlock);
4372bcc9736cSJeff Kirsher last = info->last;
4373bcc9736cSJeff Kirsher
4374bcc9736cSJeff Kirsher while (info->avail < info->alloc) {
4375bcc9736cSJeff Kirsher /* Get next descriptor which is not hardware owned. */
4376bcc9736cSJeff Kirsher desc = &info->ring[last];
4377bcc9736cSJeff Kirsher status.data = le32_to_cpu(desc->phw->ctrl.data);
4378bcc9736cSJeff Kirsher if (status.tx.hw_owned) {
4379bcc9736cSJeff Kirsher if (normal)
4380bcc9736cSJeff Kirsher break;
4381bcc9736cSJeff Kirsher else
4382bcc9736cSJeff Kirsher reset_desc(desc, status);
4383bcc9736cSJeff Kirsher }
4384bcc9736cSJeff Kirsher
4385bcc9736cSJeff Kirsher dma_buf = DMA_BUFFER(desc);
438681adcd65SChristophe JAILLET dma_unmap_single(&hw_priv->pdev->dev, dma_buf->dma,
438781adcd65SChristophe JAILLET dma_buf->len, DMA_TO_DEVICE);
4388bcc9736cSJeff Kirsher
4389bcc9736cSJeff Kirsher /* This descriptor contains the last buffer in the packet. */
4390bcc9736cSJeff Kirsher if (dma_buf->skb) {
4391bcc9736cSJeff Kirsher dev = dma_buf->skb->dev;
4392bcc9736cSJeff Kirsher
4393bcc9736cSJeff Kirsher /* Release the packet back to network subsystem. */
4394bcc9736cSJeff Kirsher dev_kfree_skb_irq(dma_buf->skb);
4395bcc9736cSJeff Kirsher dma_buf->skb = NULL;
4396bcc9736cSJeff Kirsher }
4397bcc9736cSJeff Kirsher
4398bcc9736cSJeff Kirsher /* Free the transmitted descriptor. */
4399bcc9736cSJeff Kirsher last++;
4400bcc9736cSJeff Kirsher last &= info->mask;
4401bcc9736cSJeff Kirsher info->avail++;
4402bcc9736cSJeff Kirsher }
4403bcc9736cSJeff Kirsher info->last = last;
44044945106dSLennert Buytenhek spin_unlock_irq(&hw_priv->hwlock);
4405bcc9736cSJeff Kirsher
4406bcc9736cSJeff Kirsher /* Notify the network subsystem that the packet has been sent. */
4407bcc9736cSJeff Kirsher if (dev)
4408860e9538SFlorian Westphal netif_trans_update(dev);
4409bcc9736cSJeff Kirsher }
4410bcc9736cSJeff Kirsher
4411bcc9736cSJeff Kirsher /**
4412229fd41fSYang Shen * tx_done - transmit done processing
4413d0ea5cbdSJesse Brandeburg * @hw_priv: Network device.
4414bcc9736cSJeff Kirsher *
4415bcc9736cSJeff Kirsher * This routine is called when the transmit interrupt is triggered, indicating
4416bcc9736cSJeff Kirsher * either a packet is sent successfully or there are transmit errors.
4417bcc9736cSJeff Kirsher */
tx_done(struct dev_info * hw_priv)4418bcc9736cSJeff Kirsher static void tx_done(struct dev_info *hw_priv)
4419bcc9736cSJeff Kirsher {
4420bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4421bcc9736cSJeff Kirsher int port;
4422bcc9736cSJeff Kirsher
4423bcc9736cSJeff Kirsher transmit_cleanup(hw_priv, 1);
4424bcc9736cSJeff Kirsher
4425bcc9736cSJeff Kirsher for (port = 0; port < hw->dev_count; port++) {
4426bcc9736cSJeff Kirsher struct net_device *dev = hw->port_info[port].pdev;
4427bcc9736cSJeff Kirsher
4428bcc9736cSJeff Kirsher if (netif_running(dev) && netif_queue_stopped(dev))
4429bcc9736cSJeff Kirsher netif_wake_queue(dev);
4430bcc9736cSJeff Kirsher }
4431bcc9736cSJeff Kirsher }
4432bcc9736cSJeff Kirsher
copy_old_skb(struct sk_buff * old,struct sk_buff * skb)4433bcc9736cSJeff Kirsher static inline void copy_old_skb(struct sk_buff *old, struct sk_buff *skb)
4434bcc9736cSJeff Kirsher {
4435bcc9736cSJeff Kirsher skb->dev = old->dev;
4436bcc9736cSJeff Kirsher skb->protocol = old->protocol;
4437bcc9736cSJeff Kirsher skb->ip_summed = old->ip_summed;
4438bcc9736cSJeff Kirsher skb->csum = old->csum;
4439bcc9736cSJeff Kirsher skb_set_network_header(skb, ETH_HLEN);
4440bcc9736cSJeff Kirsher
4441641e9b73SEric W. Biederman dev_consume_skb_any(old);
4442bcc9736cSJeff Kirsher }
4443bcc9736cSJeff Kirsher
4444bcc9736cSJeff Kirsher /**
4445bcc9736cSJeff Kirsher * netdev_tx - send out packet
4446bcc9736cSJeff Kirsher * @skb: Socket buffer.
4447bcc9736cSJeff Kirsher * @dev: Network device.
4448bcc9736cSJeff Kirsher *
4449bcc9736cSJeff Kirsher * This function is used by the upper network layer to send out a packet.
4450bcc9736cSJeff Kirsher *
4451bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code indicating failure.
4452bcc9736cSJeff Kirsher */
netdev_tx(struct sk_buff * skb,struct net_device * dev)4453bcc9736cSJeff Kirsher static netdev_tx_t netdev_tx(struct sk_buff *skb, struct net_device *dev)
4454bcc9736cSJeff Kirsher {
4455bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
4456bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
4457bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4458bcc9736cSJeff Kirsher int left;
4459bcc9736cSJeff Kirsher int num = 1;
4460bcc9736cSJeff Kirsher int rc = 0;
4461bcc9736cSJeff Kirsher
4462bcc9736cSJeff Kirsher if (hw->features & SMALL_PACKET_TX_BUG) {
4463bcc9736cSJeff Kirsher struct sk_buff *org_skb = skb;
4464bcc9736cSJeff Kirsher
4465bcc9736cSJeff Kirsher if (skb->len <= 48) {
4466bcc9736cSJeff Kirsher if (skb_end_pointer(skb) - skb->data >= 50) {
4467bcc9736cSJeff Kirsher memset(&skb->data[skb->len], 0, 50 - skb->len);
4468bcc9736cSJeff Kirsher skb->len = 50;
4469bcc9736cSJeff Kirsher } else {
4470c056b734SPradeep A Dalvi skb = netdev_alloc_skb(dev, 50);
4471bcc9736cSJeff Kirsher if (!skb)
4472bcc9736cSJeff Kirsher return NETDEV_TX_BUSY;
4473bcc9736cSJeff Kirsher memcpy(skb->data, org_skb->data, org_skb->len);
4474bcc9736cSJeff Kirsher memset(&skb->data[org_skb->len], 0,
4475bcc9736cSJeff Kirsher 50 - org_skb->len);
4476bcc9736cSJeff Kirsher skb->len = 50;
4477bcc9736cSJeff Kirsher copy_old_skb(org_skb, skb);
4478bcc9736cSJeff Kirsher }
4479bcc9736cSJeff Kirsher }
4480bcc9736cSJeff Kirsher }
4481bcc9736cSJeff Kirsher
4482bcc9736cSJeff Kirsher spin_lock_irq(&hw_priv->hwlock);
4483bcc9736cSJeff Kirsher
4484bcc9736cSJeff Kirsher num = skb_shinfo(skb)->nr_frags + 1;
4485bcc9736cSJeff Kirsher left = hw_alloc_pkt(hw, skb->len, num);
4486bcc9736cSJeff Kirsher if (left) {
4487bcc9736cSJeff Kirsher if (left < num ||
44885b70ca35SLi RongQing (CHECKSUM_PARTIAL == skb->ip_summed &&
44895b70ca35SLi RongQing skb->protocol == htons(ETH_P_IPV6))) {
4490bcc9736cSJeff Kirsher struct sk_buff *org_skb = skb;
4491bcc9736cSJeff Kirsher
4492c056b734SPradeep A Dalvi skb = netdev_alloc_skb(dev, org_skb->len);
4493bcc9736cSJeff Kirsher if (!skb) {
4494bcc9736cSJeff Kirsher rc = NETDEV_TX_BUSY;
4495bcc9736cSJeff Kirsher goto unlock;
4496bcc9736cSJeff Kirsher }
4497bcc9736cSJeff Kirsher skb_copy_and_csum_dev(org_skb, skb->data);
4498bcc9736cSJeff Kirsher org_skb->ip_summed = CHECKSUM_NONE;
4499bcc9736cSJeff Kirsher skb->len = org_skb->len;
4500bcc9736cSJeff Kirsher copy_old_skb(org_skb, skb);
4501bcc9736cSJeff Kirsher }
4502bcc9736cSJeff Kirsher send_packet(skb, dev);
4503bcc9736cSJeff Kirsher if (left <= num)
4504bcc9736cSJeff Kirsher netif_stop_queue(dev);
4505bcc9736cSJeff Kirsher } else {
4506bcc9736cSJeff Kirsher /* Stop the transmit queue until packet is allocated. */
4507bcc9736cSJeff Kirsher netif_stop_queue(dev);
4508bcc9736cSJeff Kirsher rc = NETDEV_TX_BUSY;
4509bcc9736cSJeff Kirsher }
4510bcc9736cSJeff Kirsher unlock:
4511bcc9736cSJeff Kirsher spin_unlock_irq(&hw_priv->hwlock);
4512bcc9736cSJeff Kirsher
4513bcc9736cSJeff Kirsher return rc;
4514bcc9736cSJeff Kirsher }
4515bcc9736cSJeff Kirsher
4516bcc9736cSJeff Kirsher /**
4517bcc9736cSJeff Kirsher * netdev_tx_timeout - transmit timeout processing
4518bcc9736cSJeff Kirsher * @dev: Network device.
4519d0ea5cbdSJesse Brandeburg * @txqueue: index of hanging queue
4520bcc9736cSJeff Kirsher *
4521bcc9736cSJeff Kirsher * This routine is called when the transmit timer expires. That indicates the
4522bcc9736cSJeff Kirsher * hardware is not running correctly because transmit interrupts are not
4523bcc9736cSJeff Kirsher * triggered to free up resources so that the transmit routine can continue
4524bcc9736cSJeff Kirsher * sending out packets. The hardware is reset to correct the problem.
4525bcc9736cSJeff Kirsher */
netdev_tx_timeout(struct net_device * dev,unsigned int txqueue)45260290bd29SMichael S. Tsirkin static void netdev_tx_timeout(struct net_device *dev, unsigned int txqueue)
4527bcc9736cSJeff Kirsher {
4528bcc9736cSJeff Kirsher static unsigned long last_reset;
4529bcc9736cSJeff Kirsher
4530bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
4531bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
4532bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4533bcc9736cSJeff Kirsher int port;
4534bcc9736cSJeff Kirsher
4535bcc9736cSJeff Kirsher if (hw->dev_count > 1) {
4536bcc9736cSJeff Kirsher /*
4537bcc9736cSJeff Kirsher * Only reset the hardware if time between calls is long
4538bcc9736cSJeff Kirsher * enough.
4539bcc9736cSJeff Kirsher */
454005e1e76eSManuel Schölling if (time_before_eq(jiffies, last_reset + dev->watchdog_timeo))
4541bcc9736cSJeff Kirsher hw_priv = NULL;
4542bcc9736cSJeff Kirsher }
4543bcc9736cSJeff Kirsher
4544bcc9736cSJeff Kirsher last_reset = jiffies;
4545bcc9736cSJeff Kirsher if (hw_priv) {
4546bcc9736cSJeff Kirsher hw_dis_intr(hw);
4547bcc9736cSJeff Kirsher hw_disable(hw);
4548bcc9736cSJeff Kirsher
4549bcc9736cSJeff Kirsher transmit_cleanup(hw_priv, 0);
4550bcc9736cSJeff Kirsher hw_reset_pkts(&hw->rx_desc_info);
4551bcc9736cSJeff Kirsher hw_reset_pkts(&hw->tx_desc_info);
4552bcc9736cSJeff Kirsher ksz_init_rx_buffers(hw_priv);
4553bcc9736cSJeff Kirsher
4554bcc9736cSJeff Kirsher hw_reset(hw);
4555bcc9736cSJeff Kirsher
4556bcc9736cSJeff Kirsher hw_set_desc_base(hw,
4557bcc9736cSJeff Kirsher hw->tx_desc_info.ring_phys,
4558bcc9736cSJeff Kirsher hw->rx_desc_info.ring_phys);
4559bcc9736cSJeff Kirsher hw_set_addr(hw);
4560bcc9736cSJeff Kirsher if (hw->all_multi)
4561bcc9736cSJeff Kirsher hw_set_multicast(hw, hw->all_multi);
4562bcc9736cSJeff Kirsher else if (hw->multi_list_size)
4563bcc9736cSJeff Kirsher hw_set_grp_addr(hw);
4564bcc9736cSJeff Kirsher
4565bcc9736cSJeff Kirsher if (hw->dev_count > 1) {
4566bcc9736cSJeff Kirsher hw_set_add_addr(hw);
4567bcc9736cSJeff Kirsher for (port = 0; port < SWITCH_PORT_NUM; port++) {
4568bcc9736cSJeff Kirsher struct net_device *port_dev;
4569bcc9736cSJeff Kirsher
4570bcc9736cSJeff Kirsher port_set_stp_state(hw, port,
4571bcc9736cSJeff Kirsher STP_STATE_DISABLED);
4572bcc9736cSJeff Kirsher
4573bcc9736cSJeff Kirsher port_dev = hw->port_info[port].pdev;
4574bcc9736cSJeff Kirsher if (netif_running(port_dev))
4575bcc9736cSJeff Kirsher port_set_stp_state(hw, port,
4576bcc9736cSJeff Kirsher STP_STATE_SIMPLE);
4577bcc9736cSJeff Kirsher }
4578bcc9736cSJeff Kirsher }
4579bcc9736cSJeff Kirsher
4580bcc9736cSJeff Kirsher hw_enable(hw);
4581bcc9736cSJeff Kirsher hw_ena_intr(hw);
4582bcc9736cSJeff Kirsher }
4583bcc9736cSJeff Kirsher
4584860e9538SFlorian Westphal netif_trans_update(dev);
4585bcc9736cSJeff Kirsher netif_wake_queue(dev);
4586bcc9736cSJeff Kirsher }
4587bcc9736cSJeff Kirsher
csum_verified(struct sk_buff * skb)4588bcc9736cSJeff Kirsher static inline void csum_verified(struct sk_buff *skb)
4589bcc9736cSJeff Kirsher {
4590bcc9736cSJeff Kirsher unsigned short protocol;
4591bcc9736cSJeff Kirsher struct iphdr *iph;
4592bcc9736cSJeff Kirsher
4593bcc9736cSJeff Kirsher protocol = skb->protocol;
4594bcc9736cSJeff Kirsher skb_reset_network_header(skb);
4595bcc9736cSJeff Kirsher iph = (struct iphdr *) skb_network_header(skb);
4596bcc9736cSJeff Kirsher if (protocol == htons(ETH_P_8021Q)) {
4597bcc9736cSJeff Kirsher protocol = iph->tot_len;
4598bcc9736cSJeff Kirsher skb_set_network_header(skb, VLAN_HLEN);
4599bcc9736cSJeff Kirsher iph = (struct iphdr *) skb_network_header(skb);
4600bcc9736cSJeff Kirsher }
4601bcc9736cSJeff Kirsher if (protocol == htons(ETH_P_IP)) {
4602bcc9736cSJeff Kirsher if (iph->protocol == IPPROTO_TCP)
4603bcc9736cSJeff Kirsher skb->ip_summed = CHECKSUM_UNNECESSARY;
4604bcc9736cSJeff Kirsher }
4605bcc9736cSJeff Kirsher }
4606bcc9736cSJeff Kirsher
rx_proc(struct net_device * dev,struct ksz_hw * hw,struct ksz_desc * desc,union desc_stat status)4607bcc9736cSJeff Kirsher static inline int rx_proc(struct net_device *dev, struct ksz_hw* hw,
4608bcc9736cSJeff Kirsher struct ksz_desc *desc, union desc_stat status)
4609bcc9736cSJeff Kirsher {
4610bcc9736cSJeff Kirsher int packet_len;
4611bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
4612bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
4613bcc9736cSJeff Kirsher struct ksz_dma_buf *dma_buf;
4614bcc9736cSJeff Kirsher struct sk_buff *skb;
4615bcc9736cSJeff Kirsher
4616bcc9736cSJeff Kirsher /* Received length includes 4-byte CRC. */
4617bcc9736cSJeff Kirsher packet_len = status.rx.frame_len - 4;
4618bcc9736cSJeff Kirsher
4619bcc9736cSJeff Kirsher dma_buf = DMA_BUFFER(desc);
462081adcd65SChristophe JAILLET dma_sync_single_for_cpu(&hw_priv->pdev->dev, dma_buf->dma,
462181adcd65SChristophe JAILLET packet_len + 4, DMA_FROM_DEVICE);
4622bcc9736cSJeff Kirsher
4623bcc9736cSJeff Kirsher do {
4624bcc9736cSJeff Kirsher /* skb->data != skb->head */
4625c056b734SPradeep A Dalvi skb = netdev_alloc_skb(dev, packet_len + 2);
4626bcc9736cSJeff Kirsher if (!skb) {
4627bcc9736cSJeff Kirsher dev->stats.rx_dropped++;
4628bcc9736cSJeff Kirsher return -ENOMEM;
4629bcc9736cSJeff Kirsher }
4630bcc9736cSJeff Kirsher
4631bcc9736cSJeff Kirsher /*
4632bcc9736cSJeff Kirsher * Align socket buffer in 4-byte boundary for better
4633bcc9736cSJeff Kirsher * performance.
4634bcc9736cSJeff Kirsher */
4635bcc9736cSJeff Kirsher skb_reserve(skb, 2);
4636bcc9736cSJeff Kirsher
463759ae1d12SJohannes Berg skb_put_data(skb, dma_buf->skb->data, packet_len);
4638bcc9736cSJeff Kirsher } while (0);
4639bcc9736cSJeff Kirsher
4640bcc9736cSJeff Kirsher skb->protocol = eth_type_trans(skb, dev);
4641bcc9736cSJeff Kirsher
4642bcc9736cSJeff Kirsher if (hw->rx_cfg & (DMA_RX_CSUM_UDP | DMA_RX_CSUM_TCP))
4643bcc9736cSJeff Kirsher csum_verified(skb);
4644bcc9736cSJeff Kirsher
4645bcc9736cSJeff Kirsher /* Update receive statistics. */
4646bcc9736cSJeff Kirsher dev->stats.rx_packets++;
4647bcc9736cSJeff Kirsher dev->stats.rx_bytes += packet_len;
4648bcc9736cSJeff Kirsher
4649bcc9736cSJeff Kirsher /* Notify upper layer for received packet. */
4650bf2977aeSZheng Yongjun netif_rx(skb);
4651bcc9736cSJeff Kirsher
4652bcc9736cSJeff Kirsher return 0;
4653bcc9736cSJeff Kirsher }
4654bcc9736cSJeff Kirsher
dev_rcv_packets(struct dev_info * hw_priv)4655bcc9736cSJeff Kirsher static int dev_rcv_packets(struct dev_info *hw_priv)
4656bcc9736cSJeff Kirsher {
4657bcc9736cSJeff Kirsher int next;
4658bcc9736cSJeff Kirsher union desc_stat status;
4659bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4660bcc9736cSJeff Kirsher struct net_device *dev = hw->port_info[0].pdev;
4661bcc9736cSJeff Kirsher struct ksz_desc_info *info = &hw->rx_desc_info;
4662bcc9736cSJeff Kirsher int left = info->alloc;
4663bcc9736cSJeff Kirsher struct ksz_desc *desc;
4664bcc9736cSJeff Kirsher int received = 0;
4665bcc9736cSJeff Kirsher
4666bcc9736cSJeff Kirsher next = info->next;
4667bcc9736cSJeff Kirsher while (left--) {
4668bcc9736cSJeff Kirsher /* Get next descriptor which is not hardware owned. */
4669bcc9736cSJeff Kirsher desc = &info->ring[next];
4670bcc9736cSJeff Kirsher status.data = le32_to_cpu(desc->phw->ctrl.data);
4671bcc9736cSJeff Kirsher if (status.rx.hw_owned)
4672bcc9736cSJeff Kirsher break;
4673bcc9736cSJeff Kirsher
4674bcc9736cSJeff Kirsher /* Status valid only when last descriptor bit is set. */
4675bcc9736cSJeff Kirsher if (status.rx.last_desc && status.rx.first_desc) {
4676bcc9736cSJeff Kirsher if (rx_proc(dev, hw, desc, status))
4677bcc9736cSJeff Kirsher goto release_packet;
4678bcc9736cSJeff Kirsher received++;
4679bcc9736cSJeff Kirsher }
4680bcc9736cSJeff Kirsher
4681bcc9736cSJeff Kirsher release_packet:
4682bcc9736cSJeff Kirsher release_desc(desc);
4683bcc9736cSJeff Kirsher next++;
4684bcc9736cSJeff Kirsher next &= info->mask;
4685bcc9736cSJeff Kirsher }
4686bcc9736cSJeff Kirsher info->next = next;
4687bcc9736cSJeff Kirsher
4688bcc9736cSJeff Kirsher return received;
4689bcc9736cSJeff Kirsher }
4690bcc9736cSJeff Kirsher
port_rcv_packets(struct dev_info * hw_priv)4691bcc9736cSJeff Kirsher static int port_rcv_packets(struct dev_info *hw_priv)
4692bcc9736cSJeff Kirsher {
4693bcc9736cSJeff Kirsher int next;
4694bcc9736cSJeff Kirsher union desc_stat status;
4695bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4696bcc9736cSJeff Kirsher struct net_device *dev = hw->port_info[0].pdev;
4697bcc9736cSJeff Kirsher struct ksz_desc_info *info = &hw->rx_desc_info;
4698bcc9736cSJeff Kirsher int left = info->alloc;
4699bcc9736cSJeff Kirsher struct ksz_desc *desc;
4700bcc9736cSJeff Kirsher int received = 0;
4701bcc9736cSJeff Kirsher
4702bcc9736cSJeff Kirsher next = info->next;
4703bcc9736cSJeff Kirsher while (left--) {
4704bcc9736cSJeff Kirsher /* Get next descriptor which is not hardware owned. */
4705bcc9736cSJeff Kirsher desc = &info->ring[next];
4706bcc9736cSJeff Kirsher status.data = le32_to_cpu(desc->phw->ctrl.data);
4707bcc9736cSJeff Kirsher if (status.rx.hw_owned)
4708bcc9736cSJeff Kirsher break;
4709bcc9736cSJeff Kirsher
4710bcc9736cSJeff Kirsher if (hw->dev_count > 1) {
4711bcc9736cSJeff Kirsher /* Get received port number. */
4712bcc9736cSJeff Kirsher int p = HW_TO_DEV_PORT(status.rx.src_port);
4713bcc9736cSJeff Kirsher
4714bcc9736cSJeff Kirsher dev = hw->port_info[p].pdev;
4715bcc9736cSJeff Kirsher if (!netif_running(dev))
4716bcc9736cSJeff Kirsher goto release_packet;
4717bcc9736cSJeff Kirsher }
4718bcc9736cSJeff Kirsher
4719bcc9736cSJeff Kirsher /* Status valid only when last descriptor bit is set. */
4720bcc9736cSJeff Kirsher if (status.rx.last_desc && status.rx.first_desc) {
4721bcc9736cSJeff Kirsher if (rx_proc(dev, hw, desc, status))
4722bcc9736cSJeff Kirsher goto release_packet;
4723bcc9736cSJeff Kirsher received++;
4724bcc9736cSJeff Kirsher }
4725bcc9736cSJeff Kirsher
4726bcc9736cSJeff Kirsher release_packet:
4727bcc9736cSJeff Kirsher release_desc(desc);
4728bcc9736cSJeff Kirsher next++;
4729bcc9736cSJeff Kirsher next &= info->mask;
4730bcc9736cSJeff Kirsher }
4731bcc9736cSJeff Kirsher info->next = next;
4732bcc9736cSJeff Kirsher
4733bcc9736cSJeff Kirsher return received;
4734bcc9736cSJeff Kirsher }
4735bcc9736cSJeff Kirsher
dev_rcv_special(struct dev_info * hw_priv)4736bcc9736cSJeff Kirsher static int dev_rcv_special(struct dev_info *hw_priv)
4737bcc9736cSJeff Kirsher {
4738bcc9736cSJeff Kirsher int next;
4739bcc9736cSJeff Kirsher union desc_stat status;
4740bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4741bcc9736cSJeff Kirsher struct net_device *dev = hw->port_info[0].pdev;
4742bcc9736cSJeff Kirsher struct ksz_desc_info *info = &hw->rx_desc_info;
4743bcc9736cSJeff Kirsher int left = info->alloc;
4744bcc9736cSJeff Kirsher struct ksz_desc *desc;
4745bcc9736cSJeff Kirsher int received = 0;
4746bcc9736cSJeff Kirsher
4747bcc9736cSJeff Kirsher next = info->next;
4748bcc9736cSJeff Kirsher while (left--) {
4749bcc9736cSJeff Kirsher /* Get next descriptor which is not hardware owned. */
4750bcc9736cSJeff Kirsher desc = &info->ring[next];
4751bcc9736cSJeff Kirsher status.data = le32_to_cpu(desc->phw->ctrl.data);
4752bcc9736cSJeff Kirsher if (status.rx.hw_owned)
4753bcc9736cSJeff Kirsher break;
4754bcc9736cSJeff Kirsher
4755bcc9736cSJeff Kirsher if (hw->dev_count > 1) {
4756bcc9736cSJeff Kirsher /* Get received port number. */
4757bcc9736cSJeff Kirsher int p = HW_TO_DEV_PORT(status.rx.src_port);
4758bcc9736cSJeff Kirsher
4759bcc9736cSJeff Kirsher dev = hw->port_info[p].pdev;
4760bcc9736cSJeff Kirsher if (!netif_running(dev))
4761bcc9736cSJeff Kirsher goto release_packet;
4762bcc9736cSJeff Kirsher }
4763bcc9736cSJeff Kirsher
4764bcc9736cSJeff Kirsher /* Status valid only when last descriptor bit is set. */
4765bcc9736cSJeff Kirsher if (status.rx.last_desc && status.rx.first_desc) {
4766bcc9736cSJeff Kirsher /*
4767bcc9736cSJeff Kirsher * Receive without error. With receive errors
4768bcc9736cSJeff Kirsher * disabled, packets with receive errors will be
4769bcc9736cSJeff Kirsher * dropped, so no need to check the error bit.
4770bcc9736cSJeff Kirsher */
4771bcc9736cSJeff Kirsher if (!status.rx.error || (status.data &
4772bcc9736cSJeff Kirsher KS_DESC_RX_ERROR_COND) ==
4773bcc9736cSJeff Kirsher KS_DESC_RX_ERROR_TOO_LONG) {
4774bcc9736cSJeff Kirsher if (rx_proc(dev, hw, desc, status))
4775bcc9736cSJeff Kirsher goto release_packet;
4776bcc9736cSJeff Kirsher received++;
4777bcc9736cSJeff Kirsher } else {
4778bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
4779bcc9736cSJeff Kirsher
4780bcc9736cSJeff Kirsher /* Update receive error statistics. */
4781bcc9736cSJeff Kirsher priv->port.counter[OID_COUNTER_RCV_ERROR]++;
4782bcc9736cSJeff Kirsher }
4783bcc9736cSJeff Kirsher }
4784bcc9736cSJeff Kirsher
4785bcc9736cSJeff Kirsher release_packet:
4786bcc9736cSJeff Kirsher release_desc(desc);
4787bcc9736cSJeff Kirsher next++;
4788bcc9736cSJeff Kirsher next &= info->mask;
4789bcc9736cSJeff Kirsher }
4790bcc9736cSJeff Kirsher info->next = next;
4791bcc9736cSJeff Kirsher
4792bcc9736cSJeff Kirsher return received;
4793bcc9736cSJeff Kirsher }
4794bcc9736cSJeff Kirsher
rx_proc_task(struct tasklet_struct * t)47959ad5a250SAllen Pais static void rx_proc_task(struct tasklet_struct *t)
4796bcc9736cSJeff Kirsher {
47979ad5a250SAllen Pais struct dev_info *hw_priv = from_tasklet(hw_priv, t, rx_tasklet);
4798bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4799bcc9736cSJeff Kirsher
4800bcc9736cSJeff Kirsher if (!hw->enabled)
4801bcc9736cSJeff Kirsher return;
4802bcc9736cSJeff Kirsher if (unlikely(!hw_priv->dev_rcv(hw_priv))) {
4803bcc9736cSJeff Kirsher
4804bcc9736cSJeff Kirsher /* In case receive process is suspended because of overrun. */
4805bcc9736cSJeff Kirsher hw_resume_rx(hw);
4806bcc9736cSJeff Kirsher
4807bcc9736cSJeff Kirsher /* tasklets are interruptible. */
4808bcc9736cSJeff Kirsher spin_lock_irq(&hw_priv->hwlock);
4809bcc9736cSJeff Kirsher hw_turn_on_intr(hw, KS884X_INT_RX_MASK);
4810bcc9736cSJeff Kirsher spin_unlock_irq(&hw_priv->hwlock);
4811bcc9736cSJeff Kirsher } else {
4812bcc9736cSJeff Kirsher hw_ack_intr(hw, KS884X_INT_RX);
4813bcc9736cSJeff Kirsher tasklet_schedule(&hw_priv->rx_tasklet);
4814bcc9736cSJeff Kirsher }
4815bcc9736cSJeff Kirsher }
4816bcc9736cSJeff Kirsher
tx_proc_task(struct tasklet_struct * t)48179ad5a250SAllen Pais static void tx_proc_task(struct tasklet_struct *t)
4818bcc9736cSJeff Kirsher {
48199ad5a250SAllen Pais struct dev_info *hw_priv = from_tasklet(hw_priv, t, tx_tasklet);
4820bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4821bcc9736cSJeff Kirsher
4822bcc9736cSJeff Kirsher hw_ack_intr(hw, KS884X_INT_TX_MASK);
4823bcc9736cSJeff Kirsher
4824bcc9736cSJeff Kirsher tx_done(hw_priv);
4825bcc9736cSJeff Kirsher
4826bcc9736cSJeff Kirsher /* tasklets are interruptible. */
4827bcc9736cSJeff Kirsher spin_lock_irq(&hw_priv->hwlock);
4828bcc9736cSJeff Kirsher hw_turn_on_intr(hw, KS884X_INT_TX);
4829bcc9736cSJeff Kirsher spin_unlock_irq(&hw_priv->hwlock);
4830bcc9736cSJeff Kirsher }
4831bcc9736cSJeff Kirsher
handle_rx_stop(struct ksz_hw * hw)4832bcc9736cSJeff Kirsher static inline void handle_rx_stop(struct ksz_hw *hw)
4833bcc9736cSJeff Kirsher {
4834bcc9736cSJeff Kirsher /* Receive just has been stopped. */
4835bcc9736cSJeff Kirsher if (0 == hw->rx_stop)
4836bcc9736cSJeff Kirsher hw->intr_mask &= ~KS884X_INT_RX_STOPPED;
4837bcc9736cSJeff Kirsher else if (hw->rx_stop > 1) {
4838bcc9736cSJeff Kirsher if (hw->enabled && (hw->rx_cfg & DMA_RX_ENABLE)) {
4839bcc9736cSJeff Kirsher hw_start_rx(hw);
4840bcc9736cSJeff Kirsher } else {
4841bcc9736cSJeff Kirsher hw->intr_mask &= ~KS884X_INT_RX_STOPPED;
4842bcc9736cSJeff Kirsher hw->rx_stop = 0;
4843bcc9736cSJeff Kirsher }
4844bcc9736cSJeff Kirsher } else
4845bcc9736cSJeff Kirsher /* Receive just has been started. */
4846bcc9736cSJeff Kirsher hw->rx_stop++;
4847bcc9736cSJeff Kirsher }
4848bcc9736cSJeff Kirsher
4849bcc9736cSJeff Kirsher /**
4850bcc9736cSJeff Kirsher * netdev_intr - interrupt handling
4851bcc9736cSJeff Kirsher * @irq: Interrupt number.
4852bcc9736cSJeff Kirsher * @dev_id: Network device.
4853bcc9736cSJeff Kirsher *
4854bcc9736cSJeff Kirsher * This function is called by upper network layer to signal interrupt.
4855bcc9736cSJeff Kirsher *
4856bcc9736cSJeff Kirsher * Return IRQ_HANDLED if interrupt is handled.
4857bcc9736cSJeff Kirsher */
netdev_intr(int irq,void * dev_id)4858bcc9736cSJeff Kirsher static irqreturn_t netdev_intr(int irq, void *dev_id)
4859bcc9736cSJeff Kirsher {
4860bcc9736cSJeff Kirsher uint int_enable = 0;
4861bcc9736cSJeff Kirsher struct net_device *dev = (struct net_device *) dev_id;
4862bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
4863bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
4864bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4865bcc9736cSJeff Kirsher
48664945106dSLennert Buytenhek spin_lock(&hw_priv->hwlock);
48674945106dSLennert Buytenhek
4868bcc9736cSJeff Kirsher hw_read_intr(hw, &int_enable);
4869bcc9736cSJeff Kirsher
4870bcc9736cSJeff Kirsher /* Not our interrupt! */
48714945106dSLennert Buytenhek if (!int_enable) {
48724945106dSLennert Buytenhek spin_unlock(&hw_priv->hwlock);
4873bcc9736cSJeff Kirsher return IRQ_NONE;
48744945106dSLennert Buytenhek }
4875bcc9736cSJeff Kirsher
4876bcc9736cSJeff Kirsher do {
4877bcc9736cSJeff Kirsher hw_ack_intr(hw, int_enable);
4878bcc9736cSJeff Kirsher int_enable &= hw->intr_mask;
4879bcc9736cSJeff Kirsher
4880bcc9736cSJeff Kirsher if (unlikely(int_enable & KS884X_INT_TX_MASK)) {
4881bcc9736cSJeff Kirsher hw_dis_intr_bit(hw, KS884X_INT_TX_MASK);
4882bcc9736cSJeff Kirsher tasklet_schedule(&hw_priv->tx_tasklet);
4883bcc9736cSJeff Kirsher }
4884bcc9736cSJeff Kirsher
4885bcc9736cSJeff Kirsher if (likely(int_enable & KS884X_INT_RX)) {
4886bcc9736cSJeff Kirsher hw_dis_intr_bit(hw, KS884X_INT_RX);
4887bcc9736cSJeff Kirsher tasklet_schedule(&hw_priv->rx_tasklet);
4888bcc9736cSJeff Kirsher }
4889bcc9736cSJeff Kirsher
4890bcc9736cSJeff Kirsher if (unlikely(int_enable & KS884X_INT_RX_OVERRUN)) {
4891bcc9736cSJeff Kirsher dev->stats.rx_fifo_errors++;
4892bcc9736cSJeff Kirsher hw_resume_rx(hw);
4893bcc9736cSJeff Kirsher }
4894bcc9736cSJeff Kirsher
4895bcc9736cSJeff Kirsher if (unlikely(int_enable & KS884X_INT_PHY)) {
4896bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
4897bcc9736cSJeff Kirsher
4898bcc9736cSJeff Kirsher hw->features |= LINK_INT_WORKING;
4899bcc9736cSJeff Kirsher port_get_link_speed(port);
4900bcc9736cSJeff Kirsher }
4901bcc9736cSJeff Kirsher
4902bcc9736cSJeff Kirsher if (unlikely(int_enable & KS884X_INT_RX_STOPPED)) {
4903bcc9736cSJeff Kirsher handle_rx_stop(hw);
4904bcc9736cSJeff Kirsher break;
4905bcc9736cSJeff Kirsher }
4906bcc9736cSJeff Kirsher
4907bcc9736cSJeff Kirsher if (unlikely(int_enable & KS884X_INT_TX_STOPPED)) {
4908bcc9736cSJeff Kirsher u32 data;
4909bcc9736cSJeff Kirsher
4910bcc9736cSJeff Kirsher hw->intr_mask &= ~KS884X_INT_TX_STOPPED;
4911bcc9736cSJeff Kirsher pr_info("Tx stopped\n");
4912bcc9736cSJeff Kirsher data = readl(hw->io + KS_DMA_TX_CTRL);
4913bcc9736cSJeff Kirsher if (!(data & DMA_TX_ENABLE))
4914bcc9736cSJeff Kirsher pr_info("Tx disabled\n");
4915bcc9736cSJeff Kirsher break;
4916bcc9736cSJeff Kirsher }
4917bcc9736cSJeff Kirsher } while (0);
4918bcc9736cSJeff Kirsher
4919bcc9736cSJeff Kirsher hw_ena_intr(hw);
4920bcc9736cSJeff Kirsher
49214945106dSLennert Buytenhek spin_unlock(&hw_priv->hwlock);
49224945106dSLennert Buytenhek
4923bcc9736cSJeff Kirsher return IRQ_HANDLED;
4924bcc9736cSJeff Kirsher }
4925bcc9736cSJeff Kirsher
4926bcc9736cSJeff Kirsher /*
4927bcc9736cSJeff Kirsher * Linux network device functions
4928bcc9736cSJeff Kirsher */
4929bcc9736cSJeff Kirsher
4930bcc9736cSJeff Kirsher
4931bcc9736cSJeff Kirsher #ifdef CONFIG_NET_POLL_CONTROLLER
netdev_netpoll(struct net_device * dev)4932bcc9736cSJeff Kirsher static void netdev_netpoll(struct net_device *dev)
4933bcc9736cSJeff Kirsher {
4934bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
4935bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
4936bcc9736cSJeff Kirsher
4937bcc9736cSJeff Kirsher hw_dis_intr(&hw_priv->hw);
4938bcc9736cSJeff Kirsher netdev_intr(dev->irq, dev);
4939bcc9736cSJeff Kirsher }
4940bcc9736cSJeff Kirsher #endif
4941bcc9736cSJeff Kirsher
bridge_change(struct ksz_hw * hw)4942bcc9736cSJeff Kirsher static void bridge_change(struct ksz_hw *hw)
4943bcc9736cSJeff Kirsher {
4944bcc9736cSJeff Kirsher int port;
4945bcc9736cSJeff Kirsher u8 member;
4946bcc9736cSJeff Kirsher struct ksz_switch *sw = hw->ksz_switch;
4947bcc9736cSJeff Kirsher
4948bcc9736cSJeff Kirsher /* No ports in forwarding state. */
4949bcc9736cSJeff Kirsher if (!sw->member) {
4950bcc9736cSJeff Kirsher port_set_stp_state(hw, SWITCH_PORT_NUM, STP_STATE_SIMPLE);
4951bcc9736cSJeff Kirsher sw_block_addr(hw);
4952bcc9736cSJeff Kirsher }
4953bcc9736cSJeff Kirsher for (port = 0; port < SWITCH_PORT_NUM; port++) {
4954bcc9736cSJeff Kirsher if (STP_STATE_FORWARDING == sw->port_cfg[port].stp_state)
4955bcc9736cSJeff Kirsher member = HOST_MASK | sw->member;
4956bcc9736cSJeff Kirsher else
4957bcc9736cSJeff Kirsher member = HOST_MASK | (1 << port);
4958bcc9736cSJeff Kirsher if (member != sw->port_cfg[port].member)
4959bcc9736cSJeff Kirsher sw_cfg_port_base_vlan(hw, port, member);
4960bcc9736cSJeff Kirsher }
4961bcc9736cSJeff Kirsher }
4962bcc9736cSJeff Kirsher
4963bcc9736cSJeff Kirsher /**
4964bcc9736cSJeff Kirsher * netdev_close - close network device
4965bcc9736cSJeff Kirsher * @dev: Network device.
4966bcc9736cSJeff Kirsher *
4967bcc9736cSJeff Kirsher * This function process the close operation of network device. This is caused
4968bcc9736cSJeff Kirsher * by the user command "ifconfig ethX down."
4969bcc9736cSJeff Kirsher *
4970bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code indicating failure.
4971bcc9736cSJeff Kirsher */
netdev_close(struct net_device * dev)4972bcc9736cSJeff Kirsher static int netdev_close(struct net_device *dev)
4973bcc9736cSJeff Kirsher {
4974bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
4975bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
4976bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
4977bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
4978bcc9736cSJeff Kirsher int pi;
4979bcc9736cSJeff Kirsher
4980bcc9736cSJeff Kirsher netif_stop_queue(dev);
4981bcc9736cSJeff Kirsher
4982bcc9736cSJeff Kirsher ksz_stop_timer(&priv->monitor_timer_info);
4983bcc9736cSJeff Kirsher
4984bcc9736cSJeff Kirsher /* Need to shut the port manually in multiple device interfaces mode. */
4985bcc9736cSJeff Kirsher if (hw->dev_count > 1) {
4986bcc9736cSJeff Kirsher port_set_stp_state(hw, port->first_port, STP_STATE_DISABLED);
4987bcc9736cSJeff Kirsher
4988bcc9736cSJeff Kirsher /* Port is closed. Need to change bridge setting. */
4989bcc9736cSJeff Kirsher if (hw->features & STP_SUPPORT) {
4990bcc9736cSJeff Kirsher pi = 1 << port->first_port;
4991bcc9736cSJeff Kirsher if (hw->ksz_switch->member & pi) {
4992bcc9736cSJeff Kirsher hw->ksz_switch->member &= ~pi;
4993bcc9736cSJeff Kirsher bridge_change(hw);
4994bcc9736cSJeff Kirsher }
4995bcc9736cSJeff Kirsher }
4996bcc9736cSJeff Kirsher }
4997bcc9736cSJeff Kirsher if (port->first_port > 0)
4998bcc9736cSJeff Kirsher hw_del_addr(hw, dev->dev_addr);
4999bcc9736cSJeff Kirsher if (!hw_priv->wol_enable)
5000bcc9736cSJeff Kirsher port_set_power_saving(port, true);
5001bcc9736cSJeff Kirsher
5002bcc9736cSJeff Kirsher if (priv->multicast)
5003bcc9736cSJeff Kirsher --hw->all_multi;
5004bcc9736cSJeff Kirsher if (priv->promiscuous)
5005bcc9736cSJeff Kirsher --hw->promiscuous;
5006bcc9736cSJeff Kirsher
5007bcc9736cSJeff Kirsher hw_priv->opened--;
5008bcc9736cSJeff Kirsher if (!(hw_priv->opened)) {
5009bcc9736cSJeff Kirsher ksz_stop_timer(&hw_priv->mib_timer_info);
5010bcc9736cSJeff Kirsher flush_work(&hw_priv->mib_read);
5011bcc9736cSJeff Kirsher
5012bcc9736cSJeff Kirsher hw_dis_intr(hw);
5013bcc9736cSJeff Kirsher hw_disable(hw);
5014bcc9736cSJeff Kirsher hw_clr_multicast(hw);
5015bcc9736cSJeff Kirsher
5016bcc9736cSJeff Kirsher /* Delay for receive task to stop scheduling itself. */
5017bcc9736cSJeff Kirsher msleep(2000 / HZ);
5018bcc9736cSJeff Kirsher
5019175c0dffSXiaotian Feng tasklet_kill(&hw_priv->rx_tasklet);
5020175c0dffSXiaotian Feng tasklet_kill(&hw_priv->tx_tasklet);
5021bcc9736cSJeff Kirsher free_irq(dev->irq, hw_priv->dev);
5022bcc9736cSJeff Kirsher
5023bcc9736cSJeff Kirsher transmit_cleanup(hw_priv, 0);
5024bcc9736cSJeff Kirsher hw_reset_pkts(&hw->rx_desc_info);
5025bcc9736cSJeff Kirsher hw_reset_pkts(&hw->tx_desc_info);
5026bcc9736cSJeff Kirsher
5027bcc9736cSJeff Kirsher /* Clean out static MAC table when the switch is shutdown. */
5028bcc9736cSJeff Kirsher if (hw->features & STP_SUPPORT)
5029bcc9736cSJeff Kirsher sw_clr_sta_mac_table(hw);
5030bcc9736cSJeff Kirsher }
5031bcc9736cSJeff Kirsher
5032bcc9736cSJeff Kirsher return 0;
5033bcc9736cSJeff Kirsher }
5034bcc9736cSJeff Kirsher
hw_cfg_huge_frame(struct dev_info * hw_priv,struct ksz_hw * hw)5035bcc9736cSJeff Kirsher static void hw_cfg_huge_frame(struct dev_info *hw_priv, struct ksz_hw *hw)
5036bcc9736cSJeff Kirsher {
5037bcc9736cSJeff Kirsher if (hw->ksz_switch) {
5038bcc9736cSJeff Kirsher u32 data;
5039bcc9736cSJeff Kirsher
5040bcc9736cSJeff Kirsher data = readw(hw->io + KS8842_SWITCH_CTRL_2_OFFSET);
5041bcc9736cSJeff Kirsher if (hw->features & RX_HUGE_FRAME)
5042bcc9736cSJeff Kirsher data |= SWITCH_HUGE_PACKET;
5043bcc9736cSJeff Kirsher else
5044bcc9736cSJeff Kirsher data &= ~SWITCH_HUGE_PACKET;
5045bcc9736cSJeff Kirsher writew(data, hw->io + KS8842_SWITCH_CTRL_2_OFFSET);
5046bcc9736cSJeff Kirsher }
5047bcc9736cSJeff Kirsher if (hw->features & RX_HUGE_FRAME) {
5048bcc9736cSJeff Kirsher hw->rx_cfg |= DMA_RX_ERROR;
5049bcc9736cSJeff Kirsher hw_priv->dev_rcv = dev_rcv_special;
5050bcc9736cSJeff Kirsher } else {
5051bcc9736cSJeff Kirsher hw->rx_cfg &= ~DMA_RX_ERROR;
5052bcc9736cSJeff Kirsher if (hw->dev_count > 1)
5053bcc9736cSJeff Kirsher hw_priv->dev_rcv = port_rcv_packets;
5054bcc9736cSJeff Kirsher else
5055bcc9736cSJeff Kirsher hw_priv->dev_rcv = dev_rcv_packets;
5056bcc9736cSJeff Kirsher }
5057bcc9736cSJeff Kirsher }
5058bcc9736cSJeff Kirsher
prepare_hardware(struct net_device * dev)5059bcc9736cSJeff Kirsher static int prepare_hardware(struct net_device *dev)
5060bcc9736cSJeff Kirsher {
5061bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5062bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5063bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
5064bcc9736cSJeff Kirsher int rc = 0;
5065bcc9736cSJeff Kirsher
5066bcc9736cSJeff Kirsher /* Remember the network device that requests interrupts. */
5067bcc9736cSJeff Kirsher hw_priv->dev = dev;
5068bcc9736cSJeff Kirsher rc = request_irq(dev->irq, netdev_intr, IRQF_SHARED, dev->name, dev);
5069bcc9736cSJeff Kirsher if (rc)
5070bcc9736cSJeff Kirsher return rc;
50719ad5a250SAllen Pais tasklet_setup(&hw_priv->rx_tasklet, rx_proc_task);
50729ad5a250SAllen Pais tasklet_setup(&hw_priv->tx_tasklet, tx_proc_task);
5073bcc9736cSJeff Kirsher
5074bcc9736cSJeff Kirsher hw->promiscuous = 0;
5075bcc9736cSJeff Kirsher hw->all_multi = 0;
5076bcc9736cSJeff Kirsher hw->multi_list_size = 0;
5077bcc9736cSJeff Kirsher
5078bcc9736cSJeff Kirsher hw_reset(hw);
5079bcc9736cSJeff Kirsher
5080bcc9736cSJeff Kirsher hw_set_desc_base(hw,
5081bcc9736cSJeff Kirsher hw->tx_desc_info.ring_phys, hw->rx_desc_info.ring_phys);
5082bcc9736cSJeff Kirsher hw_set_addr(hw);
5083bcc9736cSJeff Kirsher hw_cfg_huge_frame(hw_priv, hw);
5084bcc9736cSJeff Kirsher ksz_init_rx_buffers(hw_priv);
5085bcc9736cSJeff Kirsher return 0;
5086bcc9736cSJeff Kirsher }
5087bcc9736cSJeff Kirsher
set_media_state(struct net_device * dev,int media_state)5088bcc9736cSJeff Kirsher static void set_media_state(struct net_device *dev, int media_state)
5089bcc9736cSJeff Kirsher {
5090bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5091bcc9736cSJeff Kirsher
5092bcc9736cSJeff Kirsher if (media_state == priv->media_state)
5093bcc9736cSJeff Kirsher netif_carrier_on(dev);
5094bcc9736cSJeff Kirsher else
5095bcc9736cSJeff Kirsher netif_carrier_off(dev);
5096bcc9736cSJeff Kirsher netif_info(priv, link, dev, "link %s\n",
5097bcc9736cSJeff Kirsher media_state == priv->media_state ? "on" : "off");
5098bcc9736cSJeff Kirsher }
5099bcc9736cSJeff Kirsher
5100bcc9736cSJeff Kirsher /**
5101bcc9736cSJeff Kirsher * netdev_open - open network device
5102bcc9736cSJeff Kirsher * @dev: Network device.
5103bcc9736cSJeff Kirsher *
5104bcc9736cSJeff Kirsher * This function process the open operation of network device. This is caused
5105bcc9736cSJeff Kirsher * by the user command "ifconfig ethX up."
5106bcc9736cSJeff Kirsher *
5107bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code indicating failure.
5108bcc9736cSJeff Kirsher */
netdev_open(struct net_device * dev)5109bcc9736cSJeff Kirsher static int netdev_open(struct net_device *dev)
5110bcc9736cSJeff Kirsher {
5111bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5112bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5113bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
5114bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
5115af1147b2Swujunwen unsigned long next_jiffies;
5116bcc9736cSJeff Kirsher int i;
5117bcc9736cSJeff Kirsher int p;
5118bcc9736cSJeff Kirsher int rc = 0;
5119bcc9736cSJeff Kirsher
5120af1147b2Swujunwen next_jiffies = jiffies + HZ * 2;
5121bcc9736cSJeff Kirsher priv->multicast = 0;
5122bcc9736cSJeff Kirsher priv->promiscuous = 0;
5123bcc9736cSJeff Kirsher
5124bcc9736cSJeff Kirsher /* Reset device statistics. */
5125bcc9736cSJeff Kirsher memset(&dev->stats, 0, sizeof(struct net_device_stats));
5126bcc9736cSJeff Kirsher memset((void *) port->counter, 0,
5127bcc9736cSJeff Kirsher (sizeof(u64) * OID_COUNTER_LAST));
5128bcc9736cSJeff Kirsher
5129bcc9736cSJeff Kirsher if (!(hw_priv->opened)) {
5130bcc9736cSJeff Kirsher rc = prepare_hardware(dev);
5131bcc9736cSJeff Kirsher if (rc)
5132bcc9736cSJeff Kirsher return rc;
5133bcc9736cSJeff Kirsher for (i = 0; i < hw->mib_port_cnt; i++) {
5134bcc9736cSJeff Kirsher next_jiffies += HZ * 1;
5135bcc9736cSJeff Kirsher hw_priv->counter[i].time = next_jiffies;
5136bcc9736cSJeff Kirsher hw->port_mib[i].state = media_disconnected;
5137bcc9736cSJeff Kirsher port_init_cnt(hw, i);
5138bcc9736cSJeff Kirsher }
5139bcc9736cSJeff Kirsher if (hw->ksz_switch)
5140bcc9736cSJeff Kirsher hw->port_mib[HOST_PORT].state = media_connected;
5141bcc9736cSJeff Kirsher else {
5142bcc9736cSJeff Kirsher hw_add_wol_bcast(hw);
5143bcc9736cSJeff Kirsher hw_cfg_wol_pme(hw, 0);
5144bcc9736cSJeff Kirsher hw_clr_wol_pme_status(&hw_priv->hw);
5145bcc9736cSJeff Kirsher }
5146bcc9736cSJeff Kirsher }
5147bcc9736cSJeff Kirsher port_set_power_saving(port, false);
5148bcc9736cSJeff Kirsher
5149bcc9736cSJeff Kirsher for (i = 0, p = port->first_port; i < port->port_cnt; i++, p++) {
5150bcc9736cSJeff Kirsher /*
5151bcc9736cSJeff Kirsher * Initialize to invalid value so that link detection
5152bcc9736cSJeff Kirsher * is done.
5153bcc9736cSJeff Kirsher */
5154bcc9736cSJeff Kirsher hw->port_info[p].partner = 0xFF;
5155bcc9736cSJeff Kirsher hw->port_info[p].state = media_disconnected;
5156bcc9736cSJeff Kirsher }
5157bcc9736cSJeff Kirsher
5158bcc9736cSJeff Kirsher /* Need to open the port in multiple device interfaces mode. */
5159bcc9736cSJeff Kirsher if (hw->dev_count > 1) {
5160bcc9736cSJeff Kirsher port_set_stp_state(hw, port->first_port, STP_STATE_SIMPLE);
5161bcc9736cSJeff Kirsher if (port->first_port > 0)
5162bcc9736cSJeff Kirsher hw_add_addr(hw, dev->dev_addr);
5163bcc9736cSJeff Kirsher }
5164bcc9736cSJeff Kirsher
5165bcc9736cSJeff Kirsher port_get_link_speed(port);
5166bcc9736cSJeff Kirsher if (port->force_link)
5167bcc9736cSJeff Kirsher port_force_link_speed(port);
5168bcc9736cSJeff Kirsher else
5169bcc9736cSJeff Kirsher port_set_link_speed(port);
5170bcc9736cSJeff Kirsher
5171bcc9736cSJeff Kirsher if (!(hw_priv->opened)) {
5172bcc9736cSJeff Kirsher hw_setup_intr(hw);
5173bcc9736cSJeff Kirsher hw_enable(hw);
5174bcc9736cSJeff Kirsher hw_ena_intr(hw);
5175bcc9736cSJeff Kirsher
5176bcc9736cSJeff Kirsher if (hw->mib_port_cnt)
5177bcc9736cSJeff Kirsher ksz_start_timer(&hw_priv->mib_timer_info,
5178bcc9736cSJeff Kirsher hw_priv->mib_timer_info.period);
5179bcc9736cSJeff Kirsher }
5180bcc9736cSJeff Kirsher
5181bcc9736cSJeff Kirsher hw_priv->opened++;
5182bcc9736cSJeff Kirsher
5183bcc9736cSJeff Kirsher ksz_start_timer(&priv->monitor_timer_info,
5184bcc9736cSJeff Kirsher priv->monitor_timer_info.period);
5185bcc9736cSJeff Kirsher
5186bcc9736cSJeff Kirsher priv->media_state = port->linked->state;
5187bcc9736cSJeff Kirsher
5188bcc9736cSJeff Kirsher set_media_state(dev, media_connected);
5189bcc9736cSJeff Kirsher netif_start_queue(dev);
5190bcc9736cSJeff Kirsher
5191bcc9736cSJeff Kirsher return 0;
5192bcc9736cSJeff Kirsher }
5193bcc9736cSJeff Kirsher
5194bcc9736cSJeff Kirsher /* RX errors = rx_errors */
5195bcc9736cSJeff Kirsher /* RX dropped = rx_dropped */
5196bcc9736cSJeff Kirsher /* RX overruns = rx_fifo_errors */
5197bcc9736cSJeff Kirsher /* RX frame = rx_crc_errors + rx_frame_errors + rx_length_errors */
5198bcc9736cSJeff Kirsher /* TX errors = tx_errors */
5199bcc9736cSJeff Kirsher /* TX dropped = tx_dropped */
5200bcc9736cSJeff Kirsher /* TX overruns = tx_fifo_errors */
5201bcc9736cSJeff Kirsher /* TX carrier = tx_aborted_errors + tx_carrier_errors + tx_window_errors */
5202bcc9736cSJeff Kirsher /* collisions = collisions */
5203bcc9736cSJeff Kirsher
5204bcc9736cSJeff Kirsher /**
5205bcc9736cSJeff Kirsher * netdev_query_statistics - query network device statistics
5206bcc9736cSJeff Kirsher * @dev: Network device.
5207bcc9736cSJeff Kirsher *
5208bcc9736cSJeff Kirsher * This function returns the statistics of the network device. The device
5209bcc9736cSJeff Kirsher * needs not be opened.
5210bcc9736cSJeff Kirsher *
5211bcc9736cSJeff Kirsher * Return network device statistics.
5212bcc9736cSJeff Kirsher */
netdev_query_statistics(struct net_device * dev)5213bcc9736cSJeff Kirsher static struct net_device_stats *netdev_query_statistics(struct net_device *dev)
5214bcc9736cSJeff Kirsher {
5215bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5216bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
5217bcc9736cSJeff Kirsher struct ksz_hw *hw = &priv->adapter->hw;
5218bcc9736cSJeff Kirsher struct ksz_port_mib *mib;
5219bcc9736cSJeff Kirsher int i;
5220bcc9736cSJeff Kirsher int p;
5221bcc9736cSJeff Kirsher
5222bcc9736cSJeff Kirsher dev->stats.rx_errors = port->counter[OID_COUNTER_RCV_ERROR];
5223bcc9736cSJeff Kirsher dev->stats.tx_errors = port->counter[OID_COUNTER_XMIT_ERROR];
5224bcc9736cSJeff Kirsher
5225bcc9736cSJeff Kirsher /* Reset to zero to add count later. */
5226bcc9736cSJeff Kirsher dev->stats.multicast = 0;
5227bcc9736cSJeff Kirsher dev->stats.collisions = 0;
5228bcc9736cSJeff Kirsher dev->stats.rx_length_errors = 0;
5229bcc9736cSJeff Kirsher dev->stats.rx_crc_errors = 0;
5230bcc9736cSJeff Kirsher dev->stats.rx_frame_errors = 0;
5231bcc9736cSJeff Kirsher dev->stats.tx_window_errors = 0;
5232bcc9736cSJeff Kirsher
5233bcc9736cSJeff Kirsher for (i = 0, p = port->first_port; i < port->mib_port_cnt; i++, p++) {
5234bcc9736cSJeff Kirsher mib = &hw->port_mib[p];
5235bcc9736cSJeff Kirsher
5236bcc9736cSJeff Kirsher dev->stats.multicast += (unsigned long)
5237bcc9736cSJeff Kirsher mib->counter[MIB_COUNTER_RX_MULTICAST];
5238bcc9736cSJeff Kirsher
5239bcc9736cSJeff Kirsher dev->stats.collisions += (unsigned long)
5240bcc9736cSJeff Kirsher mib->counter[MIB_COUNTER_TX_TOTAL_COLLISION];
5241bcc9736cSJeff Kirsher
5242bcc9736cSJeff Kirsher dev->stats.rx_length_errors += (unsigned long)(
5243bcc9736cSJeff Kirsher mib->counter[MIB_COUNTER_RX_UNDERSIZE] +
5244bcc9736cSJeff Kirsher mib->counter[MIB_COUNTER_RX_FRAGMENT] +
5245bcc9736cSJeff Kirsher mib->counter[MIB_COUNTER_RX_OVERSIZE] +
5246bcc9736cSJeff Kirsher mib->counter[MIB_COUNTER_RX_JABBER]);
5247bcc9736cSJeff Kirsher dev->stats.rx_crc_errors += (unsigned long)
5248bcc9736cSJeff Kirsher mib->counter[MIB_COUNTER_RX_CRC_ERR];
5249bcc9736cSJeff Kirsher dev->stats.rx_frame_errors += (unsigned long)(
5250bcc9736cSJeff Kirsher mib->counter[MIB_COUNTER_RX_ALIGNMENT_ERR] +
5251bcc9736cSJeff Kirsher mib->counter[MIB_COUNTER_RX_SYMBOL_ERR]);
5252bcc9736cSJeff Kirsher
5253bcc9736cSJeff Kirsher dev->stats.tx_window_errors += (unsigned long)
5254bcc9736cSJeff Kirsher mib->counter[MIB_COUNTER_TX_LATE_COLLISION];
5255bcc9736cSJeff Kirsher }
5256bcc9736cSJeff Kirsher
5257bcc9736cSJeff Kirsher return &dev->stats;
5258bcc9736cSJeff Kirsher }
5259bcc9736cSJeff Kirsher
5260bcc9736cSJeff Kirsher /**
5261bcc9736cSJeff Kirsher * netdev_set_mac_address - set network device MAC address
5262bcc9736cSJeff Kirsher * @dev: Network device.
5263bcc9736cSJeff Kirsher * @addr: Buffer of MAC address.
5264bcc9736cSJeff Kirsher *
5265bcc9736cSJeff Kirsher * This function is used to set the MAC address of the network device.
5266bcc9736cSJeff Kirsher *
5267bcc9736cSJeff Kirsher * Return 0 to indicate success.
5268bcc9736cSJeff Kirsher */
netdev_set_mac_address(struct net_device * dev,void * addr)5269bcc9736cSJeff Kirsher static int netdev_set_mac_address(struct net_device *dev, void *addr)
5270bcc9736cSJeff Kirsher {
5271bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5272bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5273bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
5274bcc9736cSJeff Kirsher struct sockaddr *mac = addr;
5275bcc9736cSJeff Kirsher uint interrupt;
5276bcc9736cSJeff Kirsher
5277bcc9736cSJeff Kirsher if (priv->port.first_port > 0)
5278bcc9736cSJeff Kirsher hw_del_addr(hw, dev->dev_addr);
5279bcc9736cSJeff Kirsher else {
5280bcc9736cSJeff Kirsher hw->mac_override = 1;
52816a3c910cSJoe Perches memcpy(hw->override_addr, mac->sa_data, ETH_ALEN);
5282bcc9736cSJeff Kirsher }
5283bcc9736cSJeff Kirsher
5284a96d317fSJakub Kicinski eth_hw_addr_set(dev, mac->sa_data);
5285bcc9736cSJeff Kirsher
5286bcc9736cSJeff Kirsher interrupt = hw_block_intr(hw);
5287bcc9736cSJeff Kirsher
5288bcc9736cSJeff Kirsher if (priv->port.first_port > 0)
5289bcc9736cSJeff Kirsher hw_add_addr(hw, dev->dev_addr);
5290bcc9736cSJeff Kirsher else
5291bcc9736cSJeff Kirsher hw_set_addr(hw);
5292bcc9736cSJeff Kirsher hw_restore_intr(hw, interrupt);
5293bcc9736cSJeff Kirsher
5294bcc9736cSJeff Kirsher return 0;
5295bcc9736cSJeff Kirsher }
5296bcc9736cSJeff Kirsher
dev_set_promiscuous(struct net_device * dev,struct dev_priv * priv,struct ksz_hw * hw,int promiscuous)5297bcc9736cSJeff Kirsher static void dev_set_promiscuous(struct net_device *dev, struct dev_priv *priv,
5298bcc9736cSJeff Kirsher struct ksz_hw *hw, int promiscuous)
5299bcc9736cSJeff Kirsher {
5300bcc9736cSJeff Kirsher if (promiscuous != priv->promiscuous) {
5301bcc9736cSJeff Kirsher u8 prev_state = hw->promiscuous;
5302bcc9736cSJeff Kirsher
5303bcc9736cSJeff Kirsher if (promiscuous)
5304bcc9736cSJeff Kirsher ++hw->promiscuous;
5305bcc9736cSJeff Kirsher else
5306bcc9736cSJeff Kirsher --hw->promiscuous;
5307bcc9736cSJeff Kirsher priv->promiscuous = promiscuous;
5308bcc9736cSJeff Kirsher
5309bcc9736cSJeff Kirsher /* Turn on/off promiscuous mode. */
5310bcc9736cSJeff Kirsher if (hw->promiscuous <= 1 && prev_state <= 1)
5311bcc9736cSJeff Kirsher hw_set_promiscuous(hw, hw->promiscuous);
5312bcc9736cSJeff Kirsher
5313bcc9736cSJeff Kirsher /*
5314bcc9736cSJeff Kirsher * Port is not in promiscuous mode, meaning it is released
5315bcc9736cSJeff Kirsher * from the bridge.
5316bcc9736cSJeff Kirsher */
5317bcc9736cSJeff Kirsher if ((hw->features & STP_SUPPORT) && !promiscuous &&
53182e92a2d0SJulian Wiedmann netif_is_bridge_port(dev)) {
5319bcc9736cSJeff Kirsher struct ksz_switch *sw = hw->ksz_switch;
5320bcc9736cSJeff Kirsher int port = priv->port.first_port;
5321bcc9736cSJeff Kirsher
5322bcc9736cSJeff Kirsher port_set_stp_state(hw, port, STP_STATE_DISABLED);
5323bcc9736cSJeff Kirsher port = 1 << port;
5324bcc9736cSJeff Kirsher if (sw->member & port) {
5325bcc9736cSJeff Kirsher sw->member &= ~port;
5326bcc9736cSJeff Kirsher bridge_change(hw);
5327bcc9736cSJeff Kirsher }
5328bcc9736cSJeff Kirsher }
5329bcc9736cSJeff Kirsher }
5330bcc9736cSJeff Kirsher }
5331bcc9736cSJeff Kirsher
dev_set_multicast(struct dev_priv * priv,struct ksz_hw * hw,int multicast)5332bcc9736cSJeff Kirsher static void dev_set_multicast(struct dev_priv *priv, struct ksz_hw *hw,
5333bcc9736cSJeff Kirsher int multicast)
5334bcc9736cSJeff Kirsher {
5335bcc9736cSJeff Kirsher if (multicast != priv->multicast) {
5336bcc9736cSJeff Kirsher u8 all_multi = hw->all_multi;
5337bcc9736cSJeff Kirsher
5338bcc9736cSJeff Kirsher if (multicast)
5339bcc9736cSJeff Kirsher ++hw->all_multi;
5340bcc9736cSJeff Kirsher else
5341bcc9736cSJeff Kirsher --hw->all_multi;
5342bcc9736cSJeff Kirsher priv->multicast = multicast;
5343bcc9736cSJeff Kirsher
5344bcc9736cSJeff Kirsher /* Turn on/off all multicast mode. */
5345bcc9736cSJeff Kirsher if (hw->all_multi <= 1 && all_multi <= 1)
5346bcc9736cSJeff Kirsher hw_set_multicast(hw, hw->all_multi);
5347bcc9736cSJeff Kirsher }
5348bcc9736cSJeff Kirsher }
5349bcc9736cSJeff Kirsher
5350bcc9736cSJeff Kirsher /**
5351bcc9736cSJeff Kirsher * netdev_set_rx_mode
5352bcc9736cSJeff Kirsher * @dev: Network device.
5353bcc9736cSJeff Kirsher *
5354bcc9736cSJeff Kirsher * This routine is used to set multicast addresses or put the network device
5355bcc9736cSJeff Kirsher * into promiscuous mode.
5356bcc9736cSJeff Kirsher */
netdev_set_rx_mode(struct net_device * dev)5357bcc9736cSJeff Kirsher static void netdev_set_rx_mode(struct net_device *dev)
5358bcc9736cSJeff Kirsher {
5359bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5360bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5361bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
5362bcc9736cSJeff Kirsher struct netdev_hw_addr *ha;
5363bcc9736cSJeff Kirsher int multicast = (dev->flags & IFF_ALLMULTI);
5364bcc9736cSJeff Kirsher
5365bcc9736cSJeff Kirsher dev_set_promiscuous(dev, priv, hw, (dev->flags & IFF_PROMISC));
5366bcc9736cSJeff Kirsher
5367bcc9736cSJeff Kirsher if (hw_priv->hw.dev_count > 1)
5368bcc9736cSJeff Kirsher multicast |= (dev->flags & IFF_MULTICAST);
5369bcc9736cSJeff Kirsher dev_set_multicast(priv, hw, multicast);
5370bcc9736cSJeff Kirsher
5371bcc9736cSJeff Kirsher /* Cannot use different hashes in multiple device interfaces mode. */
5372bcc9736cSJeff Kirsher if (hw_priv->hw.dev_count > 1)
5373bcc9736cSJeff Kirsher return;
5374bcc9736cSJeff Kirsher
5375bcc9736cSJeff Kirsher if ((dev->flags & IFF_MULTICAST) && !netdev_mc_empty(dev)) {
5376bcc9736cSJeff Kirsher int i = 0;
5377bcc9736cSJeff Kirsher
5378bcc9736cSJeff Kirsher /* List too big to support so turn on all multicast mode. */
5379bcc9736cSJeff Kirsher if (netdev_mc_count(dev) > MAX_MULTICAST_LIST) {
5380bcc9736cSJeff Kirsher if (MAX_MULTICAST_LIST != hw->multi_list_size) {
5381bcc9736cSJeff Kirsher hw->multi_list_size = MAX_MULTICAST_LIST;
5382bcc9736cSJeff Kirsher ++hw->all_multi;
5383bcc9736cSJeff Kirsher hw_set_multicast(hw, hw->all_multi);
5384bcc9736cSJeff Kirsher }
5385bcc9736cSJeff Kirsher return;
5386bcc9736cSJeff Kirsher }
5387bcc9736cSJeff Kirsher
5388bcc9736cSJeff Kirsher netdev_for_each_mc_addr(ha, dev) {
5389bcc9736cSJeff Kirsher if (i >= MAX_MULTICAST_LIST)
5390bcc9736cSJeff Kirsher break;
53916a3c910cSJoe Perches memcpy(hw->multi_list[i++], ha->addr, ETH_ALEN);
5392bcc9736cSJeff Kirsher }
5393bcc9736cSJeff Kirsher hw->multi_list_size = (u8) i;
5394bcc9736cSJeff Kirsher hw_set_grp_addr(hw);
5395bcc9736cSJeff Kirsher } else {
5396bcc9736cSJeff Kirsher if (MAX_MULTICAST_LIST == hw->multi_list_size) {
5397bcc9736cSJeff Kirsher --hw->all_multi;
5398bcc9736cSJeff Kirsher hw_set_multicast(hw, hw->all_multi);
5399bcc9736cSJeff Kirsher }
5400bcc9736cSJeff Kirsher hw->multi_list_size = 0;
5401bcc9736cSJeff Kirsher hw_clr_multicast(hw);
5402bcc9736cSJeff Kirsher }
5403bcc9736cSJeff Kirsher }
5404bcc9736cSJeff Kirsher
netdev_change_mtu(struct net_device * dev,int new_mtu)5405bcc9736cSJeff Kirsher static int netdev_change_mtu(struct net_device *dev, int new_mtu)
5406bcc9736cSJeff Kirsher {
5407bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5408bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5409bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
5410bcc9736cSJeff Kirsher int hw_mtu;
5411bcc9736cSJeff Kirsher
5412bcc9736cSJeff Kirsher if (netif_running(dev))
5413bcc9736cSJeff Kirsher return -EBUSY;
5414bcc9736cSJeff Kirsher
5415bcc9736cSJeff Kirsher /* Cannot use different MTU in multiple device interfaces mode. */
5416bcc9736cSJeff Kirsher if (hw->dev_count > 1)
5417bcc9736cSJeff Kirsher if (dev != hw_priv->dev)
5418bcc9736cSJeff Kirsher return 0;
5419bcc9736cSJeff Kirsher
5420bcc9736cSJeff Kirsher hw_mtu = new_mtu + ETHERNET_HEADER_SIZE + 4;
5421bcc9736cSJeff Kirsher if (hw_mtu > REGULAR_RX_BUF_SIZE) {
5422bcc9736cSJeff Kirsher hw->features |= RX_HUGE_FRAME;
5423bcc9736cSJeff Kirsher hw_mtu = MAX_RX_BUF_SIZE;
5424bcc9736cSJeff Kirsher } else {
5425bcc9736cSJeff Kirsher hw->features &= ~RX_HUGE_FRAME;
5426bcc9736cSJeff Kirsher hw_mtu = REGULAR_RX_BUF_SIZE;
5427bcc9736cSJeff Kirsher }
5428bcc9736cSJeff Kirsher hw_mtu = (hw_mtu + 3) & ~3;
5429bcc9736cSJeff Kirsher hw_priv->mtu = hw_mtu;
5430bcc9736cSJeff Kirsher dev->mtu = new_mtu;
543144770e11SJarod Wilson
5432bcc9736cSJeff Kirsher return 0;
5433bcc9736cSJeff Kirsher }
5434bcc9736cSJeff Kirsher
5435bcc9736cSJeff Kirsher /**
5436bcc9736cSJeff Kirsher * netdev_ioctl - I/O control processing
5437bcc9736cSJeff Kirsher * @dev: Network device.
5438bcc9736cSJeff Kirsher * @ifr: Interface request structure.
5439bcc9736cSJeff Kirsher * @cmd: I/O control code.
5440bcc9736cSJeff Kirsher *
5441bcc9736cSJeff Kirsher * This function is used to process I/O control calls.
5442bcc9736cSJeff Kirsher *
5443bcc9736cSJeff Kirsher * Return 0 to indicate success.
5444bcc9736cSJeff Kirsher */
netdev_ioctl(struct net_device * dev,struct ifreq * ifr,int cmd)5445bcc9736cSJeff Kirsher static int netdev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
5446bcc9736cSJeff Kirsher {
5447bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5448bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5449bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
5450bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
5451bcc9736cSJeff Kirsher int result = 0;
5452bcc9736cSJeff Kirsher struct mii_ioctl_data *data = if_mii(ifr);
5453bcc9736cSJeff Kirsher
5454bcc9736cSJeff Kirsher if (down_interruptible(&priv->proc_sem))
5455bcc9736cSJeff Kirsher return -ERESTARTSYS;
5456bcc9736cSJeff Kirsher
5457bcc9736cSJeff Kirsher switch (cmd) {
5458bcc9736cSJeff Kirsher /* Get address of MII PHY in use. */
5459bcc9736cSJeff Kirsher case SIOCGMIIPHY:
5460bcc9736cSJeff Kirsher data->phy_id = priv->id;
5461401d8ce4SGustavo A. R. Silva fallthrough;
5462bcc9736cSJeff Kirsher
5463bcc9736cSJeff Kirsher /* Read MII PHY register. */
5464bcc9736cSJeff Kirsher case SIOCGMIIREG:
5465bcc9736cSJeff Kirsher if (data->phy_id != priv->id || data->reg_num >= 6)
5466bcc9736cSJeff Kirsher result = -EIO;
5467bcc9736cSJeff Kirsher else
5468bcc9736cSJeff Kirsher hw_r_phy(hw, port->linked->port_id, data->reg_num,
5469bcc9736cSJeff Kirsher &data->val_out);
5470bcc9736cSJeff Kirsher break;
5471bcc9736cSJeff Kirsher
5472bcc9736cSJeff Kirsher /* Write MII PHY register. */
5473bcc9736cSJeff Kirsher case SIOCSMIIREG:
5474bcc9736cSJeff Kirsher if (!capable(CAP_NET_ADMIN))
5475bcc9736cSJeff Kirsher result = -EPERM;
5476bcc9736cSJeff Kirsher else if (data->phy_id != priv->id || data->reg_num >= 6)
5477bcc9736cSJeff Kirsher result = -EIO;
5478bcc9736cSJeff Kirsher else
5479bcc9736cSJeff Kirsher hw_w_phy(hw, port->linked->port_id, data->reg_num,
5480bcc9736cSJeff Kirsher data->val_in);
5481bcc9736cSJeff Kirsher break;
5482bcc9736cSJeff Kirsher
5483bcc9736cSJeff Kirsher default:
5484bcc9736cSJeff Kirsher result = -EOPNOTSUPP;
5485bcc9736cSJeff Kirsher }
5486bcc9736cSJeff Kirsher
5487bcc9736cSJeff Kirsher up(&priv->proc_sem);
5488bcc9736cSJeff Kirsher
5489bcc9736cSJeff Kirsher return result;
5490bcc9736cSJeff Kirsher }
5491bcc9736cSJeff Kirsher
5492bcc9736cSJeff Kirsher /*
5493bcc9736cSJeff Kirsher * MII support
5494bcc9736cSJeff Kirsher */
5495bcc9736cSJeff Kirsher
5496bcc9736cSJeff Kirsher /**
5497bcc9736cSJeff Kirsher * mdio_read - read PHY register
5498bcc9736cSJeff Kirsher * @dev: Network device.
5499bcc9736cSJeff Kirsher * @phy_id: The PHY id.
5500bcc9736cSJeff Kirsher * @reg_num: The register number.
5501bcc9736cSJeff Kirsher *
5502bcc9736cSJeff Kirsher * This function returns the PHY register value.
5503bcc9736cSJeff Kirsher *
5504bcc9736cSJeff Kirsher * Return the register value.
5505bcc9736cSJeff Kirsher */
mdio_read(struct net_device * dev,int phy_id,int reg_num)5506bcc9736cSJeff Kirsher static int mdio_read(struct net_device *dev, int phy_id, int reg_num)
5507bcc9736cSJeff Kirsher {
5508bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5509bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
5510bcc9736cSJeff Kirsher struct ksz_hw *hw = port->hw;
5511bcc9736cSJeff Kirsher u16 val_out;
5512bcc9736cSJeff Kirsher
5513bcc9736cSJeff Kirsher hw_r_phy(hw, port->linked->port_id, reg_num << 1, &val_out);
5514bcc9736cSJeff Kirsher return val_out;
5515bcc9736cSJeff Kirsher }
5516bcc9736cSJeff Kirsher
5517bcc9736cSJeff Kirsher /**
5518bcc9736cSJeff Kirsher * mdio_write - set PHY register
5519bcc9736cSJeff Kirsher * @dev: Network device.
5520bcc9736cSJeff Kirsher * @phy_id: The PHY id.
5521bcc9736cSJeff Kirsher * @reg_num: The register number.
5522bcc9736cSJeff Kirsher * @val: The register value.
5523bcc9736cSJeff Kirsher *
5524bcc9736cSJeff Kirsher * This procedure sets the PHY register value.
5525bcc9736cSJeff Kirsher */
mdio_write(struct net_device * dev,int phy_id,int reg_num,int val)5526bcc9736cSJeff Kirsher static void mdio_write(struct net_device *dev, int phy_id, int reg_num, int val)
5527bcc9736cSJeff Kirsher {
5528bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5529bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
5530bcc9736cSJeff Kirsher struct ksz_hw *hw = port->hw;
5531bcc9736cSJeff Kirsher int i;
5532bcc9736cSJeff Kirsher int pi;
5533bcc9736cSJeff Kirsher
5534bcc9736cSJeff Kirsher for (i = 0, pi = port->first_port; i < port->port_cnt; i++, pi++)
5535bcc9736cSJeff Kirsher hw_w_phy(hw, pi, reg_num << 1, val);
5536bcc9736cSJeff Kirsher }
5537bcc9736cSJeff Kirsher
5538bcc9736cSJeff Kirsher /*
5539bcc9736cSJeff Kirsher * ethtool support
5540bcc9736cSJeff Kirsher */
5541bcc9736cSJeff Kirsher
5542bcc9736cSJeff Kirsher #define EEPROM_SIZE 0x40
5543bcc9736cSJeff Kirsher
5544bcc9736cSJeff Kirsher static u16 eeprom_data[EEPROM_SIZE] = { 0 };
5545bcc9736cSJeff Kirsher
5546bcc9736cSJeff Kirsher #define ADVERTISED_ALL \
5547bcc9736cSJeff Kirsher (ADVERTISED_10baseT_Half | \
5548bcc9736cSJeff Kirsher ADVERTISED_10baseT_Full | \
5549bcc9736cSJeff Kirsher ADVERTISED_100baseT_Half | \
5550bcc9736cSJeff Kirsher ADVERTISED_100baseT_Full)
5551bcc9736cSJeff Kirsher
5552bcc9736cSJeff Kirsher /* These functions use the MII functions in mii.c. */
5553bcc9736cSJeff Kirsher
5554bcc9736cSJeff Kirsher /**
55552fb93a1aSPhilippe Reynes * netdev_get_link_ksettings - get network device settings
5556bcc9736cSJeff Kirsher * @dev: Network device.
5557bcc9736cSJeff Kirsher * @cmd: Ethtool command.
5558bcc9736cSJeff Kirsher *
5559bcc9736cSJeff Kirsher * This function queries the PHY and returns its state in the ethtool command.
5560bcc9736cSJeff Kirsher *
5561bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code.
5562bcc9736cSJeff Kirsher */
netdev_get_link_ksettings(struct net_device * dev,struct ethtool_link_ksettings * cmd)55632fb93a1aSPhilippe Reynes static int netdev_get_link_ksettings(struct net_device *dev,
55642fb93a1aSPhilippe Reynes struct ethtool_link_ksettings *cmd)
5565bcc9736cSJeff Kirsher {
5566bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5567bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5568bcc9736cSJeff Kirsher
5569bcc9736cSJeff Kirsher mutex_lock(&hw_priv->lock);
55702fb93a1aSPhilippe Reynes mii_ethtool_get_link_ksettings(&priv->mii_if, cmd);
55712fb93a1aSPhilippe Reynes ethtool_link_ksettings_add_link_mode(cmd, advertising, TP);
5572bcc9736cSJeff Kirsher mutex_unlock(&hw_priv->lock);
5573bcc9736cSJeff Kirsher
5574bcc9736cSJeff Kirsher /* Save advertised settings for workaround in next function. */
55752fb93a1aSPhilippe Reynes ethtool_convert_link_mode_to_legacy_u32(&priv->advertising,
55762fb93a1aSPhilippe Reynes cmd->link_modes.advertising);
55772fb93a1aSPhilippe Reynes
5578bcc9736cSJeff Kirsher return 0;
5579bcc9736cSJeff Kirsher }
5580bcc9736cSJeff Kirsher
5581bcc9736cSJeff Kirsher /**
55822fb93a1aSPhilippe Reynes * netdev_set_link_ksettings - set network device settings
5583bcc9736cSJeff Kirsher * @dev: Network device.
5584bcc9736cSJeff Kirsher * @cmd: Ethtool command.
5585bcc9736cSJeff Kirsher *
5586bcc9736cSJeff Kirsher * This function sets the PHY according to the ethtool command.
5587bcc9736cSJeff Kirsher *
5588bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code.
5589bcc9736cSJeff Kirsher */
netdev_set_link_ksettings(struct net_device * dev,const struct ethtool_link_ksettings * cmd)55902fb93a1aSPhilippe Reynes static int netdev_set_link_ksettings(struct net_device *dev,
55912fb93a1aSPhilippe Reynes const struct ethtool_link_ksettings *cmd)
5592bcc9736cSJeff Kirsher {
5593bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5594bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5595bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
55962fb93a1aSPhilippe Reynes struct ethtool_link_ksettings copy_cmd;
55972fb93a1aSPhilippe Reynes u32 speed = cmd->base.speed;
55982fb93a1aSPhilippe Reynes u32 advertising;
5599bcc9736cSJeff Kirsher int rc;
5600bcc9736cSJeff Kirsher
56012fb93a1aSPhilippe Reynes ethtool_convert_link_mode_to_legacy_u32(&advertising,
56022fb93a1aSPhilippe Reynes cmd->link_modes.advertising);
56032fb93a1aSPhilippe Reynes
5604bcc9736cSJeff Kirsher /*
5605bcc9736cSJeff Kirsher * ethtool utility does not change advertised setting if auto
5606bcc9736cSJeff Kirsher * negotiation is not specified explicitly.
5607bcc9736cSJeff Kirsher */
56082fb93a1aSPhilippe Reynes if (cmd->base.autoneg && priv->advertising == advertising) {
56092fb93a1aSPhilippe Reynes advertising |= ADVERTISED_ALL;
5610bcc9736cSJeff Kirsher if (10 == speed)
56112fb93a1aSPhilippe Reynes advertising &=
5612bcc9736cSJeff Kirsher ~(ADVERTISED_100baseT_Full |
5613bcc9736cSJeff Kirsher ADVERTISED_100baseT_Half);
5614bcc9736cSJeff Kirsher else if (100 == speed)
56152fb93a1aSPhilippe Reynes advertising &=
5616bcc9736cSJeff Kirsher ~(ADVERTISED_10baseT_Full |
5617bcc9736cSJeff Kirsher ADVERTISED_10baseT_Half);
56182fb93a1aSPhilippe Reynes if (0 == cmd->base.duplex)
56192fb93a1aSPhilippe Reynes advertising &=
5620bcc9736cSJeff Kirsher ~(ADVERTISED_100baseT_Full |
5621bcc9736cSJeff Kirsher ADVERTISED_10baseT_Full);
56222fb93a1aSPhilippe Reynes else if (1 == cmd->base.duplex)
56232fb93a1aSPhilippe Reynes advertising &=
5624bcc9736cSJeff Kirsher ~(ADVERTISED_100baseT_Half |
5625bcc9736cSJeff Kirsher ADVERTISED_10baseT_Half);
5626bcc9736cSJeff Kirsher }
5627bcc9736cSJeff Kirsher mutex_lock(&hw_priv->lock);
56282fb93a1aSPhilippe Reynes if (cmd->base.autoneg &&
56292fb93a1aSPhilippe Reynes (advertising & ADVERTISED_ALL) == ADVERTISED_ALL) {
5630bcc9736cSJeff Kirsher port->duplex = 0;
5631bcc9736cSJeff Kirsher port->speed = 0;
5632bcc9736cSJeff Kirsher port->force_link = 0;
5633bcc9736cSJeff Kirsher } else {
56342fb93a1aSPhilippe Reynes port->duplex = cmd->base.duplex + 1;
5635bcc9736cSJeff Kirsher if (1000 != speed)
5636bcc9736cSJeff Kirsher port->speed = speed;
56372fb93a1aSPhilippe Reynes if (cmd->base.autoneg)
5638bcc9736cSJeff Kirsher port->force_link = 0;
5639bcc9736cSJeff Kirsher else
5640bcc9736cSJeff Kirsher port->force_link = 1;
5641bcc9736cSJeff Kirsher }
56422fb93a1aSPhilippe Reynes
56432fb93a1aSPhilippe Reynes memcpy(©_cmd, cmd, sizeof(copy_cmd));
56442fb93a1aSPhilippe Reynes ethtool_convert_legacy_u32_to_link_mode(copy_cmd.link_modes.advertising,
56452fb93a1aSPhilippe Reynes advertising);
56462fb93a1aSPhilippe Reynes rc = mii_ethtool_set_link_ksettings(
56472fb93a1aSPhilippe Reynes &priv->mii_if,
56482fb93a1aSPhilippe Reynes (const struct ethtool_link_ksettings *)©_cmd);
5649bcc9736cSJeff Kirsher mutex_unlock(&hw_priv->lock);
5650bcc9736cSJeff Kirsher return rc;
5651bcc9736cSJeff Kirsher }
5652bcc9736cSJeff Kirsher
5653bcc9736cSJeff Kirsher /**
5654bcc9736cSJeff Kirsher * netdev_nway_reset - restart auto-negotiation
5655bcc9736cSJeff Kirsher * @dev: Network device.
5656bcc9736cSJeff Kirsher *
5657bcc9736cSJeff Kirsher * This function restarts the PHY for auto-negotiation.
5658bcc9736cSJeff Kirsher *
5659bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code.
5660bcc9736cSJeff Kirsher */
netdev_nway_reset(struct net_device * dev)5661bcc9736cSJeff Kirsher static int netdev_nway_reset(struct net_device *dev)
5662bcc9736cSJeff Kirsher {
5663bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5664bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5665bcc9736cSJeff Kirsher int rc;
5666bcc9736cSJeff Kirsher
5667bcc9736cSJeff Kirsher mutex_lock(&hw_priv->lock);
5668bcc9736cSJeff Kirsher rc = mii_nway_restart(&priv->mii_if);
5669bcc9736cSJeff Kirsher mutex_unlock(&hw_priv->lock);
5670bcc9736cSJeff Kirsher return rc;
5671bcc9736cSJeff Kirsher }
5672bcc9736cSJeff Kirsher
5673bcc9736cSJeff Kirsher /**
5674bcc9736cSJeff Kirsher * netdev_get_link - get network device link status
5675bcc9736cSJeff Kirsher * @dev: Network device.
5676bcc9736cSJeff Kirsher *
5677bcc9736cSJeff Kirsher * This function gets the link status from the PHY.
5678bcc9736cSJeff Kirsher *
5679bcc9736cSJeff Kirsher * Return true if PHY is linked and false otherwise.
5680bcc9736cSJeff Kirsher */
netdev_get_link(struct net_device * dev)5681bcc9736cSJeff Kirsher static u32 netdev_get_link(struct net_device *dev)
5682bcc9736cSJeff Kirsher {
5683bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5684bcc9736cSJeff Kirsher int rc;
5685bcc9736cSJeff Kirsher
5686bcc9736cSJeff Kirsher rc = mii_link_ok(&priv->mii_if);
5687bcc9736cSJeff Kirsher return rc;
5688bcc9736cSJeff Kirsher }
5689bcc9736cSJeff Kirsher
5690bcc9736cSJeff Kirsher /**
5691bcc9736cSJeff Kirsher * netdev_get_drvinfo - get network driver information
5692bcc9736cSJeff Kirsher * @dev: Network device.
5693bcc9736cSJeff Kirsher * @info: Ethtool driver info data structure.
5694bcc9736cSJeff Kirsher *
5695bcc9736cSJeff Kirsher * This procedure returns the driver information.
5696bcc9736cSJeff Kirsher */
netdev_get_drvinfo(struct net_device * dev,struct ethtool_drvinfo * info)5697bcc9736cSJeff Kirsher static void netdev_get_drvinfo(struct net_device *dev,
5698bcc9736cSJeff Kirsher struct ethtool_drvinfo *info)
5699bcc9736cSJeff Kirsher {
5700bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5701bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5702bcc9736cSJeff Kirsher
5703f029c781SWolfram Sang strscpy(info->driver, DRV_NAME, sizeof(info->driver));
5704f029c781SWolfram Sang strscpy(info->version, DRV_VERSION, sizeof(info->version));
5705f029c781SWolfram Sang strscpy(info->bus_info, pci_name(hw_priv->pdev),
570623020ab3SRick Jones sizeof(info->bus_info));
5707bcc9736cSJeff Kirsher }
5708bcc9736cSJeff Kirsher
5709bcc9736cSJeff Kirsher static struct hw_regs {
5710bcc9736cSJeff Kirsher int start;
5711bcc9736cSJeff Kirsher int end;
5712bcc9736cSJeff Kirsher } hw_regs_range[] = {
5713bcc9736cSJeff Kirsher { KS_DMA_TX_CTRL, KS884X_INTERRUPTS_STATUS },
5714bcc9736cSJeff Kirsher { KS_ADD_ADDR_0_LO, KS_ADD_ADDR_F_HI },
5715bcc9736cSJeff Kirsher { KS884X_ADDR_0_OFFSET, KS8841_WOL_FRAME_BYTE2_OFFSET },
5716bcc9736cSJeff Kirsher { KS884X_SIDER_P, KS8842_SGCR7_P },
5717bcc9736cSJeff Kirsher { KS8842_MACAR1_P, KS8842_TOSR8_P },
5718bcc9736cSJeff Kirsher { KS884X_P1MBCR_P, KS8842_P3ERCR_P },
5719bcc9736cSJeff Kirsher { 0, 0 }
5720bcc9736cSJeff Kirsher };
5721bcc9736cSJeff Kirsher
5722d0ea5cbdSJesse Brandeburg /**
5723d0ea5cbdSJesse Brandeburg * netdev_get_regs_len - get length of register dump
5724d0ea5cbdSJesse Brandeburg * @dev: Network device.
5725d0ea5cbdSJesse Brandeburg *
5726d0ea5cbdSJesse Brandeburg * This function returns the length of the register dump.
5727d0ea5cbdSJesse Brandeburg *
5728d0ea5cbdSJesse Brandeburg * Return length of the register dump.
5729d0ea5cbdSJesse Brandeburg */
netdev_get_regs_len(struct net_device * dev)5730bcc9736cSJeff Kirsher static int netdev_get_regs_len(struct net_device *dev)
5731bcc9736cSJeff Kirsher {
5732bcc9736cSJeff Kirsher struct hw_regs *range = hw_regs_range;
5733bcc9736cSJeff Kirsher int regs_len = 0x10 * sizeof(u32);
5734bcc9736cSJeff Kirsher
5735bcc9736cSJeff Kirsher while (range->end > range->start) {
5736bcc9736cSJeff Kirsher regs_len += (range->end - range->start + 3) / 4 * 4;
5737bcc9736cSJeff Kirsher range++;
5738bcc9736cSJeff Kirsher }
5739bcc9736cSJeff Kirsher return regs_len;
5740bcc9736cSJeff Kirsher }
5741bcc9736cSJeff Kirsher
5742bcc9736cSJeff Kirsher /**
5743bcc9736cSJeff Kirsher * netdev_get_regs - get register dump
5744bcc9736cSJeff Kirsher * @dev: Network device.
5745bcc9736cSJeff Kirsher * @regs: Ethtool registers data structure.
5746bcc9736cSJeff Kirsher * @ptr: Buffer to store the register values.
5747bcc9736cSJeff Kirsher *
5748bcc9736cSJeff Kirsher * This procedure dumps the register values in the provided buffer.
5749bcc9736cSJeff Kirsher */
netdev_get_regs(struct net_device * dev,struct ethtool_regs * regs,void * ptr)5750bcc9736cSJeff Kirsher static void netdev_get_regs(struct net_device *dev, struct ethtool_regs *regs,
5751bcc9736cSJeff Kirsher void *ptr)
5752bcc9736cSJeff Kirsher {
5753bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5754bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5755bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
5756bcc9736cSJeff Kirsher int *buf = (int *) ptr;
5757bcc9736cSJeff Kirsher struct hw_regs *range = hw_regs_range;
5758bcc9736cSJeff Kirsher int len;
5759bcc9736cSJeff Kirsher
5760bcc9736cSJeff Kirsher mutex_lock(&hw_priv->lock);
5761bcc9736cSJeff Kirsher regs->version = 0;
5762bcc9736cSJeff Kirsher for (len = 0; len < 0x40; len += 4) {
5763bcc9736cSJeff Kirsher pci_read_config_dword(hw_priv->pdev, len, buf);
5764bcc9736cSJeff Kirsher buf++;
5765bcc9736cSJeff Kirsher }
5766bcc9736cSJeff Kirsher while (range->end > range->start) {
5767bcc9736cSJeff Kirsher for (len = range->start; len < range->end; len += 4) {
5768bcc9736cSJeff Kirsher *buf = readl(hw->io + len);
5769bcc9736cSJeff Kirsher buf++;
5770bcc9736cSJeff Kirsher }
5771bcc9736cSJeff Kirsher range++;
5772bcc9736cSJeff Kirsher }
5773bcc9736cSJeff Kirsher mutex_unlock(&hw_priv->lock);
5774bcc9736cSJeff Kirsher }
5775bcc9736cSJeff Kirsher
5776bcc9736cSJeff Kirsher #define WOL_SUPPORT \
5777bcc9736cSJeff Kirsher (WAKE_PHY | WAKE_MAGIC | \
5778bcc9736cSJeff Kirsher WAKE_UCAST | WAKE_MCAST | \
5779bcc9736cSJeff Kirsher WAKE_BCAST | WAKE_ARP)
5780bcc9736cSJeff Kirsher
5781bcc9736cSJeff Kirsher /**
5782bcc9736cSJeff Kirsher * netdev_get_wol - get Wake-on-LAN support
5783bcc9736cSJeff Kirsher * @dev: Network device.
5784bcc9736cSJeff Kirsher * @wol: Ethtool Wake-on-LAN data structure.
5785bcc9736cSJeff Kirsher *
5786bcc9736cSJeff Kirsher * This procedure returns Wake-on-LAN support.
5787bcc9736cSJeff Kirsher */
netdev_get_wol(struct net_device * dev,struct ethtool_wolinfo * wol)5788bcc9736cSJeff Kirsher static void netdev_get_wol(struct net_device *dev,
5789bcc9736cSJeff Kirsher struct ethtool_wolinfo *wol)
5790bcc9736cSJeff Kirsher {
5791bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5792bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5793bcc9736cSJeff Kirsher
5794bcc9736cSJeff Kirsher wol->supported = hw_priv->wol_support;
5795bcc9736cSJeff Kirsher wol->wolopts = hw_priv->wol_enable;
5796bcc9736cSJeff Kirsher memset(&wol->sopass, 0, sizeof(wol->sopass));
5797bcc9736cSJeff Kirsher }
5798bcc9736cSJeff Kirsher
5799bcc9736cSJeff Kirsher /**
5800bcc9736cSJeff Kirsher * netdev_set_wol - set Wake-on-LAN support
5801bcc9736cSJeff Kirsher * @dev: Network device.
5802bcc9736cSJeff Kirsher * @wol: Ethtool Wake-on-LAN data structure.
5803bcc9736cSJeff Kirsher *
5804bcc9736cSJeff Kirsher * This function sets Wake-on-LAN support.
5805bcc9736cSJeff Kirsher *
5806bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code.
5807bcc9736cSJeff Kirsher */
netdev_set_wol(struct net_device * dev,struct ethtool_wolinfo * wol)5808bcc9736cSJeff Kirsher static int netdev_set_wol(struct net_device *dev,
5809bcc9736cSJeff Kirsher struct ethtool_wolinfo *wol)
5810bcc9736cSJeff Kirsher {
5811bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5812bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5813bcc9736cSJeff Kirsher
5814bcc9736cSJeff Kirsher /* Need to find a way to retrieve the device IP address. */
5815bcc9736cSJeff Kirsher static const u8 net_addr[] = { 192, 168, 1, 1 };
5816bcc9736cSJeff Kirsher
5817bcc9736cSJeff Kirsher if (wol->wolopts & ~hw_priv->wol_support)
5818bcc9736cSJeff Kirsher return -EINVAL;
5819bcc9736cSJeff Kirsher
5820bcc9736cSJeff Kirsher hw_priv->wol_enable = wol->wolopts;
5821bcc9736cSJeff Kirsher
5822bcc9736cSJeff Kirsher /* Link wakeup cannot really be disabled. */
5823bcc9736cSJeff Kirsher if (wol->wolopts)
5824bcc9736cSJeff Kirsher hw_priv->wol_enable |= WAKE_PHY;
5825bcc9736cSJeff Kirsher hw_enable_wol(&hw_priv->hw, hw_priv->wol_enable, net_addr);
5826bcc9736cSJeff Kirsher return 0;
5827bcc9736cSJeff Kirsher }
5828bcc9736cSJeff Kirsher
5829bcc9736cSJeff Kirsher /**
5830bcc9736cSJeff Kirsher * netdev_get_msglevel - get debug message level
5831bcc9736cSJeff Kirsher * @dev: Network device.
5832bcc9736cSJeff Kirsher *
5833bcc9736cSJeff Kirsher * This function returns current debug message level.
5834bcc9736cSJeff Kirsher *
5835bcc9736cSJeff Kirsher * Return current debug message flags.
5836bcc9736cSJeff Kirsher */
netdev_get_msglevel(struct net_device * dev)5837bcc9736cSJeff Kirsher static u32 netdev_get_msglevel(struct net_device *dev)
5838bcc9736cSJeff Kirsher {
5839bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5840bcc9736cSJeff Kirsher
5841bcc9736cSJeff Kirsher return priv->msg_enable;
5842bcc9736cSJeff Kirsher }
5843bcc9736cSJeff Kirsher
5844bcc9736cSJeff Kirsher /**
5845bcc9736cSJeff Kirsher * netdev_set_msglevel - set debug message level
5846bcc9736cSJeff Kirsher * @dev: Network device.
5847bcc9736cSJeff Kirsher * @value: Debug message flags.
5848bcc9736cSJeff Kirsher *
5849bcc9736cSJeff Kirsher * This procedure sets debug message level.
5850bcc9736cSJeff Kirsher */
netdev_set_msglevel(struct net_device * dev,u32 value)5851bcc9736cSJeff Kirsher static void netdev_set_msglevel(struct net_device *dev, u32 value)
5852bcc9736cSJeff Kirsher {
5853bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5854bcc9736cSJeff Kirsher
5855bcc9736cSJeff Kirsher priv->msg_enable = value;
5856bcc9736cSJeff Kirsher }
5857bcc9736cSJeff Kirsher
5858bcc9736cSJeff Kirsher /**
5859bcc9736cSJeff Kirsher * netdev_get_eeprom_len - get EEPROM length
5860bcc9736cSJeff Kirsher * @dev: Network device.
5861bcc9736cSJeff Kirsher *
5862bcc9736cSJeff Kirsher * This function returns the length of the EEPROM.
5863bcc9736cSJeff Kirsher *
5864bcc9736cSJeff Kirsher * Return length of the EEPROM.
5865bcc9736cSJeff Kirsher */
netdev_get_eeprom_len(struct net_device * dev)5866bcc9736cSJeff Kirsher static int netdev_get_eeprom_len(struct net_device *dev)
5867bcc9736cSJeff Kirsher {
5868bcc9736cSJeff Kirsher return EEPROM_SIZE * 2;
5869bcc9736cSJeff Kirsher }
5870bcc9736cSJeff Kirsher
5871d0ea5cbdSJesse Brandeburg #define EEPROM_MAGIC 0x10A18842
5872d0ea5cbdSJesse Brandeburg
5873bcc9736cSJeff Kirsher /**
5874bcc9736cSJeff Kirsher * netdev_get_eeprom - get EEPROM data
5875bcc9736cSJeff Kirsher * @dev: Network device.
5876bcc9736cSJeff Kirsher * @eeprom: Ethtool EEPROM data structure.
5877bcc9736cSJeff Kirsher * @data: Buffer to store the EEPROM data.
5878bcc9736cSJeff Kirsher *
5879bcc9736cSJeff Kirsher * This function dumps the EEPROM data in the provided buffer.
5880bcc9736cSJeff Kirsher *
5881bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code.
5882bcc9736cSJeff Kirsher */
netdev_get_eeprom(struct net_device * dev,struct ethtool_eeprom * eeprom,u8 * data)5883bcc9736cSJeff Kirsher static int netdev_get_eeprom(struct net_device *dev,
5884bcc9736cSJeff Kirsher struct ethtool_eeprom *eeprom, u8 *data)
5885bcc9736cSJeff Kirsher {
5886bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5887bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5888bcc9736cSJeff Kirsher u8 *eeprom_byte = (u8 *) eeprom_data;
5889bcc9736cSJeff Kirsher int i;
5890bcc9736cSJeff Kirsher int len;
5891bcc9736cSJeff Kirsher
5892bcc9736cSJeff Kirsher len = (eeprom->offset + eeprom->len + 1) / 2;
5893bcc9736cSJeff Kirsher for (i = eeprom->offset / 2; i < len; i++)
5894bcc9736cSJeff Kirsher eeprom_data[i] = eeprom_read(&hw_priv->hw, i);
5895bcc9736cSJeff Kirsher eeprom->magic = EEPROM_MAGIC;
5896bcc9736cSJeff Kirsher memcpy(data, &eeprom_byte[eeprom->offset], eeprom->len);
5897bcc9736cSJeff Kirsher
5898bcc9736cSJeff Kirsher return 0;
5899bcc9736cSJeff Kirsher }
5900bcc9736cSJeff Kirsher
5901bcc9736cSJeff Kirsher /**
5902bcc9736cSJeff Kirsher * netdev_set_eeprom - write EEPROM data
5903bcc9736cSJeff Kirsher * @dev: Network device.
5904bcc9736cSJeff Kirsher * @eeprom: Ethtool EEPROM data structure.
5905bcc9736cSJeff Kirsher * @data: Data buffer.
5906bcc9736cSJeff Kirsher *
5907bcc9736cSJeff Kirsher * This function modifies the EEPROM data one byte at a time.
5908bcc9736cSJeff Kirsher *
5909bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code.
5910bcc9736cSJeff Kirsher */
netdev_set_eeprom(struct net_device * dev,struct ethtool_eeprom * eeprom,u8 * data)5911bcc9736cSJeff Kirsher static int netdev_set_eeprom(struct net_device *dev,
5912bcc9736cSJeff Kirsher struct ethtool_eeprom *eeprom, u8 *data)
5913bcc9736cSJeff Kirsher {
5914bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5915bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5916bcc9736cSJeff Kirsher u16 eeprom_word[EEPROM_SIZE];
5917bcc9736cSJeff Kirsher u8 *eeprom_byte = (u8 *) eeprom_word;
5918bcc9736cSJeff Kirsher int i;
5919bcc9736cSJeff Kirsher int len;
5920bcc9736cSJeff Kirsher
5921bcc9736cSJeff Kirsher if (eeprom->magic != EEPROM_MAGIC)
5922bcc9736cSJeff Kirsher return -EINVAL;
5923bcc9736cSJeff Kirsher
5924bcc9736cSJeff Kirsher len = (eeprom->offset + eeprom->len + 1) / 2;
5925bcc9736cSJeff Kirsher for (i = eeprom->offset / 2; i < len; i++)
5926bcc9736cSJeff Kirsher eeprom_data[i] = eeprom_read(&hw_priv->hw, i);
5927bcc9736cSJeff Kirsher memcpy(eeprom_word, eeprom_data, EEPROM_SIZE * 2);
5928bcc9736cSJeff Kirsher memcpy(&eeprom_byte[eeprom->offset], data, eeprom->len);
5929bcc9736cSJeff Kirsher for (i = 0; i < EEPROM_SIZE; i++)
5930bcc9736cSJeff Kirsher if (eeprom_word[i] != eeprom_data[i]) {
5931bcc9736cSJeff Kirsher eeprom_data[i] = eeprom_word[i];
5932bcc9736cSJeff Kirsher eeprom_write(&hw_priv->hw, i, eeprom_data[i]);
5933bcc9736cSJeff Kirsher }
5934bcc9736cSJeff Kirsher
5935bcc9736cSJeff Kirsher return 0;
5936bcc9736cSJeff Kirsher }
5937bcc9736cSJeff Kirsher
5938bcc9736cSJeff Kirsher /**
5939bcc9736cSJeff Kirsher * netdev_get_pauseparam - get flow control parameters
5940bcc9736cSJeff Kirsher * @dev: Network device.
5941bcc9736cSJeff Kirsher * @pause: Ethtool PAUSE settings data structure.
5942bcc9736cSJeff Kirsher *
5943bcc9736cSJeff Kirsher * This procedure returns the PAUSE control flow settings.
5944bcc9736cSJeff Kirsher */
netdev_get_pauseparam(struct net_device * dev,struct ethtool_pauseparam * pause)5945bcc9736cSJeff Kirsher static void netdev_get_pauseparam(struct net_device *dev,
5946bcc9736cSJeff Kirsher struct ethtool_pauseparam *pause)
5947bcc9736cSJeff Kirsher {
5948bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5949bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5950bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
5951bcc9736cSJeff Kirsher
5952bcc9736cSJeff Kirsher pause->autoneg = (hw->overrides & PAUSE_FLOW_CTRL) ? 0 : 1;
5953bcc9736cSJeff Kirsher if (!hw->ksz_switch) {
5954bcc9736cSJeff Kirsher pause->rx_pause =
5955bcc9736cSJeff Kirsher (hw->rx_cfg & DMA_RX_FLOW_ENABLE) ? 1 : 0;
5956bcc9736cSJeff Kirsher pause->tx_pause =
5957bcc9736cSJeff Kirsher (hw->tx_cfg & DMA_TX_FLOW_ENABLE) ? 1 : 0;
5958bcc9736cSJeff Kirsher } else {
5959bcc9736cSJeff Kirsher pause->rx_pause =
5960bcc9736cSJeff Kirsher (sw_chk(hw, KS8842_SWITCH_CTRL_1_OFFSET,
5961bcc9736cSJeff Kirsher SWITCH_RX_FLOW_CTRL)) ? 1 : 0;
5962bcc9736cSJeff Kirsher pause->tx_pause =
5963bcc9736cSJeff Kirsher (sw_chk(hw, KS8842_SWITCH_CTRL_1_OFFSET,
5964bcc9736cSJeff Kirsher SWITCH_TX_FLOW_CTRL)) ? 1 : 0;
5965bcc9736cSJeff Kirsher }
5966bcc9736cSJeff Kirsher }
5967bcc9736cSJeff Kirsher
5968bcc9736cSJeff Kirsher /**
5969bcc9736cSJeff Kirsher * netdev_set_pauseparam - set flow control parameters
5970bcc9736cSJeff Kirsher * @dev: Network device.
5971bcc9736cSJeff Kirsher * @pause: Ethtool PAUSE settings data structure.
5972bcc9736cSJeff Kirsher *
5973bcc9736cSJeff Kirsher * This function sets the PAUSE control flow settings.
5974bcc9736cSJeff Kirsher * Not implemented yet.
5975bcc9736cSJeff Kirsher *
5976bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code.
5977bcc9736cSJeff Kirsher */
netdev_set_pauseparam(struct net_device * dev,struct ethtool_pauseparam * pause)5978bcc9736cSJeff Kirsher static int netdev_set_pauseparam(struct net_device *dev,
5979bcc9736cSJeff Kirsher struct ethtool_pauseparam *pause)
5980bcc9736cSJeff Kirsher {
5981bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
5982bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
5983bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
5984bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
5985bcc9736cSJeff Kirsher
5986bcc9736cSJeff Kirsher mutex_lock(&hw_priv->lock);
5987bcc9736cSJeff Kirsher if (pause->autoneg) {
5988bcc9736cSJeff Kirsher if (!pause->rx_pause && !pause->tx_pause)
5989bcc9736cSJeff Kirsher port->flow_ctrl = PHY_NO_FLOW_CTRL;
5990bcc9736cSJeff Kirsher else
5991bcc9736cSJeff Kirsher port->flow_ctrl = PHY_FLOW_CTRL;
5992bcc9736cSJeff Kirsher hw->overrides &= ~PAUSE_FLOW_CTRL;
5993bcc9736cSJeff Kirsher port->force_link = 0;
5994bcc9736cSJeff Kirsher if (hw->ksz_switch) {
5995bcc9736cSJeff Kirsher sw_cfg(hw, KS8842_SWITCH_CTRL_1_OFFSET,
5996bcc9736cSJeff Kirsher SWITCH_RX_FLOW_CTRL, 1);
5997bcc9736cSJeff Kirsher sw_cfg(hw, KS8842_SWITCH_CTRL_1_OFFSET,
5998bcc9736cSJeff Kirsher SWITCH_TX_FLOW_CTRL, 1);
5999bcc9736cSJeff Kirsher }
6000bcc9736cSJeff Kirsher port_set_link_speed(port);
6001bcc9736cSJeff Kirsher } else {
6002bcc9736cSJeff Kirsher hw->overrides |= PAUSE_FLOW_CTRL;
6003bcc9736cSJeff Kirsher if (hw->ksz_switch) {
6004bcc9736cSJeff Kirsher sw_cfg(hw, KS8842_SWITCH_CTRL_1_OFFSET,
6005bcc9736cSJeff Kirsher SWITCH_RX_FLOW_CTRL, pause->rx_pause);
6006bcc9736cSJeff Kirsher sw_cfg(hw, KS8842_SWITCH_CTRL_1_OFFSET,
6007bcc9736cSJeff Kirsher SWITCH_TX_FLOW_CTRL, pause->tx_pause);
6008bcc9736cSJeff Kirsher } else
6009bcc9736cSJeff Kirsher set_flow_ctrl(hw, pause->rx_pause, pause->tx_pause);
6010bcc9736cSJeff Kirsher }
6011bcc9736cSJeff Kirsher mutex_unlock(&hw_priv->lock);
6012bcc9736cSJeff Kirsher
6013bcc9736cSJeff Kirsher return 0;
6014bcc9736cSJeff Kirsher }
6015bcc9736cSJeff Kirsher
6016bcc9736cSJeff Kirsher /**
6017bcc9736cSJeff Kirsher * netdev_get_ringparam - get tx/rx ring parameters
6018bcc9736cSJeff Kirsher * @dev: Network device.
6019d0ea5cbdSJesse Brandeburg * @ring: Ethtool RING settings data structure.
602074624944SHao Chen * @kernel_ring: Ethtool external RING settings data structure.
602174624944SHao Chen * @extack: Netlink handle.
6022bcc9736cSJeff Kirsher *
6023bcc9736cSJeff Kirsher * This procedure returns the TX/RX ring settings.
6024bcc9736cSJeff Kirsher */
netdev_get_ringparam(struct net_device * dev,struct ethtool_ringparam * ring,struct kernel_ethtool_ringparam * kernel_ring,struct netlink_ext_ack * extack)6025bcc9736cSJeff Kirsher static void netdev_get_ringparam(struct net_device *dev,
602674624944SHao Chen struct ethtool_ringparam *ring,
602774624944SHao Chen struct kernel_ethtool_ringparam *kernel_ring,
602874624944SHao Chen struct netlink_ext_ack *extack)
6029bcc9736cSJeff Kirsher {
6030bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
6031bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
6032bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
6033bcc9736cSJeff Kirsher
6034bcc9736cSJeff Kirsher ring->tx_max_pending = (1 << 9);
6035bcc9736cSJeff Kirsher ring->tx_pending = hw->tx_desc_info.alloc;
6036bcc9736cSJeff Kirsher ring->rx_max_pending = (1 << 9);
6037bcc9736cSJeff Kirsher ring->rx_pending = hw->rx_desc_info.alloc;
6038bcc9736cSJeff Kirsher }
6039bcc9736cSJeff Kirsher
6040bcc9736cSJeff Kirsher #define STATS_LEN (TOTAL_PORT_COUNTER_NUM)
6041bcc9736cSJeff Kirsher
6042bcc9736cSJeff Kirsher static struct {
6043bcc9736cSJeff Kirsher char string[ETH_GSTRING_LEN];
6044bcc9736cSJeff Kirsher } ethtool_stats_keys[STATS_LEN] = {
6045bcc9736cSJeff Kirsher { "rx_lo_priority_octets" },
6046bcc9736cSJeff Kirsher { "rx_hi_priority_octets" },
6047bcc9736cSJeff Kirsher { "rx_undersize_packets" },
6048bcc9736cSJeff Kirsher { "rx_fragments" },
6049bcc9736cSJeff Kirsher { "rx_oversize_packets" },
6050bcc9736cSJeff Kirsher { "rx_jabbers" },
6051bcc9736cSJeff Kirsher { "rx_symbol_errors" },
6052bcc9736cSJeff Kirsher { "rx_crc_errors" },
6053bcc9736cSJeff Kirsher { "rx_align_errors" },
6054bcc9736cSJeff Kirsher { "rx_mac_ctrl_packets" },
6055bcc9736cSJeff Kirsher { "rx_pause_packets" },
6056bcc9736cSJeff Kirsher { "rx_bcast_packets" },
6057bcc9736cSJeff Kirsher { "rx_mcast_packets" },
6058bcc9736cSJeff Kirsher { "rx_ucast_packets" },
6059bcc9736cSJeff Kirsher { "rx_64_or_less_octet_packets" },
6060bcc9736cSJeff Kirsher { "rx_65_to_127_octet_packets" },
6061bcc9736cSJeff Kirsher { "rx_128_to_255_octet_packets" },
6062bcc9736cSJeff Kirsher { "rx_256_to_511_octet_packets" },
6063bcc9736cSJeff Kirsher { "rx_512_to_1023_octet_packets" },
6064bcc9736cSJeff Kirsher { "rx_1024_to_1522_octet_packets" },
6065bcc9736cSJeff Kirsher
6066bcc9736cSJeff Kirsher { "tx_lo_priority_octets" },
6067bcc9736cSJeff Kirsher { "tx_hi_priority_octets" },
6068bcc9736cSJeff Kirsher { "tx_late_collisions" },
6069bcc9736cSJeff Kirsher { "tx_pause_packets" },
6070bcc9736cSJeff Kirsher { "tx_bcast_packets" },
6071bcc9736cSJeff Kirsher { "tx_mcast_packets" },
6072bcc9736cSJeff Kirsher { "tx_ucast_packets" },
6073bcc9736cSJeff Kirsher { "tx_deferred" },
6074bcc9736cSJeff Kirsher { "tx_total_collisions" },
6075bcc9736cSJeff Kirsher { "tx_excessive_collisions" },
6076bcc9736cSJeff Kirsher { "tx_single_collisions" },
6077bcc9736cSJeff Kirsher { "tx_mult_collisions" },
6078bcc9736cSJeff Kirsher
6079bcc9736cSJeff Kirsher { "rx_discards" },
6080bcc9736cSJeff Kirsher { "tx_discards" },
6081bcc9736cSJeff Kirsher };
6082bcc9736cSJeff Kirsher
6083bcc9736cSJeff Kirsher /**
6084bcc9736cSJeff Kirsher * netdev_get_strings - get statistics identity strings
6085bcc9736cSJeff Kirsher * @dev: Network device.
6086bcc9736cSJeff Kirsher * @stringset: String set identifier.
6087bcc9736cSJeff Kirsher * @buf: Buffer to store the strings.
6088bcc9736cSJeff Kirsher *
6089bcc9736cSJeff Kirsher * This procedure returns the strings used to identify the statistics.
6090bcc9736cSJeff Kirsher */
netdev_get_strings(struct net_device * dev,u32 stringset,u8 * buf)6091bcc9736cSJeff Kirsher static void netdev_get_strings(struct net_device *dev, u32 stringset, u8 *buf)
6092bcc9736cSJeff Kirsher {
6093bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
6094bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
6095bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
6096bcc9736cSJeff Kirsher
6097bcc9736cSJeff Kirsher if (ETH_SS_STATS == stringset)
6098bcc9736cSJeff Kirsher memcpy(buf, ðtool_stats_keys,
6099bcc9736cSJeff Kirsher ETH_GSTRING_LEN * hw->mib_cnt);
6100bcc9736cSJeff Kirsher }
6101bcc9736cSJeff Kirsher
6102bcc9736cSJeff Kirsher /**
6103bcc9736cSJeff Kirsher * netdev_get_sset_count - get statistics size
6104bcc9736cSJeff Kirsher * @dev: Network device.
6105bcc9736cSJeff Kirsher * @sset: The statistics set number.
6106bcc9736cSJeff Kirsher *
6107bcc9736cSJeff Kirsher * This function returns the size of the statistics to be reported.
6108bcc9736cSJeff Kirsher *
6109bcc9736cSJeff Kirsher * Return size of the statistics to be reported.
6110bcc9736cSJeff Kirsher */
netdev_get_sset_count(struct net_device * dev,int sset)6111bcc9736cSJeff Kirsher static int netdev_get_sset_count(struct net_device *dev, int sset)
6112bcc9736cSJeff Kirsher {
6113bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
6114bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
6115bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
6116bcc9736cSJeff Kirsher
6117bcc9736cSJeff Kirsher switch (sset) {
6118bcc9736cSJeff Kirsher case ETH_SS_STATS:
6119bcc9736cSJeff Kirsher return hw->mib_cnt;
6120bcc9736cSJeff Kirsher default:
6121bcc9736cSJeff Kirsher return -EOPNOTSUPP;
6122bcc9736cSJeff Kirsher }
6123bcc9736cSJeff Kirsher }
6124bcc9736cSJeff Kirsher
6125bcc9736cSJeff Kirsher /**
6126bcc9736cSJeff Kirsher * netdev_get_ethtool_stats - get network device statistics
6127bcc9736cSJeff Kirsher * @dev: Network device.
6128bcc9736cSJeff Kirsher * @stats: Ethtool statistics data structure.
6129bcc9736cSJeff Kirsher * @data: Buffer to store the statistics.
6130bcc9736cSJeff Kirsher *
6131bcc9736cSJeff Kirsher * This procedure returns the statistics.
6132bcc9736cSJeff Kirsher */
netdev_get_ethtool_stats(struct net_device * dev,struct ethtool_stats * stats,u64 * data)6133bcc9736cSJeff Kirsher static void netdev_get_ethtool_stats(struct net_device *dev,
6134bcc9736cSJeff Kirsher struct ethtool_stats *stats, u64 *data)
6135bcc9736cSJeff Kirsher {
6136bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
6137bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
6138bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
6139bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
6140bcc9736cSJeff Kirsher int n_stats = stats->n_stats;
6141bcc9736cSJeff Kirsher int i;
6142bcc9736cSJeff Kirsher int n;
6143bcc9736cSJeff Kirsher int p;
6144bcc9736cSJeff Kirsher u64 counter[TOTAL_PORT_COUNTER_NUM];
6145bcc9736cSJeff Kirsher
6146bcc9736cSJeff Kirsher mutex_lock(&hw_priv->lock);
6147bcc9736cSJeff Kirsher n = SWITCH_PORT_NUM;
6148bcc9736cSJeff Kirsher for (i = 0, p = port->first_port; i < port->mib_port_cnt; i++, p++) {
6149bcc9736cSJeff Kirsher if (media_connected == hw->port_mib[p].state) {
6150bcc9736cSJeff Kirsher hw_priv->counter[p].read = 1;
6151bcc9736cSJeff Kirsher
6152bcc9736cSJeff Kirsher /* Remember first port that requests read. */
6153bcc9736cSJeff Kirsher if (n == SWITCH_PORT_NUM)
6154bcc9736cSJeff Kirsher n = p;
6155bcc9736cSJeff Kirsher }
6156bcc9736cSJeff Kirsher }
6157bcc9736cSJeff Kirsher mutex_unlock(&hw_priv->lock);
6158bcc9736cSJeff Kirsher
6159bcc9736cSJeff Kirsher if (n < SWITCH_PORT_NUM)
6160bcc9736cSJeff Kirsher schedule_work(&hw_priv->mib_read);
6161bcc9736cSJeff Kirsher
6162bcc9736cSJeff Kirsher if (1 == port->mib_port_cnt && n < SWITCH_PORT_NUM) {
6163bcc9736cSJeff Kirsher p = n;
6164bf2977aeSZheng Yongjun wait_event_interruptible_timeout(
6165bcc9736cSJeff Kirsher hw_priv->counter[p].counter,
6166bcc9736cSJeff Kirsher 2 == hw_priv->counter[p].read,
6167bcc9736cSJeff Kirsher HZ * 1);
6168bcc9736cSJeff Kirsher } else
6169bcc9736cSJeff Kirsher for (i = 0, p = n; i < port->mib_port_cnt - n; i++, p++) {
6170bcc9736cSJeff Kirsher if (0 == i) {
6171bf2977aeSZheng Yongjun wait_event_interruptible_timeout(
6172bcc9736cSJeff Kirsher hw_priv->counter[p].counter,
6173bcc9736cSJeff Kirsher 2 == hw_priv->counter[p].read,
6174bcc9736cSJeff Kirsher HZ * 2);
6175bcc9736cSJeff Kirsher } else if (hw->port_mib[p].cnt_ptr) {
6176bf2977aeSZheng Yongjun wait_event_interruptible_timeout(
6177bcc9736cSJeff Kirsher hw_priv->counter[p].counter,
6178bcc9736cSJeff Kirsher 2 == hw_priv->counter[p].read,
6179bcc9736cSJeff Kirsher HZ * 1);
6180bcc9736cSJeff Kirsher }
6181bcc9736cSJeff Kirsher }
6182bcc9736cSJeff Kirsher
6183bcc9736cSJeff Kirsher get_mib_counters(hw, port->first_port, port->mib_port_cnt, counter);
6184bcc9736cSJeff Kirsher n = hw->mib_cnt;
6185bcc9736cSJeff Kirsher if (n > n_stats)
6186bcc9736cSJeff Kirsher n = n_stats;
6187bcc9736cSJeff Kirsher n_stats -= n;
6188bcc9736cSJeff Kirsher for (i = 0; i < n; i++)
6189bcc9736cSJeff Kirsher *data++ = counter[i];
6190bcc9736cSJeff Kirsher }
6191bcc9736cSJeff Kirsher
6192bcc9736cSJeff Kirsher /**
6193bcc9736cSJeff Kirsher * netdev_set_features - set receive checksum support
6194bcc9736cSJeff Kirsher * @dev: Network device.
6195bcc9736cSJeff Kirsher * @features: New device features (offloads).
6196bcc9736cSJeff Kirsher *
6197bcc9736cSJeff Kirsher * This function sets receive checksum support setting.
6198bcc9736cSJeff Kirsher *
6199bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code.
6200bcc9736cSJeff Kirsher */
netdev_set_features(struct net_device * dev,netdev_features_t features)6201c8f44affSMichał Mirosław static int netdev_set_features(struct net_device *dev,
6202c8f44affSMichał Mirosław netdev_features_t features)
6203bcc9736cSJeff Kirsher {
6204bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
6205bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
6206bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
6207bcc9736cSJeff Kirsher
6208bcc9736cSJeff Kirsher mutex_lock(&hw_priv->lock);
6209bcc9736cSJeff Kirsher
6210bcc9736cSJeff Kirsher /* see note in hw_setup() */
6211bcc9736cSJeff Kirsher if (features & NETIF_F_RXCSUM)
6212bcc9736cSJeff Kirsher hw->rx_cfg |= DMA_RX_CSUM_TCP | DMA_RX_CSUM_IP;
6213bcc9736cSJeff Kirsher else
6214bcc9736cSJeff Kirsher hw->rx_cfg &= ~(DMA_RX_CSUM_TCP | DMA_RX_CSUM_IP);
6215bcc9736cSJeff Kirsher
6216bcc9736cSJeff Kirsher if (hw->enabled)
6217bcc9736cSJeff Kirsher writel(hw->rx_cfg, hw->io + KS_DMA_RX_CTRL);
6218bcc9736cSJeff Kirsher
6219bcc9736cSJeff Kirsher mutex_unlock(&hw_priv->lock);
6220bcc9736cSJeff Kirsher
6221bcc9736cSJeff Kirsher return 0;
6222bcc9736cSJeff Kirsher }
6223bcc9736cSJeff Kirsher
62249b07be4bSstephen hemminger static const struct ethtool_ops netdev_ethtool_ops = {
6225bcc9736cSJeff Kirsher .nway_reset = netdev_nway_reset,
6226bcc9736cSJeff Kirsher .get_link = netdev_get_link,
6227bcc9736cSJeff Kirsher .get_drvinfo = netdev_get_drvinfo,
6228bcc9736cSJeff Kirsher .get_regs_len = netdev_get_regs_len,
6229bcc9736cSJeff Kirsher .get_regs = netdev_get_regs,
6230bcc9736cSJeff Kirsher .get_wol = netdev_get_wol,
6231bcc9736cSJeff Kirsher .set_wol = netdev_set_wol,
6232bcc9736cSJeff Kirsher .get_msglevel = netdev_get_msglevel,
6233bcc9736cSJeff Kirsher .set_msglevel = netdev_set_msglevel,
6234bcc9736cSJeff Kirsher .get_eeprom_len = netdev_get_eeprom_len,
6235bcc9736cSJeff Kirsher .get_eeprom = netdev_get_eeprom,
6236bcc9736cSJeff Kirsher .set_eeprom = netdev_set_eeprom,
6237bcc9736cSJeff Kirsher .get_pauseparam = netdev_get_pauseparam,
6238bcc9736cSJeff Kirsher .set_pauseparam = netdev_set_pauseparam,
6239bcc9736cSJeff Kirsher .get_ringparam = netdev_get_ringparam,
6240bcc9736cSJeff Kirsher .get_strings = netdev_get_strings,
6241bcc9736cSJeff Kirsher .get_sset_count = netdev_get_sset_count,
6242bcc9736cSJeff Kirsher .get_ethtool_stats = netdev_get_ethtool_stats,
62432fb93a1aSPhilippe Reynes .get_link_ksettings = netdev_get_link_ksettings,
62442fb93a1aSPhilippe Reynes .set_link_ksettings = netdev_set_link_ksettings,
6245bcc9736cSJeff Kirsher };
6246bcc9736cSJeff Kirsher
6247bcc9736cSJeff Kirsher /*
6248bcc9736cSJeff Kirsher * Hardware monitoring
6249bcc9736cSJeff Kirsher */
6250bcc9736cSJeff Kirsher
update_link(struct net_device * dev,struct dev_priv * priv,struct ksz_port * port)6251bcc9736cSJeff Kirsher static void update_link(struct net_device *dev, struct dev_priv *priv,
6252bcc9736cSJeff Kirsher struct ksz_port *port)
6253bcc9736cSJeff Kirsher {
6254bcc9736cSJeff Kirsher if (priv->media_state != port->linked->state) {
6255bcc9736cSJeff Kirsher priv->media_state = port->linked->state;
6256bcc9736cSJeff Kirsher if (netif_running(dev))
6257bcc9736cSJeff Kirsher set_media_state(dev, media_connected);
6258bcc9736cSJeff Kirsher }
6259bcc9736cSJeff Kirsher }
6260bcc9736cSJeff Kirsher
mib_read_work(struct work_struct * work)6261bcc9736cSJeff Kirsher static void mib_read_work(struct work_struct *work)
6262bcc9736cSJeff Kirsher {
6263bcc9736cSJeff Kirsher struct dev_info *hw_priv =
6264bcc9736cSJeff Kirsher container_of(work, struct dev_info, mib_read);
6265bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
6266af1147b2Swujunwen unsigned long next_jiffies;
6267bcc9736cSJeff Kirsher struct ksz_port_mib *mib;
6268bcc9736cSJeff Kirsher int i;
6269bcc9736cSJeff Kirsher
6270bcc9736cSJeff Kirsher next_jiffies = jiffies;
6271bcc9736cSJeff Kirsher for (i = 0; i < hw->mib_port_cnt; i++) {
6272bcc9736cSJeff Kirsher mib = &hw->port_mib[i];
6273bcc9736cSJeff Kirsher
6274bcc9736cSJeff Kirsher /* Reading MIB counters or requested to read. */
6275bcc9736cSJeff Kirsher if (mib->cnt_ptr || 1 == hw_priv->counter[i].read) {
6276bcc9736cSJeff Kirsher
6277bcc9736cSJeff Kirsher /* Need to process receive interrupt. */
6278bcc9736cSJeff Kirsher if (port_r_cnt(hw, i))
6279bcc9736cSJeff Kirsher break;
6280bcc9736cSJeff Kirsher hw_priv->counter[i].read = 0;
6281bcc9736cSJeff Kirsher
6282bcc9736cSJeff Kirsher /* Finish reading counters. */
6283bcc9736cSJeff Kirsher if (0 == mib->cnt_ptr) {
6284bcc9736cSJeff Kirsher hw_priv->counter[i].read = 2;
6285bcc9736cSJeff Kirsher wake_up_interruptible(
6286bcc9736cSJeff Kirsher &hw_priv->counter[i].counter);
6287bcc9736cSJeff Kirsher }
6288f6b59f36SAntonio Murdaca } else if (time_after_eq(jiffies, hw_priv->counter[i].time)) {
6289bcc9736cSJeff Kirsher /* Only read MIB counters when the port is connected. */
6290bcc9736cSJeff Kirsher if (media_connected == mib->state)
6291bcc9736cSJeff Kirsher hw_priv->counter[i].read = 1;
6292bcc9736cSJeff Kirsher next_jiffies += HZ * 1 * hw->mib_port_cnt;
6293bcc9736cSJeff Kirsher hw_priv->counter[i].time = next_jiffies;
6294bcc9736cSJeff Kirsher
6295bcc9736cSJeff Kirsher /* Port is just disconnected. */
6296bcc9736cSJeff Kirsher } else if (mib->link_down) {
6297bcc9736cSJeff Kirsher mib->link_down = 0;
6298bcc9736cSJeff Kirsher
6299bcc9736cSJeff Kirsher /* Read counters one last time after link is lost. */
6300bcc9736cSJeff Kirsher hw_priv->counter[i].read = 1;
6301bcc9736cSJeff Kirsher }
6302bcc9736cSJeff Kirsher }
6303bcc9736cSJeff Kirsher }
6304bcc9736cSJeff Kirsher
mib_monitor(struct timer_list * t)630511dd894eSKees Cook static void mib_monitor(struct timer_list *t)
6306bcc9736cSJeff Kirsher {
630711dd894eSKees Cook struct dev_info *hw_priv = from_timer(hw_priv, t, mib_timer_info.timer);
6308bcc9736cSJeff Kirsher
6309bcc9736cSJeff Kirsher mib_read_work(&hw_priv->mib_read);
6310bcc9736cSJeff Kirsher
6311bcc9736cSJeff Kirsher /* This is used to verify Wake-on-LAN is working. */
6312bcc9736cSJeff Kirsher if (hw_priv->pme_wait) {
6313addae62eSAntonio Murdaca if (time_is_before_eq_jiffies(hw_priv->pme_wait)) {
6314bcc9736cSJeff Kirsher hw_clr_wol_pme_status(&hw_priv->hw);
6315bcc9736cSJeff Kirsher hw_priv->pme_wait = 0;
6316bcc9736cSJeff Kirsher }
6317bcc9736cSJeff Kirsher } else if (hw_chk_wol_pme_status(&hw_priv->hw)) {
6318bcc9736cSJeff Kirsher
6319bcc9736cSJeff Kirsher /* PME is asserted. Wait 2 seconds to clear it. */
6320bcc9736cSJeff Kirsher hw_priv->pme_wait = jiffies + HZ * 2;
6321bcc9736cSJeff Kirsher }
6322bcc9736cSJeff Kirsher
6323bcc9736cSJeff Kirsher ksz_update_timer(&hw_priv->mib_timer_info);
6324bcc9736cSJeff Kirsher }
6325bcc9736cSJeff Kirsher
6326bcc9736cSJeff Kirsher /**
6327bcc9736cSJeff Kirsher * dev_monitor - periodic monitoring
6328d0ea5cbdSJesse Brandeburg * @t: timer list containing a network device pointer.
6329bcc9736cSJeff Kirsher *
6330bcc9736cSJeff Kirsher * This routine is run in a kernel timer to monitor the network device.
6331bcc9736cSJeff Kirsher */
dev_monitor(struct timer_list * t)633211dd894eSKees Cook static void dev_monitor(struct timer_list *t)
6333bcc9736cSJeff Kirsher {
633411dd894eSKees Cook struct dev_priv *priv = from_timer(priv, t, monitor_timer_info.timer);
633511dd894eSKees Cook struct net_device *dev = priv->mii_if.dev;
6336bcc9736cSJeff Kirsher struct dev_info *hw_priv = priv->adapter;
6337bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
6338bcc9736cSJeff Kirsher struct ksz_port *port = &priv->port;
6339bcc9736cSJeff Kirsher
6340bcc9736cSJeff Kirsher if (!(hw->features & LINK_INT_WORKING))
6341bcc9736cSJeff Kirsher port_get_link_speed(port);
6342bcc9736cSJeff Kirsher update_link(dev, priv, port);
6343bcc9736cSJeff Kirsher
6344bcc9736cSJeff Kirsher ksz_update_timer(&priv->monitor_timer_info);
6345bcc9736cSJeff Kirsher }
6346bcc9736cSJeff Kirsher
6347bcc9736cSJeff Kirsher /*
6348bcc9736cSJeff Kirsher * Linux network device interface functions
6349bcc9736cSJeff Kirsher */
6350bcc9736cSJeff Kirsher
6351bcc9736cSJeff Kirsher /* Driver exported variables */
6352bcc9736cSJeff Kirsher
6353bcc9736cSJeff Kirsher static int msg_enable;
6354bcc9736cSJeff Kirsher
6355bcc9736cSJeff Kirsher static char *macaddr = ":";
6356bcc9736cSJeff Kirsher static char *mac1addr = ":";
6357bcc9736cSJeff Kirsher
6358bcc9736cSJeff Kirsher /*
6359bcc9736cSJeff Kirsher * This enables multiple network device mode for KSZ8842, which contains a
6360bcc9736cSJeff Kirsher * switch with two physical ports. Some users like to take control of the
6361bcc9736cSJeff Kirsher * ports for running Spanning Tree Protocol. The driver will create an
6362bcc9736cSJeff Kirsher * additional eth? device for the other port.
6363bcc9736cSJeff Kirsher *
6364bcc9736cSJeff Kirsher * Some limitations are the network devices cannot have different MTU and
6365bcc9736cSJeff Kirsher * multicast hash tables.
6366bcc9736cSJeff Kirsher */
6367bcc9736cSJeff Kirsher static int multi_dev;
6368bcc9736cSJeff Kirsher
6369bcc9736cSJeff Kirsher /*
6370bcc9736cSJeff Kirsher * As most users select multiple network device mode to use Spanning Tree
6371bcc9736cSJeff Kirsher * Protocol, this enables a feature in which most unicast and multicast packets
6372bcc9736cSJeff Kirsher * are forwarded inside the switch and not passed to the host. Only packets
6373bcc9736cSJeff Kirsher * that need the host's attention are passed to it. This prevents the host
6374bcc9736cSJeff Kirsher * wasting CPU time to examine each and every incoming packets and do the
6375bcc9736cSJeff Kirsher * forwarding itself.
6376bcc9736cSJeff Kirsher *
6377bcc9736cSJeff Kirsher * As the hack requires the private bridge header, the driver cannot compile
6378bcc9736cSJeff Kirsher * with just the kernel headers.
6379bcc9736cSJeff Kirsher *
6380bcc9736cSJeff Kirsher * Enabling STP support also turns on multiple network device mode.
6381bcc9736cSJeff Kirsher */
6382bcc9736cSJeff Kirsher static int stp;
6383bcc9736cSJeff Kirsher
6384bcc9736cSJeff Kirsher /*
6385bcc9736cSJeff Kirsher * This enables fast aging in the KSZ8842 switch. Not sure what situation
6386bcc9736cSJeff Kirsher * needs that. However, fast aging is used to flush the dynamic MAC table when
638702582e9bSMasanari Iida * STP support is enabled.
6388bcc9736cSJeff Kirsher */
6389bcc9736cSJeff Kirsher static int fast_aging;
6390bcc9736cSJeff Kirsher
6391bcc9736cSJeff Kirsher /**
6392bcc9736cSJeff Kirsher * netdev_init - initialize network device.
6393bcc9736cSJeff Kirsher * @dev: Network device.
6394bcc9736cSJeff Kirsher *
6395bcc9736cSJeff Kirsher * This function initializes the network device.
6396bcc9736cSJeff Kirsher *
6397bcc9736cSJeff Kirsher * Return 0 if successful; otherwise an error code indicating failure.
6398bcc9736cSJeff Kirsher */
netdev_init(struct net_device * dev)6399bcc9736cSJeff Kirsher static int __init netdev_init(struct net_device *dev)
6400bcc9736cSJeff Kirsher {
6401bcc9736cSJeff Kirsher struct dev_priv *priv = netdev_priv(dev);
6402bcc9736cSJeff Kirsher
6403bcc9736cSJeff Kirsher /* 500 ms timeout */
6404bcc9736cSJeff Kirsher ksz_init_timer(&priv->monitor_timer_info, 500 * HZ / 1000,
640511dd894eSKees Cook dev_monitor);
6406bcc9736cSJeff Kirsher
6407bcc9736cSJeff Kirsher /* 500 ms timeout */
6408bcc9736cSJeff Kirsher dev->watchdog_timeo = HZ / 2;
6409bcc9736cSJeff Kirsher
6410bcc9736cSJeff Kirsher dev->hw_features = NETIF_F_IP_CSUM | NETIF_F_SG | NETIF_F_RXCSUM;
6411bcc9736cSJeff Kirsher
6412bcc9736cSJeff Kirsher /*
6413bcc9736cSJeff Kirsher * Hardware does not really support IPv6 checksum generation, but
6414bcc9736cSJeff Kirsher * driver actually runs faster with this on.
6415bcc9736cSJeff Kirsher */
6416bcc9736cSJeff Kirsher dev->hw_features |= NETIF_F_IPV6_CSUM;
6417bcc9736cSJeff Kirsher
6418bcc9736cSJeff Kirsher dev->features |= dev->hw_features;
6419bcc9736cSJeff Kirsher
6420bcc9736cSJeff Kirsher sema_init(&priv->proc_sem, 1);
6421bcc9736cSJeff Kirsher
6422bcc9736cSJeff Kirsher priv->mii_if.phy_id_mask = 0x1;
6423bcc9736cSJeff Kirsher priv->mii_if.reg_num_mask = 0x7;
6424bcc9736cSJeff Kirsher priv->mii_if.dev = dev;
6425bcc9736cSJeff Kirsher priv->mii_if.mdio_read = mdio_read;
6426bcc9736cSJeff Kirsher priv->mii_if.mdio_write = mdio_write;
6427bcc9736cSJeff Kirsher priv->mii_if.phy_id = priv->port.first_port + 1;
6428bcc9736cSJeff Kirsher
6429bcc9736cSJeff Kirsher priv->msg_enable = netif_msg_init(msg_enable,
6430bcc9736cSJeff Kirsher (NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_LINK));
6431bcc9736cSJeff Kirsher
6432bcc9736cSJeff Kirsher return 0;
6433bcc9736cSJeff Kirsher }
6434bcc9736cSJeff Kirsher
6435bcc9736cSJeff Kirsher static const struct net_device_ops netdev_ops = {
6436bcc9736cSJeff Kirsher .ndo_init = netdev_init,
6437bcc9736cSJeff Kirsher .ndo_open = netdev_open,
6438bcc9736cSJeff Kirsher .ndo_stop = netdev_close,
6439bcc9736cSJeff Kirsher .ndo_get_stats = netdev_query_statistics,
6440bcc9736cSJeff Kirsher .ndo_start_xmit = netdev_tx,
6441bcc9736cSJeff Kirsher .ndo_tx_timeout = netdev_tx_timeout,
6442bcc9736cSJeff Kirsher .ndo_change_mtu = netdev_change_mtu,
6443bcc9736cSJeff Kirsher .ndo_set_features = netdev_set_features,
6444bcc9736cSJeff Kirsher .ndo_set_mac_address = netdev_set_mac_address,
6445bcc9736cSJeff Kirsher .ndo_validate_addr = eth_validate_addr,
6446a7605370SArnd Bergmann .ndo_eth_ioctl = netdev_ioctl,
6447bcc9736cSJeff Kirsher .ndo_set_rx_mode = netdev_set_rx_mode,
6448bcc9736cSJeff Kirsher #ifdef CONFIG_NET_POLL_CONTROLLER
6449bcc9736cSJeff Kirsher .ndo_poll_controller = netdev_netpoll,
6450bcc9736cSJeff Kirsher #endif
6451bcc9736cSJeff Kirsher };
6452bcc9736cSJeff Kirsher
netdev_free(struct net_device * dev)6453bcc9736cSJeff Kirsher static void netdev_free(struct net_device *dev)
6454bcc9736cSJeff Kirsher {
6455bcc9736cSJeff Kirsher if (dev->watchdog_timeo)
6456bcc9736cSJeff Kirsher unregister_netdev(dev);
6457bcc9736cSJeff Kirsher
6458bcc9736cSJeff Kirsher free_netdev(dev);
6459bcc9736cSJeff Kirsher }
6460bcc9736cSJeff Kirsher
6461bcc9736cSJeff Kirsher struct platform_info {
6462bcc9736cSJeff Kirsher struct dev_info dev_info;
6463bcc9736cSJeff Kirsher struct net_device *netdev[SWITCH_PORT_NUM];
6464bcc9736cSJeff Kirsher };
6465bcc9736cSJeff Kirsher
6466bcc9736cSJeff Kirsher static int net_device_present;
6467bcc9736cSJeff Kirsher
get_mac_addr(struct dev_info * hw_priv,u8 * macaddr,int port)6468bcc9736cSJeff Kirsher static void get_mac_addr(struct dev_info *hw_priv, u8 *macaddr, int port)
6469bcc9736cSJeff Kirsher {
6470bcc9736cSJeff Kirsher int i;
6471bcc9736cSJeff Kirsher int j;
6472bcc9736cSJeff Kirsher int got_num;
6473bcc9736cSJeff Kirsher int num;
6474bcc9736cSJeff Kirsher
6475bcc9736cSJeff Kirsher i = j = num = got_num = 0;
64766a3c910cSJoe Perches while (j < ETH_ALEN) {
6477bcc9736cSJeff Kirsher if (macaddr[i]) {
6478bcc9736cSJeff Kirsher int digit;
6479bcc9736cSJeff Kirsher
6480bcc9736cSJeff Kirsher got_num = 1;
6481bcc9736cSJeff Kirsher digit = hex_to_bin(macaddr[i]);
6482bcc9736cSJeff Kirsher if (digit >= 0)
6483bcc9736cSJeff Kirsher num = num * 16 + digit;
6484bcc9736cSJeff Kirsher else if (':' == macaddr[i])
6485bcc9736cSJeff Kirsher got_num = 2;
6486bcc9736cSJeff Kirsher else
6487bcc9736cSJeff Kirsher break;
6488bcc9736cSJeff Kirsher } else if (got_num)
6489bcc9736cSJeff Kirsher got_num = 2;
6490bcc9736cSJeff Kirsher else
6491bcc9736cSJeff Kirsher break;
6492bcc9736cSJeff Kirsher if (2 == got_num) {
6493bcc9736cSJeff Kirsher if (MAIN_PORT == port) {
6494bcc9736cSJeff Kirsher hw_priv->hw.override_addr[j++] = (u8) num;
6495bcc9736cSJeff Kirsher hw_priv->hw.override_addr[5] +=
6496bcc9736cSJeff Kirsher hw_priv->hw.id;
6497bcc9736cSJeff Kirsher } else {
6498bcc9736cSJeff Kirsher hw_priv->hw.ksz_switch->other_addr[j++] =
6499bcc9736cSJeff Kirsher (u8) num;
6500bcc9736cSJeff Kirsher hw_priv->hw.ksz_switch->other_addr[5] +=
6501bcc9736cSJeff Kirsher hw_priv->hw.id;
6502bcc9736cSJeff Kirsher }
6503bcc9736cSJeff Kirsher num = got_num = 0;
6504bcc9736cSJeff Kirsher }
6505bcc9736cSJeff Kirsher i++;
6506bcc9736cSJeff Kirsher }
65076a3c910cSJoe Perches if (ETH_ALEN == j) {
6508bcc9736cSJeff Kirsher if (MAIN_PORT == port)
6509bcc9736cSJeff Kirsher hw_priv->hw.mac_override = 1;
6510bcc9736cSJeff Kirsher }
6511bcc9736cSJeff Kirsher }
6512bcc9736cSJeff Kirsher
6513bcc9736cSJeff Kirsher #define KS884X_DMA_MASK (~0x0UL)
6514bcc9736cSJeff Kirsher
read_other_addr(struct ksz_hw * hw)6515bcc9736cSJeff Kirsher static void read_other_addr(struct ksz_hw *hw)
6516bcc9736cSJeff Kirsher {
6517bcc9736cSJeff Kirsher int i;
6518bcc9736cSJeff Kirsher u16 data[3];
6519bcc9736cSJeff Kirsher struct ksz_switch *sw = hw->ksz_switch;
6520bcc9736cSJeff Kirsher
6521bcc9736cSJeff Kirsher for (i = 0; i < 3; i++)
6522bcc9736cSJeff Kirsher data[i] = eeprom_read(hw, i + EEPROM_DATA_OTHER_MAC_ADDR);
6523bcc9736cSJeff Kirsher if ((data[0] || data[1] || data[2]) && data[0] != 0xffff) {
6524bcc9736cSJeff Kirsher sw->other_addr[5] = (u8) data[0];
6525bcc9736cSJeff Kirsher sw->other_addr[4] = (u8)(data[0] >> 8);
6526bcc9736cSJeff Kirsher sw->other_addr[3] = (u8) data[1];
6527bcc9736cSJeff Kirsher sw->other_addr[2] = (u8)(data[1] >> 8);
6528bcc9736cSJeff Kirsher sw->other_addr[1] = (u8) data[2];
6529bcc9736cSJeff Kirsher sw->other_addr[0] = (u8)(data[2] >> 8);
6530bcc9736cSJeff Kirsher }
6531bcc9736cSJeff Kirsher }
6532bcc9736cSJeff Kirsher
6533bcc9736cSJeff Kirsher #ifndef PCI_VENDOR_ID_MICREL_KS
6534bcc9736cSJeff Kirsher #define PCI_VENDOR_ID_MICREL_KS 0x16c6
6535bcc9736cSJeff Kirsher #endif
6536bcc9736cSJeff Kirsher
pcidev_init(struct pci_dev * pdev,const struct pci_device_id * id)65371dd06ae8SGreg Kroah-Hartman static int pcidev_init(struct pci_dev *pdev, const struct pci_device_id *id)
6538bcc9736cSJeff Kirsher {
6539bcc9736cSJeff Kirsher struct net_device *dev;
6540bcc9736cSJeff Kirsher struct dev_priv *priv;
6541bcc9736cSJeff Kirsher struct dev_info *hw_priv;
6542bcc9736cSJeff Kirsher struct ksz_hw *hw;
6543bcc9736cSJeff Kirsher struct platform_info *info;
6544bcc9736cSJeff Kirsher struct ksz_port *port;
6545bcc9736cSJeff Kirsher unsigned long reg_base;
6546bcc9736cSJeff Kirsher unsigned long reg_len;
6547bcc9736cSJeff Kirsher int cnt;
6548bcc9736cSJeff Kirsher int i;
6549bcc9736cSJeff Kirsher int mib_port_count;
6550bcc9736cSJeff Kirsher int pi;
6551bcc9736cSJeff Kirsher int port_count;
6552bcc9736cSJeff Kirsher int result;
6553bcc9736cSJeff Kirsher char banner[sizeof(version)];
6554bcc9736cSJeff Kirsher struct ksz_switch *sw = NULL;
6555bcc9736cSJeff Kirsher
65565da6d655SYang Yingliang result = pcim_enable_device(pdev);
6557bcc9736cSJeff Kirsher if (result)
6558bcc9736cSJeff Kirsher return result;
6559bcc9736cSJeff Kirsher
6560bcc9736cSJeff Kirsher result = -ENODEV;
6561bcc9736cSJeff Kirsher
656281adcd65SChristophe JAILLET if (dma_set_mask(&pdev->dev, DMA_BIT_MASK(32)) ||
656381adcd65SChristophe JAILLET dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(32)))
6564bcc9736cSJeff Kirsher return result;
6565bcc9736cSJeff Kirsher
6566bcc9736cSJeff Kirsher reg_base = pci_resource_start(pdev, 0);
6567bcc9736cSJeff Kirsher reg_len = pci_resource_len(pdev, 0);
6568bcc9736cSJeff Kirsher if ((pci_resource_flags(pdev, 0) & IORESOURCE_IO) != 0)
6569bcc9736cSJeff Kirsher return result;
6570bcc9736cSJeff Kirsher
6571bcc9736cSJeff Kirsher if (!request_mem_region(reg_base, reg_len, DRV_NAME))
6572bcc9736cSJeff Kirsher return result;
6573bcc9736cSJeff Kirsher pci_set_master(pdev);
6574bcc9736cSJeff Kirsher
6575bcc9736cSJeff Kirsher result = -ENOMEM;
6576bcc9736cSJeff Kirsher
6577bcc9736cSJeff Kirsher info = kzalloc(sizeof(struct platform_info), GFP_KERNEL);
6578bcc9736cSJeff Kirsher if (!info)
6579bcc9736cSJeff Kirsher goto pcidev_init_dev_err;
6580bcc9736cSJeff Kirsher
6581bcc9736cSJeff Kirsher hw_priv = &info->dev_info;
6582bcc9736cSJeff Kirsher hw_priv->pdev = pdev;
6583bcc9736cSJeff Kirsher
6584bcc9736cSJeff Kirsher hw = &hw_priv->hw;
6585bcc9736cSJeff Kirsher
6586bcc9736cSJeff Kirsher hw->io = ioremap(reg_base, reg_len);
6587bcc9736cSJeff Kirsher if (!hw->io)
6588bcc9736cSJeff Kirsher goto pcidev_init_io_err;
6589bcc9736cSJeff Kirsher
6590bcc9736cSJeff Kirsher cnt = hw_init(hw);
6591bcc9736cSJeff Kirsher if (!cnt) {
6592bcc9736cSJeff Kirsher if (msg_enable & NETIF_MSG_PROBE)
6593bcc9736cSJeff Kirsher pr_alert("chip not detected\n");
6594bcc9736cSJeff Kirsher result = -ENODEV;
6595bcc9736cSJeff Kirsher goto pcidev_init_alloc_err;
6596bcc9736cSJeff Kirsher }
6597bcc9736cSJeff Kirsher
6598bcc9736cSJeff Kirsher snprintf(banner, sizeof(banner), "%s", version);
6599bcc9736cSJeff Kirsher banner[13] = cnt + '0'; /* Replace x in "Micrel KSZ884x" */
6600bcc9736cSJeff Kirsher dev_info(&hw_priv->pdev->dev, "%s\n", banner);
6601bcc9736cSJeff Kirsher dev_dbg(&hw_priv->pdev->dev, "Mem = %p; IRQ = %d\n", hw->io, pdev->irq);
6602bcc9736cSJeff Kirsher
6603bcc9736cSJeff Kirsher /* Assume device is KSZ8841. */
6604bcc9736cSJeff Kirsher hw->dev_count = 1;
6605bcc9736cSJeff Kirsher port_count = 1;
6606bcc9736cSJeff Kirsher mib_port_count = 1;
6607bcc9736cSJeff Kirsher hw->addr_list_size = 0;
6608bcc9736cSJeff Kirsher hw->mib_cnt = PORT_COUNTER_NUM;
6609bcc9736cSJeff Kirsher hw->mib_port_cnt = 1;
6610bcc9736cSJeff Kirsher
6611bcc9736cSJeff Kirsher /* KSZ8842 has a switch with multiple ports. */
6612bcc9736cSJeff Kirsher if (2 == cnt) {
6613bcc9736cSJeff Kirsher if (fast_aging)
6614bcc9736cSJeff Kirsher hw->overrides |= FAST_AGING;
6615bcc9736cSJeff Kirsher
6616bcc9736cSJeff Kirsher hw->mib_cnt = TOTAL_PORT_COUNTER_NUM;
6617bcc9736cSJeff Kirsher
6618bcc9736cSJeff Kirsher /* Multiple network device interfaces are required. */
6619bcc9736cSJeff Kirsher if (multi_dev) {
6620bcc9736cSJeff Kirsher hw->dev_count = SWITCH_PORT_NUM;
6621bcc9736cSJeff Kirsher hw->addr_list_size = SWITCH_PORT_NUM - 1;
6622bcc9736cSJeff Kirsher }
6623bcc9736cSJeff Kirsher
6624bcc9736cSJeff Kirsher /* Single network device has multiple ports. */
6625bcc9736cSJeff Kirsher if (1 == hw->dev_count) {
6626bcc9736cSJeff Kirsher port_count = SWITCH_PORT_NUM;
6627bcc9736cSJeff Kirsher mib_port_count = SWITCH_PORT_NUM;
6628bcc9736cSJeff Kirsher }
6629bcc9736cSJeff Kirsher hw->mib_port_cnt = TOTAL_PORT_NUM;
6630bcc9736cSJeff Kirsher hw->ksz_switch = kzalloc(sizeof(struct ksz_switch), GFP_KERNEL);
6631bcc9736cSJeff Kirsher if (!hw->ksz_switch)
6632bcc9736cSJeff Kirsher goto pcidev_init_alloc_err;
6633bcc9736cSJeff Kirsher
6634bcc9736cSJeff Kirsher sw = hw->ksz_switch;
6635bcc9736cSJeff Kirsher }
6636bcc9736cSJeff Kirsher for (i = 0; i < hw->mib_port_cnt; i++)
6637bcc9736cSJeff Kirsher hw->port_mib[i].mib_start = 0;
6638bcc9736cSJeff Kirsher
6639bcc9736cSJeff Kirsher hw->parent = hw_priv;
6640bcc9736cSJeff Kirsher
6641bcc9736cSJeff Kirsher /* Default MTU is 1500. */
6642bcc9736cSJeff Kirsher hw_priv->mtu = (REGULAR_RX_BUF_SIZE + 3) & ~3;
6643bcc9736cSJeff Kirsher
6644bcc9736cSJeff Kirsher if (ksz_alloc_mem(hw_priv))
6645bcc9736cSJeff Kirsher goto pcidev_init_mem_err;
6646bcc9736cSJeff Kirsher
6647bcc9736cSJeff Kirsher hw_priv->hw.id = net_device_present;
6648bcc9736cSJeff Kirsher
6649bcc9736cSJeff Kirsher spin_lock_init(&hw_priv->hwlock);
6650bcc9736cSJeff Kirsher mutex_init(&hw_priv->lock);
6651bcc9736cSJeff Kirsher
6652bcc9736cSJeff Kirsher for (i = 0; i < TOTAL_PORT_NUM; i++)
6653bcc9736cSJeff Kirsher init_waitqueue_head(&hw_priv->counter[i].counter);
6654bcc9736cSJeff Kirsher
6655bcc9736cSJeff Kirsher if (macaddr[0] != ':')
6656bcc9736cSJeff Kirsher get_mac_addr(hw_priv, macaddr, MAIN_PORT);
6657bcc9736cSJeff Kirsher
665803671057SMasahiro Yamada /* Read MAC address and initialize override address if not overridden. */
6659bcc9736cSJeff Kirsher hw_read_addr(hw);
6660bcc9736cSJeff Kirsher
6661bcc9736cSJeff Kirsher /* Multiple device interfaces mode requires a second MAC address. */
6662bcc9736cSJeff Kirsher if (hw->dev_count > 1) {
66636a3c910cSJoe Perches memcpy(sw->other_addr, hw->override_addr, ETH_ALEN);
6664bcc9736cSJeff Kirsher read_other_addr(hw);
6665bcc9736cSJeff Kirsher if (mac1addr[0] != ':')
6666bcc9736cSJeff Kirsher get_mac_addr(hw_priv, mac1addr, OTHER_PORT);
6667bcc9736cSJeff Kirsher }
6668bcc9736cSJeff Kirsher
6669bcc9736cSJeff Kirsher hw_setup(hw);
6670bcc9736cSJeff Kirsher if (hw->ksz_switch)
6671bcc9736cSJeff Kirsher sw_setup(hw);
6672bcc9736cSJeff Kirsher else {
6673bcc9736cSJeff Kirsher hw_priv->wol_support = WOL_SUPPORT;
6674bcc9736cSJeff Kirsher hw_priv->wol_enable = 0;
6675bcc9736cSJeff Kirsher }
6676bcc9736cSJeff Kirsher
6677bcc9736cSJeff Kirsher INIT_WORK(&hw_priv->mib_read, mib_read_work);
6678bcc9736cSJeff Kirsher
6679bcc9736cSJeff Kirsher /* 500 ms timeout */
6680bcc9736cSJeff Kirsher ksz_init_timer(&hw_priv->mib_timer_info, 500 * HZ / 1000,
668111dd894eSKees Cook mib_monitor);
6682bcc9736cSJeff Kirsher
6683bcc9736cSJeff Kirsher for (i = 0; i < hw->dev_count; i++) {
6684bcc9736cSJeff Kirsher dev = alloc_etherdev(sizeof(struct dev_priv));
6685bcc9736cSJeff Kirsher if (!dev)
6686bcc9736cSJeff Kirsher goto pcidev_init_reg_err;
66879dbccc30SMarkus Lottmann SET_NETDEV_DEV(dev, &pdev->dev);
6688bcc9736cSJeff Kirsher info->netdev[i] = dev;
6689bcc9736cSJeff Kirsher
6690bcc9736cSJeff Kirsher priv = netdev_priv(dev);
6691bcc9736cSJeff Kirsher priv->adapter = hw_priv;
6692bcc9736cSJeff Kirsher priv->id = net_device_present++;
6693bcc9736cSJeff Kirsher
6694bcc9736cSJeff Kirsher port = &priv->port;
6695bcc9736cSJeff Kirsher port->port_cnt = port_count;
6696bcc9736cSJeff Kirsher port->mib_port_cnt = mib_port_count;
6697bcc9736cSJeff Kirsher port->first_port = i;
6698bcc9736cSJeff Kirsher port->flow_ctrl = PHY_FLOW_CTRL;
6699bcc9736cSJeff Kirsher
6700bcc9736cSJeff Kirsher port->hw = hw;
6701bcc9736cSJeff Kirsher port->linked = &hw->port_info[port->first_port];
6702bcc9736cSJeff Kirsher
6703bcc9736cSJeff Kirsher for (cnt = 0, pi = i; cnt < port_count; cnt++, pi++) {
6704bcc9736cSJeff Kirsher hw->port_info[pi].port_id = pi;
6705bcc9736cSJeff Kirsher hw->port_info[pi].pdev = dev;
6706bcc9736cSJeff Kirsher hw->port_info[pi].state = media_disconnected;
6707bcc9736cSJeff Kirsher }
6708bcc9736cSJeff Kirsher
6709bcc9736cSJeff Kirsher dev->mem_start = (unsigned long) hw->io;
6710bcc9736cSJeff Kirsher dev->mem_end = dev->mem_start + reg_len - 1;
6711bcc9736cSJeff Kirsher dev->irq = pdev->irq;
6712bcc9736cSJeff Kirsher if (MAIN_PORT == i)
6713a96d317fSJakub Kicinski eth_hw_addr_set(dev, hw_priv->hw.override_addr);
6714bcc9736cSJeff Kirsher else {
67154abd7cffSJakub Kicinski u8 addr[ETH_ALEN];
67164abd7cffSJakub Kicinski
67174abd7cffSJakub Kicinski ether_addr_copy(addr, sw->other_addr);
67187ced5440Sdingtianhong if (ether_addr_equal(sw->other_addr, hw->override_addr))
67194abd7cffSJakub Kicinski addr[5] += port->first_port;
67204abd7cffSJakub Kicinski eth_hw_addr_set(dev, addr);
6721bcc9736cSJeff Kirsher }
6722bcc9736cSJeff Kirsher
6723bcc9736cSJeff Kirsher dev->netdev_ops = &netdev_ops;
67247ad24ea4SWilfried Klaebe dev->ethtool_ops = &netdev_ethtool_ops;
672544770e11SJarod Wilson
672644770e11SJarod Wilson /* MTU range: 60 - 1894 */
672744770e11SJarod Wilson dev->min_mtu = ETH_ZLEN;
672844770e11SJarod Wilson dev->max_mtu = MAX_RX_BUF_SIZE -
672944770e11SJarod Wilson (ETH_HLEN + ETH_FCS_LEN + VLAN_HLEN);
673044770e11SJarod Wilson
6731bcc9736cSJeff Kirsher if (register_netdev(dev))
6732bcc9736cSJeff Kirsher goto pcidev_init_reg_err;
6733bcc9736cSJeff Kirsher port_set_power_saving(port, true);
6734bcc9736cSJeff Kirsher }
6735bcc9736cSJeff Kirsher
6736bcc9736cSJeff Kirsher pci_dev_get(hw_priv->pdev);
6737bcc9736cSJeff Kirsher pci_set_drvdata(pdev, info);
6738bcc9736cSJeff Kirsher return 0;
6739bcc9736cSJeff Kirsher
6740bcc9736cSJeff Kirsher pcidev_init_reg_err:
6741bcc9736cSJeff Kirsher for (i = 0; i < hw->dev_count; i++) {
6742bcc9736cSJeff Kirsher if (info->netdev[i]) {
6743bcc9736cSJeff Kirsher netdev_free(info->netdev[i]);
6744bcc9736cSJeff Kirsher info->netdev[i] = NULL;
6745bcc9736cSJeff Kirsher }
6746bcc9736cSJeff Kirsher }
6747bcc9736cSJeff Kirsher
6748bcc9736cSJeff Kirsher pcidev_init_mem_err:
6749bcc9736cSJeff Kirsher ksz_free_mem(hw_priv);
6750bcc9736cSJeff Kirsher kfree(hw->ksz_switch);
6751bcc9736cSJeff Kirsher
6752bcc9736cSJeff Kirsher pcidev_init_alloc_err:
6753bcc9736cSJeff Kirsher iounmap(hw->io);
6754bcc9736cSJeff Kirsher
6755bcc9736cSJeff Kirsher pcidev_init_io_err:
6756bcc9736cSJeff Kirsher kfree(info);
6757bcc9736cSJeff Kirsher
6758bcc9736cSJeff Kirsher pcidev_init_dev_err:
6759bcc9736cSJeff Kirsher release_mem_region(reg_base, reg_len);
6760bcc9736cSJeff Kirsher
6761bcc9736cSJeff Kirsher return result;
6762bcc9736cSJeff Kirsher }
6763bcc9736cSJeff Kirsher
pcidev_exit(struct pci_dev * pdev)6764bcc9736cSJeff Kirsher static void pcidev_exit(struct pci_dev *pdev)
6765bcc9736cSJeff Kirsher {
6766bcc9736cSJeff Kirsher int i;
6767bcc9736cSJeff Kirsher struct platform_info *info = pci_get_drvdata(pdev);
6768bcc9736cSJeff Kirsher struct dev_info *hw_priv = &info->dev_info;
6769bcc9736cSJeff Kirsher
6770bcc9736cSJeff Kirsher release_mem_region(pci_resource_start(pdev, 0),
6771bcc9736cSJeff Kirsher pci_resource_len(pdev, 0));
6772bcc9736cSJeff Kirsher for (i = 0; i < hw_priv->hw.dev_count; i++) {
6773bcc9736cSJeff Kirsher if (info->netdev[i])
6774bcc9736cSJeff Kirsher netdev_free(info->netdev[i]);
6775bcc9736cSJeff Kirsher }
6776bcc9736cSJeff Kirsher if (hw_priv->hw.io)
6777bcc9736cSJeff Kirsher iounmap(hw_priv->hw.io);
6778bcc9736cSJeff Kirsher ksz_free_mem(hw_priv);
6779bcc9736cSJeff Kirsher kfree(hw_priv->hw.ksz_switch);
6780bcc9736cSJeff Kirsher pci_dev_put(hw_priv->pdev);
6781bcc9736cSJeff Kirsher kfree(info);
6782bcc9736cSJeff Kirsher }
6783bcc9736cSJeff Kirsher
pcidev_resume(struct device * dev_d)678464120615SVaibhav Gupta static int __maybe_unused pcidev_resume(struct device *dev_d)
6785bcc9736cSJeff Kirsher {
6786bcc9736cSJeff Kirsher int i;
678764120615SVaibhav Gupta struct platform_info *info = dev_get_drvdata(dev_d);
6788bcc9736cSJeff Kirsher struct dev_info *hw_priv = &info->dev_info;
6789bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
6790bcc9736cSJeff Kirsher
679164120615SVaibhav Gupta device_wakeup_disable(dev_d);
6792bcc9736cSJeff Kirsher
6793bcc9736cSJeff Kirsher if (hw_priv->wol_enable)
6794bcc9736cSJeff Kirsher hw_cfg_wol_pme(hw, 0);
6795bcc9736cSJeff Kirsher for (i = 0; i < hw->dev_count; i++) {
6796bcc9736cSJeff Kirsher if (info->netdev[i]) {
6797bcc9736cSJeff Kirsher struct net_device *dev = info->netdev[i];
6798bcc9736cSJeff Kirsher
6799bcc9736cSJeff Kirsher if (netif_running(dev)) {
6800bcc9736cSJeff Kirsher netdev_open(dev);
6801bcc9736cSJeff Kirsher netif_device_attach(dev);
6802bcc9736cSJeff Kirsher }
6803bcc9736cSJeff Kirsher }
6804bcc9736cSJeff Kirsher }
6805bcc9736cSJeff Kirsher return 0;
6806bcc9736cSJeff Kirsher }
6807bcc9736cSJeff Kirsher
pcidev_suspend(struct device * dev_d)6808ffa76e38SWei Yongjun static int __maybe_unused pcidev_suspend(struct device *dev_d)
6809bcc9736cSJeff Kirsher {
6810bcc9736cSJeff Kirsher int i;
681164120615SVaibhav Gupta struct platform_info *info = dev_get_drvdata(dev_d);
6812bcc9736cSJeff Kirsher struct dev_info *hw_priv = &info->dev_info;
6813bcc9736cSJeff Kirsher struct ksz_hw *hw = &hw_priv->hw;
6814bcc9736cSJeff Kirsher
6815bcc9736cSJeff Kirsher /* Need to find a way to retrieve the device IP address. */
6816bcc9736cSJeff Kirsher static const u8 net_addr[] = { 192, 168, 1, 1 };
6817bcc9736cSJeff Kirsher
6818bcc9736cSJeff Kirsher for (i = 0; i < hw->dev_count; i++) {
6819bcc9736cSJeff Kirsher if (info->netdev[i]) {
6820bcc9736cSJeff Kirsher struct net_device *dev = info->netdev[i];
6821bcc9736cSJeff Kirsher
6822bcc9736cSJeff Kirsher if (netif_running(dev)) {
6823bcc9736cSJeff Kirsher netif_device_detach(dev);
6824bcc9736cSJeff Kirsher netdev_close(dev);
6825bcc9736cSJeff Kirsher }
6826bcc9736cSJeff Kirsher }
6827bcc9736cSJeff Kirsher }
6828bcc9736cSJeff Kirsher if (hw_priv->wol_enable) {
6829bcc9736cSJeff Kirsher hw_enable_wol(hw, hw_priv->wol_enable, net_addr);
6830bcc9736cSJeff Kirsher hw_cfg_wol_pme(hw, 1);
6831bcc9736cSJeff Kirsher }
6832bcc9736cSJeff Kirsher
683364120615SVaibhav Gupta device_wakeup_enable(dev_d);
6834bcc9736cSJeff Kirsher return 0;
6835bcc9736cSJeff Kirsher }
6836bcc9736cSJeff Kirsher
6837bcc9736cSJeff Kirsher static char pcidev_name[] = "ksz884xp";
6838bcc9736cSJeff Kirsher
68399baa3c34SBenoit Taine static const struct pci_device_id pcidev_table[] = {
6840bcc9736cSJeff Kirsher { PCI_VENDOR_ID_MICREL_KS, 0x8841,
6841bcc9736cSJeff Kirsher PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
6842bcc9736cSJeff Kirsher { PCI_VENDOR_ID_MICREL_KS, 0x8842,
6843bcc9736cSJeff Kirsher PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
6844bcc9736cSJeff Kirsher { 0 }
6845bcc9736cSJeff Kirsher };
6846bcc9736cSJeff Kirsher
6847bcc9736cSJeff Kirsher MODULE_DEVICE_TABLE(pci, pcidev_table);
6848bcc9736cSJeff Kirsher
684964120615SVaibhav Gupta static SIMPLE_DEV_PM_OPS(pcidev_pm_ops, pcidev_suspend, pcidev_resume);
685064120615SVaibhav Gupta
6851bcc9736cSJeff Kirsher static struct pci_driver pci_device_driver = {
685264120615SVaibhav Gupta .driver.pm = &pcidev_pm_ops,
6853bcc9736cSJeff Kirsher .name = pcidev_name,
6854bcc9736cSJeff Kirsher .id_table = pcidev_table,
6855bcc9736cSJeff Kirsher .probe = pcidev_init,
6856bcc9736cSJeff Kirsher .remove = pcidev_exit
6857bcc9736cSJeff Kirsher };
6858bcc9736cSJeff Kirsher
685985894866SWei Yongjun module_pci_driver(pci_device_driver);
6860bcc9736cSJeff Kirsher
6861bcc9736cSJeff Kirsher MODULE_DESCRIPTION("KSZ8841/2 PCI network driver");
6862bcc9736cSJeff Kirsher MODULE_AUTHOR("Tristram Ha <Tristram.Ha@micrel.com>");
6863bcc9736cSJeff Kirsher MODULE_LICENSE("GPL");
6864bcc9736cSJeff Kirsher
6865bcc9736cSJeff Kirsher module_param_named(message, msg_enable, int, 0);
6866bcc9736cSJeff Kirsher MODULE_PARM_DESC(message, "Message verbosity level (0=none, 31=all)");
6867bcc9736cSJeff Kirsher
6868bcc9736cSJeff Kirsher module_param(macaddr, charp, 0);
6869bcc9736cSJeff Kirsher module_param(mac1addr, charp, 0);
6870bcc9736cSJeff Kirsher module_param(fast_aging, int, 0);
6871bcc9736cSJeff Kirsher module_param(multi_dev, int, 0);
6872bcc9736cSJeff Kirsher module_param(stp, int, 0);
6873bcc9736cSJeff Kirsher MODULE_PARM_DESC(macaddr, "MAC address");
6874bcc9736cSJeff Kirsher MODULE_PARM_DESC(mac1addr, "Second MAC address");
6875bcc9736cSJeff Kirsher MODULE_PARM_DESC(fast_aging, "Fast aging");
6876bcc9736cSJeff Kirsher MODULE_PARM_DESC(multi_dev, "Multiple device interfaces");
6877bcc9736cSJeff Kirsher MODULE_PARM_DESC(stp, "STP support");
6878