2 * Copyright (c) 2014-2015 Hisilicon Limited.
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
10 #include <linux/clk.h>
11 #include <linux/cpumask.h>
12 #include <linux/etherdevice.h>
13 #include <linux/if_vlan.h>
14 #include <linux/interrupt.h>
17 #include <linux/ipv6.h>
18 #include <linux/module.h>
19 #include <linux/phy.h>
20 #include <linux/platform_device.h>
21 #include <linux/skbuff.h>
25 #include "hns_dsaf_mac.h"
27 #define NIC_MAX_Q_PER_VF 16
28 #define HNS_NIC_TX_TIMEOUT (5 * HZ)
30 #define SERVICE_TIMER_HZ (1 * HZ)
32 #define NIC_TX_CLEAN_MAX_NUM 256
33 #define NIC_RX_CLEAN_MAX_NUM 64
35 #define RCB_IRQ_NOT_INITED 0
36 #define RCB_IRQ_INITED 1
37 #define HNS_BUFFER_SIZE_2048 2048
39 #define BD_MAX_SEND_SIZE 8191
40 #define SKB_TMP_LEN(SKB) \
41 (((SKB)->transport_header - (SKB)->mac_header) + tcp_hdrlen(SKB))
43 static void fill_v2_desc(struct hnae_ring
*ring
, void *priv
,
44 int size
, dma_addr_t dma
, int frag_end
,
45 int buf_num
, enum hns_desc_type type
, int mtu
)
47 struct hnae_desc
*desc
= &ring
->desc
[ring
->next_to_use
];
48 struct hnae_desc_cb
*desc_cb
= &ring
->desc_cb
[ring
->next_to_use
];
50 struct ipv6hdr
*ipv6hdr
;
62 desc_cb
->length
= size
;
66 desc
->addr
= cpu_to_le64(dma
);
67 desc
->tx
.send_size
= cpu_to_le16((u16
)size
);
69 /* config bd buffer end */
70 hnae_set_bit(rrcfv
, HNSV2_TXD_VLD_B
, 1);
71 hnae_set_field(bn_pid
, HNSV2_TXD_BUFNUM_M
, 0, buf_num
- 1);
73 /* fill port_id in the tx bd for sending management pkts */
74 hnae_set_field(bn_pid
, HNSV2_TXD_PORTID_M
,
75 HNSV2_TXD_PORTID_S
, ring
->q
->handle
->dport_id
);
77 if (type
== DESC_TYPE_SKB
) {
78 skb
= (struct sk_buff
*)priv
;
80 if (skb
->ip_summed
== CHECKSUM_PARTIAL
) {
81 skb_reset_mac_len(skb
);
82 protocol
= skb
->protocol
;
85 if (protocol
== htons(ETH_P_8021Q
)) {
86 ip_offset
+= VLAN_HLEN
;
87 protocol
= vlan_get_protocol(skb
);
88 skb
->protocol
= protocol
;
91 if (skb
->protocol
== htons(ETH_P_IP
)) {
93 hnae_set_bit(rrcfv
, HNSV2_TXD_L3CS_B
, 1);
94 hnae_set_bit(rrcfv
, HNSV2_TXD_L4CS_B
, 1);
96 /* check for tcp/udp header */
97 if (iphdr
->protocol
== IPPROTO_TCP
&&
101 l4_len
= tcp_hdrlen(skb
);
102 mss
= skb_shinfo(skb
)->gso_size
;
103 paylen
= skb
->len
- SKB_TMP_LEN(skb
);
105 } else if (skb
->protocol
== htons(ETH_P_IPV6
)) {
106 hnae_set_bit(tvsvsn
, HNSV2_TXD_IPV6_B
, 1);
107 ipv6hdr
= ipv6_hdr(skb
);
108 hnae_set_bit(rrcfv
, HNSV2_TXD_L4CS_B
, 1);
110 /* check for tcp/udp header */
111 if (ipv6hdr
->nexthdr
== IPPROTO_TCP
&&
112 skb_is_gso(skb
) && skb_is_gso_v6(skb
)) {
115 l4_len
= tcp_hdrlen(skb
);
116 mss
= skb_shinfo(skb
)->gso_size
;
117 paylen
= skb
->len
- SKB_TMP_LEN(skb
);
120 desc
->tx
.ip_offset
= ip_offset
;
121 desc
->tx
.tse_vlan_snap_v6_sctp_nth
= tvsvsn
;
122 desc
->tx
.mss
= cpu_to_le16(mss
);
123 desc
->tx
.l4_len
= l4_len
;
124 desc
->tx
.paylen
= cpu_to_le16(paylen
);
128 hnae_set_bit(rrcfv
, HNSV2_TXD_FE_B
, frag_end
);
130 desc
->tx
.bn_pid
= bn_pid
;
131 desc
->tx
.ra_ri_cs_fe_vld
= rrcfv
;
133 ring_ptr_move_fw(ring
, next_to_use
);
136 static const struct acpi_device_id hns_enet_acpi_match
[] = {
141 MODULE_DEVICE_TABLE(acpi
, hns_enet_acpi_match
);
143 static void fill_desc(struct hnae_ring
*ring
, void *priv
,
144 int size
, dma_addr_t dma
, int frag_end
,
145 int buf_num
, enum hns_desc_type type
, int mtu
)
147 struct hnae_desc
*desc
= &ring
->desc
[ring
->next_to_use
];
148 struct hnae_desc_cb
*desc_cb
= &ring
->desc_cb
[ring
->next_to_use
];
152 u32 asid_bufnum_pid
= 0;
153 u32 flag_ipoffset
= 0;
155 desc_cb
->priv
= priv
;
156 desc_cb
->length
= size
;
158 desc_cb
->type
= type
;
160 desc
->addr
= cpu_to_le64(dma
);
161 desc
->tx
.send_size
= cpu_to_le16((u16
)size
);
163 /*config bd buffer end */
164 flag_ipoffset
|= 1 << HNS_TXD_VLD_B
;
166 asid_bufnum_pid
|= buf_num
<< HNS_TXD_BUFNUM_S
;
168 if (type
== DESC_TYPE_SKB
) {
169 skb
= (struct sk_buff
*)priv
;
171 if (skb
->ip_summed
== CHECKSUM_PARTIAL
) {
172 protocol
= skb
->protocol
;
173 ip_offset
= ETH_HLEN
;
175 /*if it is a SW VLAN check the next protocol*/
176 if (protocol
== htons(ETH_P_8021Q
)) {
177 ip_offset
+= VLAN_HLEN
;
178 protocol
= vlan_get_protocol(skb
);
179 skb
->protocol
= protocol
;
182 if (skb
->protocol
== htons(ETH_P_IP
)) {
183 flag_ipoffset
|= 1 << HNS_TXD_L3CS_B
;
184 /* check for tcp/udp header */
185 flag_ipoffset
|= 1 << HNS_TXD_L4CS_B
;
187 } else if (skb
->protocol
== htons(ETH_P_IPV6
)) {
188 /* ipv6 has not l3 cs, check for L4 header */
189 flag_ipoffset
|= 1 << HNS_TXD_L4CS_B
;
192 flag_ipoffset
|= ip_offset
<< HNS_TXD_IPOFFSET_S
;
196 flag_ipoffset
|= frag_end
<< HNS_TXD_FE_B
;
198 desc
->tx
.asid_bufnum_pid
= cpu_to_le16(asid_bufnum_pid
);
199 desc
->tx
.flag_ipoffset
= cpu_to_le32(flag_ipoffset
);
201 ring_ptr_move_fw(ring
, next_to_use
);
204 static void unfill_desc(struct hnae_ring
*ring
)
206 ring_ptr_move_bw(ring
, next_to_use
);
209 static int hns_nic_maybe_stop_tx(
210 struct sk_buff
**out_skb
, int *bnum
, struct hnae_ring
*ring
)
212 struct sk_buff
*skb
= *out_skb
;
213 struct sk_buff
*new_skb
= NULL
;
216 /* no. of segments (plus a header) */
217 buf_num
= skb_shinfo(skb
)->nr_frags
+ 1;
219 if (unlikely(buf_num
> ring
->max_desc_num_per_pkt
)) {
220 if (ring_space(ring
) < 1)
223 new_skb
= skb_copy(skb
, GFP_ATOMIC
);
227 dev_kfree_skb_any(skb
);
230 } else if (buf_num
> ring_space(ring
)) {
238 static int hns_nic_maybe_stop_tso(
239 struct sk_buff
**out_skb
, int *bnum
, struct hnae_ring
*ring
)
245 struct sk_buff
*skb
= *out_skb
;
246 struct sk_buff
*new_skb
= NULL
;
247 struct skb_frag_struct
*frag
;
249 size
= skb_headlen(skb
);
250 buf_num
= (size
+ BD_MAX_SEND_SIZE
- 1) / BD_MAX_SEND_SIZE
;
252 frag_num
= skb_shinfo(skb
)->nr_frags
;
253 for (i
= 0; i
< frag_num
; i
++) {
254 frag
= &skb_shinfo(skb
)->frags
[i
];
255 size
= skb_frag_size(frag
);
256 buf_num
+= (size
+ BD_MAX_SEND_SIZE
- 1) / BD_MAX_SEND_SIZE
;
259 if (unlikely(buf_num
> ring
->max_desc_num_per_pkt
)) {
260 buf_num
= (skb
->len
+ BD_MAX_SEND_SIZE
- 1) / BD_MAX_SEND_SIZE
;
261 if (ring_space(ring
) < buf_num
)
263 /* manual split the send packet */
264 new_skb
= skb_copy(skb
, GFP_ATOMIC
);
267 dev_kfree_skb_any(skb
);
270 } else if (ring_space(ring
) < buf_num
) {
278 static void fill_tso_desc(struct hnae_ring
*ring
, void *priv
,
279 int size
, dma_addr_t dma
, int frag_end
,
280 int buf_num
, enum hns_desc_type type
, int mtu
)
286 frag_buf_num
= (size
+ BD_MAX_SEND_SIZE
- 1) / BD_MAX_SEND_SIZE
;
287 sizeoflast
= size
% BD_MAX_SEND_SIZE
;
288 sizeoflast
= sizeoflast
? sizeoflast
: BD_MAX_SEND_SIZE
;
290 /* when the frag size is bigger than hardware, split this frag */
291 for (k
= 0; k
< frag_buf_num
; k
++)
292 fill_v2_desc(ring
, priv
,
293 (k
== frag_buf_num
- 1) ?
294 sizeoflast
: BD_MAX_SEND_SIZE
,
295 dma
+ BD_MAX_SEND_SIZE
* k
,
296 frag_end
&& (k
== frag_buf_num
- 1) ? 1 : 0,
298 (type
== DESC_TYPE_SKB
&& !k
) ?
299 DESC_TYPE_SKB
: DESC_TYPE_PAGE
,
303 netdev_tx_t
hns_nic_net_xmit_hw(struct net_device
*ndev
,
305 struct hns_nic_ring_data
*ring_data
)
307 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
308 struct hnae_ring
*ring
= ring_data
->ring
;
309 struct device
*dev
= ring_to_dev(ring
);
310 struct netdev_queue
*dev_queue
;
311 struct skb_frag_struct
*frag
;
315 int size
, next_to_use
;
318 switch (priv
->ops
.maybe_stop_tx(&skb
, &buf_num
, ring
)) {
320 ring
->stats
.tx_busy
++;
321 goto out_net_tx_busy
;
323 ring
->stats
.sw_err_cnt
++;
324 netdev_err(ndev
, "no memory to xmit!\n");
330 /* no. of segments (plus a header) */
331 seg_num
= skb_shinfo(skb
)->nr_frags
+ 1;
332 next_to_use
= ring
->next_to_use
;
334 /* fill the first part */
335 size
= skb_headlen(skb
);
336 dma
= dma_map_single(dev
, skb
->data
, size
, DMA_TO_DEVICE
);
337 if (dma_mapping_error(dev
, dma
)) {
338 netdev_err(ndev
, "TX head DMA map failed\n");
339 ring
->stats
.sw_err_cnt
++;
342 priv
->ops
.fill_desc(ring
, skb
, size
, dma
, seg_num
== 1 ? 1 : 0,
343 buf_num
, DESC_TYPE_SKB
, ndev
->mtu
);
345 /* fill the fragments */
346 for (i
= 1; i
< seg_num
; i
++) {
347 frag
= &skb_shinfo(skb
)->frags
[i
- 1];
348 size
= skb_frag_size(frag
);
349 dma
= skb_frag_dma_map(dev
, frag
, 0, size
, DMA_TO_DEVICE
);
350 if (dma_mapping_error(dev
, dma
)) {
351 netdev_err(ndev
, "TX frag(%d) DMA map failed\n", i
);
352 ring
->stats
.sw_err_cnt
++;
353 goto out_map_frag_fail
;
355 priv
->ops
.fill_desc(ring
, skb_frag_page(frag
), size
, dma
,
356 seg_num
- 1 == i
? 1 : 0, buf_num
,
357 DESC_TYPE_PAGE
, ndev
->mtu
);
360 /*complete translate all packets*/
361 dev_queue
= netdev_get_tx_queue(ndev
, skb
->queue_mapping
);
362 netdev_tx_sent_queue(dev_queue
, skb
->len
);
364 netif_trans_update(ndev
);
365 ndev
->stats
.tx_bytes
+= skb
->len
;
366 ndev
->stats
.tx_packets
++;
368 wmb(); /* commit all data before submit */
369 assert(skb
->queue_mapping
< priv
->ae_handle
->q_num
);
370 hnae_queue_xmit(priv
->ae_handle
->qs
[skb
->queue_mapping
], buf_num
);
371 ring
->stats
.tx_pkts
++;
372 ring
->stats
.tx_bytes
+= skb
->len
;
378 while (ring
->next_to_use
!= next_to_use
) {
380 if (ring
->next_to_use
!= next_to_use
)
382 ring
->desc_cb
[ring
->next_to_use
].dma
,
383 ring
->desc_cb
[ring
->next_to_use
].length
,
386 dma_unmap_single(dev
,
387 ring
->desc_cb
[next_to_use
].dma
,
388 ring
->desc_cb
[next_to_use
].length
,
394 dev_kfree_skb_any(skb
);
399 netif_stop_subqueue(ndev
, skb
->queue_mapping
);
401 /* Herbert's original patch had:
402 * smp_mb__after_netif_stop_queue();
403 * but since that doesn't exist yet, just open code it.
406 return NETDEV_TX_BUSY
;
410 * hns_nic_get_headlen - determine size of header for RSC/LRO/GRO/FCOE
411 * @data: pointer to the start of the headers
412 * @max: total length of section to find headers in
414 * This function is meant to determine the length of headers that will
415 * be recognized by hardware for LRO, GRO, and RSC offloads. The main
416 * motivation of doing this is to only perform one pull for IPv4 TCP
417 * packets so that we can do basic things like calculating the gso_size
418 * based on the average data per packet.
420 static unsigned int hns_nic_get_headlen(unsigned char *data
, u32 flag
,
421 unsigned int max_size
)
423 unsigned char *network
;
426 /* this should never happen, but better safe than sorry */
427 if (max_size
< ETH_HLEN
)
430 /* initialize network frame pointer */
433 /* set first protocol and move network header forward */
436 /* handle any vlan tag if present */
437 if (hnae_get_field(flag
, HNS_RXD_VLAN_M
, HNS_RXD_VLAN_S
)
438 == HNS_RX_FLAG_VLAN_PRESENT
) {
439 if ((typeof(max_size
))(network
- data
) > (max_size
- VLAN_HLEN
))
442 network
+= VLAN_HLEN
;
445 /* handle L3 protocols */
446 if (hnae_get_field(flag
, HNS_RXD_L3ID_M
, HNS_RXD_L3ID_S
)
447 == HNS_RX_FLAG_L3ID_IPV4
) {
448 if ((typeof(max_size
))(network
- data
) >
449 (max_size
- sizeof(struct iphdr
)))
452 /* access ihl as a u8 to avoid unaligned access on ia64 */
453 hlen
= (network
[0] & 0x0F) << 2;
455 /* verify hlen meets minimum size requirements */
456 if (hlen
< sizeof(struct iphdr
))
457 return network
- data
;
459 /* record next protocol if header is present */
460 } else if (hnae_get_field(flag
, HNS_RXD_L3ID_M
, HNS_RXD_L3ID_S
)
461 == HNS_RX_FLAG_L3ID_IPV6
) {
462 if ((typeof(max_size
))(network
- data
) >
463 (max_size
- sizeof(struct ipv6hdr
)))
466 /* record next protocol */
467 hlen
= sizeof(struct ipv6hdr
);
469 return network
- data
;
472 /* relocate pointer to start of L4 header */
475 /* finally sort out TCP/UDP */
476 if (hnae_get_field(flag
, HNS_RXD_L4ID_M
, HNS_RXD_L4ID_S
)
477 == HNS_RX_FLAG_L4ID_TCP
) {
478 if ((typeof(max_size
))(network
- data
) >
479 (max_size
- sizeof(struct tcphdr
)))
482 /* access doff as a u8 to avoid unaligned access on ia64 */
483 hlen
= (network
[12] & 0xF0) >> 2;
485 /* verify hlen meets minimum size requirements */
486 if (hlen
< sizeof(struct tcphdr
))
487 return network
- data
;
490 } else if (hnae_get_field(flag
, HNS_RXD_L4ID_M
, HNS_RXD_L4ID_S
)
491 == HNS_RX_FLAG_L4ID_UDP
) {
492 if ((typeof(max_size
))(network
- data
) >
493 (max_size
- sizeof(struct udphdr
)))
496 network
+= sizeof(struct udphdr
);
499 /* If everything has gone correctly network should be the
500 * data section of the packet and will be the end of the header.
501 * If not then it probably represents the end of the last recognized
504 if ((typeof(max_size
))(network
- data
) < max_size
)
505 return network
- data
;
510 static void hns_nic_reuse_page(struct sk_buff
*skb
, int i
,
511 struct hnae_ring
*ring
, int pull_len
,
512 struct hnae_desc_cb
*desc_cb
)
514 struct hnae_desc
*desc
;
519 twobufs
= ((PAGE_SIZE
< 8192) &&
520 hnae_buf_size(ring
) == HNS_BUFFER_SIZE_2048
);
522 desc
= &ring
->desc
[ring
->next_to_clean
];
523 size
= le16_to_cpu(desc
->rx
.size
);
526 truesize
= hnae_buf_size(ring
);
528 truesize
= ALIGN(size
, L1_CACHE_BYTES
);
529 last_offset
= hnae_page_size(ring
) - hnae_buf_size(ring
);
532 skb_add_rx_frag(skb
, i
, desc_cb
->priv
, desc_cb
->page_offset
+ pull_len
,
533 size
- pull_len
, truesize
- pull_len
);
535 /* avoid re-using remote pages,flag default unreuse */
536 if (unlikely(page_to_nid(desc_cb
->priv
) != numa_node_id()))
540 /* if we are only owner of page we can reuse it */
541 if (likely(page_count(desc_cb
->priv
) == 1)) {
542 /* flip page offset to other buffer */
543 desc_cb
->page_offset
^= truesize
;
545 desc_cb
->reuse_flag
= 1;
546 /* bump ref count on page before it is given*/
547 get_page(desc_cb
->priv
);
552 /* move offset up to the next cache line */
553 desc_cb
->page_offset
+= truesize
;
555 if (desc_cb
->page_offset
<= last_offset
) {
556 desc_cb
->reuse_flag
= 1;
557 /* bump ref count on page before it is given*/
558 get_page(desc_cb
->priv
);
562 static void get_v2rx_desc_bnum(u32 bnum_flag
, int *out_bnum
)
564 *out_bnum
= hnae_get_field(bnum_flag
,
565 HNS_RXD_BUFNUM_M
, HNS_RXD_BUFNUM_S
) + 1;
568 static void get_rx_desc_bnum(u32 bnum_flag
, int *out_bnum
)
570 *out_bnum
= hnae_get_field(bnum_flag
,
571 HNS_RXD_BUFNUM_M
, HNS_RXD_BUFNUM_S
);
574 static void hns_nic_rx_checksum(struct hns_nic_ring_data
*ring_data
,
575 struct sk_buff
*skb
, u32 flag
)
577 struct net_device
*netdev
= ring_data
->napi
.dev
;
581 /* check if RX checksum offload is enabled */
582 if (unlikely(!(netdev
->features
& NETIF_F_RXCSUM
)))
585 /* In hardware, we only support checksum for the following protocols:
587 * 2) TCP(over IPv4 or IPv6),
588 * 3) UDP(over IPv4 or IPv6),
589 * 4) SCTP(over IPv4 or IPv6)
590 * but we support many L3(IPv4, IPv6, MPLS, PPPoE etc) and L4(TCP,
591 * UDP, GRE, SCTP, IGMP, ICMP etc.) protocols.
593 * Hardware limitation:
594 * Our present hardware RX Descriptor lacks L3/L4 checksum "Status &
595 * Error" bit (which usually can be used to indicate whether checksum
596 * was calculated by the hardware and if there was any error encountered
597 * during checksum calculation).
599 * Software workaround:
600 * We do get info within the RX descriptor about the kind of L3/L4
601 * protocol coming in the packet and the error status. These errors
602 * might not just be checksum errors but could be related to version,
603 * length of IPv4, UDP, TCP etc.
604 * Because there is no-way of knowing if it is a L3/L4 error due to bad
605 * checksum or any other L3/L4 error, we will not (cannot) convey
606 * checksum status for such cases to upper stack and will not maintain
607 * the RX L3/L4 checksum counters as well.
610 l3id
= hnae_get_field(flag
, HNS_RXD_L3ID_M
, HNS_RXD_L3ID_S
);
611 l4id
= hnae_get_field(flag
, HNS_RXD_L4ID_M
, HNS_RXD_L4ID_S
);
613 /* check L3 protocol for which checksum is supported */
614 if ((l3id
!= HNS_RX_FLAG_L3ID_IPV4
) && (l3id
!= HNS_RX_FLAG_L3ID_IPV6
))
617 /* check for any(not just checksum)flagged L3 protocol errors */
618 if (unlikely(hnae_get_bit(flag
, HNS_RXD_L3E_B
)))
621 /* we do not support checksum of fragmented packets */
622 if (unlikely(hnae_get_bit(flag
, HNS_RXD_FRAG_B
)))
625 /* check L4 protocol for which checksum is supported */
626 if ((l4id
!= HNS_RX_FLAG_L4ID_TCP
) &&
627 (l4id
!= HNS_RX_FLAG_L4ID_UDP
) &&
628 (l4id
!= HNS_RX_FLAG_L4ID_SCTP
))
631 /* check for any(not just checksum)flagged L4 protocol errors */
632 if (unlikely(hnae_get_bit(flag
, HNS_RXD_L4E_B
)))
635 /* now, this has to be a packet with valid RX checksum */
636 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
639 static int hns_nic_poll_rx_skb(struct hns_nic_ring_data
*ring_data
,
640 struct sk_buff
**out_skb
, int *out_bnum
)
642 struct hnae_ring
*ring
= ring_data
->ring
;
643 struct net_device
*ndev
= ring_data
->napi
.dev
;
644 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
646 struct hnae_desc
*desc
;
647 struct hnae_desc_cb
*desc_cb
;
653 desc
= &ring
->desc
[ring
->next_to_clean
];
654 desc_cb
= &ring
->desc_cb
[ring
->next_to_clean
];
658 va
= (unsigned char *)desc_cb
->buf
+ desc_cb
->page_offset
;
660 /* prefetch first cache line of first page */
662 #if L1_CACHE_BYTES < 128
663 prefetch(va
+ L1_CACHE_BYTES
);
666 skb
= *out_skb
= napi_alloc_skb(&ring_data
->napi
,
668 if (unlikely(!skb
)) {
669 netdev_err(ndev
, "alloc rx skb fail\n");
670 ring
->stats
.sw_err_cnt
++;
674 prefetchw(skb
->data
);
675 length
= le16_to_cpu(desc
->rx
.pkt_len
);
676 bnum_flag
= le32_to_cpu(desc
->rx
.ipoff_bnum_pid_flag
);
677 priv
->ops
.get_rxd_bnum(bnum_flag
, &bnum
);
680 if (length
<= HNS_RX_HEAD_SIZE
) {
681 memcpy(__skb_put(skb
, length
), va
, ALIGN(length
, sizeof(long)));
683 /* we can reuse buffer as-is, just make sure it is local */
684 if (likely(page_to_nid(desc_cb
->priv
) == numa_node_id()))
685 desc_cb
->reuse_flag
= 1;
686 else /* this page cannot be reused so discard it */
687 put_page(desc_cb
->priv
);
689 ring_ptr_move_fw(ring
, next_to_clean
);
691 if (unlikely(bnum
!= 1)) { /* check err*/
696 ring
->stats
.seg_pkt_cnt
++;
698 pull_len
= hns_nic_get_headlen(va
, bnum_flag
, HNS_RX_HEAD_SIZE
);
699 memcpy(__skb_put(skb
, pull_len
), va
,
700 ALIGN(pull_len
, sizeof(long)));
702 hns_nic_reuse_page(skb
, 0, ring
, pull_len
, desc_cb
);
703 ring_ptr_move_fw(ring
, next_to_clean
);
705 if (unlikely(bnum
>= (int)MAX_SKB_FRAGS
)) { /* check err*/
709 for (i
= 1; i
< bnum
; i
++) {
710 desc
= &ring
->desc
[ring
->next_to_clean
];
711 desc_cb
= &ring
->desc_cb
[ring
->next_to_clean
];
713 hns_nic_reuse_page(skb
, i
, ring
, 0, desc_cb
);
714 ring_ptr_move_fw(ring
, next_to_clean
);
718 /* check except process, free skb and jump the desc */
719 if (unlikely((!bnum
) || (bnum
> ring
->max_desc_num_per_pkt
))) {
721 *out_bnum
= *out_bnum
? *out_bnum
: 1; /* ntc moved,cannot 0*/
722 netdev_err(ndev
, "invalid bnum(%d,%d,%d,%d),%016llx,%016llx\n",
723 bnum
, ring
->max_desc_num_per_pkt
,
724 length
, (int)MAX_SKB_FRAGS
,
725 ((u64
*)desc
)[0], ((u64
*)desc
)[1]);
726 ring
->stats
.err_bd_num
++;
727 dev_kfree_skb_any(skb
);
731 bnum_flag
= le32_to_cpu(desc
->rx
.ipoff_bnum_pid_flag
);
733 if (unlikely(!hnae_get_bit(bnum_flag
, HNS_RXD_VLD_B
))) {
734 netdev_err(ndev
, "no valid bd,%016llx,%016llx\n",
735 ((u64
*)desc
)[0], ((u64
*)desc
)[1]);
736 ring
->stats
.non_vld_descs
++;
737 dev_kfree_skb_any(skb
);
741 if (unlikely((!desc
->rx
.pkt_len
) ||
742 hnae_get_bit(bnum_flag
, HNS_RXD_DROP_B
))) {
743 ring
->stats
.err_pkt_len
++;
744 dev_kfree_skb_any(skb
);
748 if (unlikely(hnae_get_bit(bnum_flag
, HNS_RXD_L2E_B
))) {
749 ring
->stats
.l2_err
++;
750 dev_kfree_skb_any(skb
);
754 ring
->stats
.rx_pkts
++;
755 ring
->stats
.rx_bytes
+= skb
->len
;
757 /* indicate to upper stack if our hardware has already calculated
760 hns_nic_rx_checksum(ring_data
, skb
, bnum_flag
);
766 hns_nic_alloc_rx_buffers(struct hns_nic_ring_data
*ring_data
, int cleand_count
)
769 struct hnae_desc_cb res_cbs
;
770 struct hnae_desc_cb
*desc_cb
;
771 struct hnae_ring
*ring
= ring_data
->ring
;
772 struct net_device
*ndev
= ring_data
->napi
.dev
;
774 for (i
= 0; i
< cleand_count
; i
++) {
775 desc_cb
= &ring
->desc_cb
[ring
->next_to_use
];
776 if (desc_cb
->reuse_flag
) {
777 ring
->stats
.reuse_pg_cnt
++;
778 hnae_reuse_buffer(ring
, ring
->next_to_use
);
780 ret
= hnae_reserve_buffer_map(ring
, &res_cbs
);
782 ring
->stats
.sw_err_cnt
++;
783 netdev_err(ndev
, "hnae reserve buffer map failed.\n");
786 hnae_replace_buffer(ring
, ring
->next_to_use
, &res_cbs
);
789 ring_ptr_move_fw(ring
, next_to_use
);
792 wmb(); /* make all data has been write before submit */
793 writel_relaxed(i
, ring
->io_base
+ RCB_REG_HEAD
);
796 /* return error number for error or number of desc left to take
798 static void hns_nic_rx_up_pro(struct hns_nic_ring_data
*ring_data
,
801 struct net_device
*ndev
= ring_data
->napi
.dev
;
803 skb
->protocol
= eth_type_trans(skb
, ndev
);
804 (void)napi_gro_receive(&ring_data
->napi
, skb
);
807 static int hns_desc_unused(struct hnae_ring
*ring
)
809 int ntc
= ring
->next_to_clean
;
810 int ntu
= ring
->next_to_use
;
812 return ((ntc
>= ntu
) ? 0 : ring
->desc_num
) + ntc
- ntu
;
815 static int hns_nic_rx_poll_one(struct hns_nic_ring_data
*ring_data
,
818 struct hnae_ring
*ring
= ring_data
->ring
;
821 #define RCB_NOF_ALLOC_RX_BUFF_ONCE 16
822 int recv_pkts
, recv_bds
, clean_count
, err
;
823 int unused_count
= hns_desc_unused(ring
);
825 num
= readl_relaxed(ring
->io_base
+ RCB_REG_FBDNUM
);
826 rmb(); /* make sure num taken effect before the other data is touched */
828 recv_pkts
= 0, recv_bds
= 0, clean_count
= 0;
831 while (recv_pkts
< budget
&& recv_bds
< num
) {
832 /* reuse or realloc buffers */
833 if (clean_count
+ unused_count
>= RCB_NOF_ALLOC_RX_BUFF_ONCE
) {
834 hns_nic_alloc_rx_buffers(ring_data
,
835 clean_count
+ unused_count
);
837 unused_count
= hns_desc_unused(ring
);
841 err
= hns_nic_poll_rx_skb(ring_data
, &skb
, &bnum
);
842 if (unlikely(!skb
)) /* this fault cannot be repaired */
847 if (unlikely(err
)) { /* do jump the err */
852 /* do update ip stack process*/
853 ((void (*)(struct hns_nic_ring_data
*, struct sk_buff
*))v
)(
859 /* make all data has been write before submit */
860 if (clean_count
+ unused_count
> 0)
861 hns_nic_alloc_rx_buffers(ring_data
,
862 clean_count
+ unused_count
);
867 static bool hns_nic_rx_fini_pro(struct hns_nic_ring_data
*ring_data
)
869 struct hnae_ring
*ring
= ring_data
->ring
;
872 ring_data
->ring
->q
->handle
->dev
->ops
->toggle_ring_irq(ring
, 0);
874 /* for hardware bug fixed */
875 num
= readl_relaxed(ring
->io_base
+ RCB_REG_FBDNUM
);
878 ring_data
->ring
->q
->handle
->dev
->ops
->toggle_ring_irq(
887 static bool hns_nic_rx_fini_pro_v2(struct hns_nic_ring_data
*ring_data
)
889 struct hnae_ring
*ring
= ring_data
->ring
;
892 num
= readl_relaxed(ring
->io_base
+ RCB_REG_FBDNUM
);
900 static inline void hns_nic_reclaim_one_desc(struct hnae_ring
*ring
,
901 int *bytes
, int *pkts
)
903 struct hnae_desc_cb
*desc_cb
= &ring
->desc_cb
[ring
->next_to_clean
];
905 (*pkts
) += (desc_cb
->type
== DESC_TYPE_SKB
);
906 (*bytes
) += desc_cb
->length
;
907 /* desc_cb will be cleaned, after hnae_free_buffer_detach*/
908 hnae_free_buffer_detach(ring
, ring
->next_to_clean
);
910 ring_ptr_move_fw(ring
, next_to_clean
);
913 static int is_valid_clean_head(struct hnae_ring
*ring
, int h
)
915 int u
= ring
->next_to_use
;
916 int c
= ring
->next_to_clean
;
918 if (unlikely(h
> ring
->desc_num
))
921 assert(u
> 0 && u
< ring
->desc_num
);
922 assert(c
> 0 && c
< ring
->desc_num
);
923 assert(u
!= c
&& h
!= c
); /* must be checked before call this func */
925 return u
> c
? (h
> c
&& h
<= u
) : (h
> c
|| h
<= u
);
928 /* netif_tx_lock will turn down the performance, set only when necessary */
929 #ifdef CONFIG_NET_POLL_CONTROLLER
930 #define NETIF_TX_LOCK(ring) spin_lock(&(ring)->lock)
931 #define NETIF_TX_UNLOCK(ring) spin_unlock(&(ring)->lock)
933 #define NETIF_TX_LOCK(ring)
934 #define NETIF_TX_UNLOCK(ring)
937 /* reclaim all desc in one budget
938 * return error or number of desc left
940 static int hns_nic_tx_poll_one(struct hns_nic_ring_data
*ring_data
,
943 struct hnae_ring
*ring
= ring_data
->ring
;
944 struct net_device
*ndev
= ring_data
->napi
.dev
;
945 struct netdev_queue
*dev_queue
;
946 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
952 head
= readl_relaxed(ring
->io_base
+ RCB_REG_HEAD
);
953 rmb(); /* make sure head is ready before touch any data */
955 if (is_ring_empty(ring
) || head
== ring
->next_to_clean
) {
956 NETIF_TX_UNLOCK(ring
);
957 return 0; /* no data to poll */
960 if (!is_valid_clean_head(ring
, head
)) {
961 netdev_err(ndev
, "wrong head (%d, %d-%d)\n", head
,
962 ring
->next_to_use
, ring
->next_to_clean
);
963 ring
->stats
.io_err_cnt
++;
964 NETIF_TX_UNLOCK(ring
);
970 while (head
!= ring
->next_to_clean
) {
971 hns_nic_reclaim_one_desc(ring
, &bytes
, &pkts
);
972 /* issue prefetch for next Tx descriptor */
973 prefetch(&ring
->desc_cb
[ring
->next_to_clean
]);
976 NETIF_TX_UNLOCK(ring
);
978 dev_queue
= netdev_get_tx_queue(ndev
, ring_data
->queue_index
);
979 netdev_tx_completed_queue(dev_queue
, pkts
, bytes
);
981 if (unlikely(priv
->link
&& !netif_carrier_ok(ndev
)))
982 netif_carrier_on(ndev
);
984 if (unlikely(pkts
&& netif_carrier_ok(ndev
) &&
985 (ring_space(ring
) >= ring
->max_desc_num_per_pkt
* 2))) {
986 /* Make sure that anybody stopping the queue after this
987 * sees the new next_to_clean.
990 if (netif_tx_queue_stopped(dev_queue
) &&
991 !test_bit(NIC_STATE_DOWN
, &priv
->state
)) {
992 netif_tx_wake_queue(dev_queue
);
993 ring
->stats
.restart_queue
++;
999 static bool hns_nic_tx_fini_pro(struct hns_nic_ring_data
*ring_data
)
1001 struct hnae_ring
*ring
= ring_data
->ring
;
1004 ring_data
->ring
->q
->handle
->dev
->ops
->toggle_ring_irq(ring
, 0);
1006 head
= readl_relaxed(ring
->io_base
+ RCB_REG_HEAD
);
1008 if (head
!= ring
->next_to_clean
) {
1009 ring_data
->ring
->q
->handle
->dev
->ops
->toggle_ring_irq(
1010 ring_data
->ring
, 1);
1018 static bool hns_nic_tx_fini_pro_v2(struct hns_nic_ring_data
*ring_data
)
1020 struct hnae_ring
*ring
= ring_data
->ring
;
1021 int head
= readl_relaxed(ring
->io_base
+ RCB_REG_HEAD
);
1023 if (head
== ring
->next_to_clean
)
1029 static void hns_nic_tx_clr_all_bufs(struct hns_nic_ring_data
*ring_data
)
1031 struct hnae_ring
*ring
= ring_data
->ring
;
1032 struct net_device
*ndev
= ring_data
->napi
.dev
;
1033 struct netdev_queue
*dev_queue
;
1037 NETIF_TX_LOCK(ring
);
1039 head
= ring
->next_to_use
; /* ntu :soft setted ring position*/
1042 while (head
!= ring
->next_to_clean
)
1043 hns_nic_reclaim_one_desc(ring
, &bytes
, &pkts
);
1045 NETIF_TX_UNLOCK(ring
);
1047 dev_queue
= netdev_get_tx_queue(ndev
, ring_data
->queue_index
);
1048 netdev_tx_reset_queue(dev_queue
);
1051 static int hns_nic_common_poll(struct napi_struct
*napi
, int budget
)
1053 int clean_complete
= 0;
1054 struct hns_nic_ring_data
*ring_data
=
1055 container_of(napi
, struct hns_nic_ring_data
, napi
);
1056 struct hnae_ring
*ring
= ring_data
->ring
;
1059 clean_complete
+= ring_data
->poll_one(
1060 ring_data
, budget
- clean_complete
,
1061 ring_data
->ex_process
);
1063 if (clean_complete
< budget
) {
1064 if (ring_data
->fini_process(ring_data
)) {
1065 napi_complete(napi
);
1066 ring
->q
->handle
->dev
->ops
->toggle_ring_irq(ring
, 0);
1072 return clean_complete
;
1075 static irqreturn_t
hns_irq_handle(int irq
, void *dev
)
1077 struct hns_nic_ring_data
*ring_data
= (struct hns_nic_ring_data
*)dev
;
1079 ring_data
->ring
->q
->handle
->dev
->ops
->toggle_ring_irq(
1080 ring_data
->ring
, 1);
1081 napi_schedule(&ring_data
->napi
);
1087 *hns_nic_adjust_link - adjust net work mode by the phy stat or new param
1090 static void hns_nic_adjust_link(struct net_device
*ndev
)
1092 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1093 struct hnae_handle
*h
= priv
->ae_handle
;
1097 h
->dev
->ops
->adjust_link(h
, ndev
->phydev
->speed
,
1098 ndev
->phydev
->duplex
);
1099 state
= ndev
->phydev
->link
;
1101 state
= state
&& h
->dev
->ops
->get_status(h
);
1103 if (state
!= priv
->link
) {
1105 netif_carrier_on(ndev
);
1106 netif_tx_wake_all_queues(ndev
);
1107 netdev_info(ndev
, "link up\n");
1109 netif_carrier_off(ndev
);
1110 netdev_info(ndev
, "link down\n");
1117 *hns_nic_init_phy - init phy
1120 * Return 0 on success, negative on failure
1122 int hns_nic_init_phy(struct net_device
*ndev
, struct hnae_handle
*h
)
1124 struct phy_device
*phy_dev
= h
->phy_dev
;
1130 if (h
->phy_if
!= PHY_INTERFACE_MODE_XGMII
) {
1131 phy_dev
->dev_flags
= 0;
1133 ret
= phy_connect_direct(ndev
, phy_dev
, hns_nic_adjust_link
,
1136 ret
= phy_attach_direct(ndev
, phy_dev
, 0, h
->phy_if
);
1141 phy_dev
->supported
&= h
->if_support
;
1142 phy_dev
->advertising
= phy_dev
->supported
;
1144 if (h
->phy_if
== PHY_INTERFACE_MODE_XGMII
)
1145 phy_dev
->autoneg
= false;
1150 static int hns_nic_ring_open(struct net_device
*netdev
, int idx
)
1152 struct hns_nic_priv
*priv
= netdev_priv(netdev
);
1153 struct hnae_handle
*h
= priv
->ae_handle
;
1155 napi_enable(&priv
->ring_data
[idx
].napi
);
1157 enable_irq(priv
->ring_data
[idx
].ring
->irq
);
1158 h
->dev
->ops
->toggle_ring_irq(priv
->ring_data
[idx
].ring
, 0);
1163 static int hns_nic_net_set_mac_address(struct net_device
*ndev
, void *p
)
1165 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1166 struct hnae_handle
*h
= priv
->ae_handle
;
1167 struct sockaddr
*mac_addr
= p
;
1170 if (!mac_addr
|| !is_valid_ether_addr((const u8
*)mac_addr
->sa_data
))
1171 return -EADDRNOTAVAIL
;
1173 ret
= h
->dev
->ops
->set_mac_addr(h
, mac_addr
->sa_data
);
1175 netdev_err(ndev
, "set_mac_address fail, ret=%d!\n", ret
);
1179 memcpy(ndev
->dev_addr
, mac_addr
->sa_data
, ndev
->addr_len
);
1184 void hns_nic_update_stats(struct net_device
*netdev
)
1186 struct hns_nic_priv
*priv
= netdev_priv(netdev
);
1187 struct hnae_handle
*h
= priv
->ae_handle
;
1189 h
->dev
->ops
->update_stats(h
, &netdev
->stats
);
1192 /* set mac addr if it is configed. or leave it to the AE driver */
1193 static void hns_init_mac_addr(struct net_device
*ndev
)
1195 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1197 if (!device_get_mac_address(priv
->dev
, ndev
->dev_addr
, ETH_ALEN
)) {
1198 eth_hw_addr_random(ndev
);
1199 dev_warn(priv
->dev
, "No valid mac, use random mac %pM",
1204 static void hns_nic_ring_close(struct net_device
*netdev
, int idx
)
1206 struct hns_nic_priv
*priv
= netdev_priv(netdev
);
1207 struct hnae_handle
*h
= priv
->ae_handle
;
1209 h
->dev
->ops
->toggle_ring_irq(priv
->ring_data
[idx
].ring
, 1);
1210 disable_irq(priv
->ring_data
[idx
].ring
->irq
);
1212 napi_disable(&priv
->ring_data
[idx
].napi
);
1215 static int hns_nic_init_affinity_mask(int q_num
, int ring_idx
,
1216 struct hnae_ring
*ring
, cpumask_t
*mask
)
1220 /* Diffrent irq banlance between 16core and 32core.
1221 * The cpu mask set by ring index according to the ring flag
1222 * which indicate the ring is tx or rx.
1224 if (q_num
== num_possible_cpus()) {
1225 if (is_tx_ring(ring
))
1228 cpu
= ring_idx
- q_num
;
1230 if (is_tx_ring(ring
))
1233 cpu
= (ring_idx
- q_num
) * 2 + 1;
1236 cpumask_clear(mask
);
1237 cpumask_set_cpu(cpu
, mask
);
1242 static int hns_nic_init_irq(struct hns_nic_priv
*priv
)
1244 struct hnae_handle
*h
= priv
->ae_handle
;
1245 struct hns_nic_ring_data
*rd
;
1250 for (i
= 0; i
< h
->q_num
* 2; i
++) {
1251 rd
= &priv
->ring_data
[i
];
1253 if (rd
->ring
->irq_init_flag
== RCB_IRQ_INITED
)
1256 snprintf(rd
->ring
->ring_name
, RCB_RING_NAME_LEN
,
1257 "%s-%s%d", priv
->netdev
->name
,
1258 (is_tx_ring(rd
->ring
) ? "tx" : "rx"), rd
->queue_index
);
1260 rd
->ring
->ring_name
[RCB_RING_NAME_LEN
- 1] = '\0';
1262 ret
= request_irq(rd
->ring
->irq
,
1263 hns_irq_handle
, 0, rd
->ring
->ring_name
, rd
);
1265 netdev_err(priv
->netdev
, "request irq(%d) fail\n",
1269 disable_irq(rd
->ring
->irq
);
1271 cpu
= hns_nic_init_affinity_mask(h
->q_num
, i
,
1272 rd
->ring
, &rd
->mask
);
1274 if (cpu_online(cpu
))
1275 irq_set_affinity_hint(rd
->ring
->irq
,
1278 rd
->ring
->irq_init_flag
= RCB_IRQ_INITED
;
1284 static int hns_nic_net_up(struct net_device
*ndev
)
1286 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1287 struct hnae_handle
*h
= priv
->ae_handle
;
1291 ret
= hns_nic_init_irq(priv
);
1293 netdev_err(ndev
, "hns init irq failed! ret=%d\n", ret
);
1297 for (i
= 0; i
< h
->q_num
* 2; i
++) {
1298 ret
= hns_nic_ring_open(ndev
, i
);
1300 goto out_has_some_queues
;
1303 ret
= h
->dev
->ops
->set_mac_addr(h
, ndev
->dev_addr
);
1305 goto out_set_mac_addr_err
;
1307 ret
= h
->dev
->ops
->start
? h
->dev
->ops
->start(h
) : 0;
1312 phy_start(ndev
->phydev
);
1314 clear_bit(NIC_STATE_DOWN
, &priv
->state
);
1315 (void)mod_timer(&priv
->service_timer
, jiffies
+ SERVICE_TIMER_HZ
);
1320 netif_stop_queue(ndev
);
1321 out_set_mac_addr_err
:
1322 out_has_some_queues
:
1323 for (j
= i
- 1; j
>= 0; j
--)
1324 hns_nic_ring_close(ndev
, j
);
1326 set_bit(NIC_STATE_DOWN
, &priv
->state
);
1331 static void hns_nic_net_down(struct net_device
*ndev
)
1334 struct hnae_ae_ops
*ops
;
1335 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1337 if (test_and_set_bit(NIC_STATE_DOWN
, &priv
->state
))
1340 (void)del_timer_sync(&priv
->service_timer
);
1341 netif_tx_stop_all_queues(ndev
);
1342 netif_carrier_off(ndev
);
1343 netif_tx_disable(ndev
);
1347 phy_stop(ndev
->phydev
);
1349 ops
= priv
->ae_handle
->dev
->ops
;
1352 ops
->stop(priv
->ae_handle
);
1354 netif_tx_stop_all_queues(ndev
);
1356 for (i
= priv
->ae_handle
->q_num
- 1; i
>= 0; i
--) {
1357 hns_nic_ring_close(ndev
, i
);
1358 hns_nic_ring_close(ndev
, i
+ priv
->ae_handle
->q_num
);
1360 /* clean tx buffers*/
1361 hns_nic_tx_clr_all_bufs(priv
->ring_data
+ i
);
1365 void hns_nic_net_reset(struct net_device
*ndev
)
1367 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1368 struct hnae_handle
*handle
= priv
->ae_handle
;
1370 while (test_and_set_bit(NIC_STATE_RESETTING
, &priv
->state
))
1371 usleep_range(1000, 2000);
1373 (void)hnae_reinit_handle(handle
);
1375 clear_bit(NIC_STATE_RESETTING
, &priv
->state
);
1378 void hns_nic_net_reinit(struct net_device
*netdev
)
1380 struct hns_nic_priv
*priv
= netdev_priv(netdev
);
1382 netif_trans_update(priv
->netdev
);
1383 while (test_and_set_bit(NIC_STATE_REINITING
, &priv
->state
))
1384 usleep_range(1000, 2000);
1386 hns_nic_net_down(netdev
);
1387 hns_nic_net_reset(netdev
);
1388 (void)hns_nic_net_up(netdev
);
1389 clear_bit(NIC_STATE_REINITING
, &priv
->state
);
1392 static int hns_nic_net_open(struct net_device
*ndev
)
1394 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1395 struct hnae_handle
*h
= priv
->ae_handle
;
1398 if (test_bit(NIC_STATE_TESTING
, &priv
->state
))
1402 netif_carrier_off(ndev
);
1404 ret
= netif_set_real_num_tx_queues(ndev
, h
->q_num
);
1406 netdev_err(ndev
, "netif_set_real_num_tx_queues fail, ret=%d!\n",
1411 ret
= netif_set_real_num_rx_queues(ndev
, h
->q_num
);
1414 "netif_set_real_num_rx_queues fail, ret=%d!\n", ret
);
1418 ret
= hns_nic_net_up(ndev
);
1421 "hns net up fail, ret=%d!\n", ret
);
1428 static int hns_nic_net_stop(struct net_device
*ndev
)
1430 hns_nic_net_down(ndev
);
1435 static void hns_tx_timeout_reset(struct hns_nic_priv
*priv
);
1436 static void hns_nic_net_timeout(struct net_device
*ndev
)
1438 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1440 hns_tx_timeout_reset(priv
);
1443 static int hns_nic_do_ioctl(struct net_device
*netdev
, struct ifreq
*ifr
,
1446 struct phy_device
*phy_dev
= netdev
->phydev
;
1448 if (!netif_running(netdev
))
1454 return phy_mii_ioctl(phy_dev
, ifr
, cmd
);
1457 /* use only for netconsole to poll with the device without interrupt */
1458 #ifdef CONFIG_NET_POLL_CONTROLLER
1459 void hns_nic_poll_controller(struct net_device
*ndev
)
1461 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1462 unsigned long flags
;
1465 local_irq_save(flags
);
1466 for (i
= 0; i
< priv
->ae_handle
->q_num
* 2; i
++)
1467 napi_schedule(&priv
->ring_data
[i
].napi
);
1468 local_irq_restore(flags
);
1472 static netdev_tx_t
hns_nic_net_xmit(struct sk_buff
*skb
,
1473 struct net_device
*ndev
)
1475 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1477 assert(skb
->queue_mapping
< ndev
->ae_handle
->q_num
);
1479 return hns_nic_net_xmit_hw(ndev
, skb
,
1480 &tx_ring_data(priv
, skb
->queue_mapping
));
1483 static void hns_nic_drop_rx_fetch(struct hns_nic_ring_data
*ring_data
,
1484 struct sk_buff
*skb
)
1486 dev_kfree_skb_any(skb
);
1489 #define HNS_LB_TX_RING 0
1490 static struct sk_buff
*hns_assemble_skb(struct net_device
*ndev
)
1492 struct sk_buff
*skb
;
1493 struct ethhdr
*ethhdr
;
1496 /* allocate test skb */
1497 skb
= alloc_skb(64, GFP_KERNEL
);
1503 memset(skb
->data
, 0xFF, skb
->len
);
1505 /* must be tcp/ip package */
1506 ethhdr
= (struct ethhdr
*)skb
->data
;
1507 ethhdr
->h_proto
= htons(ETH_P_IP
);
1509 frame_len
= skb
->len
& (~1ul);
1510 memset(&skb
->data
[frame_len
/ 2], 0xAA,
1513 skb
->queue_mapping
= HNS_LB_TX_RING
;
1518 static int hns_enable_serdes_lb(struct net_device
*ndev
)
1520 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1521 struct hnae_handle
*h
= priv
->ae_handle
;
1522 struct hnae_ae_ops
*ops
= h
->dev
->ops
;
1526 ret
= ops
->set_loopback(h
, MAC_INTERNALLOOP_SERDES
, 1);
1530 ret
= ops
->start
? ops
->start(h
) : 0;
1534 /* link adjust duplex*/
1535 if (h
->phy_if
!= PHY_INTERFACE_MODE_XGMII
)
1541 ops
->adjust_link(h
, speed
, duplex
);
1543 /* wait h/w ready */
1549 static void hns_disable_serdes_lb(struct net_device
*ndev
)
1551 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1552 struct hnae_handle
*h
= priv
->ae_handle
;
1553 struct hnae_ae_ops
*ops
= h
->dev
->ops
;
1556 ops
->set_loopback(h
, MAC_INTERNALLOOP_SERDES
, 0);
1560 *hns_nic_clear_all_rx_fetch - clear the chip fetched descriptions. The
1561 *function as follows:
1562 * 1. if one rx ring has found the page_offset is not equal 0 between head
1563 * and tail, it means that the chip fetched the wrong descs for the ring
1564 * which buffer size is 4096.
1565 * 2. we set the chip serdes loopback and set rss indirection to the ring.
1566 * 3. construct 64-bytes ip broadcast packages, wait the associated rx ring
1567 * recieving all packages and it will fetch new descriptions.
1568 * 4. recover to the original state.
1572 static int hns_nic_clear_all_rx_fetch(struct net_device
*ndev
)
1574 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1575 struct hnae_handle
*h
= priv
->ae_handle
;
1576 struct hnae_ae_ops
*ops
= h
->dev
->ops
;
1577 struct hns_nic_ring_data
*rd
;
1578 struct hnae_ring
*ring
;
1579 struct sk_buff
*skb
;
1590 /* alloc indir memory */
1591 indir_size
= ops
->get_rss_indir_size(h
) * sizeof(*org_indir
);
1592 org_indir
= kzalloc(indir_size
, GFP_KERNEL
);
1596 /* store the orginal indirection */
1597 ops
->get_rss(h
, org_indir
, NULL
, NULL
);
1599 cur_indir
= kzalloc(indir_size
, GFP_KERNEL
);
1602 goto cur_indir_alloc_err
;
1606 if (hns_enable_serdes_lb(ndev
)) {
1608 goto enable_serdes_lb_err
;
1611 /* foreach every rx ring to clear fetch desc */
1612 for (i
= 0; i
< h
->q_num
; i
++) {
1613 ring
= &h
->qs
[i
]->rx_ring
;
1614 head
= readl_relaxed(ring
->io_base
+ RCB_REG_HEAD
);
1615 tail
= readl_relaxed(ring
->io_base
+ RCB_REG_TAIL
);
1617 fetch_num
= ring_dist(ring
, head
, tail
);
1619 while (head
!= tail
) {
1620 if (ring
->desc_cb
[head
].page_offset
!= 0) {
1626 if (head
== ring
->desc_num
)
1631 for (j
= 0; j
< indir_size
/ sizeof(*org_indir
); j
++)
1633 ops
->set_rss(h
, cur_indir
, NULL
, 0);
1635 for (j
= 0; j
< fetch_num
; j
++) {
1636 /* alloc one skb and init */
1637 skb
= hns_assemble_skb(ndev
);
1640 rd
= &tx_ring_data(priv
, skb
->queue_mapping
);
1641 hns_nic_net_xmit_hw(ndev
, skb
, rd
);
1644 while (retry_times
++ < 10) {
1647 rd
= &rx_ring_data(priv
, i
);
1648 if (rd
->poll_one(rd
, fetch_num
,
1649 hns_nic_drop_rx_fetch
))
1654 while (retry_times
++ < 10) {
1656 /* clean tx ring 0 send package */
1657 rd
= &tx_ring_data(priv
,
1659 if (rd
->poll_one(rd
, fetch_num
, NULL
))
1667 /* restore everything */
1668 ops
->set_rss(h
, org_indir
, NULL
, 0);
1669 hns_disable_serdes_lb(ndev
);
1670 enable_serdes_lb_err
:
1672 cur_indir_alloc_err
:
1678 static int hns_nic_change_mtu(struct net_device
*ndev
, int new_mtu
)
1680 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1681 struct hnae_handle
*h
= priv
->ae_handle
;
1682 bool if_running
= netif_running(ndev
);
1685 /* MTU < 68 is an error and causes problems on some kernels */
1690 if (new_mtu
== ndev
->mtu
)
1693 if (!h
->dev
->ops
->set_mtu
)
1697 (void)hns_nic_net_stop(ndev
);
1701 if (priv
->enet_ver
!= AE_VERSION_1
&&
1702 ndev
->mtu
<= BD_SIZE_2048_MAX_MTU
&&
1703 new_mtu
> BD_SIZE_2048_MAX_MTU
) {
1705 hnae_reinit_all_ring_desc(h
);
1707 /* clear the package which the chip has fetched */
1708 ret
= hns_nic_clear_all_rx_fetch(ndev
);
1710 /* the page offset must be consist with desc */
1711 hnae_reinit_all_ring_page_off(h
);
1714 netdev_err(ndev
, "clear the fetched desc fail\n");
1719 ret
= h
->dev
->ops
->set_mtu(h
, new_mtu
);
1721 netdev_err(ndev
, "set mtu fail, return value %d\n",
1726 /* finally, set new mtu to netdevice */
1727 ndev
->mtu
= new_mtu
;
1731 if (hns_nic_net_open(ndev
)) {
1732 netdev_err(ndev
, "hns net open fail\n");
1740 static int hns_nic_set_features(struct net_device
*netdev
,
1741 netdev_features_t features
)
1743 struct hns_nic_priv
*priv
= netdev_priv(netdev
);
1745 switch (priv
->enet_ver
) {
1747 if (features
& (NETIF_F_TSO
| NETIF_F_TSO6
))
1748 netdev_info(netdev
, "enet v1 do not support tso!\n");
1751 if (features
& (NETIF_F_TSO
| NETIF_F_TSO6
)) {
1752 priv
->ops
.fill_desc
= fill_tso_desc
;
1753 priv
->ops
.maybe_stop_tx
= hns_nic_maybe_stop_tso
;
1754 /* The chip only support 7*4096 */
1755 netif_set_gso_max_size(netdev
, 7 * 4096);
1757 priv
->ops
.fill_desc
= fill_v2_desc
;
1758 priv
->ops
.maybe_stop_tx
= hns_nic_maybe_stop_tx
;
1762 netdev
->features
= features
;
1766 static netdev_features_t
hns_nic_fix_features(
1767 struct net_device
*netdev
, netdev_features_t features
)
1769 struct hns_nic_priv
*priv
= netdev_priv(netdev
);
1771 switch (priv
->enet_ver
) {
1773 features
&= ~(NETIF_F_TSO
| NETIF_F_TSO6
|
1774 NETIF_F_HW_VLAN_CTAG_FILTER
);
1782 static int hns_nic_uc_sync(struct net_device
*netdev
, const unsigned char *addr
)
1784 struct hns_nic_priv
*priv
= netdev_priv(netdev
);
1785 struct hnae_handle
*h
= priv
->ae_handle
;
1787 if (h
->dev
->ops
->add_uc_addr
)
1788 return h
->dev
->ops
->add_uc_addr(h
, addr
);
1793 static int hns_nic_uc_unsync(struct net_device
*netdev
,
1794 const unsigned char *addr
)
1796 struct hns_nic_priv
*priv
= netdev_priv(netdev
);
1797 struct hnae_handle
*h
= priv
->ae_handle
;
1799 if (h
->dev
->ops
->rm_uc_addr
)
1800 return h
->dev
->ops
->rm_uc_addr(h
, addr
);
1806 * nic_set_multicast_list - set mutl mac address
1807 * @netdev: net device
1812 void hns_set_multicast_list(struct net_device
*ndev
)
1814 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1815 struct hnae_handle
*h
= priv
->ae_handle
;
1816 struct netdev_hw_addr
*ha
= NULL
;
1819 netdev_err(ndev
, "hnae handle is null\n");
1823 if (h
->dev
->ops
->clr_mc_addr
)
1824 if (h
->dev
->ops
->clr_mc_addr(h
))
1825 netdev_err(ndev
, "clear multicast address fail\n");
1827 if (h
->dev
->ops
->set_mc_addr
) {
1828 netdev_for_each_mc_addr(ha
, ndev
)
1829 if (h
->dev
->ops
->set_mc_addr(h
, ha
->addr
))
1830 netdev_err(ndev
, "set multicast fail\n");
1834 void hns_nic_set_rx_mode(struct net_device
*ndev
)
1836 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1837 struct hnae_handle
*h
= priv
->ae_handle
;
1839 if (h
->dev
->ops
->set_promisc_mode
) {
1840 if (ndev
->flags
& IFF_PROMISC
)
1841 h
->dev
->ops
->set_promisc_mode(h
, 1);
1843 h
->dev
->ops
->set_promisc_mode(h
, 0);
1846 hns_set_multicast_list(ndev
);
1848 if (__dev_uc_sync(ndev
, hns_nic_uc_sync
, hns_nic_uc_unsync
))
1849 netdev_err(ndev
, "sync uc address fail\n");
1852 static void hns_nic_get_stats64(struct net_device
*ndev
,
1853 struct rtnl_link_stats64
*stats
)
1860 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1861 struct hnae_handle
*h
= priv
->ae_handle
;
1863 for (idx
= 0; idx
< h
->q_num
; idx
++) {
1864 tx_bytes
+= h
->qs
[idx
]->tx_ring
.stats
.tx_bytes
;
1865 tx_pkts
+= h
->qs
[idx
]->tx_ring
.stats
.tx_pkts
;
1866 rx_bytes
+= h
->qs
[idx
]->rx_ring
.stats
.rx_bytes
;
1867 rx_pkts
+= h
->qs
[idx
]->rx_ring
.stats
.rx_pkts
;
1870 stats
->tx_bytes
= tx_bytes
;
1871 stats
->tx_packets
= tx_pkts
;
1872 stats
->rx_bytes
= rx_bytes
;
1873 stats
->rx_packets
= rx_pkts
;
1875 stats
->rx_errors
= ndev
->stats
.rx_errors
;
1876 stats
->multicast
= ndev
->stats
.multicast
;
1877 stats
->rx_length_errors
= ndev
->stats
.rx_length_errors
;
1878 stats
->rx_crc_errors
= ndev
->stats
.rx_crc_errors
;
1879 stats
->rx_missed_errors
= ndev
->stats
.rx_missed_errors
;
1881 stats
->tx_errors
= ndev
->stats
.tx_errors
;
1882 stats
->rx_dropped
= ndev
->stats
.rx_dropped
;
1883 stats
->tx_dropped
= ndev
->stats
.tx_dropped
;
1884 stats
->collisions
= ndev
->stats
.collisions
;
1885 stats
->rx_over_errors
= ndev
->stats
.rx_over_errors
;
1886 stats
->rx_frame_errors
= ndev
->stats
.rx_frame_errors
;
1887 stats
->rx_fifo_errors
= ndev
->stats
.rx_fifo_errors
;
1888 stats
->tx_aborted_errors
= ndev
->stats
.tx_aborted_errors
;
1889 stats
->tx_carrier_errors
= ndev
->stats
.tx_carrier_errors
;
1890 stats
->tx_fifo_errors
= ndev
->stats
.tx_fifo_errors
;
1891 stats
->tx_heartbeat_errors
= ndev
->stats
.tx_heartbeat_errors
;
1892 stats
->tx_window_errors
= ndev
->stats
.tx_window_errors
;
1893 stats
->rx_compressed
= ndev
->stats
.rx_compressed
;
1894 stats
->tx_compressed
= ndev
->stats
.tx_compressed
;
1898 hns_nic_select_queue(struct net_device
*ndev
, struct sk_buff
*skb
,
1899 void *accel_priv
, select_queue_fallback_t fallback
)
1901 struct ethhdr
*eth_hdr
= (struct ethhdr
*)skb
->data
;
1902 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
1904 /* fix hardware broadcast/multicast packets queue loopback */
1905 if (!AE_IS_VER1(priv
->enet_ver
) &&
1906 is_multicast_ether_addr(eth_hdr
->h_dest
))
1909 return fallback(ndev
, skb
);
1912 static const struct net_device_ops hns_nic_netdev_ops
= {
1913 .ndo_open
= hns_nic_net_open
,
1914 .ndo_stop
= hns_nic_net_stop
,
1915 .ndo_start_xmit
= hns_nic_net_xmit
,
1916 .ndo_tx_timeout
= hns_nic_net_timeout
,
1917 .ndo_set_mac_address
= hns_nic_net_set_mac_address
,
1918 .ndo_change_mtu
= hns_nic_change_mtu
,
1919 .ndo_do_ioctl
= hns_nic_do_ioctl
,
1920 .ndo_set_features
= hns_nic_set_features
,
1921 .ndo_fix_features
= hns_nic_fix_features
,
1922 .ndo_get_stats64
= hns_nic_get_stats64
,
1923 #ifdef CONFIG_NET_POLL_CONTROLLER
1924 .ndo_poll_controller
= hns_nic_poll_controller
,
1926 .ndo_set_rx_mode
= hns_nic_set_rx_mode
,
1927 .ndo_select_queue
= hns_nic_select_queue
,
1930 static void hns_nic_update_link_status(struct net_device
*netdev
)
1932 struct hns_nic_priv
*priv
= netdev_priv(netdev
);
1934 struct hnae_handle
*h
= priv
->ae_handle
;
1937 if (h
->phy_if
!= PHY_INTERFACE_MODE_XGMII
)
1940 (void)genphy_read_status(h
->phy_dev
);
1942 hns_nic_adjust_link(netdev
);
1945 /* for dumping key regs*/
1946 static void hns_nic_dump(struct hns_nic_priv
*priv
)
1948 struct hnae_handle
*h
= priv
->ae_handle
;
1949 struct hnae_ae_ops
*ops
= h
->dev
->ops
;
1950 u32
*data
, reg_num
, i
;
1952 if (ops
->get_regs_len
&& ops
->get_regs
) {
1953 reg_num
= ops
->get_regs_len(priv
->ae_handle
);
1954 reg_num
= (reg_num
+ 3ul) & ~3ul;
1955 data
= kcalloc(reg_num
, sizeof(u32
), GFP_KERNEL
);
1957 ops
->get_regs(priv
->ae_handle
, data
);
1958 for (i
= 0; i
< reg_num
; i
+= 4)
1959 pr_info("0x%08x: 0x%08x 0x%08x 0x%08x 0x%08x\n",
1960 i
, data
[i
], data
[i
+ 1],
1961 data
[i
+ 2], data
[i
+ 3]);
1966 for (i
= 0; i
< h
->q_num
; i
++) {
1967 pr_info("tx_queue%d_next_to_clean:%d\n",
1968 i
, h
->qs
[i
]->tx_ring
.next_to_clean
);
1969 pr_info("tx_queue%d_next_to_use:%d\n",
1970 i
, h
->qs
[i
]->tx_ring
.next_to_use
);
1971 pr_info("rx_queue%d_next_to_clean:%d\n",
1972 i
, h
->qs
[i
]->rx_ring
.next_to_clean
);
1973 pr_info("rx_queue%d_next_to_use:%d\n",
1974 i
, h
->qs
[i
]->rx_ring
.next_to_use
);
1978 /* for resetting subtask */
1979 static void hns_nic_reset_subtask(struct hns_nic_priv
*priv
)
1981 enum hnae_port_type type
= priv
->ae_handle
->port_type
;
1983 if (!test_bit(NIC_STATE2_RESET_REQUESTED
, &priv
->state
))
1985 clear_bit(NIC_STATE2_RESET_REQUESTED
, &priv
->state
);
1987 /* If we're already down, removing or resetting, just bail */
1988 if (test_bit(NIC_STATE_DOWN
, &priv
->state
) ||
1989 test_bit(NIC_STATE_REMOVING
, &priv
->state
) ||
1990 test_bit(NIC_STATE_RESETTING
, &priv
->state
))
1994 netdev_info(priv
->netdev
, "try to reset %s port!\n",
1995 (type
== HNAE_PORT_DEBUG
? "debug" : "service"));
1998 /* put off any impending NetWatchDogTimeout */
1999 netif_trans_update(priv
->netdev
);
2001 if (type
== HNAE_PORT_DEBUG
) {
2002 hns_nic_net_reinit(priv
->netdev
);
2004 netif_carrier_off(priv
->netdev
);
2005 netif_tx_disable(priv
->netdev
);
2010 /* for doing service complete*/
2011 static void hns_nic_service_event_complete(struct hns_nic_priv
*priv
)
2013 WARN_ON(!test_bit(NIC_STATE_SERVICE_SCHED
, &priv
->state
));
2014 /* make sure to commit the things */
2015 smp_mb__before_atomic();
2016 clear_bit(NIC_STATE_SERVICE_SCHED
, &priv
->state
);
2019 static void hns_nic_service_task(struct work_struct
*work
)
2021 struct hns_nic_priv
*priv
2022 = container_of(work
, struct hns_nic_priv
, service_task
);
2023 struct hnae_handle
*h
= priv
->ae_handle
;
2025 hns_nic_update_link_status(priv
->netdev
);
2026 h
->dev
->ops
->update_led_status(h
);
2027 hns_nic_update_stats(priv
->netdev
);
2029 hns_nic_reset_subtask(priv
);
2030 hns_nic_service_event_complete(priv
);
2033 static void hns_nic_task_schedule(struct hns_nic_priv
*priv
)
2035 if (!test_bit(NIC_STATE_DOWN
, &priv
->state
) &&
2036 !test_bit(NIC_STATE_REMOVING
, &priv
->state
) &&
2037 !test_and_set_bit(NIC_STATE_SERVICE_SCHED
, &priv
->state
))
2038 (void)schedule_work(&priv
->service_task
);
2041 static void hns_nic_service_timer(unsigned long data
)
2043 struct hns_nic_priv
*priv
= (struct hns_nic_priv
*)data
;
2045 (void)mod_timer(&priv
->service_timer
, jiffies
+ SERVICE_TIMER_HZ
);
2047 hns_nic_task_schedule(priv
);
2051 * hns_tx_timeout_reset - initiate reset due to Tx timeout
2052 * @priv: driver private struct
2054 static void hns_tx_timeout_reset(struct hns_nic_priv
*priv
)
2056 /* Do the reset outside of interrupt context */
2057 if (!test_bit(NIC_STATE_DOWN
, &priv
->state
)) {
2058 set_bit(NIC_STATE2_RESET_REQUESTED
, &priv
->state
);
2059 netdev_warn(priv
->netdev
,
2060 "initiating reset due to tx timeout(%llu,0x%lx)\n",
2061 priv
->tx_timeout_count
, priv
->state
);
2062 priv
->tx_timeout_count
++;
2063 hns_nic_task_schedule(priv
);
2067 static int hns_nic_init_ring_data(struct hns_nic_priv
*priv
)
2069 struct hnae_handle
*h
= priv
->ae_handle
;
2070 struct hns_nic_ring_data
*rd
;
2071 bool is_ver1
= AE_IS_VER1(priv
->enet_ver
);
2074 if (h
->q_num
> NIC_MAX_Q_PER_VF
) {
2075 netdev_err(priv
->netdev
, "too much queue (%d)\n", h
->q_num
);
2079 priv
->ring_data
= kzalloc(h
->q_num
* sizeof(*priv
->ring_data
) * 2,
2081 if (!priv
->ring_data
)
2084 for (i
= 0; i
< h
->q_num
; i
++) {
2085 rd
= &priv
->ring_data
[i
];
2086 rd
->queue_index
= i
;
2087 rd
->ring
= &h
->qs
[i
]->tx_ring
;
2088 rd
->poll_one
= hns_nic_tx_poll_one
;
2089 rd
->fini_process
= is_ver1
? hns_nic_tx_fini_pro
:
2090 hns_nic_tx_fini_pro_v2
;
2092 netif_napi_add(priv
->netdev
, &rd
->napi
,
2093 hns_nic_common_poll
, NIC_TX_CLEAN_MAX_NUM
);
2094 rd
->ring
->irq_init_flag
= RCB_IRQ_NOT_INITED
;
2096 for (i
= h
->q_num
; i
< h
->q_num
* 2; i
++) {
2097 rd
= &priv
->ring_data
[i
];
2098 rd
->queue_index
= i
- h
->q_num
;
2099 rd
->ring
= &h
->qs
[i
- h
->q_num
]->rx_ring
;
2100 rd
->poll_one
= hns_nic_rx_poll_one
;
2101 rd
->ex_process
= hns_nic_rx_up_pro
;
2102 rd
->fini_process
= is_ver1
? hns_nic_rx_fini_pro
:
2103 hns_nic_rx_fini_pro_v2
;
2105 netif_napi_add(priv
->netdev
, &rd
->napi
,
2106 hns_nic_common_poll
, NIC_RX_CLEAN_MAX_NUM
);
2107 rd
->ring
->irq_init_flag
= RCB_IRQ_NOT_INITED
;
2113 static void hns_nic_uninit_ring_data(struct hns_nic_priv
*priv
)
2115 struct hnae_handle
*h
= priv
->ae_handle
;
2118 for (i
= 0; i
< h
->q_num
* 2; i
++) {
2119 netif_napi_del(&priv
->ring_data
[i
].napi
);
2120 if (priv
->ring_data
[i
].ring
->irq_init_flag
== RCB_IRQ_INITED
) {
2121 (void)irq_set_affinity_hint(
2122 priv
->ring_data
[i
].ring
->irq
,
2124 free_irq(priv
->ring_data
[i
].ring
->irq
,
2125 &priv
->ring_data
[i
]);
2128 priv
->ring_data
[i
].ring
->irq_init_flag
= RCB_IRQ_NOT_INITED
;
2130 kfree(priv
->ring_data
);
2133 static void hns_nic_set_priv_ops(struct net_device
*netdev
)
2135 struct hns_nic_priv
*priv
= netdev_priv(netdev
);
2136 struct hnae_handle
*h
= priv
->ae_handle
;
2138 if (AE_IS_VER1(priv
->enet_ver
)) {
2139 priv
->ops
.fill_desc
= fill_desc
;
2140 priv
->ops
.get_rxd_bnum
= get_rx_desc_bnum
;
2141 priv
->ops
.maybe_stop_tx
= hns_nic_maybe_stop_tx
;
2143 priv
->ops
.get_rxd_bnum
= get_v2rx_desc_bnum
;
2144 if ((netdev
->features
& NETIF_F_TSO
) ||
2145 (netdev
->features
& NETIF_F_TSO6
)) {
2146 priv
->ops
.fill_desc
= fill_tso_desc
;
2147 priv
->ops
.maybe_stop_tx
= hns_nic_maybe_stop_tso
;
2148 /* This chip only support 7*4096 */
2149 netif_set_gso_max_size(netdev
, 7 * 4096);
2151 priv
->ops
.fill_desc
= fill_v2_desc
;
2152 priv
->ops
.maybe_stop_tx
= hns_nic_maybe_stop_tx
;
2154 /* enable tso when init
2155 * control tso on/off through TSE bit in bd
2157 h
->dev
->ops
->set_tso_stats(h
, 1);
2161 static int hns_nic_try_get_ae(struct net_device
*ndev
)
2163 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
2164 struct hnae_handle
*h
;
2167 h
= hnae_get_handle(&priv
->netdev
->dev
,
2168 priv
->fwnode
, priv
->port_id
, NULL
);
2169 if (IS_ERR_OR_NULL(h
)) {
2171 dev_dbg(priv
->dev
, "has not handle, register notifier!\n");
2174 priv
->ae_handle
= h
;
2176 ret
= hns_nic_init_phy(ndev
, h
);
2178 dev_err(priv
->dev
, "probe phy device fail!\n");
2182 ret
= hns_nic_init_ring_data(priv
);
2185 goto out_init_ring_data
;
2188 hns_nic_set_priv_ops(ndev
);
2190 ret
= register_netdev(ndev
);
2192 dev_err(priv
->dev
, "probe register netdev fail!\n");
2193 goto out_reg_ndev_fail
;
2198 hns_nic_uninit_ring_data(priv
);
2199 priv
->ring_data
= NULL
;
2202 hnae_put_handle(priv
->ae_handle
);
2203 priv
->ae_handle
= NULL
;
2208 static int hns_nic_notifier_action(struct notifier_block
*nb
,
2209 unsigned long action
, void *data
)
2211 struct hns_nic_priv
*priv
=
2212 container_of(nb
, struct hns_nic_priv
, notifier_block
);
2214 assert(action
== HNAE_AE_REGISTER
);
2216 if (!hns_nic_try_get_ae(priv
->netdev
)) {
2217 hnae_unregister_notifier(&priv
->notifier_block
);
2218 priv
->notifier_block
.notifier_call
= NULL
;
2223 static int hns_nic_dev_probe(struct platform_device
*pdev
)
2225 struct device
*dev
= &pdev
->dev
;
2226 struct net_device
*ndev
;
2227 struct hns_nic_priv
*priv
;
2231 ndev
= alloc_etherdev_mq(sizeof(struct hns_nic_priv
), NIC_MAX_Q_PER_VF
);
2235 platform_set_drvdata(pdev
, ndev
);
2237 priv
= netdev_priv(ndev
);
2239 priv
->netdev
= ndev
;
2241 if (dev_of_node(dev
)) {
2242 struct device_node
*ae_node
;
2244 if (of_device_is_compatible(dev
->of_node
,
2245 "hisilicon,hns-nic-v1"))
2246 priv
->enet_ver
= AE_VERSION_1
;
2248 priv
->enet_ver
= AE_VERSION_2
;
2250 ae_node
= of_parse_phandle(dev
->of_node
, "ae-handle", 0);
2251 if (IS_ERR_OR_NULL(ae_node
)) {
2252 ret
= PTR_ERR(ae_node
);
2253 dev_err(dev
, "not find ae-handle\n");
2254 goto out_read_prop_fail
;
2256 priv
->fwnode
= &ae_node
->fwnode
;
2257 } else if (is_acpi_node(dev
->fwnode
)) {
2258 struct acpi_reference_args args
;
2260 if (acpi_dev_found(hns_enet_acpi_match
[0].id
))
2261 priv
->enet_ver
= AE_VERSION_1
;
2262 else if (acpi_dev_found(hns_enet_acpi_match
[1].id
))
2263 priv
->enet_ver
= AE_VERSION_2
;
2267 /* try to find port-idx-in-ae first */
2268 ret
= acpi_node_get_property_reference(dev
->fwnode
,
2269 "ae-handle", 0, &args
);
2271 dev_err(dev
, "not find ae-handle\n");
2272 goto out_read_prop_fail
;
2274 priv
->fwnode
= acpi_fwnode_handle(args
.adev
);
2276 dev_err(dev
, "cannot read cfg data from OF or acpi\n");
2280 ret
= device_property_read_u32(dev
, "port-idx-in-ae", &port_id
);
2282 /* only for old code compatible */
2283 ret
= device_property_read_u32(dev
, "port-id", &port_id
);
2285 goto out_read_prop_fail
;
2286 /* for old dts, we need to caculate the port offset */
2287 port_id
= port_id
< HNS_SRV_OFFSET
? port_id
+ HNS_DEBUG_OFFSET
2288 : port_id
- HNS_SRV_OFFSET
;
2290 priv
->port_id
= port_id
;
2292 hns_init_mac_addr(ndev
);
2294 ndev
->watchdog_timeo
= HNS_NIC_TX_TIMEOUT
;
2295 ndev
->priv_flags
|= IFF_UNICAST_FLT
;
2296 ndev
->netdev_ops
= &hns_nic_netdev_ops
;
2297 hns_ethtool_set_ops(ndev
);
2299 ndev
->features
|= NETIF_F_IP_CSUM
| NETIF_F_IPV6_CSUM
|
2300 NETIF_F_RXCSUM
| NETIF_F_SG
| NETIF_F_GSO
|
2302 ndev
->vlan_features
|=
2303 NETIF_F_IP_CSUM
| NETIF_F_IPV6_CSUM
| NETIF_F_RXCSUM
;
2304 ndev
->vlan_features
|= NETIF_F_SG
| NETIF_F_GSO
| NETIF_F_GRO
;
2306 /* MTU range: 68 - 9578 (v1) or 9706 (v2) */
2307 ndev
->min_mtu
= MAC_MIN_MTU
;
2308 switch (priv
->enet_ver
) {
2310 ndev
->features
|= NETIF_F_TSO
| NETIF_F_TSO6
;
2311 ndev
->hw_features
|= NETIF_F_IP_CSUM
| NETIF_F_IPV6_CSUM
|
2312 NETIF_F_RXCSUM
| NETIF_F_SG
| NETIF_F_GSO
|
2313 NETIF_F_GRO
| NETIF_F_TSO
| NETIF_F_TSO6
;
2314 ndev
->max_mtu
= MAC_MAX_MTU_V2
-
2315 (ETH_HLEN
+ ETH_FCS_LEN
+ VLAN_HLEN
);
2318 ndev
->max_mtu
= MAC_MAX_MTU
-
2319 (ETH_HLEN
+ ETH_FCS_LEN
+ VLAN_HLEN
);
2323 SET_NETDEV_DEV(ndev
, dev
);
2325 if (!dma_set_mask_and_coherent(dev
, DMA_BIT_MASK(64)))
2326 dev_dbg(dev
, "set mask to 64bit\n");
2328 dev_err(dev
, "set mask to 64bit fail!\n");
2330 /* carrier off reporting is important to ethtool even BEFORE open */
2331 netif_carrier_off(ndev
);
2333 setup_timer(&priv
->service_timer
, hns_nic_service_timer
,
2334 (unsigned long)priv
);
2335 INIT_WORK(&priv
->service_task
, hns_nic_service_task
);
2337 set_bit(NIC_STATE_SERVICE_INITED
, &priv
->state
);
2338 clear_bit(NIC_STATE_SERVICE_SCHED
, &priv
->state
);
2339 set_bit(NIC_STATE_DOWN
, &priv
->state
);
2341 if (hns_nic_try_get_ae(priv
->netdev
)) {
2342 priv
->notifier_block
.notifier_call
= hns_nic_notifier_action
;
2343 ret
= hnae_register_notifier(&priv
->notifier_block
);
2345 dev_err(dev
, "register notifier fail!\n");
2346 goto out_notify_fail
;
2348 dev_dbg(dev
, "has not handle, register notifier!\n");
2354 (void)cancel_work_sync(&priv
->service_task
);
2360 static int hns_nic_dev_remove(struct platform_device
*pdev
)
2362 struct net_device
*ndev
= platform_get_drvdata(pdev
);
2363 struct hns_nic_priv
*priv
= netdev_priv(ndev
);
2365 if (ndev
->reg_state
!= NETREG_UNINITIALIZED
)
2366 unregister_netdev(ndev
);
2368 if (priv
->ring_data
)
2369 hns_nic_uninit_ring_data(priv
);
2370 priv
->ring_data
= NULL
;
2373 phy_disconnect(ndev
->phydev
);
2375 if (!IS_ERR_OR_NULL(priv
->ae_handle
))
2376 hnae_put_handle(priv
->ae_handle
);
2377 priv
->ae_handle
= NULL
;
2378 if (priv
->notifier_block
.notifier_call
)
2379 hnae_unregister_notifier(&priv
->notifier_block
);
2380 priv
->notifier_block
.notifier_call
= NULL
;
2382 set_bit(NIC_STATE_REMOVING
, &priv
->state
);
2383 (void)cancel_work_sync(&priv
->service_task
);
2389 static const struct of_device_id hns_enet_of_match
[] = {
2390 {.compatible
= "hisilicon,hns-nic-v1",},
2391 {.compatible
= "hisilicon,hns-nic-v2",},
2395 MODULE_DEVICE_TABLE(of
, hns_enet_of_match
);
2397 static struct platform_driver hns_nic_dev_driver
= {
2400 .of_match_table
= hns_enet_of_match
,
2401 .acpi_match_table
= ACPI_PTR(hns_enet_acpi_match
),
2403 .probe
= hns_nic_dev_probe
,
2404 .remove
= hns_nic_dev_remove
,
2407 module_platform_driver(hns_nic_dev_driver
);
2409 MODULE_DESCRIPTION("HISILICON HNS Ethernet driver");
2410 MODULE_AUTHOR("Hisilicon, Inc.");
2411 MODULE_LICENSE("GPL");
2412 MODULE_ALIAS("platform:hns-nic");