1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright (c) 2013-2016, The Linux Foundation. All rights reserved.
3  */
4 
5 /* Qualcomm Technologies, Inc. EMAC Ethernet Controller MAC layer support
6  */
7 
8 #include <linux/tcp.h>
9 #include <linux/ip.h>
10 #include <linux/ipv6.h>
11 #include <linux/crc32.h>
12 #include <linux/if_vlan.h>
13 #include <linux/jiffies.h>
14 #include <linux/phy.h>
15 #include <linux/of.h>
16 #include <net/ip6_checksum.h>
17 #include "emac.h"
18 #include "emac-sgmii.h"
19 
20 /* EMAC_MAC_CTRL */
21 #define SINGLE_PAUSE_MODE       	0x10000000
22 #define DEBUG_MODE                      0x08000000
23 #define BROAD_EN                        0x04000000
24 #define MULTI_ALL                       0x02000000
25 #define RX_CHKSUM_EN                    0x01000000
26 #define HUGE                            0x00800000
27 #define SPEED(x)			(((x) & 0x3) << 20)
28 #define SPEED_MASK			SPEED(0x3)
29 #define SIMR                            0x00080000
30 #define TPAUSE                          0x00010000
31 #define PROM_MODE                       0x00008000
32 #define VLAN_STRIP                      0x00004000
33 #define PRLEN_BMSK                      0x00003c00
34 #define PRLEN_SHFT                      10
35 #define HUGEN                           0x00000200
36 #define FLCHK                           0x00000100
37 #define PCRCE                           0x00000080
38 #define CRCE                            0x00000040
39 #define FULLD                           0x00000020
40 #define MAC_LP_EN                       0x00000010
41 #define RXFC                            0x00000008
42 #define TXFC                            0x00000004
43 #define RXEN                            0x00000002
44 #define TXEN                            0x00000001
45 
46 /* EMAC_DESC_CTRL_3 */
47 #define RFD_RING_SIZE_BMSK                                       0xfff
48 
49 /* EMAC_DESC_CTRL_4 */
50 #define RX_BUFFER_SIZE_BMSK                                     0xffff
51 
52 /* EMAC_DESC_CTRL_6 */
53 #define RRD_RING_SIZE_BMSK                                       0xfff
54 
55 /* EMAC_DESC_CTRL_9 */
56 #define TPD_RING_SIZE_BMSK                                      0xffff
57 
58 /* EMAC_TXQ_CTRL_0 */
59 #define NUM_TXF_BURST_PREF_BMSK                             0xffff0000
60 #define NUM_TXF_BURST_PREF_SHFT                                     16
61 #define LS_8023_SP                                                0x80
62 #define TXQ_MODE                                                  0x40
63 #define TXQ_EN                                                    0x20
64 #define IP_OP_SP                                                  0x10
65 #define NUM_TPD_BURST_PREF_BMSK                                    0xf
66 #define NUM_TPD_BURST_PREF_SHFT                                      0
67 
68 /* EMAC_TXQ_CTRL_1 */
69 #define JUMBO_TASK_OFFLOAD_THRESHOLD_BMSK                        0x7ff
70 
71 /* EMAC_TXQ_CTRL_2 */
72 #define TXF_HWM_BMSK                                         0xfff0000
73 #define TXF_LWM_BMSK                                             0xfff
74 
75 /* EMAC_RXQ_CTRL_0 */
76 #define RXQ_EN                                                 BIT(31)
77 #define CUT_THRU_EN                                            BIT(30)
78 #define RSS_HASH_EN                                            BIT(29)
79 #define NUM_RFD_BURST_PREF_BMSK                              0x3f00000
80 #define NUM_RFD_BURST_PREF_SHFT                                     20
81 #define IDT_TABLE_SIZE_BMSK                                    0x1ff00
82 #define IDT_TABLE_SIZE_SHFT                                          8
83 #define SP_IPV6                                                   0x80
84 
85 /* EMAC_RXQ_CTRL_1 */
86 #define JUMBO_1KAH_BMSK                                         0xf000
87 #define JUMBO_1KAH_SHFT                                             12
88 #define RFD_PREF_LOW_TH                                           0x10
89 #define RFD_PREF_LOW_THRESHOLD_BMSK                              0xfc0
90 #define RFD_PREF_LOW_THRESHOLD_SHFT                                  6
91 #define RFD_PREF_UP_TH                                            0x10
92 #define RFD_PREF_UP_THRESHOLD_BMSK                                0x3f
93 #define RFD_PREF_UP_THRESHOLD_SHFT                                   0
94 
95 /* EMAC_RXQ_CTRL_2 */
96 #define RXF_DOF_THRESFHOLD                                       0x1a0
97 #define RXF_DOF_THRESHOLD_BMSK                               0xfff0000
98 #define RXF_DOF_THRESHOLD_SHFT                                      16
99 #define RXF_UOF_THRESFHOLD                                        0xbe
100 #define RXF_UOF_THRESHOLD_BMSK                                   0xfff
101 #define RXF_UOF_THRESHOLD_SHFT                                       0
102 
103 /* EMAC_RXQ_CTRL_3 */
104 #define RXD_TIMER_BMSK                                      0xffff0000
105 #define RXD_THRESHOLD_BMSK                                       0xfff
106 #define RXD_THRESHOLD_SHFT                                           0
107 
108 /* EMAC_DMA_CTRL */
109 #define DMAW_DLY_CNT_BMSK                                      0xf0000
110 #define DMAW_DLY_CNT_SHFT                                           16
111 #define DMAR_DLY_CNT_BMSK                                       0xf800
112 #define DMAR_DLY_CNT_SHFT                                           11
113 #define DMAR_REQ_PRI                                             0x400
114 #define REGWRBLEN_BMSK                                           0x380
115 #define REGWRBLEN_SHFT                                               7
116 #define REGRDBLEN_BMSK                                            0x70
117 #define REGRDBLEN_SHFT                                               4
118 #define OUT_ORDER_MODE                                             0x4
119 #define ENH_ORDER_MODE                                             0x2
120 #define IN_ORDER_MODE                                              0x1
121 
122 /* EMAC_MAILBOX_13 */
123 #define RFD3_PROC_IDX_BMSK                                   0xfff0000
124 #define RFD3_PROC_IDX_SHFT                                          16
125 #define RFD3_PROD_IDX_BMSK                                       0xfff
126 #define RFD3_PROD_IDX_SHFT                                           0
127 
128 /* EMAC_MAILBOX_2 */
129 #define NTPD_CONS_IDX_BMSK                                  0xffff0000
130 #define NTPD_CONS_IDX_SHFT                                          16
131 
132 /* EMAC_MAILBOX_3 */
133 #define RFD0_CONS_IDX_BMSK                                       0xfff
134 #define RFD0_CONS_IDX_SHFT                                           0
135 
136 /* EMAC_MAILBOX_11 */
137 #define H3TPD_PROD_IDX_BMSK                                 0xffff0000
138 #define H3TPD_PROD_IDX_SHFT                                         16
139 
140 /* EMAC_AXI_MAST_CTRL */
141 #define DATA_BYTE_SWAP                                             0x8
142 #define MAX_BOUND                                                  0x2
143 #define MAX_BTYPE                                                  0x1
144 
145 /* EMAC_MAILBOX_12 */
146 #define H3TPD_CONS_IDX_BMSK                                 0xffff0000
147 #define H3TPD_CONS_IDX_SHFT                                         16
148 
149 /* EMAC_MAILBOX_9 */
150 #define H2TPD_PROD_IDX_BMSK                                     0xffff
151 #define H2TPD_PROD_IDX_SHFT                                          0
152 
153 /* EMAC_MAILBOX_10 */
154 #define H1TPD_CONS_IDX_BMSK                                 0xffff0000
155 #define H1TPD_CONS_IDX_SHFT                                         16
156 #define H2TPD_CONS_IDX_BMSK                                     0xffff
157 #define H2TPD_CONS_IDX_SHFT                                          0
158 
159 /* EMAC_ATHR_HEADER_CTRL */
160 #define HEADER_CNT_EN                                              0x2
161 #define HEADER_ENABLE                                              0x1
162 
163 /* EMAC_MAILBOX_0 */
164 #define RFD0_PROC_IDX_BMSK                                   0xfff0000
165 #define RFD0_PROC_IDX_SHFT                                          16
166 #define RFD0_PROD_IDX_BMSK                                       0xfff
167 #define RFD0_PROD_IDX_SHFT                                           0
168 
169 /* EMAC_MAILBOX_5 */
170 #define RFD1_PROC_IDX_BMSK                                   0xfff0000
171 #define RFD1_PROC_IDX_SHFT                                          16
172 #define RFD1_PROD_IDX_BMSK                                       0xfff
173 #define RFD1_PROD_IDX_SHFT                                           0
174 
175 /* EMAC_MISC_CTRL */
176 #define RX_UNCPL_INT_EN                                            0x1
177 
178 /* EMAC_MAILBOX_7 */
179 #define RFD2_CONS_IDX_BMSK                                   0xfff0000
180 #define RFD2_CONS_IDX_SHFT                                          16
181 #define RFD1_CONS_IDX_BMSK                                       0xfff
182 #define RFD1_CONS_IDX_SHFT                                           0
183 
184 /* EMAC_MAILBOX_8 */
185 #define RFD3_CONS_IDX_BMSK                                       0xfff
186 #define RFD3_CONS_IDX_SHFT                                           0
187 
188 /* EMAC_MAILBOX_15 */
189 #define NTPD_PROD_IDX_BMSK                                      0xffff
190 #define NTPD_PROD_IDX_SHFT                                           0
191 
192 /* EMAC_MAILBOX_16 */
193 #define H1TPD_PROD_IDX_BMSK                                     0xffff
194 #define H1TPD_PROD_IDX_SHFT                                          0
195 
196 #define RXQ0_RSS_HSTYP_IPV6_TCP_EN                                0x20
197 #define RXQ0_RSS_HSTYP_IPV6_EN                                    0x10
198 #define RXQ0_RSS_HSTYP_IPV4_TCP_EN                                 0x8
199 #define RXQ0_RSS_HSTYP_IPV4_EN                                     0x4
200 
201 /* EMAC_EMAC_WRAPPER_TX_TS_INX */
202 #define EMAC_WRAPPER_TX_TS_EMPTY                               BIT(31)
203 #define EMAC_WRAPPER_TX_TS_INX_BMSK                             0xffff
204 
205 struct emac_skb_cb {
206 	u32           tpd_idx;
207 	unsigned long jiffies;
208 };
209 
210 #define EMAC_SKB_CB(skb)	((struct emac_skb_cb *)(skb)->cb)
211 #define EMAC_RSS_IDT_SIZE	256
212 #define JUMBO_1KAH		0x4
213 #define RXD_TH			0x100
214 #define EMAC_TPD_LAST_FRAGMENT	0x80000000
215 #define EMAC_TPD_TSTAMP_SAVE	0x80000000
216 
217 /* EMAC Errors in emac_rrd.word[3] */
218 #define EMAC_RRD_L4F		BIT(14)
219 #define EMAC_RRD_IPF		BIT(15)
220 #define EMAC_RRD_CRC		BIT(21)
221 #define EMAC_RRD_FAE		BIT(22)
222 #define EMAC_RRD_TRN		BIT(23)
223 #define EMAC_RRD_RNT		BIT(24)
224 #define EMAC_RRD_INC		BIT(25)
225 #define EMAC_RRD_FOV		BIT(29)
226 #define EMAC_RRD_LEN		BIT(30)
227 
228 /* Error bits that will result in a received frame being discarded */
229 #define EMAC_RRD_ERROR (EMAC_RRD_IPF | EMAC_RRD_CRC | EMAC_RRD_FAE | \
230 			EMAC_RRD_TRN | EMAC_RRD_RNT | EMAC_RRD_INC | \
231 			EMAC_RRD_FOV | EMAC_RRD_LEN)
232 #define EMAC_RRD_STATS_DW_IDX 3
233 
234 #define EMAC_RRD(RXQ, SIZE, IDX)	((RXQ)->rrd.v_addr + (SIZE * (IDX)))
235 #define EMAC_RFD(RXQ, SIZE, IDX)	((RXQ)->rfd.v_addr + (SIZE * (IDX)))
236 #define EMAC_TPD(TXQ, SIZE, IDX)	((TXQ)->tpd.v_addr + (SIZE * (IDX)))
237 
238 #define GET_RFD_BUFFER(RXQ, IDX)	(&((RXQ)->rfd.rfbuff[(IDX)]))
239 #define GET_TPD_BUFFER(RTQ, IDX)	(&((RTQ)->tpd.tpbuff[(IDX)]))
240 
241 #define EMAC_TX_POLL_HWTXTSTAMP_THRESHOLD	8
242 
243 #define ISR_RX_PKT      (\
244 	RX_PKT_INT0     |\
245 	RX_PKT_INT1     |\
246 	RX_PKT_INT2     |\
247 	RX_PKT_INT3)
248 
249 void emac_mac_multicast_addr_set(struct emac_adapter *adpt, u8 *addr)
250 {
251 	u32 crc32, bit, reg, mta;
252 
253 	/* Calculate the CRC of the MAC address */
254 	crc32 = ether_crc(ETH_ALEN, addr);
255 
256 	/* The HASH Table is an array of 2 32-bit registers. It is
257 	 * treated like an array of 64 bits (BitArray[hash_value]).
258 	 * Use the upper 6 bits of the above CRC as the hash value.
259 	 */
260 	reg = (crc32 >> 31) & 0x1;
261 	bit = (crc32 >> 26) & 0x1F;
262 
263 	mta = readl(adpt->base + EMAC_HASH_TAB_REG0 + (reg << 2));
264 	mta |= BIT(bit);
265 	writel(mta, adpt->base + EMAC_HASH_TAB_REG0 + (reg << 2));
266 }
267 
268 void emac_mac_multicast_addr_clear(struct emac_adapter *adpt)
269 {
270 	writel(0, adpt->base + EMAC_HASH_TAB_REG0);
271 	writel(0, adpt->base + EMAC_HASH_TAB_REG1);
272 }
273 
274 /* definitions for RSS */
275 #define EMAC_RSS_KEY(_i, _type) \
276 		(EMAC_RSS_KEY0 + ((_i) * sizeof(_type)))
277 #define EMAC_RSS_TBL(_i, _type) \
278 		(EMAC_IDT_TABLE0 + ((_i) * sizeof(_type)))
279 
280 /* Config MAC modes */
281 void emac_mac_mode_config(struct emac_adapter *adpt)
282 {
283 	struct net_device *netdev = adpt->netdev;
284 	u32 mac;
285 
286 	mac = readl(adpt->base + EMAC_MAC_CTRL);
287 	mac &= ~(VLAN_STRIP | PROM_MODE | MULTI_ALL | MAC_LP_EN);
288 
289 	if (netdev->features & NETIF_F_HW_VLAN_CTAG_RX)
290 		mac |= VLAN_STRIP;
291 
292 	if (netdev->flags & IFF_PROMISC)
293 		mac |= PROM_MODE;
294 
295 	if (netdev->flags & IFF_ALLMULTI)
296 		mac |= MULTI_ALL;
297 
298 	writel(mac, adpt->base + EMAC_MAC_CTRL);
299 }
300 
301 /* Config descriptor rings */
302 static void emac_mac_dma_rings_config(struct emac_adapter *adpt)
303 {
304 	/* TPD (Transmit Packet Descriptor) */
305 	writel(upper_32_bits(adpt->tx_q.tpd.dma_addr),
306 	       adpt->base + EMAC_DESC_CTRL_1);
307 
308 	writel(lower_32_bits(adpt->tx_q.tpd.dma_addr),
309 	       adpt->base + EMAC_DESC_CTRL_8);
310 
311 	writel(adpt->tx_q.tpd.count & TPD_RING_SIZE_BMSK,
312 	       adpt->base + EMAC_DESC_CTRL_9);
313 
314 	/* RFD (Receive Free Descriptor) & RRD (Receive Return Descriptor) */
315 	writel(upper_32_bits(adpt->rx_q.rfd.dma_addr),
316 	       adpt->base + EMAC_DESC_CTRL_0);
317 
318 	writel(lower_32_bits(adpt->rx_q.rfd.dma_addr),
319 	       adpt->base + EMAC_DESC_CTRL_2);
320 	writel(lower_32_bits(adpt->rx_q.rrd.dma_addr),
321 	       adpt->base + EMAC_DESC_CTRL_5);
322 
323 	writel(adpt->rx_q.rfd.count & RFD_RING_SIZE_BMSK,
324 	       adpt->base + EMAC_DESC_CTRL_3);
325 	writel(adpt->rx_q.rrd.count & RRD_RING_SIZE_BMSK,
326 	       adpt->base + EMAC_DESC_CTRL_6);
327 
328 	writel(adpt->rxbuf_size & RX_BUFFER_SIZE_BMSK,
329 	       adpt->base + EMAC_DESC_CTRL_4);
330 
331 	writel(0, adpt->base + EMAC_DESC_CTRL_11);
332 
333 	/* Load all of the base addresses above and ensure that triggering HW to
334 	 * read ring pointers is flushed
335 	 */
336 	writel(1, adpt->base + EMAC_INTER_SRAM_PART9);
337 }
338 
339 /* Config transmit parameters */
340 static void emac_mac_tx_config(struct emac_adapter *adpt)
341 {
342 	u32 val;
343 
344 	writel((EMAC_MAX_TX_OFFLOAD_THRESH >> 3) &
345 	       JUMBO_TASK_OFFLOAD_THRESHOLD_BMSK, adpt->base + EMAC_TXQ_CTRL_1);
346 
347 	val = (adpt->tpd_burst << NUM_TPD_BURST_PREF_SHFT) &
348 	       NUM_TPD_BURST_PREF_BMSK;
349 
350 	val |= TXQ_MODE | LS_8023_SP;
351 	val |= (0x0100 << NUM_TXF_BURST_PREF_SHFT) &
352 		NUM_TXF_BURST_PREF_BMSK;
353 
354 	writel(val, adpt->base + EMAC_TXQ_CTRL_0);
355 	emac_reg_update32(adpt->base + EMAC_TXQ_CTRL_2,
356 			  (TXF_HWM_BMSK | TXF_LWM_BMSK), 0);
357 }
358 
359 /* Config receive parameters */
360 static void emac_mac_rx_config(struct emac_adapter *adpt)
361 {
362 	u32 val;
363 
364 	val = (adpt->rfd_burst << NUM_RFD_BURST_PREF_SHFT) &
365 	       NUM_RFD_BURST_PREF_BMSK;
366 	val |= (SP_IPV6 | CUT_THRU_EN);
367 
368 	writel(val, adpt->base + EMAC_RXQ_CTRL_0);
369 
370 	val = readl(adpt->base + EMAC_RXQ_CTRL_1);
371 	val &= ~(JUMBO_1KAH_BMSK | RFD_PREF_LOW_THRESHOLD_BMSK |
372 		 RFD_PREF_UP_THRESHOLD_BMSK);
373 	val |= (JUMBO_1KAH << JUMBO_1KAH_SHFT) |
374 		(RFD_PREF_LOW_TH << RFD_PREF_LOW_THRESHOLD_SHFT) |
375 		(RFD_PREF_UP_TH  << RFD_PREF_UP_THRESHOLD_SHFT);
376 	writel(val, adpt->base + EMAC_RXQ_CTRL_1);
377 
378 	val = readl(adpt->base + EMAC_RXQ_CTRL_2);
379 	val &= ~(RXF_DOF_THRESHOLD_BMSK | RXF_UOF_THRESHOLD_BMSK);
380 	val |= (RXF_DOF_THRESFHOLD  << RXF_DOF_THRESHOLD_SHFT) |
381 		(RXF_UOF_THRESFHOLD << RXF_UOF_THRESHOLD_SHFT);
382 	writel(val, adpt->base + EMAC_RXQ_CTRL_2);
383 
384 	val = readl(adpt->base + EMAC_RXQ_CTRL_3);
385 	val &= ~(RXD_TIMER_BMSK | RXD_THRESHOLD_BMSK);
386 	val |= RXD_TH << RXD_THRESHOLD_SHFT;
387 	writel(val, adpt->base + EMAC_RXQ_CTRL_3);
388 }
389 
390 /* Config dma */
391 static void emac_mac_dma_config(struct emac_adapter *adpt)
392 {
393 	u32 dma_ctrl = DMAR_REQ_PRI;
394 
395 	switch (adpt->dma_order) {
396 	case emac_dma_ord_in:
397 		dma_ctrl |= IN_ORDER_MODE;
398 		break;
399 	case emac_dma_ord_enh:
400 		dma_ctrl |= ENH_ORDER_MODE;
401 		break;
402 	case emac_dma_ord_out:
403 		dma_ctrl |= OUT_ORDER_MODE;
404 		break;
405 	default:
406 		break;
407 	}
408 
409 	dma_ctrl |= (((u32)adpt->dmar_block) << REGRDBLEN_SHFT) &
410 						REGRDBLEN_BMSK;
411 	dma_ctrl |= (((u32)adpt->dmaw_block) << REGWRBLEN_SHFT) &
412 						REGWRBLEN_BMSK;
413 	dma_ctrl |= (((u32)adpt->dmar_dly_cnt) << DMAR_DLY_CNT_SHFT) &
414 						DMAR_DLY_CNT_BMSK;
415 	dma_ctrl |= (((u32)adpt->dmaw_dly_cnt) << DMAW_DLY_CNT_SHFT) &
416 						DMAW_DLY_CNT_BMSK;
417 
418 	/* config DMA and ensure that configuration is flushed to HW */
419 	writel(dma_ctrl, adpt->base + EMAC_DMA_CTRL);
420 }
421 
422 /* set MAC address */
423 static void emac_set_mac_address(struct emac_adapter *adpt, u8 *addr)
424 {
425 	u32 sta;
426 
427 	/* for example: 00-A0-C6-11-22-33
428 	 * 0<-->C6112233, 1<-->00A0.
429 	 */
430 
431 	/* low 32bit word */
432 	sta = (((u32)addr[2]) << 24) | (((u32)addr[3]) << 16) |
433 	      (((u32)addr[4]) << 8)  | (((u32)addr[5]));
434 	writel(sta, adpt->base + EMAC_MAC_STA_ADDR0);
435 
436 	/* hight 32bit word */
437 	sta = (((u32)addr[0]) << 8) | (u32)addr[1];
438 	writel(sta, adpt->base + EMAC_MAC_STA_ADDR1);
439 }
440 
441 static void emac_mac_config(struct emac_adapter *adpt)
442 {
443 	struct net_device *netdev = adpt->netdev;
444 	unsigned int max_frame;
445 	u32 val;
446 
447 	emac_set_mac_address(adpt, netdev->dev_addr);
448 
449 	max_frame = netdev->mtu + ETH_HLEN + ETH_FCS_LEN + VLAN_HLEN;
450 	adpt->rxbuf_size = netdev->mtu > EMAC_DEF_RX_BUF_SIZE ?
451 		ALIGN(max_frame, 8) : EMAC_DEF_RX_BUF_SIZE;
452 
453 	emac_mac_dma_rings_config(adpt);
454 
455 	writel(netdev->mtu + ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN,
456 	       adpt->base + EMAC_MAX_FRAM_LEN_CTRL);
457 
458 	emac_mac_tx_config(adpt);
459 	emac_mac_rx_config(adpt);
460 	emac_mac_dma_config(adpt);
461 
462 	val = readl(adpt->base + EMAC_AXI_MAST_CTRL);
463 	val &= ~(DATA_BYTE_SWAP | MAX_BOUND);
464 	val |= MAX_BTYPE;
465 	writel(val, adpt->base + EMAC_AXI_MAST_CTRL);
466 	writel(0, adpt->base + EMAC_CLK_GATE_CTRL);
467 	writel(RX_UNCPL_INT_EN, adpt->base + EMAC_MISC_CTRL);
468 }
469 
470 void emac_mac_reset(struct emac_adapter *adpt)
471 {
472 	emac_mac_stop(adpt);
473 
474 	emac_reg_update32(adpt->base + EMAC_DMA_MAS_CTRL, 0, SOFT_RST);
475 	usleep_range(100, 150); /* reset may take up to 100usec */
476 
477 	/* interrupt clear-on-read */
478 	emac_reg_update32(adpt->base + EMAC_DMA_MAS_CTRL, 0, INT_RD_CLR_EN);
479 }
480 
481 static void emac_mac_start(struct emac_adapter *adpt)
482 {
483 	struct phy_device *phydev = adpt->phydev;
484 	u32 mac, csr1;
485 
486 	/* enable tx queue */
487 	emac_reg_update32(adpt->base + EMAC_TXQ_CTRL_0, 0, TXQ_EN);
488 
489 	/* enable rx queue */
490 	emac_reg_update32(adpt->base + EMAC_RXQ_CTRL_0, 0, RXQ_EN);
491 
492 	/* enable mac control */
493 	mac = readl(adpt->base + EMAC_MAC_CTRL);
494 	csr1 = readl(adpt->csr + EMAC_EMAC_WRAPPER_CSR1);
495 
496 	mac |= TXEN | RXEN;     /* enable RX/TX */
497 
498 	/* Configure MAC flow control. If set to automatic, then match
499 	 * whatever the PHY does. Otherwise, enable or disable it, depending
500 	 * on what the user configured via ethtool.
501 	 */
502 	mac &= ~(RXFC | TXFC);
503 
504 	if (adpt->automatic) {
505 		/* If it's set to automatic, then update our local values */
506 		adpt->rx_flow_control = phydev->pause;
507 		adpt->tx_flow_control = phydev->pause != phydev->asym_pause;
508 	}
509 	mac |= adpt->rx_flow_control ? RXFC : 0;
510 	mac |= adpt->tx_flow_control ? TXFC : 0;
511 
512 	/* setup link speed */
513 	mac &= ~SPEED_MASK;
514 	if (phydev->speed == SPEED_1000) {
515 		mac |= SPEED(2);
516 		csr1 |= FREQ_MODE;
517 	} else {
518 		mac |= SPEED(1);
519 		csr1 &= ~FREQ_MODE;
520 	}
521 
522 	if (phydev->duplex == DUPLEX_FULL)
523 		mac |= FULLD;
524 	else
525 		mac &= ~FULLD;
526 
527 	/* other parameters */
528 	mac |= (CRCE | PCRCE);
529 	mac |= ((adpt->preamble << PRLEN_SHFT) & PRLEN_BMSK);
530 	mac |= BROAD_EN;
531 	mac |= FLCHK;
532 	mac &= ~RX_CHKSUM_EN;
533 	mac &= ~(HUGEN | VLAN_STRIP | TPAUSE | SIMR | HUGE | MULTI_ALL |
534 		 DEBUG_MODE | SINGLE_PAUSE_MODE);
535 
536 	/* Enable single-pause-frame mode if requested.
537 	 *
538 	 * If enabled, the EMAC will send a single pause frame when the RX
539 	 * queue is full.  This normally leads to packet loss because
540 	 * the pause frame disables the remote MAC only for 33ms (the quanta),
541 	 * and then the remote MAC continues sending packets even though
542 	 * the RX queue is still full.
543 	 *
544 	 * If disabled, the EMAC sends a pause frame every 31ms until the RX
545 	 * queue is no longer full.  Normally, this is the preferred
546 	 * method of operation.  However, when the system is hung (e.g.
547 	 * cores are halted), the EMAC interrupt handler is never called
548 	 * and so the RX queue fills up quickly and stays full.  The resuling
549 	 * non-stop "flood" of pause frames sometimes has the effect of
550 	 * disabling nearby switches.  In some cases, other nearby switches
551 	 * are also affected, shutting down the entire network.
552 	 *
553 	 * The user can enable or disable single-pause-frame mode
554 	 * via ethtool.
555 	 */
556 	mac |= adpt->single_pause_mode ? SINGLE_PAUSE_MODE : 0;
557 
558 	writel_relaxed(csr1, adpt->csr + EMAC_EMAC_WRAPPER_CSR1);
559 
560 	writel_relaxed(mac, adpt->base + EMAC_MAC_CTRL);
561 
562 	/* enable interrupt read clear, low power sleep mode and
563 	 * the irq moderators
564 	 */
565 
566 	writel_relaxed(adpt->irq_mod, adpt->base + EMAC_IRQ_MOD_TIM_INIT);
567 	writel_relaxed(INT_RD_CLR_EN | LPW_MODE | IRQ_MODERATOR_EN |
568 			IRQ_MODERATOR2_EN, adpt->base + EMAC_DMA_MAS_CTRL);
569 
570 	emac_mac_mode_config(adpt);
571 
572 	emac_reg_update32(adpt->base + EMAC_ATHR_HEADER_CTRL,
573 			  (HEADER_ENABLE | HEADER_CNT_EN), 0);
574 }
575 
576 void emac_mac_stop(struct emac_adapter *adpt)
577 {
578 	emac_reg_update32(adpt->base + EMAC_RXQ_CTRL_0, RXQ_EN, 0);
579 	emac_reg_update32(adpt->base + EMAC_TXQ_CTRL_0, TXQ_EN, 0);
580 	emac_reg_update32(adpt->base + EMAC_MAC_CTRL, TXEN | RXEN, 0);
581 	usleep_range(1000, 1050); /* stopping mac may take upto 1msec */
582 }
583 
584 /* Free all descriptors of given transmit queue */
585 static void emac_tx_q_descs_free(struct emac_adapter *adpt)
586 {
587 	struct emac_tx_queue *tx_q = &adpt->tx_q;
588 	unsigned int i;
589 	size_t size;
590 
591 	/* ring already cleared, nothing to do */
592 	if (!tx_q->tpd.tpbuff)
593 		return;
594 
595 	for (i = 0; i < tx_q->tpd.count; i++) {
596 		struct emac_buffer *tpbuf = GET_TPD_BUFFER(tx_q, i);
597 
598 		if (tpbuf->dma_addr) {
599 			dma_unmap_single(adpt->netdev->dev.parent,
600 					 tpbuf->dma_addr, tpbuf->length,
601 					 DMA_TO_DEVICE);
602 			tpbuf->dma_addr = 0;
603 		}
604 		if (tpbuf->skb) {
605 			dev_kfree_skb_any(tpbuf->skb);
606 			tpbuf->skb = NULL;
607 		}
608 	}
609 
610 	size = sizeof(struct emac_buffer) * tx_q->tpd.count;
611 	memset(tx_q->tpd.tpbuff, 0, size);
612 
613 	/* clear the descriptor ring */
614 	memset(tx_q->tpd.v_addr, 0, tx_q->tpd.size);
615 
616 	tx_q->tpd.consume_idx = 0;
617 	tx_q->tpd.produce_idx = 0;
618 }
619 
620 /* Free all descriptors of given receive queue */
621 static void emac_rx_q_free_descs(struct emac_adapter *adpt)
622 {
623 	struct device *dev = adpt->netdev->dev.parent;
624 	struct emac_rx_queue *rx_q = &adpt->rx_q;
625 	unsigned int i;
626 	size_t size;
627 
628 	/* ring already cleared, nothing to do */
629 	if (!rx_q->rfd.rfbuff)
630 		return;
631 
632 	for (i = 0; i < rx_q->rfd.count; i++) {
633 		struct emac_buffer *rfbuf = GET_RFD_BUFFER(rx_q, i);
634 
635 		if (rfbuf->dma_addr) {
636 			dma_unmap_single(dev, rfbuf->dma_addr, rfbuf->length,
637 					 DMA_FROM_DEVICE);
638 			rfbuf->dma_addr = 0;
639 		}
640 		if (rfbuf->skb) {
641 			dev_kfree_skb(rfbuf->skb);
642 			rfbuf->skb = NULL;
643 		}
644 	}
645 
646 	size =  sizeof(struct emac_buffer) * rx_q->rfd.count;
647 	memset(rx_q->rfd.rfbuff, 0, size);
648 
649 	/* clear the descriptor rings */
650 	memset(rx_q->rrd.v_addr, 0, rx_q->rrd.size);
651 	rx_q->rrd.produce_idx = 0;
652 	rx_q->rrd.consume_idx = 0;
653 
654 	memset(rx_q->rfd.v_addr, 0, rx_q->rfd.size);
655 	rx_q->rfd.produce_idx = 0;
656 	rx_q->rfd.consume_idx = 0;
657 }
658 
659 /* Free all buffers associated with given transmit queue */
660 static void emac_tx_q_bufs_free(struct emac_adapter *adpt)
661 {
662 	struct emac_tx_queue *tx_q = &adpt->tx_q;
663 
664 	emac_tx_q_descs_free(adpt);
665 
666 	kfree(tx_q->tpd.tpbuff);
667 	tx_q->tpd.tpbuff = NULL;
668 	tx_q->tpd.v_addr = NULL;
669 	tx_q->tpd.dma_addr = 0;
670 	tx_q->tpd.size = 0;
671 }
672 
673 /* Allocate TX descriptor ring for the given transmit queue */
674 static int emac_tx_q_desc_alloc(struct emac_adapter *adpt,
675 				struct emac_tx_queue *tx_q)
676 {
677 	struct emac_ring_header *ring_header = &adpt->ring_header;
678 	int node = dev_to_node(adpt->netdev->dev.parent);
679 	size_t size;
680 
681 	size = sizeof(struct emac_buffer) * tx_q->tpd.count;
682 	tx_q->tpd.tpbuff = kzalloc_node(size, GFP_KERNEL, node);
683 	if (!tx_q->tpd.tpbuff)
684 		return -ENOMEM;
685 
686 	tx_q->tpd.size = tx_q->tpd.count * (adpt->tpd_size * 4);
687 	tx_q->tpd.dma_addr = ring_header->dma_addr + ring_header->used;
688 	tx_q->tpd.v_addr = ring_header->v_addr + ring_header->used;
689 	ring_header->used += ALIGN(tx_q->tpd.size, 8);
690 	tx_q->tpd.produce_idx = 0;
691 	tx_q->tpd.consume_idx = 0;
692 
693 	return 0;
694 }
695 
696 /* Free all buffers associated with given transmit queue */
697 static void emac_rx_q_bufs_free(struct emac_adapter *adpt)
698 {
699 	struct emac_rx_queue *rx_q = &adpt->rx_q;
700 
701 	emac_rx_q_free_descs(adpt);
702 
703 	kfree(rx_q->rfd.rfbuff);
704 	rx_q->rfd.rfbuff   = NULL;
705 
706 	rx_q->rfd.v_addr   = NULL;
707 	rx_q->rfd.dma_addr = 0;
708 	rx_q->rfd.size     = 0;
709 
710 	rx_q->rrd.v_addr   = NULL;
711 	rx_q->rrd.dma_addr = 0;
712 	rx_q->rrd.size     = 0;
713 }
714 
715 /* Allocate RX descriptor rings for the given receive queue */
716 static int emac_rx_descs_alloc(struct emac_adapter *adpt)
717 {
718 	struct emac_ring_header *ring_header = &adpt->ring_header;
719 	int node = dev_to_node(adpt->netdev->dev.parent);
720 	struct emac_rx_queue *rx_q = &adpt->rx_q;
721 	size_t size;
722 
723 	size = sizeof(struct emac_buffer) * rx_q->rfd.count;
724 	rx_q->rfd.rfbuff = kzalloc_node(size, GFP_KERNEL, node);
725 	if (!rx_q->rfd.rfbuff)
726 		return -ENOMEM;
727 
728 	rx_q->rrd.size = rx_q->rrd.count * (adpt->rrd_size * 4);
729 	rx_q->rfd.size = rx_q->rfd.count * (adpt->rfd_size * 4);
730 
731 	rx_q->rrd.dma_addr = ring_header->dma_addr + ring_header->used;
732 	rx_q->rrd.v_addr   = ring_header->v_addr + ring_header->used;
733 	ring_header->used += ALIGN(rx_q->rrd.size, 8);
734 
735 	rx_q->rfd.dma_addr = ring_header->dma_addr + ring_header->used;
736 	rx_q->rfd.v_addr   = ring_header->v_addr + ring_header->used;
737 	ring_header->used += ALIGN(rx_q->rfd.size, 8);
738 
739 	rx_q->rrd.produce_idx = 0;
740 	rx_q->rrd.consume_idx = 0;
741 
742 	rx_q->rfd.produce_idx = 0;
743 	rx_q->rfd.consume_idx = 0;
744 
745 	return 0;
746 }
747 
748 /* Allocate all TX and RX descriptor rings */
749 int emac_mac_rx_tx_rings_alloc_all(struct emac_adapter *adpt)
750 {
751 	struct emac_ring_header *ring_header = &adpt->ring_header;
752 	struct device *dev = adpt->netdev->dev.parent;
753 	unsigned int num_tx_descs = adpt->tx_desc_cnt;
754 	unsigned int num_rx_descs = adpt->rx_desc_cnt;
755 	int ret;
756 
757 	adpt->tx_q.tpd.count = adpt->tx_desc_cnt;
758 
759 	adpt->rx_q.rrd.count = adpt->rx_desc_cnt;
760 	adpt->rx_q.rfd.count = adpt->rx_desc_cnt;
761 
762 	/* Ring DMA buffer. Each ring may need up to 8 bytes for alignment,
763 	 * hence the additional padding bytes are allocated.
764 	 */
765 	ring_header->size = num_tx_descs * (adpt->tpd_size * 4) +
766 			    num_rx_descs * (adpt->rfd_size * 4) +
767 			    num_rx_descs * (adpt->rrd_size * 4) +
768 			    8 + 2 * 8; /* 8 byte per one Tx and two Rx rings */
769 
770 	ring_header->used = 0;
771 	ring_header->v_addr = dma_alloc_coherent(dev, ring_header->size,
772 						 &ring_header->dma_addr,
773 						 GFP_KERNEL);
774 	if (!ring_header->v_addr)
775 		return -ENOMEM;
776 
777 	ring_header->used = ALIGN(ring_header->dma_addr, 8) -
778 							ring_header->dma_addr;
779 
780 	ret = emac_tx_q_desc_alloc(adpt, &adpt->tx_q);
781 	if (ret) {
782 		netdev_err(adpt->netdev, "error: Tx Queue alloc failed\n");
783 		goto err_alloc_tx;
784 	}
785 
786 	ret = emac_rx_descs_alloc(adpt);
787 	if (ret) {
788 		netdev_err(adpt->netdev, "error: Rx Queue alloc failed\n");
789 		goto err_alloc_rx;
790 	}
791 
792 	return 0;
793 
794 err_alloc_rx:
795 	emac_tx_q_bufs_free(adpt);
796 err_alloc_tx:
797 	dma_free_coherent(dev, ring_header->size,
798 			  ring_header->v_addr, ring_header->dma_addr);
799 
800 	ring_header->v_addr   = NULL;
801 	ring_header->dma_addr = 0;
802 	ring_header->size     = 0;
803 	ring_header->used     = 0;
804 
805 	return ret;
806 }
807 
808 /* Free all TX and RX descriptor rings */
809 void emac_mac_rx_tx_rings_free_all(struct emac_adapter *adpt)
810 {
811 	struct emac_ring_header *ring_header = &adpt->ring_header;
812 	struct device *dev = adpt->netdev->dev.parent;
813 
814 	emac_tx_q_bufs_free(adpt);
815 	emac_rx_q_bufs_free(adpt);
816 
817 	dma_free_coherent(dev, ring_header->size,
818 			  ring_header->v_addr, ring_header->dma_addr);
819 
820 	ring_header->v_addr   = NULL;
821 	ring_header->dma_addr = 0;
822 	ring_header->size     = 0;
823 	ring_header->used     = 0;
824 }
825 
826 /* Initialize descriptor rings */
827 static void emac_mac_rx_tx_ring_reset_all(struct emac_adapter *adpt)
828 {
829 	unsigned int i;
830 
831 	adpt->tx_q.tpd.produce_idx = 0;
832 	adpt->tx_q.tpd.consume_idx = 0;
833 	for (i = 0; i < adpt->tx_q.tpd.count; i++)
834 		adpt->tx_q.tpd.tpbuff[i].dma_addr = 0;
835 
836 	adpt->rx_q.rrd.produce_idx = 0;
837 	adpt->rx_q.rrd.consume_idx = 0;
838 	adpt->rx_q.rfd.produce_idx = 0;
839 	adpt->rx_q.rfd.consume_idx = 0;
840 	for (i = 0; i < adpt->rx_q.rfd.count; i++)
841 		adpt->rx_q.rfd.rfbuff[i].dma_addr = 0;
842 }
843 
844 /* Produce new receive free descriptor */
845 static void emac_mac_rx_rfd_create(struct emac_adapter *adpt,
846 				   struct emac_rx_queue *rx_q,
847 				   dma_addr_t addr)
848 {
849 	u32 *hw_rfd = EMAC_RFD(rx_q, adpt->rfd_size, rx_q->rfd.produce_idx);
850 
851 	*(hw_rfd++) = lower_32_bits(addr);
852 	*hw_rfd = upper_32_bits(addr);
853 
854 	if (++rx_q->rfd.produce_idx == rx_q->rfd.count)
855 		rx_q->rfd.produce_idx = 0;
856 }
857 
858 /* Fill up receive queue's RFD with preallocated receive buffers */
859 static void emac_mac_rx_descs_refill(struct emac_adapter *adpt,
860 				    struct emac_rx_queue *rx_q)
861 {
862 	struct emac_buffer *curr_rxbuf;
863 	struct emac_buffer *next_rxbuf;
864 	unsigned int count = 0;
865 	u32 next_produce_idx;
866 
867 	next_produce_idx = rx_q->rfd.produce_idx + 1;
868 	if (next_produce_idx == rx_q->rfd.count)
869 		next_produce_idx = 0;
870 
871 	curr_rxbuf = GET_RFD_BUFFER(rx_q, rx_q->rfd.produce_idx);
872 	next_rxbuf = GET_RFD_BUFFER(rx_q, next_produce_idx);
873 
874 	/* this always has a blank rx_buffer*/
875 	while (!next_rxbuf->dma_addr) {
876 		struct sk_buff *skb;
877 		int ret;
878 
879 		skb = netdev_alloc_skb_ip_align(adpt->netdev, adpt->rxbuf_size);
880 		if (!skb)
881 			break;
882 
883 		curr_rxbuf->dma_addr =
884 			dma_map_single(adpt->netdev->dev.parent, skb->data,
885 				       adpt->rxbuf_size, DMA_FROM_DEVICE);
886 
887 		ret = dma_mapping_error(adpt->netdev->dev.parent,
888 					curr_rxbuf->dma_addr);
889 		if (ret) {
890 			dev_kfree_skb(skb);
891 			break;
892 		}
893 		curr_rxbuf->skb = skb;
894 		curr_rxbuf->length = adpt->rxbuf_size;
895 
896 		emac_mac_rx_rfd_create(adpt, rx_q, curr_rxbuf->dma_addr);
897 		next_produce_idx = rx_q->rfd.produce_idx + 1;
898 		if (next_produce_idx == rx_q->rfd.count)
899 			next_produce_idx = 0;
900 
901 		curr_rxbuf = GET_RFD_BUFFER(rx_q, rx_q->rfd.produce_idx);
902 		next_rxbuf = GET_RFD_BUFFER(rx_q, next_produce_idx);
903 		count++;
904 	}
905 
906 	if (count) {
907 		u32 prod_idx = (rx_q->rfd.produce_idx << rx_q->produce_shift) &
908 				rx_q->produce_mask;
909 		emac_reg_update32(adpt->base + rx_q->produce_reg,
910 				  rx_q->produce_mask, prod_idx);
911 	}
912 }
913 
914 static void emac_adjust_link(struct net_device *netdev)
915 {
916 	struct emac_adapter *adpt = netdev_priv(netdev);
917 	struct phy_device *phydev = netdev->phydev;
918 
919 	if (phydev->link) {
920 		emac_mac_start(adpt);
921 		emac_sgmii_link_change(adpt, true);
922 	} else {
923 		emac_sgmii_link_change(adpt, false);
924 		emac_mac_stop(adpt);
925 	}
926 
927 	phy_print_status(phydev);
928 }
929 
930 /* Bringup the interface/HW */
931 int emac_mac_up(struct emac_adapter *adpt)
932 {
933 	struct net_device *netdev = adpt->netdev;
934 	int ret;
935 
936 	emac_mac_rx_tx_ring_reset_all(adpt);
937 	emac_mac_config(adpt);
938 	emac_mac_rx_descs_refill(adpt, &adpt->rx_q);
939 
940 	adpt->phydev->irq = PHY_POLL;
941 	ret = phy_connect_direct(netdev, adpt->phydev, emac_adjust_link,
942 				 PHY_INTERFACE_MODE_SGMII);
943 	if (ret) {
944 		netdev_err(adpt->netdev, "could not connect phy\n");
945 		return ret;
946 	}
947 
948 	phy_attached_print(adpt->phydev, NULL);
949 
950 	/* enable mac irq */
951 	writel((u32)~DIS_INT, adpt->base + EMAC_INT_STATUS);
952 	writel(adpt->irq.mask, adpt->base + EMAC_INT_MASK);
953 
954 	phy_start(adpt->phydev);
955 
956 	napi_enable(&adpt->rx_q.napi);
957 	netif_start_queue(netdev);
958 
959 	return 0;
960 }
961 
962 /* Bring down the interface/HW */
963 void emac_mac_down(struct emac_adapter *adpt)
964 {
965 	struct net_device *netdev = adpt->netdev;
966 
967 	netif_stop_queue(netdev);
968 	napi_disable(&adpt->rx_q.napi);
969 
970 	phy_stop(adpt->phydev);
971 
972 	/* Interrupts must be disabled before the PHY is disconnected, to
973 	 * avoid a race condition where adjust_link is null when we get
974 	 * an interrupt.
975 	 */
976 	writel(DIS_INT, adpt->base + EMAC_INT_STATUS);
977 	writel(0, adpt->base + EMAC_INT_MASK);
978 	synchronize_irq(adpt->irq.irq);
979 
980 	phy_disconnect(adpt->phydev);
981 
982 	emac_mac_reset(adpt);
983 
984 	emac_tx_q_descs_free(adpt);
985 	netdev_reset_queue(adpt->netdev);
986 	emac_rx_q_free_descs(adpt);
987 }
988 
989 /* Consume next received packet descriptor */
990 static bool emac_rx_process_rrd(struct emac_adapter *adpt,
991 				struct emac_rx_queue *rx_q,
992 				struct emac_rrd *rrd)
993 {
994 	u32 *hw_rrd = EMAC_RRD(rx_q, adpt->rrd_size, rx_q->rrd.consume_idx);
995 
996 	rrd->word[3] = *(hw_rrd + 3);
997 
998 	if (!RRD_UPDT(rrd))
999 		return false;
1000 
1001 	rrd->word[4] = 0;
1002 	rrd->word[5] = 0;
1003 
1004 	rrd->word[0] = *(hw_rrd++);
1005 	rrd->word[1] = *(hw_rrd++);
1006 	rrd->word[2] = *(hw_rrd++);
1007 
1008 	if (unlikely(RRD_NOR(rrd) != 1)) {
1009 		netdev_err(adpt->netdev,
1010 			   "error: multi-RFD not support yet! nor:%lu\n",
1011 			   RRD_NOR(rrd));
1012 	}
1013 
1014 	/* mark rrd as processed */
1015 	RRD_UPDT_SET(rrd, 0);
1016 	*hw_rrd = rrd->word[3];
1017 
1018 	if (++rx_q->rrd.consume_idx == rx_q->rrd.count)
1019 		rx_q->rrd.consume_idx = 0;
1020 
1021 	return true;
1022 }
1023 
1024 /* Produce new transmit descriptor */
1025 static void emac_tx_tpd_create(struct emac_adapter *adpt,
1026 			       struct emac_tx_queue *tx_q, struct emac_tpd *tpd)
1027 {
1028 	u32 *hw_tpd;
1029 
1030 	tx_q->tpd.last_produce_idx = tx_q->tpd.produce_idx;
1031 	hw_tpd = EMAC_TPD(tx_q, adpt->tpd_size, tx_q->tpd.produce_idx);
1032 
1033 	if (++tx_q->tpd.produce_idx == tx_q->tpd.count)
1034 		tx_q->tpd.produce_idx = 0;
1035 
1036 	*(hw_tpd++) = tpd->word[0];
1037 	*(hw_tpd++) = tpd->word[1];
1038 	*(hw_tpd++) = tpd->word[2];
1039 	*hw_tpd = tpd->word[3];
1040 }
1041 
1042 /* Mark the last transmit descriptor as such (for the transmit packet) */
1043 static void emac_tx_tpd_mark_last(struct emac_adapter *adpt,
1044 				  struct emac_tx_queue *tx_q)
1045 {
1046 	u32 *hw_tpd =
1047 		EMAC_TPD(tx_q, adpt->tpd_size, tx_q->tpd.last_produce_idx);
1048 	u32 tmp_tpd;
1049 
1050 	tmp_tpd = *(hw_tpd + 1);
1051 	tmp_tpd |= EMAC_TPD_LAST_FRAGMENT;
1052 	*(hw_tpd + 1) = tmp_tpd;
1053 }
1054 
1055 static void emac_rx_rfd_clean(struct emac_rx_queue *rx_q, struct emac_rrd *rrd)
1056 {
1057 	struct emac_buffer *rfbuf = rx_q->rfd.rfbuff;
1058 	u32 consume_idx = RRD_SI(rrd);
1059 	unsigned int i;
1060 
1061 	for (i = 0; i < RRD_NOR(rrd); i++) {
1062 		rfbuf[consume_idx].skb = NULL;
1063 		if (++consume_idx == rx_q->rfd.count)
1064 			consume_idx = 0;
1065 	}
1066 
1067 	rx_q->rfd.consume_idx = consume_idx;
1068 	rx_q->rfd.process_idx = consume_idx;
1069 }
1070 
1071 /* Push the received skb to upper layers */
1072 static void emac_receive_skb(struct emac_rx_queue *rx_q,
1073 			     struct sk_buff *skb,
1074 			     u16 vlan_tag, bool vlan_flag)
1075 {
1076 	if (vlan_flag) {
1077 		u16 vlan;
1078 
1079 		EMAC_TAG_TO_VLAN(vlan_tag, vlan);
1080 		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vlan);
1081 	}
1082 
1083 	napi_gro_receive(&rx_q->napi, skb);
1084 }
1085 
1086 /* Process receive event */
1087 void emac_mac_rx_process(struct emac_adapter *adpt, struct emac_rx_queue *rx_q,
1088 			 int *num_pkts, int max_pkts)
1089 {
1090 	u32 proc_idx, hw_consume_idx, num_consume_pkts;
1091 	struct net_device *netdev  = adpt->netdev;
1092 	struct emac_buffer *rfbuf;
1093 	unsigned int count = 0;
1094 	struct emac_rrd rrd;
1095 	struct sk_buff *skb;
1096 	u32 reg;
1097 
1098 	reg = readl_relaxed(adpt->base + rx_q->consume_reg);
1099 
1100 	hw_consume_idx = (reg & rx_q->consume_mask) >> rx_q->consume_shift;
1101 	num_consume_pkts = (hw_consume_idx >= rx_q->rrd.consume_idx) ?
1102 		(hw_consume_idx -  rx_q->rrd.consume_idx) :
1103 		(hw_consume_idx + rx_q->rrd.count - rx_q->rrd.consume_idx);
1104 
1105 	do {
1106 		if (!num_consume_pkts)
1107 			break;
1108 
1109 		if (!emac_rx_process_rrd(adpt, rx_q, &rrd))
1110 			break;
1111 
1112 		if (likely(RRD_NOR(&rrd) == 1)) {
1113 			/* good receive */
1114 			rfbuf = GET_RFD_BUFFER(rx_q, RRD_SI(&rrd));
1115 			dma_unmap_single(adpt->netdev->dev.parent,
1116 					 rfbuf->dma_addr, rfbuf->length,
1117 					 DMA_FROM_DEVICE);
1118 			rfbuf->dma_addr = 0;
1119 			skb = rfbuf->skb;
1120 		} else {
1121 			netdev_err(adpt->netdev,
1122 				   "error: multi-RFD not support yet!\n");
1123 			break;
1124 		}
1125 		emac_rx_rfd_clean(rx_q, &rrd);
1126 		num_consume_pkts--;
1127 		count++;
1128 
1129 		/* Due to a HW issue in L4 check sum detection (UDP/TCP frags
1130 		 * with DF set are marked as error), drop packets based on the
1131 		 * error mask rather than the summary bit (ignoring L4F errors)
1132 		 */
1133 		if (rrd.word[EMAC_RRD_STATS_DW_IDX] & EMAC_RRD_ERROR) {
1134 			netif_dbg(adpt, rx_status, adpt->netdev,
1135 				  "Drop error packet[RRD: 0x%x:0x%x:0x%x:0x%x]\n",
1136 				  rrd.word[0], rrd.word[1],
1137 				  rrd.word[2], rrd.word[3]);
1138 
1139 			dev_kfree_skb(skb);
1140 			continue;
1141 		}
1142 
1143 		skb_put(skb, RRD_PKT_SIZE(&rrd) - ETH_FCS_LEN);
1144 		skb->dev = netdev;
1145 		skb->protocol = eth_type_trans(skb, skb->dev);
1146 		if (netdev->features & NETIF_F_RXCSUM)
1147 			skb->ip_summed = RRD_L4F(&rrd) ?
1148 					  CHECKSUM_NONE : CHECKSUM_UNNECESSARY;
1149 		else
1150 			skb_checksum_none_assert(skb);
1151 
1152 		emac_receive_skb(rx_q, skb, (u16)RRD_CVALN_TAG(&rrd),
1153 				 (bool)RRD_CVTAG(&rrd));
1154 
1155 		(*num_pkts)++;
1156 	} while (*num_pkts < max_pkts);
1157 
1158 	if (count) {
1159 		proc_idx = (rx_q->rfd.process_idx << rx_q->process_shft) &
1160 				rx_q->process_mask;
1161 		emac_reg_update32(adpt->base + rx_q->process_reg,
1162 				  rx_q->process_mask, proc_idx);
1163 		emac_mac_rx_descs_refill(adpt, rx_q);
1164 	}
1165 }
1166 
1167 /* get the number of free transmit descriptors */
1168 static unsigned int emac_tpd_num_free_descs(struct emac_tx_queue *tx_q)
1169 {
1170 	u32 produce_idx = tx_q->tpd.produce_idx;
1171 	u32 consume_idx = tx_q->tpd.consume_idx;
1172 
1173 	return (consume_idx > produce_idx) ?
1174 		(consume_idx - produce_idx - 1) :
1175 		(tx_q->tpd.count + consume_idx - produce_idx - 1);
1176 }
1177 
1178 /* Process transmit event */
1179 void emac_mac_tx_process(struct emac_adapter *adpt, struct emac_tx_queue *tx_q)
1180 {
1181 	u32 reg = readl_relaxed(adpt->base + tx_q->consume_reg);
1182 	u32 hw_consume_idx, pkts_compl = 0, bytes_compl = 0;
1183 	struct emac_buffer *tpbuf;
1184 
1185 	hw_consume_idx = (reg & tx_q->consume_mask) >> tx_q->consume_shift;
1186 
1187 	while (tx_q->tpd.consume_idx != hw_consume_idx) {
1188 		tpbuf = GET_TPD_BUFFER(tx_q, tx_q->tpd.consume_idx);
1189 		if (tpbuf->dma_addr) {
1190 			dma_unmap_page(adpt->netdev->dev.parent,
1191 				       tpbuf->dma_addr, tpbuf->length,
1192 				       DMA_TO_DEVICE);
1193 			tpbuf->dma_addr = 0;
1194 		}
1195 
1196 		if (tpbuf->skb) {
1197 			pkts_compl++;
1198 			bytes_compl += tpbuf->skb->len;
1199 			dev_consume_skb_irq(tpbuf->skb);
1200 			tpbuf->skb = NULL;
1201 		}
1202 
1203 		if (++tx_q->tpd.consume_idx == tx_q->tpd.count)
1204 			tx_q->tpd.consume_idx = 0;
1205 	}
1206 
1207 	netdev_completed_queue(adpt->netdev, pkts_compl, bytes_compl);
1208 
1209 	if (netif_queue_stopped(adpt->netdev))
1210 		if (emac_tpd_num_free_descs(tx_q) > (MAX_SKB_FRAGS + 1))
1211 			netif_wake_queue(adpt->netdev);
1212 }
1213 
1214 /* Initialize all queue data structures */
1215 void emac_mac_rx_tx_ring_init_all(struct platform_device *pdev,
1216 				  struct emac_adapter *adpt)
1217 {
1218 	adpt->rx_q.netdev = adpt->netdev;
1219 
1220 	adpt->rx_q.produce_reg  = EMAC_MAILBOX_0;
1221 	adpt->rx_q.produce_mask = RFD0_PROD_IDX_BMSK;
1222 	adpt->rx_q.produce_shift = RFD0_PROD_IDX_SHFT;
1223 
1224 	adpt->rx_q.process_reg  = EMAC_MAILBOX_0;
1225 	adpt->rx_q.process_mask = RFD0_PROC_IDX_BMSK;
1226 	adpt->rx_q.process_shft = RFD0_PROC_IDX_SHFT;
1227 
1228 	adpt->rx_q.consume_reg  = EMAC_MAILBOX_3;
1229 	adpt->rx_q.consume_mask = RFD0_CONS_IDX_BMSK;
1230 	adpt->rx_q.consume_shift = RFD0_CONS_IDX_SHFT;
1231 
1232 	adpt->rx_q.irq          = &adpt->irq;
1233 	adpt->rx_q.intr         = adpt->irq.mask & ISR_RX_PKT;
1234 
1235 	adpt->tx_q.produce_reg  = EMAC_MAILBOX_15;
1236 	adpt->tx_q.produce_mask = NTPD_PROD_IDX_BMSK;
1237 	adpt->tx_q.produce_shift = NTPD_PROD_IDX_SHFT;
1238 
1239 	adpt->tx_q.consume_reg  = EMAC_MAILBOX_2;
1240 	adpt->tx_q.consume_mask = NTPD_CONS_IDX_BMSK;
1241 	adpt->tx_q.consume_shift = NTPD_CONS_IDX_SHFT;
1242 }
1243 
1244 /* Fill up transmit descriptors with TSO and Checksum offload information */
1245 static int emac_tso_csum(struct emac_adapter *adpt,
1246 			 struct emac_tx_queue *tx_q,
1247 			 struct sk_buff *skb,
1248 			 struct emac_tpd *tpd)
1249 {
1250 	unsigned int hdr_len;
1251 	int ret;
1252 
1253 	if (skb_is_gso(skb)) {
1254 		if (skb_header_cloned(skb)) {
1255 			ret = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
1256 			if (unlikely(ret))
1257 				return ret;
1258 		}
1259 
1260 		if (skb->protocol == htons(ETH_P_IP)) {
1261 			u32 pkt_len = ((unsigned char *)ip_hdr(skb) - skb->data)
1262 				       + ntohs(ip_hdr(skb)->tot_len);
1263 			if (skb->len > pkt_len)
1264 				pskb_trim(skb, pkt_len);
1265 		}
1266 
1267 		hdr_len = skb_transport_offset(skb) + tcp_hdrlen(skb);
1268 		if (unlikely(skb->len == hdr_len)) {
1269 			/* we only need to do csum */
1270 			netif_warn(adpt, tx_err, adpt->netdev,
1271 				   "tso not needed for packet with 0 data\n");
1272 			goto do_csum;
1273 		}
1274 
1275 		if (skb_shinfo(skb)->gso_type & SKB_GSO_TCPV4) {
1276 			ip_hdr(skb)->check = 0;
1277 			tcp_hdr(skb)->check =
1278 				~csum_tcpudp_magic(ip_hdr(skb)->saddr,
1279 						   ip_hdr(skb)->daddr,
1280 						   0, IPPROTO_TCP, 0);
1281 			TPD_IPV4_SET(tpd, 1);
1282 		}
1283 
1284 		if (skb_shinfo(skb)->gso_type & SKB_GSO_TCPV6) {
1285 			/* ipv6 tso need an extra tpd */
1286 			struct emac_tpd extra_tpd;
1287 
1288 			memset(tpd, 0, sizeof(*tpd));
1289 			memset(&extra_tpd, 0, sizeof(extra_tpd));
1290 
1291 			ipv6_hdr(skb)->payload_len = 0;
1292 			tcp_hdr(skb)->check =
1293 				~csum_ipv6_magic(&ipv6_hdr(skb)->saddr,
1294 						 &ipv6_hdr(skb)->daddr,
1295 						 0, IPPROTO_TCP, 0);
1296 			TPD_PKT_LEN_SET(&extra_tpd, skb->len);
1297 			TPD_LSO_SET(&extra_tpd, 1);
1298 			TPD_LSOV_SET(&extra_tpd, 1);
1299 			emac_tx_tpd_create(adpt, tx_q, &extra_tpd);
1300 			TPD_LSOV_SET(tpd, 1);
1301 		}
1302 
1303 		TPD_LSO_SET(tpd, 1);
1304 		TPD_TCPHDR_OFFSET_SET(tpd, skb_transport_offset(skb));
1305 		TPD_MSS_SET(tpd, skb_shinfo(skb)->gso_size);
1306 		return 0;
1307 	}
1308 
1309 do_csum:
1310 	if (likely(skb->ip_summed == CHECKSUM_PARTIAL)) {
1311 		unsigned int css, cso;
1312 
1313 		cso = skb_transport_offset(skb);
1314 		if (unlikely(cso & 0x1)) {
1315 			netdev_err(adpt->netdev,
1316 				   "error: payload offset should be even\n");
1317 			return -EINVAL;
1318 		}
1319 		css = cso + skb->csum_offset;
1320 
1321 		TPD_PAYLOAD_OFFSET_SET(tpd, cso >> 1);
1322 		TPD_CXSUM_OFFSET_SET(tpd, css >> 1);
1323 		TPD_CSX_SET(tpd, 1);
1324 	}
1325 
1326 	return 0;
1327 }
1328 
1329 /* Fill up transmit descriptors */
1330 static void emac_tx_fill_tpd(struct emac_adapter *adpt,
1331 			     struct emac_tx_queue *tx_q, struct sk_buff *skb,
1332 			     struct emac_tpd *tpd)
1333 {
1334 	unsigned int nr_frags = skb_shinfo(skb)->nr_frags;
1335 	unsigned int first = tx_q->tpd.produce_idx;
1336 	unsigned int len = skb_headlen(skb);
1337 	struct emac_buffer *tpbuf = NULL;
1338 	unsigned int mapped_len = 0;
1339 	unsigned int i;
1340 	int count = 0;
1341 	int ret;
1342 
1343 	/* if Large Segment Offload is (in TCP Segmentation Offload struct) */
1344 	if (TPD_LSO(tpd)) {
1345 		mapped_len = skb_transport_offset(skb) + tcp_hdrlen(skb);
1346 
1347 		tpbuf = GET_TPD_BUFFER(tx_q, tx_q->tpd.produce_idx);
1348 		tpbuf->length = mapped_len;
1349 		tpbuf->dma_addr = dma_map_page(adpt->netdev->dev.parent,
1350 					       virt_to_page(skb->data),
1351 					       offset_in_page(skb->data),
1352 					       tpbuf->length,
1353 					       DMA_TO_DEVICE);
1354 		ret = dma_mapping_error(adpt->netdev->dev.parent,
1355 					tpbuf->dma_addr);
1356 		if (ret)
1357 			goto error;
1358 
1359 		TPD_BUFFER_ADDR_L_SET(tpd, lower_32_bits(tpbuf->dma_addr));
1360 		TPD_BUFFER_ADDR_H_SET(tpd, upper_32_bits(tpbuf->dma_addr));
1361 		TPD_BUF_LEN_SET(tpd, tpbuf->length);
1362 		emac_tx_tpd_create(adpt, tx_q, tpd);
1363 		count++;
1364 	}
1365 
1366 	if (mapped_len < len) {
1367 		tpbuf = GET_TPD_BUFFER(tx_q, tx_q->tpd.produce_idx);
1368 		tpbuf->length = len - mapped_len;
1369 		tpbuf->dma_addr = dma_map_page(adpt->netdev->dev.parent,
1370 					       virt_to_page(skb->data +
1371 							    mapped_len),
1372 					       offset_in_page(skb->data +
1373 							      mapped_len),
1374 					       tpbuf->length, DMA_TO_DEVICE);
1375 		ret = dma_mapping_error(adpt->netdev->dev.parent,
1376 					tpbuf->dma_addr);
1377 		if (ret)
1378 			goto error;
1379 
1380 		TPD_BUFFER_ADDR_L_SET(tpd, lower_32_bits(tpbuf->dma_addr));
1381 		TPD_BUFFER_ADDR_H_SET(tpd, upper_32_bits(tpbuf->dma_addr));
1382 		TPD_BUF_LEN_SET(tpd, tpbuf->length);
1383 		emac_tx_tpd_create(adpt, tx_q, tpd);
1384 		count++;
1385 	}
1386 
1387 	for (i = 0; i < nr_frags; i++) {
1388 		struct skb_frag_struct *frag;
1389 
1390 		frag = &skb_shinfo(skb)->frags[i];
1391 
1392 		tpbuf = GET_TPD_BUFFER(tx_q, tx_q->tpd.produce_idx);
1393 		tpbuf->length = frag->size;
1394 		tpbuf->dma_addr = dma_map_page(adpt->netdev->dev.parent,
1395 					       frag->page.p, frag->page_offset,
1396 					       tpbuf->length, DMA_TO_DEVICE);
1397 		ret = dma_mapping_error(adpt->netdev->dev.parent,
1398 					tpbuf->dma_addr);
1399 		if (ret)
1400 			goto error;
1401 
1402 		TPD_BUFFER_ADDR_L_SET(tpd, lower_32_bits(tpbuf->dma_addr));
1403 		TPD_BUFFER_ADDR_H_SET(tpd, upper_32_bits(tpbuf->dma_addr));
1404 		TPD_BUF_LEN_SET(tpd, tpbuf->length);
1405 		emac_tx_tpd_create(adpt, tx_q, tpd);
1406 		count++;
1407 	}
1408 
1409 	/* The last tpd */
1410 	wmb();
1411 	emac_tx_tpd_mark_last(adpt, tx_q);
1412 
1413 	/* The last buffer info contain the skb address,
1414 	 * so it will be freed after unmap
1415 	 */
1416 	tpbuf->skb = skb;
1417 
1418 	return;
1419 
1420 error:
1421 	/* One of the memory mappings failed, so undo everything */
1422 	tx_q->tpd.produce_idx = first;
1423 
1424 	while (count--) {
1425 		tpbuf = GET_TPD_BUFFER(tx_q, first);
1426 		dma_unmap_page(adpt->netdev->dev.parent, tpbuf->dma_addr,
1427 			       tpbuf->length, DMA_TO_DEVICE);
1428 		tpbuf->dma_addr = 0;
1429 		tpbuf->length = 0;
1430 
1431 		if (++first == tx_q->tpd.count)
1432 			first = 0;
1433 	}
1434 
1435 	dev_kfree_skb(skb);
1436 }
1437 
1438 /* Transmit the packet using specified transmit queue */
1439 int emac_mac_tx_buf_send(struct emac_adapter *adpt, struct emac_tx_queue *tx_q,
1440 			 struct sk_buff *skb)
1441 {
1442 	struct emac_tpd tpd;
1443 	u32 prod_idx;
1444 
1445 	memset(&tpd, 0, sizeof(tpd));
1446 
1447 	if (emac_tso_csum(adpt, tx_q, skb, &tpd) != 0) {
1448 		dev_kfree_skb_any(skb);
1449 		return NETDEV_TX_OK;
1450 	}
1451 
1452 	if (skb_vlan_tag_present(skb)) {
1453 		u16 tag;
1454 
1455 		EMAC_VLAN_TO_TAG(skb_vlan_tag_get(skb), tag);
1456 		TPD_CVLAN_TAG_SET(&tpd, tag);
1457 		TPD_INSTC_SET(&tpd, 1);
1458 	}
1459 
1460 	if (skb_network_offset(skb) != ETH_HLEN)
1461 		TPD_TYP_SET(&tpd, 1);
1462 
1463 	emac_tx_fill_tpd(adpt, tx_q, skb, &tpd);
1464 
1465 	netdev_sent_queue(adpt->netdev, skb->len);
1466 
1467 	/* Make sure the are enough free descriptors to hold one
1468 	 * maximum-sized SKB.  We need one desc for each fragment,
1469 	 * one for the checksum (emac_tso_csum), one for TSO, and
1470 	 * and one for the SKB header.
1471 	 */
1472 	if (emac_tpd_num_free_descs(tx_q) < (MAX_SKB_FRAGS + 3))
1473 		netif_stop_queue(adpt->netdev);
1474 
1475 	/* update produce idx */
1476 	prod_idx = (tx_q->tpd.produce_idx << tx_q->produce_shift) &
1477 		    tx_q->produce_mask;
1478 	emac_reg_update32(adpt->base + tx_q->produce_reg,
1479 			  tx_q->produce_mask, prod_idx);
1480 
1481 	return NETDEV_TX_OK;
1482 }
1483