1
2
3
4
5
6
7
8
9#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
10
11#include <linux/init.h>
12#include <linux/interrupt.h>
13#include <linux/kernel.h>
14#include <linux/module.h>
15#include <linux/ioport.h>
16#include <linux/pci.h>
17#include <linux/proc_fs.h>
18#include <linux/mii.h>
19#include <linux/platform_device.h>
20#include <linux/ethtool.h>
21#include <linux/etherdevice.h>
22#include <linux/in.h>
23#include <linux/ip.h>
24#include <linux/if_vlan.h>
25#include <linux/crc32.h>
26#include <linux/sched.h>
27#include <linux/slab.h>
28#include <linux/micrel_phy.h>
29
30
31
32
33#define KS_DMA_TX_CTRL 0x0000
34#define DMA_TX_ENABLE 0x00000001
35#define DMA_TX_CRC_ENABLE 0x00000002
36#define DMA_TX_PAD_ENABLE 0x00000004
37#define DMA_TX_LOOPBACK 0x00000100
38#define DMA_TX_FLOW_ENABLE 0x00000200
39#define DMA_TX_CSUM_IP 0x00010000
40#define DMA_TX_CSUM_TCP 0x00020000
41#define DMA_TX_CSUM_UDP 0x00040000
42#define DMA_TX_BURST_SIZE 0x3F000000
43
44#define KS_DMA_RX_CTRL 0x0004
45#define DMA_RX_ENABLE 0x00000001
46#define KS884X_DMA_RX_MULTICAST 0x00000002
47#define DMA_RX_PROMISCUOUS 0x00000004
48#define DMA_RX_ERROR 0x00000008
49#define DMA_RX_UNICAST 0x00000010
50#define DMA_RX_ALL_MULTICAST 0x00000020
51#define DMA_RX_BROADCAST 0x00000040
52#define DMA_RX_FLOW_ENABLE 0x00000200
53#define DMA_RX_CSUM_IP 0x00010000
54#define DMA_RX_CSUM_TCP 0x00020000
55#define DMA_RX_CSUM_UDP 0x00040000
56#define DMA_RX_BURST_SIZE 0x3F000000
57
58#define DMA_BURST_SHIFT 24
59#define DMA_BURST_DEFAULT 8
60
61#define KS_DMA_TX_START 0x0008
62#define KS_DMA_RX_START 0x000C
63#define DMA_START 0x00000001
64
65#define KS_DMA_TX_ADDR 0x0010
66#define KS_DMA_RX_ADDR 0x0014
67
68#define DMA_ADDR_LIST_MASK 0xFFFFFFFC
69#define DMA_ADDR_LIST_SHIFT 2
70
71
72#define KS884X_MULTICAST_0_OFFSET 0x0020
73#define KS884X_MULTICAST_1_OFFSET 0x0021
74#define KS884X_MULTICAST_2_OFFSET 0x0022
75#define KS884x_MULTICAST_3_OFFSET 0x0023
76
77#define KS884X_MULTICAST_4_OFFSET 0x0024
78#define KS884X_MULTICAST_5_OFFSET 0x0025
79#define KS884X_MULTICAST_6_OFFSET 0x0026
80#define KS884X_MULTICAST_7_OFFSET 0x0027
81
82
83
84
85#define KS884X_INTERRUPTS_ENABLE 0x0028
86
87#define KS884X_INTERRUPTS_STATUS 0x002C
88
89#define KS884X_INT_RX_STOPPED 0x02000000
90#define KS884X_INT_TX_STOPPED 0x04000000
91#define KS884X_INT_RX_OVERRUN 0x08000000
92#define KS884X_INT_TX_EMPTY 0x10000000
93#define KS884X_INT_RX 0x20000000
94#define KS884X_INT_TX 0x40000000
95#define KS884X_INT_PHY 0x80000000
96
97#define KS884X_INT_RX_MASK \
98 (KS884X_INT_RX | KS884X_INT_RX_OVERRUN)
99#define KS884X_INT_TX_MASK \
100 (KS884X_INT_TX | KS884X_INT_TX_EMPTY)
101#define KS884X_INT_MASK (KS884X_INT_RX | KS884X_INT_TX | KS884X_INT_PHY)
102
103
104
105
106#define KS_ADD_ADDR_0_LO 0x0080
107
108#define KS_ADD_ADDR_0_HI 0x0084
109
110#define KS_ADD_ADDR_1_LO 0x0088
111
112#define KS_ADD_ADDR_1_HI 0x008C
113
114#define KS_ADD_ADDR_2_LO 0x0090
115
116#define KS_ADD_ADDR_2_HI 0x0094
117
118#define KS_ADD_ADDR_3_LO 0x0098
119
120#define KS_ADD_ADDR_3_HI 0x009C
121
122#define KS_ADD_ADDR_4_LO 0x00A0
123
124#define KS_ADD_ADDR_4_HI 0x00A4
125
126#define KS_ADD_ADDR_5_LO 0x00A8
127
128#define KS_ADD_ADDR_5_HI 0x00AC
129
130#define KS_ADD_ADDR_6_LO 0x00B0
131
132#define KS_ADD_ADDR_6_HI 0x00B4
133
134#define KS_ADD_ADDR_7_LO 0x00B8
135
136#define KS_ADD_ADDR_7_HI 0x00BC
137
138#define KS_ADD_ADDR_8_LO 0x00C0
139
140#define KS_ADD_ADDR_8_HI 0x00C4
141
142#define KS_ADD_ADDR_9_LO 0x00C8
143
144#define KS_ADD_ADDR_9_HI 0x00CC
145
146#define KS_ADD_ADDR_A_LO 0x00D0
147
148#define KS_ADD_ADDR_A_HI 0x00D4
149
150#define KS_ADD_ADDR_B_LO 0x00D8
151
152#define KS_ADD_ADDR_B_HI 0x00DC
153
154#define KS_ADD_ADDR_C_LO 0x00E0
155
156#define KS_ADD_ADDR_C_HI 0x00E4
157
158#define KS_ADD_ADDR_D_LO 0x00E8
159
160#define KS_ADD_ADDR_D_HI 0x00EC
161
162#define KS_ADD_ADDR_E_LO 0x00F0
163
164#define KS_ADD_ADDR_E_HI 0x00F4
165
166#define KS_ADD_ADDR_F_LO 0x00F8
167
168#define KS_ADD_ADDR_F_HI 0x00FC
169
170#define ADD_ADDR_HI_MASK 0x0000FFFF
171#define ADD_ADDR_ENABLE 0x80000000
172#define ADD_ADDR_INCR 8
173
174
175
176
177#define KS884X_ADDR_0_OFFSET 0x0200
178#define KS884X_ADDR_1_OFFSET 0x0201
179
180#define KS884X_ADDR_2_OFFSET 0x0202
181#define KS884X_ADDR_3_OFFSET 0x0203
182
183#define KS884X_ADDR_4_OFFSET 0x0204
184#define KS884X_ADDR_5_OFFSET 0x0205
185
186
187#define KS884X_BUS_CTRL_OFFSET 0x0210
188
189#define BUS_SPEED_125_MHZ 0x0000
190#define BUS_SPEED_62_5_MHZ 0x0001
191#define BUS_SPEED_41_66_MHZ 0x0002
192#define BUS_SPEED_25_MHZ 0x0003
193
194
195#define KS884X_EEPROM_CTRL_OFFSET 0x0212
196
197#define EEPROM_CHIP_SELECT 0x0001
198#define EEPROM_SERIAL_CLOCK 0x0002
199#define EEPROM_DATA_OUT 0x0004
200#define EEPROM_DATA_IN 0x0008
201#define EEPROM_ACCESS_ENABLE 0x0010
202
203
204#define KS884X_MEM_INFO_OFFSET 0x0214
205
206#define RX_MEM_TEST_FAILED 0x0008
207#define RX_MEM_TEST_FINISHED 0x0010
208#define TX_MEM_TEST_FAILED 0x0800
209#define TX_MEM_TEST_FINISHED 0x1000
210
211
212#define KS884X_GLOBAL_CTRL_OFFSET 0x0216
213#define GLOBAL_SOFTWARE_RESET 0x0001
214
215#define KS8841_POWER_MANAGE_OFFSET 0x0218
216
217
218#define KS8841_WOL_CTRL_OFFSET 0x021A
219#define KS8841_WOL_MAGIC_ENABLE 0x0080
220#define KS8841_WOL_FRAME3_ENABLE 0x0008
221#define KS8841_WOL_FRAME2_ENABLE 0x0004
222#define KS8841_WOL_FRAME1_ENABLE 0x0002
223#define KS8841_WOL_FRAME0_ENABLE 0x0001
224
225
226#define KS8841_WOL_FRAME_CRC_OFFSET 0x0220
227#define KS8841_WOL_FRAME_BYTE0_OFFSET 0x0224
228#define KS8841_WOL_FRAME_BYTE2_OFFSET 0x0228
229
230
231#define KS884X_IACR_P 0x04A0
232#define KS884X_IACR_OFFSET KS884X_IACR_P
233
234
235#define KS884X_IADR1_P 0x04A2
236#define KS884X_IADR2_P 0x04A4
237#define KS884X_IADR3_P 0x04A6
238#define KS884X_IADR4_P 0x04A8
239#define KS884X_IADR5_P 0x04AA
240
241#define KS884X_ACC_CTRL_SEL_OFFSET KS884X_IACR_P
242#define KS884X_ACC_CTRL_INDEX_OFFSET (KS884X_ACC_CTRL_SEL_OFFSET + 1)
243
244#define KS884X_ACC_DATA_0_OFFSET KS884X_IADR4_P
245#define KS884X_ACC_DATA_1_OFFSET (KS884X_ACC_DATA_0_OFFSET + 1)
246#define KS884X_ACC_DATA_2_OFFSET KS884X_IADR5_P
247#define KS884X_ACC_DATA_3_OFFSET (KS884X_ACC_DATA_2_OFFSET + 1)
248#define KS884X_ACC_DATA_4_OFFSET KS884X_IADR2_P
249#define KS884X_ACC_DATA_5_OFFSET (KS884X_ACC_DATA_4_OFFSET + 1)
250#define KS884X_ACC_DATA_6_OFFSET KS884X_IADR3_P
251#define KS884X_ACC_DATA_7_OFFSET (KS884X_ACC_DATA_6_OFFSET + 1)
252#define KS884X_ACC_DATA_8_OFFSET KS884X_IADR1_P
253
254
255#define KS884X_P1MBCR_P 0x04D0
256#define KS884X_P1MBSR_P 0x04D2
257#define KS884X_PHY1ILR_P 0x04D4
258#define KS884X_PHY1IHR_P 0x04D6
259#define KS884X_P1ANAR_P 0x04D8
260#define KS884X_P1ANLPR_P 0x04DA
261
262
263#define KS884X_P2MBCR_P 0x04E0
264#define KS884X_P2MBSR_P 0x04E2
265#define KS884X_PHY2ILR_P 0x04E4
266#define KS884X_PHY2IHR_P 0x04E6
267#define KS884X_P2ANAR_P 0x04E8
268#define KS884X_P2ANLPR_P 0x04EA
269
270#define KS884X_PHY_1_CTRL_OFFSET KS884X_P1MBCR_P
271#define PHY_CTRL_INTERVAL (KS884X_P2MBCR_P - KS884X_P1MBCR_P)
272
273#define KS884X_PHY_CTRL_OFFSET 0x00
274
275#define KS884X_PHY_STATUS_OFFSET 0x02
276
277#define KS884X_PHY_ID_1_OFFSET 0x04
278#define KS884X_PHY_ID_2_OFFSET 0x06
279
280#define KS884X_PHY_AUTO_NEG_OFFSET 0x08
281
282#define KS884X_PHY_REMOTE_CAP_OFFSET 0x0A
283
284
285#define KS884X_P1VCT_P 0x04F0
286#define KS884X_P1PHYCTRL_P 0x04F2
287
288
289#define KS884X_P2VCT_P 0x04F4
290#define KS884X_P2PHYCTRL_P 0x04F6
291
292#define KS884X_PHY_SPECIAL_OFFSET KS884X_P1VCT_P
293#define PHY_SPECIAL_INTERVAL (KS884X_P2VCT_P - KS884X_P1VCT_P)
294
295#define KS884X_PHY_LINK_MD_OFFSET 0x00
296
297#define PHY_START_CABLE_DIAG 0x8000
298#define PHY_CABLE_DIAG_RESULT 0x6000
299#define PHY_CABLE_STAT_NORMAL 0x0000
300#define PHY_CABLE_STAT_OPEN 0x2000
301#define PHY_CABLE_STAT_SHORT 0x4000
302#define PHY_CABLE_STAT_FAILED 0x6000
303#define PHY_CABLE_10M_SHORT 0x1000
304#define PHY_CABLE_FAULT_COUNTER 0x01FF
305
306#define KS884X_PHY_PHY_CTRL_OFFSET 0x02
307
308#define PHY_STAT_REVERSED_POLARITY 0x0020
309#define PHY_STAT_MDIX 0x0010
310#define PHY_FORCE_LINK 0x0008
311#define PHY_POWER_SAVING_DISABLE 0x0004
312#define PHY_REMOTE_LOOPBACK 0x0002
313
314
315#define KS884X_SIDER_P 0x0400
316#define KS884X_CHIP_ID_OFFSET KS884X_SIDER_P
317#define KS884X_FAMILY_ID_OFFSET (KS884X_CHIP_ID_OFFSET + 1)
318
319#define REG_FAMILY_ID 0x88
320
321#define REG_CHIP_ID_41 0x8810
322#define REG_CHIP_ID_42 0x8800
323
324#define KS884X_CHIP_ID_MASK_41 0xFF10
325#define KS884X_CHIP_ID_MASK 0xFFF0
326#define KS884X_CHIP_ID_SHIFT 4
327#define KS884X_REVISION_MASK 0x000E
328#define KS884X_REVISION_SHIFT 1
329#define KS8842_START 0x0001
330
331#define CHIP_IP_41_M 0x8810
332#define CHIP_IP_42_M 0x8800
333#define CHIP_IP_61_M 0x8890
334#define CHIP_IP_62_M 0x8880
335
336#define CHIP_IP_41_P 0x8850
337#define CHIP_IP_42_P 0x8840
338#define CHIP_IP_61_P 0x88D0
339#define CHIP_IP_62_P 0x88C0
340
341
342#define KS8842_SGCR1_P 0x0402
343#define KS8842_SWITCH_CTRL_1_OFFSET KS8842_SGCR1_P
344
345#define SWITCH_PASS_ALL 0x8000
346#define SWITCH_TX_FLOW_CTRL 0x2000
347#define SWITCH_RX_FLOW_CTRL 0x1000
348#define SWITCH_CHECK_LENGTH 0x0800
349#define SWITCH_AGING_ENABLE 0x0400
350#define SWITCH_FAST_AGING 0x0200
351#define SWITCH_AGGR_BACKOFF 0x0100
352#define SWITCH_PASS_PAUSE 0x0008
353#define SWITCH_LINK_AUTO_AGING 0x0001
354
355
356#define KS8842_SGCR2_P 0x0404
357#define KS8842_SWITCH_CTRL_2_OFFSET KS8842_SGCR2_P
358
359#define SWITCH_VLAN_ENABLE 0x8000
360#define SWITCH_IGMP_SNOOP 0x4000
361#define IPV6_MLD_SNOOP_ENABLE 0x2000
362#define IPV6_MLD_SNOOP_OPTION 0x1000
363#define PRIORITY_SCHEME_SELECT 0x0800
364#define SWITCH_MIRROR_RX_TX 0x0100
365#define UNICAST_VLAN_BOUNDARY 0x0080
366#define MULTICAST_STORM_DISABLE 0x0040
367#define SWITCH_BACK_PRESSURE 0x0020
368#define FAIR_FLOW_CTRL 0x0010
369#define NO_EXC_COLLISION_DROP 0x0008
370#define SWITCH_HUGE_PACKET 0x0004
371#define SWITCH_LEGAL_PACKET 0x0002
372#define SWITCH_BUF_RESERVE 0x0001
373
374
375#define KS8842_SGCR3_P 0x0406
376#define KS8842_SWITCH_CTRL_3_OFFSET KS8842_SGCR3_P
377
378#define BROADCAST_STORM_RATE_LO 0xFF00
379#define SWITCH_REPEATER 0x0080
380#define SWITCH_HALF_DUPLEX 0x0040
381#define SWITCH_FLOW_CTRL 0x0020
382#define SWITCH_10_MBIT 0x0010
383#define SWITCH_REPLACE_NULL_VID 0x0008
384#define BROADCAST_STORM_RATE_HI 0x0007
385
386#define BROADCAST_STORM_RATE 0x07FF
387
388
389#define KS8842_SGCR4_P 0x0408
390
391
392#define KS8842_SGCR5_P 0x040A
393#define KS8842_SWITCH_CTRL_5_OFFSET KS8842_SGCR5_P
394
395#define LED_MODE 0x8200
396#define LED_SPEED_DUPLEX_ACT 0x0000
397#define LED_SPEED_DUPLEX_LINK_ACT 0x8000
398#define LED_DUPLEX_10_100 0x0200
399
400
401#define KS8842_SGCR6_P 0x0410
402#define KS8842_SWITCH_CTRL_6_OFFSET KS8842_SGCR6_P
403
404#define KS8842_PRIORITY_MASK 3
405#define KS8842_PRIORITY_SHIFT 2
406
407
408#define KS8842_SGCR7_P 0x0412
409#define KS8842_SWITCH_CTRL_7_OFFSET KS8842_SGCR7_P
410
411#define SWITCH_UNK_DEF_PORT_ENABLE 0x0008
412#define SWITCH_UNK_DEF_PORT_3 0x0004
413#define SWITCH_UNK_DEF_PORT_2 0x0002
414#define SWITCH_UNK_DEF_PORT_1 0x0001
415
416
417#define KS8842_MACAR1_P 0x0470
418#define KS8842_MACAR2_P 0x0472
419#define KS8842_MACAR3_P 0x0474
420#define KS8842_MAC_ADDR_1_OFFSET KS8842_MACAR1_P
421#define KS8842_MAC_ADDR_0_OFFSET (KS8842_MAC_ADDR_1_OFFSET + 1)
422#define KS8842_MAC_ADDR_3_OFFSET KS8842_MACAR2_P
423#define KS8842_MAC_ADDR_2_OFFSET (KS8842_MAC_ADDR_3_OFFSET + 1)
424#define KS8842_MAC_ADDR_5_OFFSET KS8842_MACAR3_P
425#define KS8842_MAC_ADDR_4_OFFSET (KS8842_MAC_ADDR_5_OFFSET + 1)
426
427
428#define KS8842_TOSR1_P 0x0480
429#define KS8842_TOSR2_P 0x0482
430#define KS8842_TOSR3_P 0x0484
431#define KS8842_TOSR4_P 0x0486
432#define KS8842_TOSR5_P 0x0488
433#define KS8842_TOSR6_P 0x048A
434#define KS8842_TOSR7_P 0x0490
435#define KS8842_TOSR8_P 0x0492
436#define KS8842_TOS_1_OFFSET KS8842_TOSR1_P
437#define KS8842_TOS_2_OFFSET KS8842_TOSR2_P
438#define KS8842_TOS_3_OFFSET KS8842_TOSR3_P
439#define KS8842_TOS_4_OFFSET KS8842_TOSR4_P
440#define KS8842_TOS_5_OFFSET KS8842_TOSR5_P
441#define KS8842_TOS_6_OFFSET KS8842_TOSR6_P
442
443#define KS8842_TOS_7_OFFSET KS8842_TOSR7_P
444#define KS8842_TOS_8_OFFSET KS8842_TOSR8_P
445
446
447#define KS8842_P1CR1_P 0x0500
448#define KS8842_P1CR2_P 0x0502
449#define KS8842_P1VIDR_P 0x0504
450#define KS8842_P1CR3_P 0x0506
451#define KS8842_P1IRCR_P 0x0508
452#define KS8842_P1ERCR_P 0x050A
453#define KS884X_P1SCSLMD_P 0x0510
454#define KS884X_P1CR4_P 0x0512
455#define KS884X_P1SR_P 0x0514
456
457
458#define KS8842_P2CR1_P 0x0520
459#define KS8842_P2CR2_P 0x0522
460#define KS8842_P2VIDR_P 0x0524
461#define KS8842_P2CR3_P 0x0526
462#define KS8842_P2IRCR_P 0x0528
463#define KS8842_P2ERCR_P 0x052A
464#define KS884X_P2SCSLMD_P 0x0530
465#define KS884X_P2CR4_P 0x0532
466#define KS884X_P2SR_P 0x0534
467
468
469#define KS8842_P3CR1_P 0x0540
470#define KS8842_P3CR2_P 0x0542
471#define KS8842_P3VIDR_P 0x0544
472#define KS8842_P3CR3_P 0x0546
473#define KS8842_P3IRCR_P 0x0548
474#define KS8842_P3ERCR_P 0x054A
475
476#define KS8842_PORT_1_CTRL_1 KS8842_P1CR1_P
477#define KS8842_PORT_2_CTRL_1 KS8842_P2CR1_P
478#define KS8842_PORT_3_CTRL_1 KS8842_P3CR1_P
479
480#define PORT_CTRL_ADDR(port, addr) \
481 (addr = KS8842_PORT_1_CTRL_1 + (port) * \
482 (KS8842_PORT_2_CTRL_1 - KS8842_PORT_1_CTRL_1))
483
484#define KS8842_PORT_CTRL_1_OFFSET 0x00
485
486#define PORT_BROADCAST_STORM 0x0080
487#define PORT_DIFFSERV_ENABLE 0x0040
488#define PORT_802_1P_ENABLE 0x0020
489#define PORT_BASED_PRIORITY_MASK 0x0018
490#define PORT_BASED_PRIORITY_BASE 0x0003
491#define PORT_BASED_PRIORITY_SHIFT 3
492#define PORT_BASED_PRIORITY_0 0x0000
493#define PORT_BASED_PRIORITY_1 0x0008
494#define PORT_BASED_PRIORITY_2 0x0010
495#define PORT_BASED_PRIORITY_3 0x0018
496#define PORT_INSERT_TAG 0x0004
497#define PORT_REMOVE_TAG 0x0002
498#define PORT_PRIO_QUEUE_ENABLE 0x0001
499
500#define KS8842_PORT_CTRL_2_OFFSET 0x02
501
502#define PORT_INGRESS_VLAN_FILTER 0x4000
503#define PORT_DISCARD_NON_VID 0x2000
504#define PORT_FORCE_FLOW_CTRL 0x1000
505#define PORT_BACK_PRESSURE 0x0800
506#define PORT_TX_ENABLE 0x0400
507#define PORT_RX_ENABLE 0x0200
508#define PORT_LEARN_DISABLE 0x0100
509#define PORT_MIRROR_SNIFFER 0x0080
510#define PORT_MIRROR_RX 0x0040
511#define PORT_MIRROR_TX 0x0020
512#define PORT_USER_PRIORITY_CEILING 0x0008
513#define PORT_VLAN_MEMBERSHIP 0x0007
514
515#define KS8842_PORT_CTRL_VID_OFFSET 0x04
516
517#define PORT_DEFAULT_VID 0x0001
518
519#define KS8842_PORT_CTRL_3_OFFSET 0x06
520
521#define PORT_INGRESS_LIMIT_MODE 0x000C
522#define PORT_INGRESS_ALL 0x0000
523#define PORT_INGRESS_UNICAST 0x0004
524#define PORT_INGRESS_MULTICAST 0x0008
525#define PORT_INGRESS_BROADCAST 0x000C
526#define PORT_COUNT_IFG 0x0002
527#define PORT_COUNT_PREAMBLE 0x0001
528
529#define KS8842_PORT_IN_RATE_OFFSET 0x08
530#define KS8842_PORT_OUT_RATE_OFFSET 0x0A
531
532#define PORT_PRIORITY_RATE 0x0F
533#define PORT_PRIORITY_RATE_SHIFT 4
534
535#define KS884X_PORT_LINK_MD 0x10
536
537#define PORT_CABLE_10M_SHORT 0x8000
538#define PORT_CABLE_DIAG_RESULT 0x6000
539#define PORT_CABLE_STAT_NORMAL 0x0000
540#define PORT_CABLE_STAT_OPEN 0x2000
541#define PORT_CABLE_STAT_SHORT 0x4000
542#define PORT_CABLE_STAT_FAILED 0x6000
543#define PORT_START_CABLE_DIAG 0x1000
544#define PORT_FORCE_LINK 0x0800
545#define PORT_POWER_SAVING_DISABLE 0x0400
546#define PORT_PHY_REMOTE_LOOPBACK 0x0200
547#define PORT_CABLE_FAULT_COUNTER 0x01FF
548
549#define KS884X_PORT_CTRL_4_OFFSET 0x12
550
551#define PORT_LED_OFF 0x8000
552#define PORT_TX_DISABLE 0x4000
553#define PORT_AUTO_NEG_RESTART 0x2000
554#define PORT_REMOTE_FAULT_DISABLE 0x1000
555#define PORT_POWER_DOWN 0x0800
556#define PORT_AUTO_MDIX_DISABLE 0x0400
557#define PORT_FORCE_MDIX 0x0200
558#define PORT_LOOPBACK 0x0100
559#define PORT_AUTO_NEG_ENABLE 0x0080
560#define PORT_FORCE_100_MBIT 0x0040
561#define PORT_FORCE_FULL_DUPLEX 0x0020
562#define PORT_AUTO_NEG_SYM_PAUSE 0x0010
563#define PORT_AUTO_NEG_100BTX_FD 0x0008
564#define PORT_AUTO_NEG_100BTX 0x0004
565#define PORT_AUTO_NEG_10BT_FD 0x0002
566#define PORT_AUTO_NEG_10BT 0x0001
567
568#define KS884X_PORT_STATUS_OFFSET 0x14
569
570#define PORT_HP_MDIX 0x8000
571#define PORT_REVERSED_POLARITY 0x2000
572#define PORT_RX_FLOW_CTRL 0x0800
573#define PORT_TX_FLOW_CTRL 0x1000
574#define PORT_STATUS_SPEED_100MBIT 0x0400
575#define PORT_STATUS_FULL_DUPLEX 0x0200
576#define PORT_REMOTE_FAULT 0x0100
577#define PORT_MDIX_STATUS 0x0080
578#define PORT_AUTO_NEG_COMPLETE 0x0040
579#define PORT_STATUS_LINK_GOOD 0x0020
580#define PORT_REMOTE_SYM_PAUSE 0x0010
581#define PORT_REMOTE_100BTX_FD 0x0008
582#define PORT_REMOTE_100BTX 0x0004
583#define PORT_REMOTE_10BT_FD 0x0002
584#define PORT_REMOTE_10BT 0x0001
585
586
587
588
589
590
591
592
593
594
595#define STATIC_MAC_TABLE_ADDR 0x0000FFFF
596#define STATIC_MAC_TABLE_FWD_PORTS 0x00070000
597#define STATIC_MAC_TABLE_VALID 0x00080000
598#define STATIC_MAC_TABLE_OVERRIDE 0x00100000
599#define STATIC_MAC_TABLE_USE_FID 0x00200000
600#define STATIC_MAC_TABLE_FID 0x03C00000
601
602#define STATIC_MAC_FWD_PORTS_SHIFT 16
603#define STATIC_MAC_FID_SHIFT 22
604
605
606
607
608
609
610
611
612#define VLAN_TABLE_VID 0x00000FFF
613#define VLAN_TABLE_FID 0x0000F000
614#define VLAN_TABLE_MEMBERSHIP 0x00070000
615#define VLAN_TABLE_VALID 0x00080000
616
617#define VLAN_TABLE_FID_SHIFT 12
618#define VLAN_TABLE_MEMBERSHIP_SHIFT 16
619
620
621
622
623
624
625
626
627
628
629
630
631#define DYNAMIC_MAC_TABLE_ADDR 0x0000FFFF
632#define DYNAMIC_MAC_TABLE_FID 0x000F0000
633#define DYNAMIC_MAC_TABLE_SRC_PORT 0x00300000
634#define DYNAMIC_MAC_TABLE_TIMESTAMP 0x00C00000
635#define DYNAMIC_MAC_TABLE_ENTRIES 0xFF000000
636
637#define DYNAMIC_MAC_TABLE_ENTRIES_H 0x03
638#define DYNAMIC_MAC_TABLE_MAC_EMPTY 0x04
639#define DYNAMIC_MAC_TABLE_RESERVED 0x78
640#define DYNAMIC_MAC_TABLE_NOT_READY 0x80
641
642#define DYNAMIC_MAC_FID_SHIFT 16
643#define DYNAMIC_MAC_SRC_PORT_SHIFT 20
644#define DYNAMIC_MAC_TIMESTAMP_SHIFT 22
645#define DYNAMIC_MAC_ENTRIES_SHIFT 24
646#define DYNAMIC_MAC_ENTRIES_H_SHIFT 8
647
648
649
650
651
652
653
654#define MIB_COUNTER_VALUE 0x3FFFFFFF
655#define MIB_COUNTER_VALID 0x40000000
656#define MIB_COUNTER_OVERFLOW 0x80000000
657
658#define MIB_PACKET_DROPPED 0x0000FFFF
659
660#define KS_MIB_PACKET_DROPPED_TX_0 0x100
661#define KS_MIB_PACKET_DROPPED_TX_1 0x101
662#define KS_MIB_PACKET_DROPPED_TX 0x102
663#define KS_MIB_PACKET_DROPPED_RX_0 0x103
664#define KS_MIB_PACKET_DROPPED_RX_1 0x104
665#define KS_MIB_PACKET_DROPPED_RX 0x105
666
667
668#define SET_DEFAULT_LED LED_SPEED_DUPLEX_ACT
669
670#define MAC_ADDR_ORDER(i) (ETH_ALEN - 1 - (i))
671
672#define MAX_ETHERNET_BODY_SIZE 1500
673#define ETHERNET_HEADER_SIZE (14 + VLAN_HLEN)
674
675#define MAX_ETHERNET_PACKET_SIZE \
676 (MAX_ETHERNET_BODY_SIZE + ETHERNET_HEADER_SIZE)
677
678#define REGULAR_RX_BUF_SIZE (MAX_ETHERNET_PACKET_SIZE + 4)
679#define MAX_RX_BUF_SIZE (1912 + 4)
680
681#define ADDITIONAL_ENTRIES 16
682#define MAX_MULTICAST_LIST 32
683
684#define HW_MULTICAST_SIZE 8
685
686#define HW_TO_DEV_PORT(port) (port - 1)
687
688enum {
689 media_connected,
690 media_disconnected
691};
692
693enum {
694 OID_COUNTER_UNKOWN,
695
696 OID_COUNTER_FIRST,
697
698
699 OID_COUNTER_XMIT_ERROR,
700
701
702 OID_COUNTER_RCV_ERROR,
703
704 OID_COUNTER_LAST
705};
706
707
708
709
710
711#define DESC_ALIGNMENT 16
712#define BUFFER_ALIGNMENT 8
713
714#define NUM_OF_RX_DESC 64
715#define NUM_OF_TX_DESC 64
716
717#define KS_DESC_RX_FRAME_LEN 0x000007FF
718#define KS_DESC_RX_FRAME_TYPE 0x00008000
719#define KS_DESC_RX_ERROR_CRC 0x00010000
720#define KS_DESC_RX_ERROR_RUNT 0x00020000
721#define KS_DESC_RX_ERROR_TOO_LONG 0x00040000
722#define KS_DESC_RX_ERROR_PHY 0x00080000
723#define KS884X_DESC_RX_PORT_MASK 0x00300000
724#define KS_DESC_RX_MULTICAST 0x01000000
725#define KS_DESC_RX_ERROR 0x02000000
726#define KS_DESC_RX_ERROR_CSUM_UDP 0x04000000
727#define KS_DESC_RX_ERROR_CSUM_TCP 0x08000000
728#define KS_DESC_RX_ERROR_CSUM_IP 0x10000000
729#define KS_DESC_RX_LAST 0x20000000
730#define KS_DESC_RX_FIRST 0x40000000
731#define KS_DESC_RX_ERROR_COND \
732 (KS_DESC_RX_ERROR_CRC | \
733 KS_DESC_RX_ERROR_RUNT | \
734 KS_DESC_RX_ERROR_PHY | \
735 KS_DESC_RX_ERROR_TOO_LONG)
736
737#define KS_DESC_HW_OWNED 0x80000000
738
739#define KS_DESC_BUF_SIZE 0x000007FF
740#define KS884X_DESC_TX_PORT_MASK 0x00300000
741#define KS_DESC_END_OF_RING 0x02000000
742#define KS_DESC_TX_CSUM_GEN_UDP 0x04000000
743#define KS_DESC_TX_CSUM_GEN_TCP 0x08000000
744#define KS_DESC_TX_CSUM_GEN_IP 0x10000000
745#define KS_DESC_TX_LAST 0x20000000
746#define KS_DESC_TX_FIRST 0x40000000
747#define KS_DESC_TX_INTERRUPT 0x80000000
748
749#define KS_DESC_PORT_SHIFT 20
750
751#define KS_DESC_RX_MASK (KS_DESC_BUF_SIZE)
752
753#define KS_DESC_TX_MASK \
754 (KS_DESC_TX_INTERRUPT | \
755 KS_DESC_TX_FIRST | \
756 KS_DESC_TX_LAST | \
757 KS_DESC_TX_CSUM_GEN_IP | \
758 KS_DESC_TX_CSUM_GEN_TCP | \
759 KS_DESC_TX_CSUM_GEN_UDP | \
760 KS_DESC_BUF_SIZE)
761
762struct ksz_desc_rx_stat {
763#ifdef __BIG_ENDIAN_BITFIELD
764 u32 hw_owned:1;
765 u32 first_desc:1;
766 u32 last_desc:1;
767 u32 csum_err_ip:1;
768 u32 csum_err_tcp:1;
769 u32 csum_err_udp:1;
770 u32 error:1;
771 u32 multicast:1;
772 u32 src_port:4;
773 u32 err_phy:1;
774 u32 err_too_long:1;
775 u32 err_runt:1;
776 u32 err_crc:1;
777 u32 frame_type:1;
778 u32 reserved1:4;
779 u32 frame_len:11;
780#else
781 u32 frame_len:11;
782 u32 reserved1:4;
783 u32 frame_type:1;
784 u32 err_crc:1;
785 u32 err_runt:1;
786 u32 err_too_long:1;
787 u32 err_phy:1;
788 u32 src_port:4;
789 u32 multicast:1;
790 u32 error:1;
791 u32 csum_err_udp:1;
792 u32 csum_err_tcp:1;
793 u32 csum_err_ip:1;
794 u32 last_desc:1;
795 u32 first_desc:1;
796 u32 hw_owned:1;
797#endif
798};
799
800struct ksz_desc_tx_stat {
801#ifdef __BIG_ENDIAN_BITFIELD
802 u32 hw_owned:1;
803 u32 reserved1:31;
804#else
805 u32 reserved1:31;
806 u32 hw_owned:1;
807#endif
808};
809
810struct ksz_desc_rx_buf {
811#ifdef __BIG_ENDIAN_BITFIELD
812 u32 reserved4:6;
813 u32 end_of_ring:1;
814 u32 reserved3:14;
815 u32 buf_size:11;
816#else
817 u32 buf_size:11;
818 u32 reserved3:14;
819 u32 end_of_ring:1;
820 u32 reserved4:6;
821#endif
822};
823
824struct ksz_desc_tx_buf {
825#ifdef __BIG_ENDIAN_BITFIELD
826 u32 intr:1;
827 u32 first_seg:1;
828 u32 last_seg:1;
829 u32 csum_gen_ip:1;
830 u32 csum_gen_tcp:1;
831 u32 csum_gen_udp:1;
832 u32 end_of_ring:1;
833 u32 reserved4:1;
834 u32 dest_port:4;
835 u32 reserved3:9;
836 u32 buf_size:11;
837#else
838 u32 buf_size:11;
839 u32 reserved3:9;
840 u32 dest_port:4;
841 u32 reserved4:1;
842 u32 end_of_ring:1;
843 u32 csum_gen_udp:1;
844 u32 csum_gen_tcp:1;
845 u32 csum_gen_ip:1;
846 u32 last_seg:1;
847 u32 first_seg:1;
848 u32 intr:1;
849#endif
850};
851
852union desc_stat {
853 struct ksz_desc_rx_stat rx;
854 struct ksz_desc_tx_stat tx;
855 u32 data;
856};
857
858union desc_buf {
859 struct ksz_desc_rx_buf rx;
860 struct ksz_desc_tx_buf tx;
861 u32 data;
862};
863
864
865
866
867
868
869
870
871struct ksz_hw_desc {
872 union desc_stat ctrl;
873 union desc_buf buf;
874 u32 addr;
875 u32 next;
876};
877
878
879
880
881
882
883
884struct ksz_sw_desc {
885 union desc_stat ctrl;
886 union desc_buf buf;
887 u32 buf_size;
888};
889
890
891
892
893
894
895
896struct ksz_dma_buf {
897 struct sk_buff *skb;
898 dma_addr_t dma;
899 int len;
900};
901
902
903
904
905
906
907
908
909
910struct ksz_desc {
911 struct ksz_hw_desc *phw;
912 struct ksz_sw_desc sw;
913 struct ksz_dma_buf dma_buf;
914};
915
916#define DMA_BUFFER(desc) ((struct ksz_dma_buf *)(&(desc)->dma_buf))
917
918
919
920
921
922
923
924
925
926
927
928
929
930
931struct ksz_desc_info {
932 struct ksz_desc *ring;
933 struct ksz_desc *cur;
934 struct ksz_hw_desc *ring_virt;
935 u32 ring_phys;
936 int size;
937 int alloc;
938 int avail;
939 int last;
940 int next;
941 int mask;
942};
943
944
945
946
947
948enum {
949 TABLE_STATIC_MAC = 0,
950 TABLE_VLAN,
951 TABLE_DYNAMIC_MAC,
952 TABLE_MIB
953};
954
955#define LEARNED_MAC_TABLE_ENTRIES 1024
956#define STATIC_MAC_TABLE_ENTRIES 8
957
958
959
960
961
962
963
964
965
966
967
968struct ksz_mac_table {
969 u8 mac_addr[ETH_ALEN];
970 u16 vid;
971 u8 fid;
972 u8 ports;
973 u8 override:1;
974 u8 use_fid:1;
975 u8 valid:1;
976};
977
978#define VLAN_TABLE_ENTRIES 16
979
980
981
982
983
984
985
986struct ksz_vlan_table {
987 u16 vid;
988 u8 fid;
989 u8 member;
990};
991
992#define DIFFSERV_ENTRIES 64
993#define PRIO_802_1P_ENTRIES 8
994#define PRIO_QUEUES 4
995
996#define SWITCH_PORT_NUM 2
997#define TOTAL_PORT_NUM (SWITCH_PORT_NUM + 1)
998#define HOST_MASK (1 << SWITCH_PORT_NUM)
999#define PORT_MASK 7
1000
1001#define MAIN_PORT 0
1002#define OTHER_PORT 1
1003#define HOST_PORT SWITCH_PORT_NUM
1004
1005#define PORT_COUNTER_NUM 0x20
1006#define TOTAL_PORT_COUNTER_NUM (PORT_COUNTER_NUM + 2)
1007
1008#define MIB_COUNTER_RX_LO_PRIORITY 0x00
1009#define MIB_COUNTER_RX_HI_PRIORITY 0x01
1010#define MIB_COUNTER_RX_UNDERSIZE 0x02
1011#define MIB_COUNTER_RX_FRAGMENT 0x03
1012#define MIB_COUNTER_RX_OVERSIZE 0x04
1013#define MIB_COUNTER_RX_JABBER 0x05
1014#define MIB_COUNTER_RX_SYMBOL_ERR 0x06
1015#define MIB_COUNTER_RX_CRC_ERR 0x07
1016#define MIB_COUNTER_RX_ALIGNMENT_ERR 0x08
1017#define MIB_COUNTER_RX_CTRL_8808 0x09
1018#define MIB_COUNTER_RX_PAUSE 0x0A
1019#define MIB_COUNTER_RX_BROADCAST 0x0B
1020#define MIB_COUNTER_RX_MULTICAST 0x0C
1021#define MIB_COUNTER_RX_UNICAST 0x0D
1022#define MIB_COUNTER_RX_OCTET_64 0x0E
1023#define MIB_COUNTER_RX_OCTET_65_127 0x0F
1024#define MIB_COUNTER_RX_OCTET_128_255 0x10
1025#define MIB_COUNTER_RX_OCTET_256_511 0x11
1026#define MIB_COUNTER_RX_OCTET_512_1023 0x12
1027#define MIB_COUNTER_RX_OCTET_1024_1522 0x13
1028#define MIB_COUNTER_TX_LO_PRIORITY 0x14
1029#define MIB_COUNTER_TX_HI_PRIORITY 0x15
1030#define MIB_COUNTER_TX_LATE_COLLISION 0x16
1031#define MIB_COUNTER_TX_PAUSE 0x17
1032#define MIB_COUNTER_TX_BROADCAST 0x18
1033#define MIB_COUNTER_TX_MULTICAST 0x19
1034#define MIB_COUNTER_TX_UNICAST 0x1A
1035#define MIB_COUNTER_TX_DEFERRED 0x1B
1036#define MIB_COUNTER_TX_TOTAL_COLLISION 0x1C
1037#define MIB_COUNTER_TX_EXCESS_COLLISION 0x1D
1038#define MIB_COUNTER_TX_SINGLE_COLLISION 0x1E
1039#define MIB_COUNTER_TX_MULTI_COLLISION 0x1F
1040
1041#define MIB_COUNTER_RX_DROPPED_PACKET 0x20
1042#define MIB_COUNTER_TX_DROPPED_PACKET 0x21
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063struct ksz_port_mib {
1064 u8 cnt_ptr;
1065 u8 link_down;
1066 u8 state;
1067 u8 mib_start;
1068
1069 u64 counter[TOTAL_PORT_COUNTER_NUM];
1070 u32 dropped[2];
1071};
1072
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082struct ksz_port_cfg {
1083 u16 vid;
1084 u8 member;
1085 u8 port_prio;
1086 u32 rx_rate[PRIO_QUEUES];
1087 u32 tx_rate[PRIO_QUEUES];
1088 int stp_state;
1089};
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105struct ksz_switch {
1106 struct ksz_mac_table mac_table[STATIC_MAC_TABLE_ENTRIES];
1107 struct ksz_vlan_table vlan_table[VLAN_TABLE_ENTRIES];
1108 struct ksz_port_cfg port_cfg[TOTAL_PORT_NUM];
1109
1110 u8 diffserv[DIFFSERV_ENTRIES];
1111 u8 p_802_1p[PRIO_802_1P_ENTRIES];
1112
1113 u8 br_addr[ETH_ALEN];
1114 u8 other_addr[ETH_ALEN];
1115
1116 u8 broad_per;
1117 u8 member;
1118};
1119
1120#define TX_RATE_UNIT 10000
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132struct ksz_port_info {
1133 uint state;
1134 uint tx_rate;
1135 u8 duplex;
1136 u8 advertised;
1137 u8 partner;
1138 u8 port_id;
1139 void *pdev;
1140};
1141
1142#define MAX_TX_HELD_SIZE 52000
1143
1144
1145#define LINK_INT_WORKING (1 << 0)
1146#define SMALL_PACKET_TX_BUG (1 << 1)
1147#define HALF_DUPLEX_SIGNAL_BUG (1 << 2)
1148#define RX_HUGE_FRAME (1 << 4)
1149#define STP_SUPPORT (1 << 8)
1150
1151
1152#define PAUSE_FLOW_CTRL (1 << 0)
1153#define FAST_AGING (1 << 1)
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188
1189
1190
1191
1192
1193
1194struct ksz_hw {
1195 void __iomem *io;
1196
1197 struct ksz_switch *ksz_switch;
1198 struct ksz_port_info port_info[SWITCH_PORT_NUM];
1199 struct ksz_port_mib port_mib[TOTAL_PORT_NUM];
1200 int dev_count;
1201 int dst_ports;
1202 int id;
1203 int mib_cnt;
1204 int mib_port_cnt;
1205
1206 u32 tx_cfg;
1207 u32 rx_cfg;
1208 u32 intr_mask;
1209 u32 intr_set;
1210 uint intr_blocked;
1211
1212 struct ksz_desc_info rx_desc_info;
1213 struct ksz_desc_info tx_desc_info;
1214
1215 int tx_int_cnt;
1216 int tx_int_mask;
1217 int tx_size;
1218
1219 u8 perm_addr[ETH_ALEN];
1220 u8 override_addr[ETH_ALEN];
1221 u8 address[ADDITIONAL_ENTRIES][ETH_ALEN];
1222 u8 addr_list_size;
1223 u8 mac_override;
1224 u8 promiscuous;
1225 u8 all_multi;
1226 u8 multi_list[MAX_MULTICAST_LIST][ETH_ALEN];
1227 u8 multi_bits[HW_MULTICAST_SIZE];
1228 u8 multi_list_size;
1229
1230 u8 enabled;
1231 u8 rx_stop;
1232 u8 reserved2[1];
1233
1234 uint features;
1235 uint overrides;
1236
1237 void *parent;
1238};
1239
1240enum {
1241 PHY_NO_FLOW_CTRL,
1242 PHY_FLOW_CTRL,
1243 PHY_TX_ONLY,
1244 PHY_RX_ONLY
1245};
1246
1247
1248
1249
1250
1251
1252
1253
1254
1255
1256
1257
1258
1259
1260
1261
1262
1263
1264
1265
1266
1267struct ksz_port {
1268 u8 duplex;
1269 u8 speed;
1270 u8 force_link;
1271 u8 flow_ctrl;
1272
1273 int first_port;
1274 int mib_port_cnt;
1275 int port_cnt;
1276 u64 counter[OID_COUNTER_LAST];
1277
1278 struct ksz_hw *hw;
1279 struct ksz_port_info *linked;
1280};
1281
1282
1283
1284
1285
1286
1287
1288
1289struct ksz_timer_info {
1290 struct timer_list timer;
1291 int cnt;
1292 int max;
1293 int period;
1294};
1295
1296
1297
1298
1299
1300
1301
1302
1303
1304struct ksz_shared_mem {
1305 dma_addr_t dma_addr;
1306 uint alloc_size;
1307 uint phys;
1308 u8 *alloc_virt;
1309 u8 *virt;
1310};
1311
1312
1313
1314
1315
1316
1317
1318struct ksz_counter_info {
1319 wait_queue_head_t counter;
1320 unsigned long time;
1321 int read;
1322};
1323
1324
1325
1326
1327
1328
1329
1330
1331
1332
1333
1334
1335
1336
1337
1338
1339
1340
1341
1342
1343
1344
1345
1346
1347
1348struct dev_info {
1349 struct net_device *dev;
1350 struct pci_dev *pdev;
1351
1352 struct ksz_hw hw;
1353 struct ksz_shared_mem desc_pool;
1354
1355 spinlock_t hwlock;
1356 struct mutex lock;
1357
1358 int (*dev_rcv)(struct dev_info *);
1359
1360 struct sk_buff *last_skb;
1361 int skb_index;
1362 int skb_len;
1363
1364 struct work_struct mib_read;
1365 struct ksz_timer_info mib_timer_info;
1366 struct ksz_counter_info counter[TOTAL_PORT_NUM];
1367
1368 int mtu;
1369 int opened;
1370
1371 struct tasklet_struct rx_tasklet;
1372 struct tasklet_struct tx_tasklet;
1373
1374 int wol_enable;
1375 int wol_support;
1376 unsigned long pme_wait;
1377};
1378
1379
1380
1381
1382
1383
1384
1385
1386
1387
1388
1389
1390
1391
1392
1393struct dev_priv {
1394 struct dev_info *adapter;
1395 struct ksz_port port;
1396 struct ksz_timer_info monitor_timer_info;
1397
1398 struct semaphore proc_sem;
1399 int id;
1400
1401 struct mii_if_info mii_if;
1402 u32 advertising;
1403
1404 u32 msg_enable;
1405 int media_state;
1406 int multicast;
1407 int promiscuous;
1408};
1409
1410#define DRV_NAME "KSZ884X PCI"
1411#define DEVICE_NAME "KSZ884x PCI"
1412#define DRV_VERSION "1.0.0"
1413#define DRV_RELDATE "Feb 8, 2010"
1414
1415static char version[] =
1416 "Micrel " DEVICE_NAME " " DRV_VERSION " (" DRV_RELDATE ")";
1417
1418static u8 DEFAULT_MAC_ADDRESS[] = { 0x00, 0x10, 0xA1, 0x88, 0x42, 0x01 };
1419
1420
1421
1422
1423
1424static inline void hw_ack_intr(struct ksz_hw *hw, uint interrupt)
1425{
1426 writel(interrupt, hw->io + KS884X_INTERRUPTS_STATUS);
1427}
1428
1429static inline void hw_dis_intr(struct ksz_hw *hw)
1430{
1431 hw->intr_blocked = hw->intr_mask;
1432 writel(0, hw->io + KS884X_INTERRUPTS_ENABLE);
1433 hw->intr_set = readl(hw->io + KS884X_INTERRUPTS_ENABLE);
1434}
1435
1436static inline void hw_set_intr(struct ksz_hw *hw, uint interrupt)
1437{
1438 hw->intr_set = interrupt;
1439 writel(interrupt, hw->io + KS884X_INTERRUPTS_ENABLE);
1440}
1441
1442static inline void hw_ena_intr(struct ksz_hw *hw)
1443{
1444 hw->intr_blocked = 0;
1445 hw_set_intr(hw, hw->intr_mask);
1446}
1447
1448static inline void hw_dis_intr_bit(struct ksz_hw *hw, uint bit)
1449{
1450 hw->intr_mask &= ~(bit);
1451}
1452
1453static inline void hw_turn_off_intr(struct ksz_hw *hw, uint interrupt)
1454{
1455 u32 read_intr;
1456
1457 read_intr = readl(hw->io + KS884X_INTERRUPTS_ENABLE);
1458 hw->intr_set = read_intr & ~interrupt;
1459 writel(hw->intr_set, hw->io + KS884X_INTERRUPTS_ENABLE);
1460 hw_dis_intr_bit(hw, interrupt);
1461}
1462
1463
1464
1465
1466
1467
1468
1469
1470
1471static void hw_turn_on_intr(struct ksz_hw *hw, u32 bit)
1472{
1473 hw->intr_mask |= bit;
1474
1475 if (!hw->intr_blocked)
1476 hw_set_intr(hw, hw->intr_mask);
1477}
1478
1479static inline void hw_ena_intr_bit(struct ksz_hw *hw, uint interrupt)
1480{
1481 u32 read_intr;
1482
1483 read_intr = readl(hw->io + KS884X_INTERRUPTS_ENABLE);
1484 hw->intr_set = read_intr | interrupt;
1485 writel(hw->intr_set, hw->io + KS884X_INTERRUPTS_ENABLE);
1486}
1487
1488static inline void hw_read_intr(struct ksz_hw *hw, uint *status)
1489{
1490 *status = readl(hw->io + KS884X_INTERRUPTS_STATUS);
1491 *status = *status & hw->intr_set;
1492}
1493
1494static inline void hw_restore_intr(struct ksz_hw *hw, uint interrupt)
1495{
1496 if (interrupt)
1497 hw_ena_intr(hw);
1498}
1499
1500
1501
1502
1503
1504
1505
1506
1507
1508
1509static uint hw_block_intr(struct ksz_hw *hw)
1510{
1511 uint interrupt = 0;
1512
1513 if (!hw->intr_blocked) {
1514 hw_dis_intr(hw);
1515 interrupt = hw->intr_blocked;
1516 }
1517 return interrupt;
1518}
1519
1520
1521
1522
1523
1524static inline void reset_desc(struct ksz_desc *desc, union desc_stat status)
1525{
1526 status.rx.hw_owned = 0;
1527 desc->phw->ctrl.data = cpu_to_le32(status.data);
1528}
1529
1530static inline void release_desc(struct ksz_desc *desc)
1531{
1532 desc->sw.ctrl.tx.hw_owned = 1;
1533 if (desc->sw.buf_size != desc->sw.buf.data) {
1534 desc->sw.buf_size = desc->sw.buf.data;
1535 desc->phw->buf.data = cpu_to_le32(desc->sw.buf.data);
1536 }
1537 desc->phw->ctrl.data = cpu_to_le32(desc->sw.ctrl.data);
1538}
1539
1540static void get_rx_pkt(struct ksz_desc_info *info, struct ksz_desc **desc)
1541{
1542 *desc = &info->ring[info->last];
1543 info->last++;
1544 info->last &= info->mask;
1545 info->avail--;
1546 (*desc)->sw.buf.data &= ~KS_DESC_RX_MASK;
1547}
1548
1549static inline void set_rx_buf(struct ksz_desc *desc, u32 addr)
1550{
1551 desc->phw->addr = cpu_to_le32(addr);
1552}
1553
1554static inline void set_rx_len(struct ksz_desc *desc, u32 len)
1555{
1556 desc->sw.buf.rx.buf_size = len;
1557}
1558
1559static inline void get_tx_pkt(struct ksz_desc_info *info,
1560 struct ksz_desc **desc)
1561{
1562 *desc = &info->ring[info->next];
1563 info->next++;
1564 info->next &= info->mask;
1565 info->avail--;
1566 (*desc)->sw.buf.data &= ~KS_DESC_TX_MASK;
1567}
1568
1569static inline void set_tx_buf(struct ksz_desc *desc, u32 addr)
1570{
1571 desc->phw->addr = cpu_to_le32(addr);
1572}
1573
1574static inline void set_tx_len(struct ksz_desc *desc, u32 len)
1575{
1576 desc->sw.buf.tx.buf_size = len;
1577}
1578
1579
1580
1581#define TABLE_READ 0x10
1582#define TABLE_SEL_SHIFT 2
1583
1584#define HW_DELAY(hw, reg) \
1585 do { \
1586 readw(hw->io + reg); \
1587 } while (0)
1588
1589
1590
1591
1592
1593
1594
1595
1596
1597
1598
1599static void sw_r_table(struct ksz_hw *hw, int table, u16 addr, u32 *data)
1600{
1601 u16 ctrl_addr;
1602 uint interrupt;
1603
1604 ctrl_addr = (((table << TABLE_SEL_SHIFT) | TABLE_READ) << 8) | addr;
1605
1606 interrupt = hw_block_intr(hw);
1607
1608 writew(ctrl_addr, hw->io + KS884X_IACR_OFFSET);
1609 HW_DELAY(hw, KS884X_IACR_OFFSET);
1610 *data = readl(hw->io + KS884X_ACC_DATA_0_OFFSET);
1611
1612 hw_restore_intr(hw, interrupt);
1613}
1614
1615
1616
1617
1618
1619
1620
1621
1622
1623
1624
1625
1626static void sw_w_table_64(struct ksz_hw *hw, int table, u16 addr, u32 data_hi,
1627 u32 data_lo)
1628{
1629 u16 ctrl_addr;
1630 uint interrupt;
1631
1632 ctrl_addr = ((table << TABLE_SEL_SHIFT) << 8) | addr;
1633
1634 interrupt = hw_block_intr(hw);
1635
1636 writel(data_hi, hw->io + KS884X_ACC_DATA_4_OFFSET);
1637 writel(data_lo, hw->io + KS884X_ACC_DATA_0_OFFSET);
1638
1639 writew(ctrl_addr, hw->io + KS884X_IACR_OFFSET);
1640 HW_DELAY(hw, KS884X_IACR_OFFSET);
1641
1642 hw_restore_intr(hw, interrupt);
1643}
1644
1645
1646
1647
1648
1649
1650
1651
1652
1653
1654
1655
1656
1657
1658
1659static void sw_w_sta_mac_table(struct ksz_hw *hw, u16 addr, u8 *mac_addr,
1660 u8 ports, int override, int valid, int use_fid, u8 fid)
1661{
1662 u32 data_hi;
1663 u32 data_lo;
1664
1665 data_lo = ((u32) mac_addr[2] << 24) |
1666 ((u32) mac_addr[3] << 16) |
1667 ((u32) mac_addr[4] << 8) | mac_addr[5];
1668 data_hi = ((u32) mac_addr[0] << 8) | mac_addr[1];
1669 data_hi |= (u32) ports << STATIC_MAC_FWD_PORTS_SHIFT;
1670
1671 if (override)
1672 data_hi |= STATIC_MAC_TABLE_OVERRIDE;
1673 if (use_fid) {
1674 data_hi |= STATIC_MAC_TABLE_USE_FID;
1675 data_hi |= (u32) fid << STATIC_MAC_FID_SHIFT;
1676 }
1677 if (valid)
1678 data_hi |= STATIC_MAC_TABLE_VALID;
1679
1680 sw_w_table_64(hw, TABLE_STATIC_MAC, addr, data_hi, data_lo);
1681}
1682
1683
1684
1685
1686
1687
1688
1689
1690
1691
1692
1693
1694
1695
1696static int sw_r_vlan_table(struct ksz_hw *hw, u16 addr, u16 *vid, u8 *fid,
1697 u8 *member)
1698{
1699 u32 data;
1700
1701 sw_r_table(hw, TABLE_VLAN, addr, &data);
1702 if (data & VLAN_TABLE_VALID) {
1703 *vid = (u16)(data & VLAN_TABLE_VID);
1704 *fid = (u8)((data & VLAN_TABLE_FID) >> VLAN_TABLE_FID_SHIFT);
1705 *member = (u8)((data & VLAN_TABLE_MEMBERSHIP) >>
1706 VLAN_TABLE_MEMBERSHIP_SHIFT);
1707 return 0;
1708 }
1709 return -1;
1710}
1711
1712
1713
1714
1715
1716
1717
1718
1719
1720
1721
1722static void port_r_mib_cnt(struct ksz_hw *hw, int port, u16 addr, u64 *cnt)
1723{
1724 u32 data;
1725 u16 ctrl_addr;
1726 uint interrupt;
1727 int timeout;
1728
1729 ctrl_addr = addr + PORT_COUNTER_NUM * port;
1730
1731 interrupt = hw_block_intr(hw);
1732
1733 ctrl_addr |= (((TABLE_MIB << TABLE_SEL_SHIFT) | TABLE_READ) << 8);
1734 writew(ctrl_addr, hw->io + KS884X_IACR_OFFSET);
1735 HW_DELAY(hw, KS884X_IACR_OFFSET);
1736
1737 for (timeout = 100; timeout > 0; timeout--) {
1738 data = readl(hw->io + KS884X_ACC_DATA_0_OFFSET);
1739
1740 if (data & MIB_COUNTER_VALID) {
1741 if (data & MIB_COUNTER_OVERFLOW)
1742 *cnt += MIB_COUNTER_VALUE + 1;
1743 *cnt += data & MIB_COUNTER_VALUE;
1744 break;
1745 }
1746 }
1747
1748 hw_restore_intr(hw, interrupt);
1749}
1750
1751
1752
1753
1754
1755
1756
1757
1758
1759
1760
1761static void port_r_mib_pkt(struct ksz_hw *hw, int port, u32 *last, u64 *cnt)
1762{
1763 u32 cur;
1764 u32 data;
1765 u16 ctrl_addr;
1766 uint interrupt;
1767 int index;
1768
1769 index = KS_MIB_PACKET_DROPPED_RX_0 + port;
1770 do {
1771 interrupt = hw_block_intr(hw);
1772
1773 ctrl_addr = (u16) index;
1774 ctrl_addr |= (((TABLE_MIB << TABLE_SEL_SHIFT) | TABLE_READ)
1775 << 8);
1776 writew(ctrl_addr, hw->io + KS884X_IACR_OFFSET);
1777 HW_DELAY(hw, KS884X_IACR_OFFSET);
1778 data = readl(hw->io + KS884X_ACC_DATA_0_OFFSET);
1779
1780 hw_restore_intr(hw, interrupt);
1781
1782 data &= MIB_PACKET_DROPPED;
1783 cur = *last;
1784 if (data != cur) {
1785 *last = data;
1786 if (data < cur)
1787 data += MIB_PACKET_DROPPED + 1;
1788 data -= cur;
1789 *cnt += data;
1790 }
1791 ++last;
1792 ++cnt;
1793 index -= KS_MIB_PACKET_DROPPED_TX -
1794 KS_MIB_PACKET_DROPPED_TX_0 + 1;
1795 } while (index >= KS_MIB_PACKET_DROPPED_TX_0 + port);
1796}
1797
1798
1799
1800
1801
1802
1803
1804
1805
1806
1807
1808
1809static int port_r_cnt(struct ksz_hw *hw, int port)
1810{
1811 struct ksz_port_mib *mib = &hw->port_mib[port];
1812
1813 if (mib->mib_start < PORT_COUNTER_NUM)
1814 while (mib->cnt_ptr < PORT_COUNTER_NUM) {
1815 port_r_mib_cnt(hw, port, mib->cnt_ptr,
1816 &mib->counter[mib->cnt_ptr]);
1817 ++mib->cnt_ptr;
1818 }
1819 if (hw->mib_cnt > PORT_COUNTER_NUM)
1820 port_r_mib_pkt(hw, port, mib->dropped,
1821 &mib->counter[PORT_COUNTER_NUM]);
1822 mib->cnt_ptr = 0;
1823 return 0;
1824}
1825
1826
1827
1828
1829
1830
1831
1832
1833
1834static void port_init_cnt(struct ksz_hw *hw, int port)
1835{
1836 struct ksz_port_mib *mib = &hw->port_mib[port];
1837
1838 mib->cnt_ptr = 0;
1839 if (mib->mib_start < PORT_COUNTER_NUM)
1840 do {
1841 port_r_mib_cnt(hw, port, mib->cnt_ptr,
1842 &mib->counter[mib->cnt_ptr]);
1843 ++mib->cnt_ptr;
1844 } while (mib->cnt_ptr < PORT_COUNTER_NUM);
1845 if (hw->mib_cnt > PORT_COUNTER_NUM)
1846 port_r_mib_pkt(hw, port, mib->dropped,
1847 &mib->counter[PORT_COUNTER_NUM]);
1848 memset((void *) mib->counter, 0, sizeof(u64) * TOTAL_PORT_COUNTER_NUM);
1849 mib->cnt_ptr = 0;
1850}
1851
1852
1853
1854
1855
1856
1857
1858
1859
1860
1861
1862
1863
1864
1865
1866
1867
1868static int port_chk(struct ksz_hw *hw, int port, int offset, u16 bits)
1869{
1870 u32 addr;
1871 u16 data;
1872
1873 PORT_CTRL_ADDR(port, addr);
1874 addr += offset;
1875 data = readw(hw->io + addr);
1876 return (data & bits) == bits;
1877}
1878
1879
1880
1881
1882
1883
1884
1885
1886
1887
1888
1889static void port_cfg(struct ksz_hw *hw, int port, int offset, u16 bits,
1890 int set)
1891{
1892 u32 addr;
1893 u16 data;
1894
1895 PORT_CTRL_ADDR(port, addr);
1896 addr += offset;
1897 data = readw(hw->io + addr);
1898 if (set)
1899 data |= bits;
1900 else
1901 data &= ~bits;
1902 writew(data, hw->io + addr);
1903}
1904
1905
1906
1907
1908
1909
1910
1911
1912
1913
1914
1915
1916
1917static int port_chk_shift(struct ksz_hw *hw, int port, u32 addr, int shift)
1918{
1919 u16 data;
1920 u16 bit = 1 << port;
1921
1922 data = readw(hw->io + addr);
1923 data >>= shift;
1924 return (data & bit) == bit;
1925}
1926
1927
1928
1929
1930
1931
1932
1933
1934
1935
1936
1937static void port_cfg_shift(struct ksz_hw *hw, int port, u32 addr, int shift,
1938 int set)
1939{
1940 u16 data;
1941 u16 bits = 1 << port;
1942
1943 data = readw(hw->io + addr);
1944 bits <<= shift;
1945 if (set)
1946 data |= bits;
1947 else
1948 data &= ~bits;
1949 writew(data, hw->io + addr);
1950}
1951
1952
1953
1954
1955
1956
1957
1958
1959
1960
1961static void port_r8(struct ksz_hw *hw, int port, int offset, u8 *data)
1962{
1963 u32 addr;
1964
1965 PORT_CTRL_ADDR(port, addr);
1966 addr += offset;
1967 *data = readb(hw->io + addr);
1968}
1969
1970
1971
1972
1973
1974
1975
1976
1977
1978
1979static void port_r16(struct ksz_hw *hw, int port, int offset, u16 *data)
1980{
1981 u32 addr;
1982
1983 PORT_CTRL_ADDR(port, addr);
1984 addr += offset;
1985 *data = readw(hw->io + addr);
1986}
1987
1988
1989
1990
1991
1992
1993
1994
1995
1996
1997static void port_w16(struct ksz_hw *hw, int port, int offset, u16 data)
1998{
1999 u32 addr;
2000
2001 PORT_CTRL_ADDR(port, addr);
2002 addr += offset;
2003 writew(data, hw->io + addr);
2004}
2005
2006
2007
2008
2009
2010
2011
2012
2013
2014
2015
2016
2017static int sw_chk(struct ksz_hw *hw, u32 addr, u16 bits)
2018{
2019 u16 data;
2020
2021 data = readw(hw->io + addr);
2022 return (data & bits) == bits;
2023}
2024
2025
2026
2027
2028
2029
2030
2031
2032
2033
2034static void sw_cfg(struct ksz_hw *hw, u32 addr, u16 bits, int set)
2035{
2036 u16 data;
2037
2038 data = readw(hw->io + addr);
2039 if (set)
2040 data |= bits;
2041 else
2042 data &= ~bits;
2043 writew(data, hw->io + addr);
2044}
2045
2046
2047
2048static inline void port_cfg_broad_storm(struct ksz_hw *hw, int p, int set)
2049{
2050 port_cfg(hw, p,
2051 KS8842_PORT_CTRL_1_OFFSET, PORT_BROADCAST_STORM, set);
2052}
2053
2054static inline int port_chk_broad_storm(struct ksz_hw *hw, int p)
2055{
2056 return port_chk(hw, p,
2057 KS8842_PORT_CTRL_1_OFFSET, PORT_BROADCAST_STORM);
2058}
2059
2060
2061#define BROADCAST_STORM_PROTECTION_RATE 10
2062
2063
2064#define BROADCAST_STORM_VALUE 9969
2065
2066
2067
2068
2069
2070
2071
2072
2073static void sw_cfg_broad_storm(struct ksz_hw *hw, u8 percent)
2074{
2075 u16 data;
2076 u32 value = ((u32) BROADCAST_STORM_VALUE * (u32) percent / 100);
2077
2078 if (value > BROADCAST_STORM_RATE)
2079 value = BROADCAST_STORM_RATE;
2080
2081 data = readw(hw->io + KS8842_SWITCH_CTRL_3_OFFSET);
2082 data &= ~(BROADCAST_STORM_RATE_LO | BROADCAST_STORM_RATE_HI);
2083 data |= ((value & 0x00FF) << 8) | ((value & 0xFF00) >> 8);
2084 writew(data, hw->io + KS8842_SWITCH_CTRL_3_OFFSET);
2085}
2086
2087
2088
2089
2090
2091
2092
2093
2094static void sw_get_broad_storm(struct ksz_hw *hw, u8 *percent)
2095{
2096 int num;
2097 u16 data;
2098
2099 data = readw(hw->io + KS8842_SWITCH_CTRL_3_OFFSET);
2100 num = (data & BROADCAST_STORM_RATE_HI);
2101 num <<= 8;
2102 num |= (data & BROADCAST_STORM_RATE_LO) >> 8;
2103 num = DIV_ROUND_CLOSEST(num * 100, BROADCAST_STORM_VALUE);
2104 *percent = (u8) num;
2105}
2106
2107
2108
2109
2110
2111
2112
2113
2114static void sw_dis_broad_storm(struct ksz_hw *hw, int port)
2115{
2116 port_cfg_broad_storm(hw, port, 0);
2117}
2118
2119
2120
2121
2122
2123
2124
2125
2126static void sw_ena_broad_storm(struct ksz_hw *hw, int port)
2127{
2128 sw_cfg_broad_storm(hw, hw->ksz_switch->broad_per);
2129 port_cfg_broad_storm(hw, port, 1);
2130}
2131
2132
2133
2134
2135
2136
2137
2138static void sw_init_broad_storm(struct ksz_hw *hw)
2139{
2140 int port;
2141
2142 hw->ksz_switch->broad_per = 1;
2143 sw_cfg_broad_storm(hw, hw->ksz_switch->broad_per);
2144 for (port = 0; port < TOTAL_PORT_NUM; port++)
2145 sw_dis_broad_storm(hw, port);
2146 sw_cfg(hw, KS8842_SWITCH_CTRL_2_OFFSET, MULTICAST_STORM_DISABLE, 1);
2147}
2148
2149
2150
2151
2152
2153
2154
2155
2156
2157static void hw_cfg_broad_storm(struct ksz_hw *hw, u8 percent)
2158{
2159 if (percent > 100)
2160 percent = 100;
2161
2162 sw_cfg_broad_storm(hw, percent);
2163 sw_get_broad_storm(hw, &percent);
2164 hw->ksz_switch->broad_per = percent;
2165}
2166
2167
2168
2169
2170
2171
2172
2173
2174static void sw_dis_prio_rate(struct ksz_hw *hw, int port)
2175{
2176 u32 addr;
2177
2178 PORT_CTRL_ADDR(port, addr);
2179 addr += KS8842_PORT_IN_RATE_OFFSET;
2180 writel(0, hw->io + addr);
2181}
2182
2183
2184
2185
2186
2187
2188
2189static void sw_init_prio_rate(struct ksz_hw *hw)
2190{
2191 int port;
2192 int prio;
2193 struct ksz_switch *sw = hw->ksz_switch;
2194
2195 for (port = 0; port < TOTAL_PORT_NUM; port++) {
2196 for (prio = 0; prio < PRIO_QUEUES; prio++) {
2197 sw->port_cfg[port].rx_rate[prio] =
2198 sw->port_cfg[port].tx_rate[prio] = 0;
2199 }
2200 sw_dis_prio_rate(hw, port);
2201 }
2202}
2203
2204
2205
2206static inline void port_cfg_back_pressure(struct ksz_hw *hw, int p, int set)
2207{
2208 port_cfg(hw, p,
2209 KS8842_PORT_CTRL_2_OFFSET, PORT_BACK_PRESSURE, set);
2210}
2211
2212static inline void port_cfg_force_flow_ctrl(struct ksz_hw *hw, int p, int set)
2213{
2214 port_cfg(hw, p,
2215 KS8842_PORT_CTRL_2_OFFSET, PORT_FORCE_FLOW_CTRL, set);
2216}
2217
2218static inline int port_chk_back_pressure(struct ksz_hw *hw, int p)
2219{
2220 return port_chk(hw, p,
2221 KS8842_PORT_CTRL_2_OFFSET, PORT_BACK_PRESSURE);
2222}
2223
2224static inline int port_chk_force_flow_ctrl(struct ksz_hw *hw, int p)
2225{
2226 return port_chk(hw, p,
2227 KS8842_PORT_CTRL_2_OFFSET, PORT_FORCE_FLOW_CTRL);
2228}
2229
2230
2231
2232static inline void port_cfg_rx(struct ksz_hw *hw, int p, int set)
2233{
2234 port_cfg(hw, p,
2235 KS8842_PORT_CTRL_2_OFFSET, PORT_RX_ENABLE, set);
2236}
2237
2238static inline void port_cfg_tx(struct ksz_hw *hw, int p, int set)
2239{
2240 port_cfg(hw, p,
2241 KS8842_PORT_CTRL_2_OFFSET, PORT_TX_ENABLE, set);
2242}
2243
2244static inline void sw_cfg_fast_aging(struct ksz_hw *hw, int set)
2245{
2246 sw_cfg(hw, KS8842_SWITCH_CTRL_1_OFFSET, SWITCH_FAST_AGING, set);
2247}
2248
2249static inline void sw_flush_dyn_mac_table(struct ksz_hw *hw)
2250{
2251 if (!(hw->overrides & FAST_AGING)) {
2252 sw_cfg_fast_aging(hw, 1);
2253 mdelay(1);
2254 sw_cfg_fast_aging(hw, 0);
2255 }
2256}
2257
2258
2259
2260static inline void port_cfg_ins_tag(struct ksz_hw *hw, int p, int insert)
2261{
2262 port_cfg(hw, p,
2263 KS8842_PORT_CTRL_1_OFFSET, PORT_INSERT_TAG, insert);
2264}
2265
2266static inline void port_cfg_rmv_tag(struct ksz_hw *hw, int p, int remove)
2267{
2268 port_cfg(hw, p,
2269 KS8842_PORT_CTRL_1_OFFSET, PORT_REMOVE_TAG, remove);
2270}
2271
2272static inline int port_chk_ins_tag(struct ksz_hw *hw, int p)
2273{
2274 return port_chk(hw, p,
2275 KS8842_PORT_CTRL_1_OFFSET, PORT_INSERT_TAG);
2276}
2277
2278static inline int port_chk_rmv_tag(struct ksz_hw *hw, int p)
2279{
2280 return port_chk(hw, p,
2281 KS8842_PORT_CTRL_1_OFFSET, PORT_REMOVE_TAG);
2282}
2283
2284static inline void port_cfg_dis_non_vid(struct ksz_hw *hw, int p, int set)
2285{
2286 port_cfg(hw, p,
2287 KS8842_PORT_CTRL_2_OFFSET, PORT_DISCARD_NON_VID, set);
2288}
2289
2290static inline void port_cfg_in_filter(struct ksz_hw *hw, int p, int set)
2291{
2292 port_cfg(hw, p,
2293 KS8842_PORT_CTRL_2_OFFSET, PORT_INGRESS_VLAN_FILTER, set);
2294}
2295
2296static inline int port_chk_dis_non_vid(struct ksz_hw *hw, int p)
2297{
2298 return port_chk(hw, p,
2299 KS8842_PORT_CTRL_2_OFFSET, PORT_DISCARD_NON_VID);
2300}
2301
2302static inline int port_chk_in_filter(struct ksz_hw *hw, int p)
2303{
2304 return port_chk(hw, p,
2305 KS8842_PORT_CTRL_2_OFFSET, PORT_INGRESS_VLAN_FILTER);
2306}
2307
2308
2309
2310static inline void port_cfg_mirror_sniffer(struct ksz_hw *hw, int p, int set)
2311{
2312 port_cfg(hw, p,
2313 KS8842_PORT_CTRL_2_OFFSET, PORT_MIRROR_SNIFFER, set);
2314}
2315
2316static inline void port_cfg_mirror_rx(struct ksz_hw *hw, int p, int set)
2317{
2318 port_cfg(hw, p,
2319 KS8842_PORT_CTRL_2_OFFSET, PORT_MIRROR_RX, set);
2320}
2321
2322static inline void port_cfg_mirror_tx(struct ksz_hw *hw, int p, int set)
2323{
2324 port_cfg(hw, p,
2325 KS8842_PORT_CTRL_2_OFFSET, PORT_MIRROR_TX, set);
2326}
2327
2328static inline void sw_cfg_mirror_rx_tx(struct ksz_hw *hw, int set)
2329{
2330 sw_cfg(hw, KS8842_SWITCH_CTRL_2_OFFSET, SWITCH_MIRROR_RX_TX, set);
2331}
2332
2333static void sw_init_mirror(struct ksz_hw *hw)
2334{
2335 int port;
2336
2337 for (port = 0; port < TOTAL_PORT_NUM; port++) {
2338 port_cfg_mirror_sniffer(hw, port, 0);
2339 port_cfg_mirror_rx(hw, port, 0);
2340 port_cfg_mirror_tx(hw, port, 0);
2341 }
2342 sw_cfg_mirror_rx_tx(hw, 0);
2343}
2344
2345static inline void sw_cfg_unk_def_deliver(struct ksz_hw *hw, int set)
2346{
2347 sw_cfg(hw, KS8842_SWITCH_CTRL_7_OFFSET,
2348 SWITCH_UNK_DEF_PORT_ENABLE, set);
2349}
2350
2351static inline int sw_cfg_chk_unk_def_deliver(struct ksz_hw *hw)
2352{
2353 return sw_chk(hw, KS8842_SWITCH_CTRL_7_OFFSET,
2354 SWITCH_UNK_DEF_PORT_ENABLE);
2355}
2356
2357static inline void sw_cfg_unk_def_port(struct ksz_hw *hw, int port, int set)
2358{
2359 port_cfg_shift(hw, port, KS8842_SWITCH_CTRL_7_OFFSET, 0, set);
2360}
2361
2362static inline int sw_chk_unk_def_port(struct ksz_hw *hw, int port)
2363{
2364 return port_chk_shift(hw, port, KS8842_SWITCH_CTRL_7_OFFSET, 0);
2365}
2366
2367
2368
2369static inline void port_cfg_diffserv(struct ksz_hw *hw, int p, int set)
2370{
2371 port_cfg(hw, p,
2372 KS8842_PORT_CTRL_1_OFFSET, PORT_DIFFSERV_ENABLE, set);
2373}
2374
2375static inline void port_cfg_802_1p(struct ksz_hw *hw, int p, int set)
2376{
2377 port_cfg(hw, p,
2378 KS8842_PORT_CTRL_1_OFFSET, PORT_802_1P_ENABLE, set);
2379}
2380
2381static inline void port_cfg_replace_vid(struct ksz_hw *hw, int p, int set)
2382{
2383 port_cfg(hw, p,
2384 KS8842_PORT_CTRL_2_OFFSET, PORT_USER_PRIORITY_CEILING, set);
2385}
2386
2387static inline void port_cfg_prio(struct ksz_hw *hw, int p, int set)
2388{
2389 port_cfg(hw, p,
2390 KS8842_PORT_CTRL_1_OFFSET, PORT_PRIO_QUEUE_ENABLE, set);
2391}
2392
2393static inline int port_chk_diffserv(struct ksz_hw *hw, int p)
2394{
2395 return port_chk(hw, p,
2396 KS8842_PORT_CTRL_1_OFFSET, PORT_DIFFSERV_ENABLE);
2397}
2398
2399static inline int port_chk_802_1p(struct ksz_hw *hw, int p)
2400{
2401 return port_chk(hw, p,
2402 KS8842_PORT_CTRL_1_OFFSET, PORT_802_1P_ENABLE);
2403}
2404
2405static inline int port_chk_replace_vid(struct ksz_hw *hw, int p)
2406{
2407 return port_chk(hw, p,
2408 KS8842_PORT_CTRL_2_OFFSET, PORT_USER_PRIORITY_CEILING);
2409}
2410
2411static inline int port_chk_prio(struct ksz_hw *hw, int p)
2412{
2413 return port_chk(hw, p,
2414 KS8842_PORT_CTRL_1_OFFSET, PORT_PRIO_QUEUE_ENABLE);
2415}
2416
2417
2418
2419
2420
2421
2422
2423
2424static void sw_dis_diffserv(struct ksz_hw *hw, int port)
2425{
2426 port_cfg_diffserv(hw, port, 0);
2427}
2428
2429
2430
2431
2432
2433
2434
2435
2436static void sw_dis_802_1p(struct ksz_hw *hw, int port)
2437{
2438 port_cfg_802_1p(hw, port, 0);
2439}
2440
2441
2442
2443
2444
2445
2446
2447static void sw_cfg_replace_null_vid(struct ksz_hw *hw, int set)
2448{
2449 sw_cfg(hw, KS8842_SWITCH_CTRL_3_OFFSET, SWITCH_REPLACE_NULL_VID, set);
2450}
2451
2452
2453
2454
2455
2456
2457
2458
2459
2460
2461
2462
2463static void sw_cfg_replace_vid(struct ksz_hw *hw, int port, int set)
2464{
2465 port_cfg_replace_vid(hw, port, set);
2466}
2467
2468
2469
2470
2471
2472
2473
2474
2475
2476static void sw_cfg_port_based(struct ksz_hw *hw, int port, u8 prio)
2477{
2478 u16 data;
2479
2480 if (prio > PORT_BASED_PRIORITY_BASE)
2481 prio = PORT_BASED_PRIORITY_BASE;
2482
2483 hw->ksz_switch->port_cfg[port].port_prio = prio;
2484
2485 port_r16(hw, port, KS8842_PORT_CTRL_1_OFFSET, &data);
2486 data &= ~PORT_BASED_PRIORITY_MASK;
2487 data |= prio << PORT_BASED_PRIORITY_SHIFT;
2488 port_w16(hw, port, KS8842_PORT_CTRL_1_OFFSET, data);
2489}
2490
2491
2492
2493
2494
2495
2496
2497
2498
2499static void sw_dis_multi_queue(struct ksz_hw *hw, int port)
2500{
2501 port_cfg_prio(hw, port, 0);
2502}
2503
2504
2505
2506
2507
2508
2509
2510static void sw_init_prio(struct ksz_hw *hw)
2511{
2512 int port;
2513 int tos;
2514 struct ksz_switch *sw = hw->ksz_switch;
2515
2516
2517
2518
2519
2520 sw->p_802_1p[0] = 0;
2521 sw->p_802_1p[1] = 0;
2522 sw->p_802_1p[2] = 1;
2523 sw->p_802_1p[3] = 1;
2524 sw->p_802_1p[4] = 2;
2525 sw->p_802_1p[5] = 2;
2526 sw->p_802_1p[6] = 3;
2527 sw->p_802_1p[7] = 3;
2528
2529
2530
2531
2532
2533 for (tos = 0; tos < DIFFSERV_ENTRIES; tos++)
2534 sw->diffserv[tos] = 0;
2535
2536
2537 for (port = 0; port < TOTAL_PORT_NUM; port++) {
2538 sw_dis_multi_queue(hw, port);
2539 sw_dis_diffserv(hw, port);
2540 sw_dis_802_1p(hw, port);
2541 sw_cfg_replace_vid(hw, port, 0);
2542
2543 sw->port_cfg[port].port_prio = 0;
2544 sw_cfg_port_based(hw, port, sw->port_cfg[port].port_prio);
2545 }
2546 sw_cfg_replace_null_vid(hw, 0);
2547}
2548
2549
2550
2551
2552
2553
2554
2555
2556
2557static void port_get_def_vid(struct ksz_hw *hw, int port, u16 *vid)
2558{
2559 u32 addr;
2560
2561 PORT_CTRL_ADDR(port, addr);
2562 addr += KS8842_PORT_CTRL_VID_OFFSET;
2563 *vid = readw(hw->io + addr);
2564}
2565
2566
2567
2568
2569
2570
2571
2572static void sw_init_vlan(struct ksz_hw *hw)
2573{
2574 int port;
2575 int entry;
2576 struct ksz_switch *sw = hw->ksz_switch;
2577
2578
2579 for (entry = 0; entry < VLAN_TABLE_ENTRIES; entry++) {
2580 sw_r_vlan_table(hw, entry,
2581 &sw->vlan_table[entry].vid,
2582 &sw->vlan_table[entry].fid,
2583 &sw->vlan_table[entry].member);
2584 }
2585
2586 for (port = 0; port < TOTAL_PORT_NUM; port++) {
2587 port_get_def_vid(hw, port, &sw->port_cfg[port].vid);
2588 sw->port_cfg[port].member = PORT_MASK;
2589 }
2590}
2591
2592
2593
2594
2595
2596
2597
2598
2599
2600static void sw_cfg_port_base_vlan(struct ksz_hw *hw, int port, u8 member)
2601{
2602 u32 addr;
2603 u8 data;
2604
2605 PORT_CTRL_ADDR(port, addr);
2606 addr += KS8842_PORT_CTRL_2_OFFSET;
2607
2608 data = readb(hw->io + addr);
2609 data &= ~PORT_VLAN_MEMBERSHIP;
2610 data |= (member & PORT_MASK);
2611 writeb(data, hw->io + addr);
2612
2613 hw->ksz_switch->port_cfg[port].member = member;
2614}
2615
2616
2617
2618
2619
2620
2621
2622
2623static inline void sw_get_addr(struct ksz_hw *hw, u8 *mac_addr)
2624{
2625 int i;
2626
2627 for (i = 0; i < 6; i += 2) {
2628 mac_addr[i] = readb(hw->io + KS8842_MAC_ADDR_0_OFFSET + i);
2629 mac_addr[1 + i] = readb(hw->io + KS8842_MAC_ADDR_1_OFFSET + i);
2630 }
2631}
2632
2633
2634
2635
2636
2637
2638
2639
2640static void sw_set_addr(struct ksz_hw *hw, u8 *mac_addr)
2641{
2642 int i;
2643
2644 for (i = 0; i < 6; i += 2) {
2645 writeb(mac_addr[i], hw->io + KS8842_MAC_ADDR_0_OFFSET + i);
2646 writeb(mac_addr[1 + i], hw->io + KS8842_MAC_ADDR_1_OFFSET + i);
2647 }
2648}
2649
2650
2651
2652
2653
2654
2655
2656static void sw_set_global_ctrl(struct ksz_hw *hw)
2657{
2658 u16 data;
2659
2660
2661 data = readw(hw->io + KS8842_SWITCH_CTRL_3_OFFSET);
2662 data |= SWITCH_FLOW_CTRL;
2663 writew(data, hw->io + KS8842_SWITCH_CTRL_3_OFFSET);
2664
2665 data = readw(hw->io + KS8842_SWITCH_CTRL_1_OFFSET);
2666
2667
2668 data |= SWITCH_AGGR_BACKOFF;
2669
2670
2671 data |= SWITCH_AGING_ENABLE;
2672 data |= SWITCH_LINK_AUTO_AGING;
2673
2674 if (hw->overrides & FAST_AGING)
2675 data |= SWITCH_FAST_AGING;
2676 else
2677 data &= ~SWITCH_FAST_AGING;
2678 writew(data, hw->io + KS8842_SWITCH_CTRL_1_OFFSET);
2679
2680 data = readw(hw->io + KS8842_SWITCH_CTRL_2_OFFSET);
2681
2682
2683 data |= NO_EXC_COLLISION_DROP;
2684 writew(data, hw->io + KS8842_SWITCH_CTRL_2_OFFSET);
2685}
2686
2687enum {
2688 STP_STATE_DISABLED = 0,
2689 STP_STATE_LISTENING,
2690 STP_STATE_LEARNING,
2691 STP_STATE_FORWARDING,
2692 STP_STATE_BLOCKED,
2693 STP_STATE_SIMPLE
2694};
2695
2696
2697
2698
2699
2700
2701
2702
2703
2704static void port_set_stp_state(struct ksz_hw *hw, int port, int state)
2705{
2706 u16 data;
2707
2708 port_r16(hw, port, KS8842_PORT_CTRL_2_OFFSET, &data);
2709 switch (state) {
2710 case STP_STATE_DISABLED:
2711 data &= ~(PORT_TX_ENABLE | PORT_RX_ENABLE);
2712 data |= PORT_LEARN_DISABLE;
2713 break;
2714 case STP_STATE_LISTENING:
2715
2716
2717
2718
2719 data &= ~PORT_TX_ENABLE;
2720 data |= PORT_RX_ENABLE;
2721 data |= PORT_LEARN_DISABLE;
2722 break;
2723 case STP_STATE_LEARNING:
2724 data &= ~PORT_TX_ENABLE;
2725 data |= PORT_RX_ENABLE;
2726 data &= ~PORT_LEARN_DISABLE;
2727 break;
2728 case STP_STATE_FORWARDING:
2729 data |= (PORT_TX_ENABLE | PORT_RX_ENABLE);
2730 data &= ~PORT_LEARN_DISABLE;
2731 break;
2732 case STP_STATE_BLOCKED:
2733
2734
2735
2736
2737 data &= ~(PORT_TX_ENABLE | PORT_RX_ENABLE);
2738 data |= PORT_LEARN_DISABLE;
2739 break;
2740 case STP_STATE_SIMPLE:
2741 data |= (PORT_TX_ENABLE | PORT_RX_ENABLE);
2742 data |= PORT_LEARN_DISABLE;
2743 break;
2744 }
2745 port_w16(hw, port, KS8842_PORT_CTRL_2_OFFSET, data);
2746 hw->ksz_switch->port_cfg[port].stp_state = state;
2747}
2748
2749#define STP_ENTRY 0
2750#define BROADCAST_ENTRY 1
2751#define BRIDGE_ADDR_ENTRY 2
2752#define IPV6_ADDR_ENTRY 3
2753
2754
2755
2756
2757
2758
2759
2760static void sw_clr_sta_mac_table(struct ksz_hw *hw)
2761{
2762 struct ksz_mac_table *entry;
2763 int i;
2764
2765 for (i = 0; i < STATIC_MAC_TABLE_ENTRIES; i++) {
2766 entry = &hw->ksz_switch->mac_table[i];
2767 sw_w_sta_mac_table(hw, i,
2768 entry->mac_addr, entry->ports,
2769 entry->override, 0,
2770 entry->use_fid, entry->fid);
2771 }
2772}
2773
2774
2775
2776
2777
2778
2779
2780static void sw_init_stp(struct ksz_hw *hw)
2781{
2782 struct ksz_mac_table *entry;
2783
2784 entry = &hw->ksz_switch->mac_table[STP_ENTRY];
2785 entry->mac_addr[0] = 0x01;
2786 entry->mac_addr[1] = 0x80;
2787 entry->mac_addr[2] = 0xC2;
2788 entry->mac_addr[3] = 0x00;
2789 entry->mac_addr[4] = 0x00;
2790 entry->mac_addr[5] = 0x00;
2791 entry->ports = HOST_MASK;
2792 entry->override = 1;
2793 entry->valid = 1;
2794 sw_w_sta_mac_table(hw, STP_ENTRY,
2795 entry->mac_addr, entry->ports,
2796 entry->override, entry->valid,
2797 entry->use_fid, entry->fid);
2798}
2799
2800
2801
2802
2803
2804
2805
2806static void sw_block_addr(struct ksz_hw *hw)
2807{
2808 struct ksz_mac_table *entry;
2809 int i;
2810
2811 for (i = BROADCAST_ENTRY; i <= IPV6_ADDR_ENTRY; i++) {
2812 entry = &hw->ksz_switch->mac_table[i];
2813 entry->valid = 0;
2814 sw_w_sta_mac_table(hw, i,
2815 entry->mac_addr, entry->ports,
2816 entry->override, entry->valid,
2817 entry->use_fid, entry->fid);
2818 }
2819}
2820
2821static inline void hw_r_phy_ctrl(struct ksz_hw *hw, int phy, u16 *data)
2822{
2823 *data = readw(hw->io + phy + KS884X_PHY_CTRL_OFFSET);
2824}
2825
2826static inline void hw_w_phy_ctrl(struct ksz_hw *hw, int phy, u16 data)
2827{
2828 writew(data, hw->io + phy + KS884X_PHY_CTRL_OFFSET);
2829}
2830
2831static inline void hw_r_phy_link_stat(struct ksz_hw *hw, int phy, u16 *data)
2832{
2833 *data = readw(hw->io + phy + KS884X_PHY_STATUS_OFFSET);
2834}
2835
2836static inline void hw_r_phy_auto_neg(struct ksz_hw *hw, int phy, u16 *data)
2837{
2838 *data = readw(hw->io + phy + KS884X_PHY_AUTO_NEG_OFFSET);
2839}
2840
2841static inline void hw_w_phy_auto_neg(struct ksz_hw *hw, int phy, u16 data)
2842{
2843 writew(data, hw->io + phy + KS884X_PHY_AUTO_NEG_OFFSET);
2844}
2845
2846static inline void hw_r_phy_rem_cap(struct ksz_hw *hw, int phy, u16 *data)
2847{
2848 *data = readw(hw->io + phy + KS884X_PHY_REMOTE_CAP_OFFSET);
2849}
2850
2851static inline void hw_r_phy_crossover(struct ksz_hw *hw, int phy, u16 *data)
2852{
2853 *data = readw(hw->io + phy + KS884X_PHY_CTRL_OFFSET);
2854}
2855
2856static inline void hw_w_phy_crossover(struct ksz_hw *hw, int phy, u16 data)
2857{
2858 writew(data, hw->io + phy + KS884X_PHY_CTRL_OFFSET);
2859}
2860
2861static inline void hw_r_phy_polarity(struct ksz_hw *hw, int phy, u16 *data)
2862{
2863 *data = readw(hw->io + phy + KS884X_PHY_PHY_CTRL_OFFSET);
2864}
2865
2866static inline void hw_w_phy_polarity(struct ksz_hw *hw, int phy, u16 data)
2867{
2868 writew(data, hw->io + phy + KS884X_PHY_PHY_CTRL_OFFSET);
2869}
2870
2871static inline void hw_r_phy_link_md(struct ksz_hw *hw, int phy, u16 *data)
2872{
2873 *data = readw(hw->io + phy + KS884X_PHY_LINK_MD_OFFSET);
2874}
2875
2876static inline void hw_w_phy_link_md(struct ksz_hw *hw, int phy, u16 data)
2877{
2878 writew(data, hw->io + phy + KS884X_PHY_LINK_MD_OFFSET);
2879}
2880
2881
2882
2883
2884
2885
2886
2887
2888
2889
2890static void hw_r_phy(struct ksz_hw *hw, int port, u16 reg, u16 *val)
2891{
2892 int phy;
2893
2894 phy = KS884X_PHY_1_CTRL_OFFSET + port * PHY_CTRL_INTERVAL + reg;
2895 *val = readw(hw->io + phy);
2896}
2897
2898
2899
2900
2901
2902
2903
2904
2905
2906
2907static void hw_w_phy(struct ksz_hw *hw, int port, u16 reg, u16 val)
2908{
2909 int phy;
2910
2911 phy = KS884X_PHY_1_CTRL_OFFSET + port * PHY_CTRL_INTERVAL + reg;
2912 writew(val, hw->io + phy);
2913}
2914
2915
2916
2917
2918
2919#define AT93C_CODE 0
2920#define AT93C_WR_OFF 0x00
2921#define AT93C_WR_ALL 0x10
2922#define AT93C_ER_ALL 0x20
2923#define AT93C_WR_ON 0x30
2924
2925#define AT93C_WRITE 1
2926#define AT93C_READ 2
2927#define AT93C_ERASE 3
2928
2929#define EEPROM_DELAY 4
2930
2931static inline void drop_gpio(struct ksz_hw *hw, u8 gpio)
2932{
2933 u16 data;
2934
2935 data = readw(hw->io + KS884X_EEPROM_CTRL_OFFSET);
2936 data &= ~gpio;
2937 writew(data, hw->io + KS884X_EEPROM_CTRL_OFFSET);
2938}
2939
2940static inline void raise_gpio(struct ksz_hw *hw, u8 gpio)
2941{
2942 u16 data;
2943
2944 data = readw(hw->io + KS884X_EEPROM_CTRL_OFFSET);
2945 data |= gpio;
2946 writew(data, hw->io + KS884X_EEPROM_CTRL_OFFSET);
2947}
2948
2949static inline u8 state_gpio(struct ksz_hw *hw, u8 gpio)
2950{
2951 u16 data;
2952
2953 data = readw(hw->io + KS884X_EEPROM_CTRL_OFFSET);
2954 return (u8)(data & gpio);
2955}
2956
2957static void eeprom_clk(struct ksz_hw *hw)
2958{
2959 raise_gpio(hw, EEPROM_SERIAL_CLOCK);
2960 udelay(EEPROM_DELAY);
2961 drop_gpio(hw, EEPROM_SERIAL_CLOCK);
2962 udelay(EEPROM_DELAY);
2963}
2964
2965static u16 spi_r(struct ksz_hw *hw)
2966{
2967 int i;
2968 u16 temp = 0;
2969
2970 for (i = 15; i >= 0; i--) {
2971 raise_gpio(hw, EEPROM_SERIAL_CLOCK);
2972 udelay(EEPROM_DELAY);
2973
2974 temp |= (state_gpio(hw, EEPROM_DATA_IN)) ? 1 << i : 0;
2975
2976 drop_gpio(hw, EEPROM_SERIAL_CLOCK);
2977 udelay(EEPROM_DELAY);
2978 }
2979 return temp;
2980}
2981
2982static void spi_w(struct ksz_hw *hw, u16 data)
2983{
2984 int i;
2985
2986 for (i = 15; i >= 0; i--) {
2987 (data & (0x01 << i)) ? raise_gpio(hw, EEPROM_DATA_OUT) :
2988 drop_gpio(hw, EEPROM_DATA_OUT);
2989 eeprom_clk(hw);
2990 }
2991}
2992
2993static void spi_reg(struct ksz_hw *hw, u8 data, u8 reg)
2994{
2995 int i;
2996
2997
2998 raise_gpio(hw, EEPROM_DATA_OUT);
2999 eeprom_clk(hw);
3000
3001
3002 for (i = 1; i >= 0; i--) {
3003 (data & (0x01 << i)) ? raise_gpio(hw, EEPROM_DATA_OUT) :
3004 drop_gpio(hw, EEPROM_DATA_OUT);
3005 eeprom_clk(hw);
3006 }
3007
3008
3009 for (i = 5; i >= 0; i--) {
3010 (reg & (0x01 << i)) ? raise_gpio(hw, EEPROM_DATA_OUT) :
3011 drop_gpio(hw, EEPROM_DATA_OUT);
3012 eeprom_clk(hw);
3013 }
3014}
3015
3016#define EEPROM_DATA_RESERVED 0
3017#define EEPROM_DATA_MAC_ADDR_0 1
3018#define EEPROM_DATA_MAC_ADDR_1 2
3019#define EEPROM_DATA_MAC_ADDR_2 3
3020#define EEPROM_DATA_SUBSYS_ID 4
3021#define EEPROM_DATA_SUBSYS_VEN_ID 5
3022#define EEPROM_DATA_PM_CAP 6
3023
3024
3025#define EEPROM_DATA_OTHER_MAC_ADDR 9
3026
3027
3028
3029
3030
3031
3032
3033
3034
3035
3036static u16 eeprom_read(struct ksz_hw *hw, u8 reg)
3037{
3038 u16 data;
3039
3040 raise_gpio(hw, EEPROM_ACCESS_ENABLE | EEPROM_CHIP_SELECT);
3041
3042 spi_reg(hw, AT93C_READ, reg);
3043 data = spi_r(hw);
3044
3045 drop_gpio(hw, EEPROM_ACCESS_ENABLE | EEPROM_CHIP_SELECT);
3046
3047 return data;
3048}
3049
3050
3051
3052
3053
3054
3055
3056
3057
3058static void eeprom_write(struct ksz_hw *hw, u8 reg, u16 data)
3059{
3060 int timeout;
3061
3062 raise_gpio(hw, EEPROM_ACCESS_ENABLE | EEPROM_CHIP_SELECT);
3063
3064
3065 spi_reg(hw, AT93C_CODE, AT93C_WR_ON);
3066 drop_gpio(hw, EEPROM_CHIP_SELECT);
3067 udelay(1);
3068
3069
3070 raise_gpio(hw, EEPROM_CHIP_SELECT);
3071 spi_reg(hw, AT93C_ERASE, reg);
3072 drop_gpio(hw, EEPROM_CHIP_SELECT);
3073 udelay(1);
3074
3075
3076 raise_gpio(hw, EEPROM_CHIP_SELECT);
3077 timeout = 8;
3078 mdelay(2);
3079 do {
3080 mdelay(1);
3081 } while (!state_gpio(hw, EEPROM_DATA_IN) && --timeout);
3082 drop_gpio(hw, EEPROM_CHIP_SELECT);
3083 udelay(1);
3084
3085
3086 raise_gpio(hw, EEPROM_CHIP_SELECT);
3087 spi_reg(hw, AT93C_WRITE, reg);
3088 spi_w(hw, data);
3089 drop_gpio(hw, EEPROM_CHIP_SELECT);
3090 udelay(1);
3091
3092
3093 raise_gpio(hw, EEPROM_CHIP_SELECT);
3094 timeout = 8;
3095 mdelay(2);
3096 do {
3097 mdelay(1);
3098 } while (!state_gpio(hw, EEPROM_DATA_IN) && --timeout);
3099 drop_gpio(hw, EEPROM_CHIP_SELECT);
3100 udelay(1);
3101
3102
3103 raise_gpio(hw, EEPROM_CHIP_SELECT);
3104 spi_reg(hw, AT93C_CODE, AT93C_WR_OFF);
3105
3106 drop_gpio(hw, EEPROM_ACCESS_ENABLE | EEPROM_CHIP_SELECT);
3107}
3108
3109
3110
3111
3112
3113static u16 advertised_flow_ctrl(struct ksz_port *port, u16 ctrl)
3114{
3115 ctrl &= ~PORT_AUTO_NEG_SYM_PAUSE;
3116 switch (port->flow_ctrl) {
3117 case PHY_FLOW_CTRL:
3118 ctrl |= PORT_AUTO_NEG_SYM_PAUSE;
3119 break;
3120
3121 case PHY_TX_ONLY:
3122 case PHY_RX_ONLY:
3123 default:
3124 break;
3125 }
3126 return ctrl;
3127}
3128
3129static void set_flow_ctrl(struct ksz_hw *hw, int rx, int tx)
3130{
3131 u32 rx_cfg;
3132 u32 tx_cfg;
3133
3134 rx_cfg = hw->rx_cfg;
3135 tx_cfg = hw->tx_cfg;
3136 if (rx)
3137 hw->rx_cfg |= DMA_RX_FLOW_ENABLE;
3138 else
3139 hw->rx_cfg &= ~DMA_RX_FLOW_ENABLE;
3140 if (tx)
3141 hw->tx_cfg |= DMA_TX_FLOW_ENABLE;
3142 else
3143 hw->tx_cfg &= ~DMA_TX_FLOW_ENABLE;
3144 if (hw->enabled) {
3145 if (rx_cfg != hw->rx_cfg)
3146 writel(hw->rx_cfg, hw->io + KS_DMA_RX_CTRL);
3147 if (tx_cfg != hw->tx_cfg)
3148 writel(hw->tx_cfg, hw->io + KS_DMA_TX_CTRL);
3149 }
3150}
3151
3152static void determine_flow_ctrl(struct ksz_hw *hw, struct ksz_port *port,
3153 u16 local, u16 remote)
3154{
3155 int rx;
3156 int tx;
3157
3158 if (hw->overrides & PAUSE_FLOW_CTRL)
3159 return;
3160
3161 rx = tx = 0;
3162 if (port->force_link)
3163 rx = tx = 1;
3164 if (remote & LPA_PAUSE_CAP) {
3165 if (local & ADVERTISE_PAUSE_CAP) {
3166 rx = tx = 1;
3167 } else if ((remote & LPA_PAUSE_ASYM) &&
3168 (local &
3169 (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM)) ==
3170 ADVERTISE_PAUSE_ASYM) {
3171 tx = 1;
3172 }
3173 } else if (remote & LPA_PAUSE_ASYM) {
3174 if ((local & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM))
3175 == (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM))
3176 rx = 1;
3177 }
3178 if (!hw->ksz_switch)
3179 set_flow_ctrl(hw, rx, tx);
3180}
3181
3182static inline void port_cfg_change(struct ksz_hw *hw, struct ksz_port *port,
3183 struct ksz_port_info *info, u16 link_status)
3184{
3185 if ((hw->features & HALF_DUPLEX_SIGNAL_BUG) &&
3186 !(hw->overrides & PAUSE_FLOW_CTRL)) {
3187 u32 cfg = hw->tx_cfg;
3188
3189
3190 if (1 == info->duplex)
3191 hw->tx_cfg &= ~DMA_TX_FLOW_ENABLE;
3192 if (hw->enabled && cfg != hw->tx_cfg)
3193 writel(hw->tx_cfg, hw->io + KS_DMA_TX_CTRL);
3194 }
3195}
3196
3197
3198
3199
3200
3201
3202
3203
3204static void port_get_link_speed(struct ksz_port *port)
3205{
3206 uint interrupt;
3207 struct ksz_port_info *info;
3208 struct ksz_port_info *linked = NULL;
3209 struct ksz_hw *hw = port->hw;
3210 u16 data;
3211 u16 status;
3212 u8 local;
3213 u8 remote;
3214 int i;
3215 int p;
3216 int change = 0;
3217
3218 interrupt = hw_block_intr(hw);
3219
3220 for (i = 0, p = port->first_port; i < port->port_cnt; i++, p++) {
3221 info = &hw->port_info[p];
3222 port_r16(hw, p, KS884X_PORT_CTRL_4_OFFSET, &data);
3223 port_r16(hw, p, KS884X_PORT_STATUS_OFFSET, &status);
3224
3225
3226
3227
3228
3229 remote = status & (PORT_AUTO_NEG_COMPLETE |
3230 PORT_STATUS_LINK_GOOD);
3231 local = (u8) data;
3232
3233
3234 if (local == info->advertised && remote == info->partner)
3235 continue;
3236
3237 info->advertised = local;
3238 info->partner = remote;
3239 if (status & PORT_STATUS_LINK_GOOD) {
3240
3241
3242 if (!linked)
3243 linked = info;
3244
3245 info->tx_rate = 10 * TX_RATE_UNIT;
3246 if (status & PORT_STATUS_SPEED_100MBIT)
3247 info->tx_rate = 100 * TX_RATE_UNIT;
3248
3249 info->duplex = 1;
3250 if (status & PORT_STATUS_FULL_DUPLEX)
3251 info->duplex = 2;
3252
3253 if (media_connected != info->state) {
3254 hw_r_phy(hw, p, KS884X_PHY_AUTO_NEG_OFFSET,
3255 &data);
3256 hw_r_phy(hw, p, KS884X_PHY_REMOTE_CAP_OFFSET,
3257 &status);
3258 determine_flow_ctrl(hw, port, data, status);
3259 if (hw->ksz_switch) {
3260 port_cfg_back_pressure(hw, p,
3261 (1 == info->duplex));
3262 }
3263 change |= 1 << i;
3264 port_cfg_change(hw, port, info, status);
3265 }
3266 info->state = media_connected;
3267 } else {
3268 if (media_disconnected != info->state) {
3269 change |= 1 << i;
3270
3271
3272 hw->port_mib[p].link_down = 1;
3273 }
3274 info->state = media_disconnected;
3275 }
3276 hw->port_mib[p].state = (u8) info->state;
3277 }
3278
3279 if (linked && media_disconnected == port->linked->state)
3280 port->linked = linked;
3281
3282 hw_restore_intr(hw, interrupt);
3283}
3284
3285#define PHY_RESET_TIMEOUT 10
3286
3287
3288
3289
3290
3291
3292
3293static void port_set_link_speed(struct ksz_port *port)
3294{
3295 struct ksz_hw *hw = port->hw;
3296 u16 data;
3297 u16 cfg;
3298 u8 status;
3299 int i;
3300 int p;
3301
3302 for (i = 0, p = port->first_port; i < port->port_cnt; i++, p++) {
3303 port_r16(hw, p, KS884X_PORT_CTRL_4_OFFSET, &data);
3304 port_r8(hw, p, KS884X_PORT_STATUS_OFFSET, &status);
3305
3306 cfg = 0;
3307 if (status & PORT_STATUS_LINK_GOOD)
3308 cfg = data;
3309
3310 data |= PORT_AUTO_NEG_ENABLE;
3311 data = advertised_flow_ctrl(port, data);
3312
3313 data |= PORT_AUTO_NEG_100BTX_FD | PORT_AUTO_NEG_100BTX |
3314 PORT_AUTO_NEG_10BT_FD | PORT_AUTO_NEG_10BT;
3315
3316
3317 if (port->speed || port->duplex) {
3318 if (10 == port->speed)
3319 data &= ~(PORT_AUTO_NEG_100BTX_FD |
3320 PORT_AUTO_NEG_100BTX);
3321 else if (100 == port->speed)
3322 data &= ~(PORT_AUTO_NEG_10BT_FD |
3323 PORT_AUTO_NEG_10BT);
3324 if (1 == port->duplex)
3325 data &= ~(PORT_AUTO_NEG_100BTX_FD |
3326 PORT_AUTO_NEG_10BT_FD);
3327 else if (2 == port->duplex)
3328 data &= ~(PORT_AUTO_NEG_100BTX |
3329 PORT_AUTO_NEG_10BT);
3330 }
3331 if (data != cfg) {
3332 data |= PORT_AUTO_NEG_RESTART;
3333 port_w16(hw, p, KS884X_PORT_CTRL_4_OFFSET, data);
3334 }
3335 }
3336}
3337
3338
3339
3340
3341
3342
3343
3344static void port_force_link_speed(struct ksz_port *port)
3345{
3346 struct ksz_hw *hw = port->hw;
3347 u16 data;
3348 int i;
3349 int phy;
3350 int p;
3351
3352 for (i = 0, p = port->first_port; i < port->port_cnt; i++, p++) {
3353 phy = KS884X_PHY_1_CTRL_OFFSET + p * PHY_CTRL_INTERVAL;
3354 hw_r_phy_ctrl(hw, phy, &data);
3355
3356 data &= ~BMCR_ANENABLE;
3357
3358 if (10 == port->speed)
3359 data &= ~BMCR_SPEED100;
3360 else if (100 == port->speed)
3361 data |= BMCR_SPEED100;
3362 if (1 == port->duplex)
3363 data &= ~BMCR_FULLDPLX;
3364 else if (2 == port->duplex)
3365 data |= BMCR_FULLDPLX;
3366 hw_w_phy_ctrl(hw, phy, data);
3367 }
3368}
3369
3370static void port_set_power_saving(struct ksz_port *port, int enable)
3371{
3372 struct ksz_hw *hw = port->hw;
3373 int i;
3374 int p;
3375
3376 for (i = 0, p = port->first_port; i < port->port_cnt; i++, p++)
3377 port_cfg(hw, p,
3378 KS884X_PORT_CTRL_4_OFFSET, PORT_POWER_DOWN, enable);
3379}
3380
3381
3382
3383
3384
3385
3386
3387
3388
3389
3390
3391
3392
3393static int hw_chk_wol_pme_status(struct ksz_hw *hw)
3394{
3395 struct dev_info *hw_priv = container_of(hw, struct dev_info, hw);
3396 struct pci_dev *pdev = hw_priv->pdev;
3397 u16 data;
3398
3399 if (!pdev->pm_cap)
3400 return 0;
3401 pci_read_config_word(pdev, pdev->pm_cap + PCI_PM_CTRL, &data);
3402 return (data & PCI_PM_CTRL_PME_STATUS) == PCI_PM_CTRL_PME_STATUS;
3403}
3404
3405
3406
3407
3408
3409
3410
3411static void hw_clr_wol_pme_status(struct ksz_hw *hw)
3412{
3413 struct dev_info *hw_priv = container_of(hw, struct dev_info, hw);
3414 struct pci_dev *pdev = hw_priv->pdev;
3415 u16 data;
3416
3417 if (!pdev->pm_cap)
3418 return;
3419
3420
3421 pci_read_config_word(pdev, pdev->pm_cap + PCI_PM_CTRL, &data);
3422 data |= PCI_PM_CTRL_PME_STATUS;
3423 pci_write_config_word(pdev, pdev->pm_cap + PCI_PM_CTRL, data);
3424}
3425
3426
3427
3428
3429
3430
3431
3432
3433static void hw_cfg_wol_pme(struct ksz_hw *hw, int set)
3434{
3435 struct dev_info *hw_priv = container_of(hw, struct dev_info, hw);
3436 struct pci_dev *pdev = hw_priv->pdev;
3437 u16 data;
3438
3439 if (!pdev->pm_cap)
3440 return;
3441 pci_read_config_word(pdev, pdev->pm_cap + PCI_PM_CTRL, &data);
3442 data &= ~PCI_PM_CTRL_STATE_MASK;
3443 if (set)
3444 data |= PCI_PM_CTRL_PME_ENABLE | PCI_D3hot;
3445 else
3446 data &= ~PCI_PM_CTRL_PME_ENABLE;
3447 pci_write_config_word(pdev, pdev->pm_cap + PCI_PM_CTRL, data);
3448}
3449
3450
3451
3452
3453
3454
3455
3456
3457
3458static void hw_cfg_wol(struct ksz_hw *hw, u16 frame, int set)
3459{
3460 u16 data;
3461
3462 data = readw(hw->io + KS8841_WOL_CTRL_OFFSET);
3463 if (set)
3464 data |= frame;
3465 else
3466 data &= ~frame;
3467 writew(data, hw->io + KS8841_WOL_CTRL_OFFSET);
3468}
3469
3470
3471
3472
3473
3474
3475
3476
3477
3478
3479
3480
3481static void hw_set_wol_frame(struct ksz_hw *hw, int i, uint mask_size,
3482 const u8 *mask, uint frame_size, const u8 *pattern)
3483{
3484 int bits;
3485 int from;
3486 int len;
3487 int to;
3488 u32 crc;
3489 u8 data[64];
3490 u8 val = 0;
3491
3492 if (frame_size > mask_size * 8)
3493 frame_size = mask_size * 8;
3494 if (frame_size > 64)
3495 frame_size = 64;
3496
3497 i *= 0x10;
3498 writel(0, hw->io + KS8841_WOL_FRAME_BYTE0_OFFSET + i);
3499 writel(0, hw->io + KS8841_WOL_FRAME_BYTE2_OFFSET + i);
3500
3501 bits = len = from = to = 0;
3502 do {
3503 if (bits) {
3504 if ((val & 1))
3505 data[to++] = pattern[from];
3506 val >>= 1;
3507 ++from;
3508 --bits;
3509 } else {
3510 val = mask[len];
3511 writeb(val, hw->io + KS8841_WOL_FRAME_BYTE0_OFFSET + i
3512 + len);
3513 ++len;
3514 if (val)
3515 bits = 8;
3516 else
3517 from += 8;
3518 }
3519 } while (from < (int) frame_size);
3520 if (val) {
3521 bits = mask[len - 1];
3522 val <<= (from % 8);
3523 bits &= ~val;
3524 writeb(bits, hw->io + KS8841_WOL_FRAME_BYTE0_OFFSET + i + len -
3525 1);
3526 }
3527 crc = ether_crc(to, data);
3528 writel(crc, hw->io + KS8841_WOL_FRAME_CRC_OFFSET + i);
3529}
3530
3531
3532
3533
3534
3535
3536
3537
3538static void hw_add_wol_arp(struct ksz_hw *hw, const u8 *ip_addr)
3539{
3540 static const u8 mask[6] = { 0x3F, 0xF0, 0x3F, 0x00, 0xC0, 0x03 };
3541 u8 pattern[42] = {
3542 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
3543 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
3544 0x08, 0x06,
3545 0x00, 0x01, 0x08, 0x00, 0x06, 0x04, 0x00, 0x01,
3546 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
3547 0x00, 0x00, 0x00, 0x00,
3548 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
3549 0x00, 0x00, 0x00, 0x00 };
3550
3551 memcpy(&pattern[38], ip_addr, 4);
3552 hw_set_wol_frame(hw, 3, 6, mask, 42, pattern);
3553}
3554
3555
3556
3557
3558
3559
3560
3561static void hw_add_wol_bcast(struct ksz_hw *hw)
3562{
3563 static const u8 mask[] = { 0x3F };
3564 static const u8 pattern[] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
3565
3566 hw_set_wol_frame(hw, 2, 1, mask, ETH_ALEN, pattern);
3567}
3568
3569
3570
3571
3572
3573
3574
3575
3576
3577
3578
3579static void hw_add_wol_mcast(struct ksz_hw *hw)
3580{
3581 static const u8 mask[] = { 0x3F };
3582 u8 pattern[] = { 0x33, 0x33, 0xFF, 0x00, 0x00, 0x00 };
3583
3584 memcpy(&pattern[3], &hw->override_addr[3], 3);
3585 hw_set_wol_frame(hw, 1, 1, mask, 6, pattern);
3586}
3587
3588
3589
3590
3591
3592
3593
3594
3595
3596
3597static void hw_add_wol_ucast(struct ksz_hw *hw)
3598{
3599 static const u8 mask[] = { 0x3F };
3600
3601 hw_set_wol_frame(hw, 0, 1, mask, ETH_ALEN, hw->override_addr);
3602}
3603
3604
3605
3606
3607
3608
3609
3610
3611
3612static void hw_enable_wol(struct ksz_hw *hw, u32 wol_enable, const u8 *net_addr)
3613{
3614 hw_cfg_wol(hw, KS8841_WOL_MAGIC_ENABLE, (wol_enable & WAKE_MAGIC));
3615 hw_cfg_wol(hw, KS8841_WOL_FRAME0_ENABLE, (wol_enable & WAKE_UCAST));
3616 hw_add_wol_ucast(hw);
3617 hw_cfg_wol(hw, KS8841_WOL_FRAME1_ENABLE, (wol_enable & WAKE_MCAST));
3618 hw_add_wol_mcast(hw);
3619 hw_cfg_wol(hw, KS8841_WOL_FRAME2_ENABLE, (wol_enable & WAKE_BCAST));
3620 hw_cfg_wol(hw, KS8841_WOL_FRAME3_ENABLE, (wol_enable & WAKE_ARP));
3621 hw_add_wol_arp(hw, net_addr);
3622}
3623
3624
3625
3626
3627
3628
3629
3630
3631
3632
3633static int hw_init(struct ksz_hw *hw)
3634{
3635 int rc = 0;
3636 u16 data;
3637 u16 revision;
3638
3639
3640 writew(BUS_SPEED_125_MHZ, hw->io + KS884X_BUS_CTRL_OFFSET);
3641
3642
3643 data = readw(hw->io + KS884X_CHIP_ID_OFFSET);
3644
3645 revision = (data & KS884X_REVISION_MASK) >> KS884X_REVISION_SHIFT;
3646 data &= KS884X_CHIP_ID_MASK_41;
3647 if (REG_CHIP_ID_41 == data)
3648 rc = 1;
3649 else if (REG_CHIP_ID_42 == data)
3650 rc = 2;
3651 else
3652 return 0;
3653
3654
3655 if (revision <= 1) {
3656 hw->features |= SMALL_PACKET_TX_BUG;
3657 if (1 == rc)
3658 hw->features |= HALF_DUPLEX_SIGNAL_BUG;
3659 }
3660 return rc;
3661}
3662
3663
3664
3665
3666
3667
3668
3669static void hw_reset(struct ksz_hw *hw)
3670{
3671 writew(GLOBAL_SOFTWARE_RESET, hw->io + KS884X_GLOBAL_CTRL_OFFSET);
3672
3673
3674 mdelay(10);
3675
3676
3677 writew(0, hw->io + KS884X_GLOBAL_CTRL_OFFSET);
3678}
3679
3680
3681
3682
3683
3684
3685
3686static void hw_setup(struct ksz_hw *hw)
3687{
3688#if SET_DEFAULT_LED
3689 u16 data;
3690
3691
3692 data = readw(hw->io + KS8842_SWITCH_CTRL_5_OFFSET);
3693 data &= ~LED_MODE;
3694 data |= SET_DEFAULT_LED;
3695 writew(data, hw->io + KS8842_SWITCH_CTRL_5_OFFSET);
3696#endif
3697
3698
3699 hw->tx_cfg = (DMA_TX_PAD_ENABLE | DMA_TX_CRC_ENABLE |
3700 (DMA_BURST_DEFAULT << DMA_BURST_SHIFT) | DMA_TX_ENABLE);
3701
3702
3703 hw->rx_cfg = (DMA_RX_BROADCAST | DMA_RX_UNICAST |
3704 (DMA_BURST_DEFAULT << DMA_BURST_SHIFT) | DMA_RX_ENABLE);
3705 hw->rx_cfg |= KS884X_DMA_RX_MULTICAST;
3706
3707
3708 hw->rx_cfg |= (DMA_RX_CSUM_TCP | DMA_RX_CSUM_IP);
3709
3710 if (hw->all_multi)
3711 hw->rx_cfg |= DMA_RX_ALL_MULTICAST;
3712 if (hw->promiscuous)
3713 hw->rx_cfg |= DMA_RX_PROMISCUOUS;
3714}
3715
3716
3717
3718
3719
3720
3721
3722static void hw_setup_intr(struct ksz_hw *hw)
3723{
3724 hw->intr_mask = KS884X_INT_MASK | KS884X_INT_RX_OVERRUN;
3725}
3726
3727static void ksz_check_desc_num(struct ksz_desc_info *info)
3728{
3729#define MIN_DESC_SHIFT 2
3730
3731 int alloc = info->alloc;
3732 int shift;
3733
3734 shift = 0;
3735 while (!(alloc & 1)) {
3736 shift++;
3737 alloc >>= 1;
3738 }
3739 if (alloc != 1 || shift < MIN_DESC_SHIFT) {
3740 pr_alert("Hardware descriptor numbers not right!\n");
3741 while (alloc) {
3742 shift++;
3743 alloc >>= 1;
3744 }
3745 if (shift < MIN_DESC_SHIFT)
3746 shift = MIN_DESC_SHIFT;
3747 alloc = 1 << shift;
3748 info->alloc = alloc;
3749 }
3750 info->mask = info->alloc - 1;
3751}
3752
3753static void hw_init_desc(struct ksz_desc_info *desc_info, int transmit)
3754{
3755 int i;
3756 u32 phys = desc_info->ring_phys;
3757 struct ksz_hw_desc *desc = desc_info->ring_virt;
3758 struct ksz_desc *cur = desc_info->ring;
3759 struct ksz_desc *previous = NULL;
3760
3761 for (i = 0; i < desc_info->alloc; i++) {
3762 cur->phw = desc++;
3763 phys += desc_info->size;
3764 previous = cur++;
3765 previous->phw->next = cpu_to_le32(phys);
3766 }
3767 previous->phw->next = cpu_to_le32(desc_info->ring_phys);
3768 previous->sw.buf.rx.end_of_ring = 1;
3769 previous->phw->buf.data = cpu_to_le32(previous->sw.buf.data);
3770
3771 desc_info->avail = desc_info->alloc;
3772 desc_info->last = desc_info->next = 0;
3773
3774 desc_info->cur = desc_info->ring;
3775}
3776
3777
3778
3779
3780
3781
3782
3783
3784
3785static void hw_set_desc_base(struct ksz_hw *hw, u32 tx_addr, u32 rx_addr)
3786{
3787
3788 writel(tx_addr, hw->io + KS_DMA_TX_ADDR);
3789 writel(rx_addr, hw->io + KS_DMA_RX_ADDR);
3790}
3791
3792static void hw_reset_pkts(struct ksz_desc_info *info)
3793{
3794 info->cur = info->ring;
3795 info->avail = info->alloc;
3796 info->last = info->next = 0;
3797}
3798
3799static inline void hw_resume_rx(struct ksz_hw *hw)
3800{
3801 writel(DMA_START, hw->io + KS_DMA_RX_START);
3802}
3803
3804
3805
3806
3807
3808
3809
3810static void hw_start_rx(struct ksz_hw *hw)
3811{
3812 writel(hw->rx_cfg, hw->io + KS_DMA_RX_CTRL);
3813
3814
3815 hw->intr_mask |= KS884X_INT_RX_STOPPED;
3816
3817 writel(DMA_START, hw->io + KS_DMA_RX_START);
3818 hw_ack_intr(hw, KS884X_INT_RX_STOPPED);
3819 hw->rx_stop++;
3820
3821
3822 if (0 == hw->rx_stop)
3823 hw->rx_stop = 2;
3824}
3825
3826
3827
3828
3829
3830
3831
3832static void hw_stop_rx(struct ksz_hw *hw)
3833{
3834 hw->rx_stop = 0;
3835 hw_turn_off_intr(hw, KS884X_INT_RX_STOPPED);
3836 writel((hw->rx_cfg & ~DMA_RX_ENABLE), hw->io + KS_DMA_RX_CTRL);
3837}
3838
3839
3840
3841
3842
3843
3844
3845static void hw_start_tx(struct ksz_hw *hw)
3846{
3847 writel(hw->tx_cfg, hw->io + KS_DMA_TX_CTRL);
3848}
3849
3850
3851
3852
3853
3854
3855
3856static void hw_stop_tx(struct ksz_hw *hw)
3857{
3858 writel((hw->tx_cfg & ~DMA_TX_ENABLE), hw->io + KS_DMA_TX_CTRL);
3859}
3860
3861
3862
3863
3864
3865
3866
3867static void hw_disable(struct ksz_hw *hw)
3868{
3869 hw_stop_rx(hw);
3870 hw_stop_tx(hw);
3871 hw->enabled = 0;
3872}
3873
3874
3875
3876
3877
3878
3879
3880static void hw_enable(struct ksz_hw *hw)
3881{
3882 hw_start_tx(hw);
3883 hw_start_rx(hw);
3884 hw->enabled = 1;
3885}
3886
3887
3888
3889
3890
3891
3892
3893
3894
3895
3896
3897static int hw_alloc_pkt(struct ksz_hw *hw, int length, int physical)
3898{
3899
3900 if (hw->tx_desc_info.avail <= 1)
3901 return 0;
3902
3903
3904 get_tx_pkt(&hw->tx_desc_info, &hw->tx_desc_info.cur);
3905 hw->tx_desc_info.cur->sw.buf.tx.first_seg = 1;
3906
3907
3908 ++hw->tx_int_cnt;
3909 hw->tx_size += length;
3910
3911
3912 if (hw->tx_size >= MAX_TX_HELD_SIZE)
3913 hw->tx_int_cnt = hw->tx_int_mask + 1;
3914
3915 if (physical > hw->tx_desc_info.avail)
3916 return 1;
3917
3918 return hw->tx_desc_info.avail;
3919}
3920
3921
3922
3923
3924
3925
3926
3927static void hw_send_pkt(struct ksz_hw *hw)
3928{
3929 struct ksz_desc *cur = hw->tx_desc_info.cur;
3930
3931 cur->sw.buf.tx.last_seg = 1;
3932
3933
3934 if (hw->tx_int_cnt > hw->tx_int_mask) {
3935 cur->sw.buf.tx.intr = 1;
3936 hw->tx_int_cnt = 0;
3937 hw->tx_size = 0;
3938 }
3939
3940
3941 cur->sw.buf.tx.dest_port = hw->dst_ports;
3942
3943 release_desc(cur);
3944
3945 writel(0, hw->io + KS_DMA_TX_START);
3946}
3947
3948static int empty_addr(u8 *addr)
3949{
3950 u32 *addr1 = (u32 *) addr;
3951 u16 *addr2 = (u16 *) &addr[4];
3952
3953 return 0 == *addr1 && 0 == *addr2;
3954}
3955
3956
3957
3958
3959
3960
3961
3962
3963static void hw_set_addr(struct ksz_hw *hw)
3964{
3965 int i;
3966
3967 for (i = 0; i < ETH_ALEN; i++)
3968 writeb(hw->override_addr[MAC_ADDR_ORDER(i)],
3969 hw->io + KS884X_ADDR_0_OFFSET + i);
3970
3971 sw_set_addr(hw, hw->override_addr);
3972}
3973
3974
3975
3976
3977
3978
3979
3980static void hw_read_addr(struct ksz_hw *hw)
3981{
3982 int i;
3983
3984 for (i = 0; i < ETH_ALEN; i++)
3985 hw->perm_addr[MAC_ADDR_ORDER(i)] = readb(hw->io +
3986 KS884X_ADDR_0_OFFSET + i);
3987
3988 if (!hw->mac_override) {
3989 memcpy(hw->override_addr, hw->perm_addr, ETH_ALEN);
3990 if (empty_addr(hw->override_addr)) {
3991 memcpy(hw->perm_addr, DEFAULT_MAC_ADDRESS, ETH_ALEN);
3992 memcpy(hw->override_addr, DEFAULT_MAC_ADDRESS,
3993 ETH_ALEN);
3994 hw->override_addr[5] += hw->id;
3995 hw_set_addr(hw);
3996 }
3997 }
3998}
3999
4000static void hw_ena_add_addr(struct ksz_hw *hw, int index, u8 *mac_addr)
4001{
4002 int i;
4003 u32 mac_addr_lo;
4004 u32 mac_addr_hi;
4005
4006 mac_addr_hi = 0;
4007 for (i = 0; i < 2; i++) {
4008 mac_addr_hi <<= 8;
4009 mac_addr_hi |= mac_addr[i];
4010 }
4011 mac_addr_hi |= ADD_ADDR_ENABLE;
4012 mac_addr_lo = 0;
4013 for (i = 2; i < 6; i++) {
4014 mac_addr_lo <<= 8;
4015 mac_addr_lo |= mac_addr[i];
4016 }
4017 index *= ADD_ADDR_INCR;
4018
4019 writel(mac_addr_lo, hw->io + index + KS_ADD_ADDR_0_LO);
4020 writel(mac_addr_hi, hw->io + index + KS_ADD_ADDR_0_HI);
4021}
4022
4023static void hw_set_add_addr(struct ksz_hw *hw)
4024{
4025 int i;
4026
4027 for (i = 0; i < ADDITIONAL_ENTRIES; i++) {
4028 if (empty_addr(hw->address[i]))
4029 writel(0, hw->io + ADD_ADDR_INCR * i +
4030 KS_ADD_ADDR_0_HI);
4031 else
4032 hw_ena_add_addr(hw, i, hw->address[i]);
4033 }
4034}
4035
4036static int hw_add_addr(struct ksz_hw *hw, u8 *mac_addr)
4037{
4038 int i;
4039 int j = ADDITIONAL_ENTRIES;
4040
4041 if (ether_addr_equal(hw->override_addr, mac_addr))
4042 return 0;
4043 for (i = 0; i < hw->addr_list_size; i++) {
4044 if (ether_addr_equal(hw->address[i], mac_addr))
4045 return 0;
4046 if (ADDITIONAL_ENTRIES == j && empty_addr(hw->address[i]))
4047 j = i;
4048 }
4049 if (j < ADDITIONAL_ENTRIES) {
4050 memcpy(hw->address[j], mac_addr, ETH_ALEN);
4051 hw_ena_add_addr(hw, j, hw->address[j]);
4052 return 0;
4053 }
4054 return -1;
4055}
4056
4057static int hw_del_addr(struct ksz_hw *hw, u8 *mac_addr)
4058{
4059 int i;
4060
4061 for (i = 0; i < hw->addr_list_size; i++) {
4062 if (ether_addr_equal(hw->address[i], mac_addr)) {
4063 eth_zero_addr(hw->address[i]);
4064 writel(0, hw->io + ADD_ADDR_INCR * i +
4065 KS_ADD_ADDR_0_HI);
4066 return 0;
4067 }
4068 }
4069 return -1;
4070}
4071
4072
4073
4074
4075
4076
4077
4078static void hw_clr_multicast(struct ksz_hw *hw)
4079{
4080 int i;
4081
4082 for (i = 0; i < HW_MULTICAST_SIZE; i++) {
4083 hw->multi_bits[i] = 0;
4084
4085 writeb(0, hw->io + KS884X_MULTICAST_0_OFFSET + i);
4086 }
4087}
4088
4089
4090
4091
4092
4093
4094
4095
4096static void hw_set_grp_addr(struct ksz_hw *hw)
4097{
4098 int i;
4099 int index;
4100 int position;
4101 int value;
4102
4103 memset(hw->multi_bits, 0, sizeof(u8) * HW_MULTICAST_SIZE);
4104
4105 for (i = 0; i < hw->multi_list_size; i++) {
4106 position = (ether_crc(6, hw->multi_list[i]) >> 26) & 0x3f;
4107 index = position >> 3;
4108 value = 1 << (position & 7);
4109 hw->multi_bits[index] |= (u8) value;
4110 }
4111
4112 for (i = 0; i < HW_MULTICAST_SIZE; i++)
4113 writeb(hw->multi_bits[i], hw->io + KS884X_MULTICAST_0_OFFSET +
4114 i);
4115}
4116
4117
4118
4119
4120
4121
4122
4123
4124static void hw_set_multicast(struct ksz_hw *hw, u8 multicast)
4125{
4126
4127 hw_stop_rx(hw);
4128
4129 if (multicast)
4130 hw->rx_cfg |= DMA_RX_ALL_MULTICAST;
4131 else
4132 hw->rx_cfg &= ~DMA_RX_ALL_MULTICAST;
4133
4134 if (hw->enabled)
4135 hw_start_rx(hw);
4136}
4137
4138
4139
4140
4141
4142
4143
4144
4145static void hw_set_promiscuous(struct ksz_hw *hw, u8 prom)
4146{
4147
4148 hw_stop_rx(hw);
4149
4150 if (prom)
4151 hw->rx_cfg |= DMA_RX_PROMISCUOUS;
4152 else
4153 hw->rx_cfg &= ~DMA_RX_PROMISCUOUS;
4154
4155 if (hw->enabled)
4156 hw_start_rx(hw);
4157}
4158
4159
4160
4161
4162
4163
4164
4165
4166static void sw_enable(struct ksz_hw *hw, int enable)
4167{
4168 int port;
4169
4170 for (port = 0; port < SWITCH_PORT_NUM; port++) {
4171 if (hw->dev_count > 1) {
4172
4173 sw_cfg_port_base_vlan(hw, port,
4174 HOST_MASK | (1 << port));
4175 port_set_stp_state(hw, port, STP_STATE_DISABLED);
4176 } else {
4177 sw_cfg_port_base_vlan(hw, port, PORT_MASK);
4178 port_set_stp_state(hw, port, STP_STATE_FORWARDING);
4179 }
4180 }
4181 if (hw->dev_count > 1)
4182 port_set_stp_state(hw, SWITCH_PORT_NUM, STP_STATE_SIMPLE);
4183 else
4184 port_set_stp_state(hw, SWITCH_PORT_NUM, STP_STATE_FORWARDING);
4185
4186 if (enable)
4187 enable = KS8842_START;
4188 writew(enable, hw->io + KS884X_CHIP_ID_OFFSET);
4189}
4190
4191
4192
4193
4194
4195
4196
4197static void sw_setup(struct ksz_hw *hw)
4198{
4199 int port;
4200
4201 sw_set_global_ctrl(hw);
4202
4203
4204 sw_init_broad_storm(hw);
4205 hw_cfg_broad_storm(hw, BROADCAST_STORM_PROTECTION_RATE);
4206 for (port = 0; port < SWITCH_PORT_NUM; port++)
4207 sw_ena_broad_storm(hw, port);
4208
4209 sw_init_prio(hw);
4210
4211 sw_init_mirror(hw);
4212
4213 sw_init_prio_rate(hw);
4214
4215 sw_init_vlan(hw);
4216
4217 if (hw->features & STP_SUPPORT)
4218 sw_init_stp(hw);
4219 if (!sw_chk(hw, KS8842_SWITCH_CTRL_1_OFFSET,
4220 SWITCH_TX_FLOW_CTRL | SWITCH_RX_FLOW_CTRL))
4221 hw->overrides |= PAUSE_FLOW_CTRL;
4222 sw_enable(hw, 1);
4223}
4224
4225
4226
4227
4228
4229
4230
4231
4232static void ksz_start_timer(struct ksz_timer_info *info, int time)
4233{
4234 info->cnt = 0;
4235 info->timer.expires = jiffies + time;
4236 add_timer(&info->timer);
4237
4238
4239 info->max = -1;
4240}
4241
4242
4243
4244
4245
4246
4247
4248static void ksz_stop_timer(struct ksz_timer_info *info)
4249{
4250 if (info->max) {
4251 info->max = 0;
4252 del_timer_sync(&info->timer);
4253 }
4254}
4255
4256static void ksz_init_timer(struct ksz_timer_info *info, int period,
4257 void (*function)(struct timer_list *))
4258{
4259 info->max = 0;
4260 info->period = period;
4261 timer_setup(&info->timer, function, 0);
4262}
4263
4264static void ksz_update_timer(struct ksz_timer_info *info)
4265{
4266 ++info->cnt;
4267 if (info->max > 0) {
4268 if (info->cnt < info->max) {
4269 info->timer.expires = jiffies + info->period;
4270 add_timer(&info->timer);
4271 } else
4272 info->max = 0;
4273 } else if (info->max < 0) {
4274 info->timer.expires = jiffies + info->period;
4275 add_timer(&info->timer);
4276 }
4277}
4278
4279
4280
4281
4282
4283
4284
4285
4286
4287
4288
4289static int ksz_alloc_soft_desc(struct ksz_desc_info *desc_info, int transmit)
4290{
4291 desc_info->ring = kcalloc(desc_info->alloc, sizeof(struct ksz_desc),
4292 GFP_KERNEL);
4293 if (!desc_info->ring)
4294 return 1;
4295 hw_init_desc(desc_info, transmit);
4296 return 0;
4297}
4298
4299
4300
4301
4302
4303
4304
4305
4306
4307
4308static int ksz_alloc_desc(struct dev_info *adapter)
4309{
4310 struct ksz_hw *hw = &adapter->hw;
4311 int offset;
4312
4313
4314 adapter->desc_pool.alloc_size =
4315 hw->rx_desc_info.size * hw->rx_desc_info.alloc +
4316 hw->tx_desc_info.size * hw->tx_desc_info.alloc +
4317 DESC_ALIGNMENT;
4318
4319 adapter->desc_pool.alloc_virt =
4320 dma_alloc_coherent(&adapter->pdev->dev,
4321 adapter->desc_pool.alloc_size,
4322 &adapter->desc_pool.dma_addr, GFP_KERNEL);
4323 if (adapter->desc_pool.alloc_virt == NULL) {
4324 adapter->desc_pool.alloc_size = 0;
4325 return 1;
4326 }
4327
4328
4329 offset = (((ulong) adapter->desc_pool.alloc_virt % DESC_ALIGNMENT) ?
4330 (DESC_ALIGNMENT -
4331 ((ulong) adapter->desc_pool.alloc_virt % DESC_ALIGNMENT)) : 0);
4332 adapter->desc_pool.virt = adapter->desc_pool.alloc_virt + offset;
4333 adapter->desc_pool.phys = adapter->desc_pool.dma_addr + offset;
4334
4335
4336 hw->rx_desc_info.ring_virt = (struct ksz_hw_desc *)
4337 adapter->desc_pool.virt;
4338 hw->rx_desc_info.ring_phys = adapter->desc_pool.phys;
4339 offset = hw->rx_desc_info.alloc * hw->rx_desc_info.size;
4340 hw->tx_desc_info.ring_virt = (struct ksz_hw_desc *)
4341 (adapter->desc_pool.virt + offset);
4342 hw->tx_desc_info.ring_phys = adapter->desc_pool.phys + offset;
4343
4344 if (ksz_alloc_soft_desc(&hw->rx_desc_info, 0))
4345 return 1;
4346 if (ksz_alloc_soft_desc(&hw->tx_desc_info, 1))
4347 return 1;
4348
4349 return 0;
4350}
4351
4352
4353
4354
4355
4356
4357
4358
4359
4360static void free_dma_buf(struct dev_info *adapter, struct ksz_dma_buf *dma_buf,
4361 int direction)
4362{
4363 dma_unmap_single(&adapter->pdev->dev, dma_buf->dma, dma_buf->len,
4364 direction);
4365 dev_kfree_skb(dma_buf->skb);
4366 dma_buf->skb = NULL;
4367 dma_buf->dma = 0;
4368}
4369
4370
4371
4372
4373
4374
4375
4376static void ksz_init_rx_buffers(struct dev_info *adapter)
4377{
4378 int i;
4379 struct ksz_desc *desc;
4380 struct ksz_dma_buf *dma_buf;
4381 struct ksz_hw *hw = &adapter->hw;
4382 struct ksz_desc_info *info = &hw->rx_desc_info;
4383
4384 for (i = 0; i < hw->rx_desc_info.alloc; i++) {
4385 get_rx_pkt(info, &desc);
4386
4387 dma_buf = DMA_BUFFER(desc);
4388 if (dma_buf->skb && dma_buf->len != adapter->mtu)
4389 free_dma_buf(adapter, dma_buf, DMA_FROM_DEVICE);
4390 dma_buf->len = adapter->mtu;
4391 if (!dma_buf->skb)
4392 dma_buf->skb = alloc_skb(dma_buf->len, GFP_ATOMIC);
4393 if (dma_buf->skb && !dma_buf->dma)
4394 dma_buf->dma = dma_map_single(&adapter->pdev->dev,
4395 skb_tail_pointer(dma_buf->skb),
4396 dma_buf->len,
4397 DMA_FROM_DEVICE);
4398
4399
4400 set_rx_buf(desc, dma_buf->dma);
4401 set_rx_len(desc, dma_buf->len);
4402 release_desc(desc);
4403 }
4404}
4405
4406
4407
4408
4409
4410
4411