GNU Linux-libre 6.8.7-gnu
[releases.git] / drivers / net / ethernet / hisilicon / hns3 / hns3_ethtool.c
1 // SPDX-License-Identifier: GPL-2.0+
2 // Copyright (c) 2016-2017 Hisilicon Limited.
3
4 #include <linux/etherdevice.h>
5 #include <linux/string.h>
6 #include <linux/phy.h>
7 #include <linux/sfp.h>
8
9 #include "hns3_enet.h"
10 #include "hns3_ethtool.h"
11
12 /* tqp related stats */
13 #define HNS3_TQP_STAT(_string, _member) {                       \
14         .stats_string = _string,                                \
15         .stats_offset = offsetof(struct hns3_enet_ring, stats) +\
16                         offsetof(struct ring_stats, _member),   \
17 }
18
19 static const struct hns3_stats hns3_txq_stats[] = {
20         /* Tx per-queue statistics */
21         HNS3_TQP_STAT("dropped", sw_err_cnt),
22         HNS3_TQP_STAT("seg_pkt_cnt", seg_pkt_cnt),
23         HNS3_TQP_STAT("packets", tx_pkts),
24         HNS3_TQP_STAT("bytes", tx_bytes),
25         HNS3_TQP_STAT("more", tx_more),
26         HNS3_TQP_STAT("push", tx_push),
27         HNS3_TQP_STAT("mem_doorbell", tx_mem_doorbell),
28         HNS3_TQP_STAT("wake", restart_queue),
29         HNS3_TQP_STAT("busy", tx_busy),
30         HNS3_TQP_STAT("copy", tx_copy),
31         HNS3_TQP_STAT("vlan_err", tx_vlan_err),
32         HNS3_TQP_STAT("l4_proto_err", tx_l4_proto_err),
33         HNS3_TQP_STAT("l2l3l4_err", tx_l2l3l4_err),
34         HNS3_TQP_STAT("tso_err", tx_tso_err),
35         HNS3_TQP_STAT("over_max_recursion", over_max_recursion),
36         HNS3_TQP_STAT("hw_limitation", hw_limitation),
37         HNS3_TQP_STAT("bounce", tx_bounce),
38         HNS3_TQP_STAT("spare_full", tx_spare_full),
39         HNS3_TQP_STAT("copy_bits_err", copy_bits_err),
40         HNS3_TQP_STAT("sgl", tx_sgl),
41         HNS3_TQP_STAT("skb2sgl_err", skb2sgl_err),
42         HNS3_TQP_STAT("map_sg_err", map_sg_err),
43 };
44
45 #define HNS3_TXQ_STATS_COUNT ARRAY_SIZE(hns3_txq_stats)
46
47 static const struct hns3_stats hns3_rxq_stats[] = {
48         /* Rx per-queue statistics */
49         HNS3_TQP_STAT("dropped", sw_err_cnt),
50         HNS3_TQP_STAT("seg_pkt_cnt", seg_pkt_cnt),
51         HNS3_TQP_STAT("packets", rx_pkts),
52         HNS3_TQP_STAT("bytes", rx_bytes),
53         HNS3_TQP_STAT("errors", rx_err_cnt),
54         HNS3_TQP_STAT("reuse_pg_cnt", reuse_pg_cnt),
55         HNS3_TQP_STAT("err_pkt_len", err_pkt_len),
56         HNS3_TQP_STAT("err_bd_num", err_bd_num),
57         HNS3_TQP_STAT("l2_err", l2_err),
58         HNS3_TQP_STAT("l3l4_csum_err", l3l4_csum_err),
59         HNS3_TQP_STAT("csum_complete", csum_complete),
60         HNS3_TQP_STAT("multicast", rx_multicast),
61         HNS3_TQP_STAT("non_reuse_pg", non_reuse_pg),
62         HNS3_TQP_STAT("frag_alloc_err", frag_alloc_err),
63         HNS3_TQP_STAT("frag_alloc", frag_alloc),
64 };
65
66 #define HNS3_PRIV_FLAGS_LEN ARRAY_SIZE(hns3_priv_flags)
67
68 #define HNS3_RXQ_STATS_COUNT ARRAY_SIZE(hns3_rxq_stats)
69
70 #define HNS3_TQP_STATS_COUNT (HNS3_TXQ_STATS_COUNT + HNS3_RXQ_STATS_COUNT)
71
72 #define HNS3_NIC_LB_TEST_PKT_NUM        1
73 #define HNS3_NIC_LB_TEST_RING_ID        0
74 #define HNS3_NIC_LB_TEST_PACKET_SIZE    128
75 #define HNS3_NIC_LB_SETUP_USEC          10000
76
77 /* Nic loopback test err  */
78 #define HNS3_NIC_LB_TEST_NO_MEM_ERR     1
79 #define HNS3_NIC_LB_TEST_TX_CNT_ERR     2
80 #define HNS3_NIC_LB_TEST_RX_CNT_ERR     3
81 #define HNS3_NIC_LB_TEST_UNEXECUTED     4
82
83 static int hns3_get_sset_count(struct net_device *netdev, int stringset);
84
85 static int hns3_lp_setup(struct net_device *ndev, enum hnae3_loop loop, bool en)
86 {
87         struct hnae3_handle *h = hns3_get_handle(ndev);
88         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(h->pdev);
89         int ret;
90
91         if (!h->ae_algo->ops->set_loopback ||
92             !h->ae_algo->ops->set_promisc_mode)
93                 return -EOPNOTSUPP;
94
95         switch (loop) {
96         case HNAE3_LOOP_SERIAL_SERDES:
97         case HNAE3_LOOP_PARALLEL_SERDES:
98         case HNAE3_LOOP_APP:
99         case HNAE3_LOOP_PHY:
100         case HNAE3_LOOP_EXTERNAL:
101                 ret = h->ae_algo->ops->set_loopback(h, loop, en);
102                 break;
103         default:
104                 ret = -ENOTSUPP;
105                 break;
106         }
107
108         if (ret || ae_dev->dev_version >= HNAE3_DEVICE_VERSION_V2)
109                 return ret;
110
111         if (en)
112                 h->ae_algo->ops->set_promisc_mode(h, true, true);
113         else
114                 /* recover promisc mode before loopback test */
115                 hns3_request_update_promisc_mode(h);
116
117         return ret;
118 }
119
120 static int hns3_lp_up(struct net_device *ndev, enum hnae3_loop loop_mode)
121 {
122         struct hnae3_handle *h = hns3_get_handle(ndev);
123         int ret;
124
125         ret = hns3_nic_reset_all_ring(h);
126         if (ret)
127                 return ret;
128
129         ret = hns3_lp_setup(ndev, loop_mode, true);
130         usleep_range(HNS3_NIC_LB_SETUP_USEC, HNS3_NIC_LB_SETUP_USEC * 2);
131
132         return ret;
133 }
134
135 static int hns3_lp_down(struct net_device *ndev, enum hnae3_loop loop_mode)
136 {
137         int ret;
138
139         ret = hns3_lp_setup(ndev, loop_mode, false);
140         if (ret) {
141                 netdev_err(ndev, "lb_setup return error: %d\n", ret);
142                 return ret;
143         }
144
145         usleep_range(HNS3_NIC_LB_SETUP_USEC, HNS3_NIC_LB_SETUP_USEC * 2);
146
147         return 0;
148 }
149
150 static void hns3_lp_setup_skb(struct sk_buff *skb)
151 {
152 #define HNS3_NIC_LB_DST_MAC_ADDR        0x1f
153
154         struct net_device *ndev = skb->dev;
155         struct hnae3_handle *handle;
156         struct hnae3_ae_dev *ae_dev;
157         unsigned char *packet;
158         struct ethhdr *ethh;
159         unsigned int i;
160
161         skb_reserve(skb, NET_IP_ALIGN);
162         ethh = skb_put(skb, sizeof(struct ethhdr));
163         packet = skb_put(skb, HNS3_NIC_LB_TEST_PACKET_SIZE);
164
165         memcpy(ethh->h_dest, ndev->dev_addr, ETH_ALEN);
166
167         /* The dst mac addr of loopback packet is the same as the host'
168          * mac addr, the SSU component may loop back the packet to host
169          * before the packet reaches mac or serdes, which will defect
170          * the purpose of mac or serdes selftest.
171          */
172         handle = hns3_get_handle(ndev);
173         ae_dev = pci_get_drvdata(handle->pdev);
174         if (ae_dev->dev_version < HNAE3_DEVICE_VERSION_V2)
175                 ethh->h_dest[5] += HNS3_NIC_LB_DST_MAC_ADDR;
176         eth_zero_addr(ethh->h_source);
177         ethh->h_proto = htons(ETH_P_ARP);
178         skb_reset_mac_header(skb);
179
180         for (i = 0; i < HNS3_NIC_LB_TEST_PACKET_SIZE; i++)
181                 packet[i] = (unsigned char)(i & 0xff);
182 }
183
184 static void hns3_lb_check_skb_data(struct hns3_enet_ring *ring,
185                                    struct sk_buff *skb)
186 {
187         struct hns3_enet_tqp_vector *tqp_vector = ring->tqp_vector;
188         unsigned char *packet = skb->data;
189         u32 len = skb_headlen(skb);
190         u32 i;
191
192         len = min_t(u32, len, HNS3_NIC_LB_TEST_PACKET_SIZE);
193
194         for (i = 0; i < len; i++)
195                 if (packet[i] != (unsigned char)(i & 0xff))
196                         break;
197
198         /* The packet is correctly received */
199         if (i == HNS3_NIC_LB_TEST_PACKET_SIZE)
200                 tqp_vector->rx_group.total_packets++;
201         else
202                 print_hex_dump(KERN_ERR, "selftest:", DUMP_PREFIX_OFFSET, 16, 1,
203                                skb->data, len, true);
204
205         dev_kfree_skb_any(skb);
206 }
207
208 static u32 hns3_lb_check_rx_ring(struct hns3_nic_priv *priv, u32 budget)
209 {
210         struct hnae3_handle *h = priv->ae_handle;
211         struct hnae3_knic_private_info *kinfo;
212         u32 i, rcv_good_pkt_total = 0;
213
214         kinfo = &h->kinfo;
215         for (i = kinfo->num_tqps; i < kinfo->num_tqps * 2; i++) {
216                 struct hns3_enet_ring *ring = &priv->ring[i];
217                 struct hns3_enet_ring_group *rx_group;
218                 u64 pre_rx_pkt;
219
220                 rx_group = &ring->tqp_vector->rx_group;
221                 pre_rx_pkt = rx_group->total_packets;
222
223                 preempt_disable();
224                 hns3_clean_rx_ring(ring, budget, hns3_lb_check_skb_data);
225                 preempt_enable();
226
227                 rcv_good_pkt_total += (rx_group->total_packets - pre_rx_pkt);
228                 rx_group->total_packets = pre_rx_pkt;
229         }
230         return rcv_good_pkt_total;
231 }
232
233 static void hns3_lb_clear_tx_ring(struct hns3_nic_priv *priv, u32 start_ringid,
234                                   u32 end_ringid)
235 {
236         u32 i;
237
238         for (i = start_ringid; i <= end_ringid; i++) {
239                 struct hns3_enet_ring *ring = &priv->ring[i];
240
241                 hns3_clean_tx_ring(ring, 0);
242         }
243 }
244
245 /**
246  * hns3_lp_run_test - run loopback test
247  * @ndev: net device
248  * @mode: loopback type
249  *
250  * Return: %0 for success or a NIC loopback test error code on failure
251  */
252 static int hns3_lp_run_test(struct net_device *ndev, enum hnae3_loop mode)
253 {
254         struct hns3_nic_priv *priv = netdev_priv(ndev);
255         struct sk_buff *skb;
256         u32 i, good_cnt;
257         int ret_val = 0;
258
259         skb = alloc_skb(HNS3_NIC_LB_TEST_PACKET_SIZE + ETH_HLEN + NET_IP_ALIGN,
260                         GFP_KERNEL);
261         if (!skb)
262                 return HNS3_NIC_LB_TEST_NO_MEM_ERR;
263
264         skb->dev = ndev;
265         hns3_lp_setup_skb(skb);
266         skb->queue_mapping = HNS3_NIC_LB_TEST_RING_ID;
267
268         good_cnt = 0;
269         for (i = 0; i < HNS3_NIC_LB_TEST_PKT_NUM; i++) {
270                 netdev_tx_t tx_ret;
271
272                 skb_get(skb);
273                 tx_ret = hns3_nic_net_xmit(skb, ndev);
274                 if (tx_ret == NETDEV_TX_OK) {
275                         good_cnt++;
276                 } else {
277                         kfree_skb(skb);
278                         netdev_err(ndev, "hns3_lb_run_test xmit failed: %d\n",
279                                    tx_ret);
280                 }
281         }
282         if (good_cnt != HNS3_NIC_LB_TEST_PKT_NUM) {
283                 ret_val = HNS3_NIC_LB_TEST_TX_CNT_ERR;
284                 netdev_err(ndev, "mode %d sent fail, cnt=0x%x, budget=0x%x\n",
285                            mode, good_cnt, HNS3_NIC_LB_TEST_PKT_NUM);
286                 goto out;
287         }
288
289         /* Allow 200 milliseconds for packets to go from Tx to Rx */
290         msleep(200);
291
292         good_cnt = hns3_lb_check_rx_ring(priv, HNS3_NIC_LB_TEST_PKT_NUM);
293         if (good_cnt != HNS3_NIC_LB_TEST_PKT_NUM) {
294                 ret_val = HNS3_NIC_LB_TEST_RX_CNT_ERR;
295                 netdev_err(ndev, "mode %d recv fail, cnt=0x%x, budget=0x%x\n",
296                            mode, good_cnt, HNS3_NIC_LB_TEST_PKT_NUM);
297         }
298
299 out:
300         hns3_lb_clear_tx_ring(priv, HNS3_NIC_LB_TEST_RING_ID,
301                               HNS3_NIC_LB_TEST_RING_ID);
302
303         kfree_skb(skb);
304         return ret_val;
305 }
306
307 static void hns3_set_selftest_param(struct hnae3_handle *h, int (*st_param)[2])
308 {
309         st_param[HNAE3_LOOP_EXTERNAL][0] = HNAE3_LOOP_EXTERNAL;
310         st_param[HNAE3_LOOP_EXTERNAL][1] =
311                         h->flags & HNAE3_SUPPORT_EXTERNAL_LOOPBACK;
312
313         st_param[HNAE3_LOOP_APP][0] = HNAE3_LOOP_APP;
314         st_param[HNAE3_LOOP_APP][1] =
315                         h->flags & HNAE3_SUPPORT_APP_LOOPBACK;
316
317         st_param[HNAE3_LOOP_SERIAL_SERDES][0] = HNAE3_LOOP_SERIAL_SERDES;
318         st_param[HNAE3_LOOP_SERIAL_SERDES][1] =
319                         h->flags & HNAE3_SUPPORT_SERDES_SERIAL_LOOPBACK;
320
321         st_param[HNAE3_LOOP_PARALLEL_SERDES][0] =
322                         HNAE3_LOOP_PARALLEL_SERDES;
323         st_param[HNAE3_LOOP_PARALLEL_SERDES][1] =
324                         h->flags & HNAE3_SUPPORT_SERDES_PARALLEL_LOOPBACK;
325
326         st_param[HNAE3_LOOP_PHY][0] = HNAE3_LOOP_PHY;
327         st_param[HNAE3_LOOP_PHY][1] =
328                         h->flags & HNAE3_SUPPORT_PHY_LOOPBACK;
329 }
330
331 static void hns3_selftest_prepare(struct net_device *ndev, bool if_running)
332 {
333         struct hns3_nic_priv *priv = netdev_priv(ndev);
334         struct hnae3_handle *h = priv->ae_handle;
335
336         if (if_running)
337                 ndev->netdev_ops->ndo_stop(ndev);
338
339 #if IS_ENABLED(CONFIG_VLAN_8021Q)
340         /* Disable the vlan filter for selftest does not support it */
341         if (h->ae_algo->ops->enable_vlan_filter &&
342             ndev->features & NETIF_F_HW_VLAN_CTAG_FILTER)
343                 h->ae_algo->ops->enable_vlan_filter(h, false);
344 #endif
345
346         /* Tell firmware to stop mac autoneg before loopback test start,
347          * otherwise loopback test may be failed when the port is still
348          * negotiating.
349          */
350         if (h->ae_algo->ops->halt_autoneg)
351                 h->ae_algo->ops->halt_autoneg(h, true);
352
353         set_bit(HNS3_NIC_STATE_TESTING, &priv->state);
354 }
355
356 static void hns3_selftest_restore(struct net_device *ndev, bool if_running)
357 {
358         struct hns3_nic_priv *priv = netdev_priv(ndev);
359         struct hnae3_handle *h = priv->ae_handle;
360
361         clear_bit(HNS3_NIC_STATE_TESTING, &priv->state);
362
363         if (h->ae_algo->ops->halt_autoneg)
364                 h->ae_algo->ops->halt_autoneg(h, false);
365
366 #if IS_ENABLED(CONFIG_VLAN_8021Q)
367         if (h->ae_algo->ops->enable_vlan_filter &&
368             ndev->features & NETIF_F_HW_VLAN_CTAG_FILTER)
369                 h->ae_algo->ops->enable_vlan_filter(h, true);
370 #endif
371
372         if (if_running)
373                 ndev->netdev_ops->ndo_open(ndev);
374 }
375
376 static void hns3_do_selftest(struct net_device *ndev, int (*st_param)[2],
377                              struct ethtool_test *eth_test, u64 *data)
378 {
379         int test_index = HNAE3_LOOP_APP;
380         u32 i;
381
382         for (i = HNAE3_LOOP_APP; i < HNAE3_LOOP_NONE; i++) {
383                 enum hnae3_loop loop_type = (enum hnae3_loop)st_param[i][0];
384
385                 if (!st_param[i][1])
386                         continue;
387
388                 data[test_index] = hns3_lp_up(ndev, loop_type);
389                 if (!data[test_index])
390                         data[test_index] = hns3_lp_run_test(ndev, loop_type);
391
392                 hns3_lp_down(ndev, loop_type);
393
394                 if (data[test_index])
395                         eth_test->flags |= ETH_TEST_FL_FAILED;
396
397                 test_index++;
398         }
399 }
400
401 static void hns3_do_external_lb(struct net_device *ndev,
402                                 struct ethtool_test *eth_test, u64 *data)
403 {
404         data[HNAE3_LOOP_EXTERNAL] = hns3_lp_up(ndev, HNAE3_LOOP_EXTERNAL);
405         if (!data[HNAE3_LOOP_EXTERNAL])
406                 data[HNAE3_LOOP_EXTERNAL] = hns3_lp_run_test(ndev, HNAE3_LOOP_EXTERNAL);
407         hns3_lp_down(ndev, HNAE3_LOOP_EXTERNAL);
408
409         if (data[HNAE3_LOOP_EXTERNAL])
410                 eth_test->flags |= ETH_TEST_FL_FAILED;
411
412         eth_test->flags |= ETH_TEST_FL_EXTERNAL_LB_DONE;
413 }
414
415 /**
416  * hns3_self_test - self test
417  * @ndev: net device
418  * @eth_test: test cmd
419  * @data: test result
420  */
421 static void hns3_self_test(struct net_device *ndev,
422                            struct ethtool_test *eth_test, u64 *data)
423 {
424         int cnt = hns3_get_sset_count(ndev, ETH_SS_TEST);
425         struct hns3_nic_priv *priv = netdev_priv(ndev);
426         struct hnae3_handle *h = priv->ae_handle;
427         int st_param[HNAE3_LOOP_NONE][2];
428         bool if_running = netif_running(ndev);
429         int i;
430
431         /* initialize the loopback test result, avoid marking an unexcuted
432          * loopback test as PASS.
433          */
434         for (i = 0; i < cnt; i++)
435                 data[i] = HNS3_NIC_LB_TEST_UNEXECUTED;
436
437         if (hns3_nic_resetting(ndev)) {
438                 netdev_err(ndev, "dev resetting!");
439                 goto failure;
440         }
441
442         if (!(eth_test->flags & ETH_TEST_FL_OFFLINE))
443                 goto failure;
444
445         if (netif_msg_ifdown(h))
446                 netdev_info(ndev, "self test start\n");
447
448         hns3_set_selftest_param(h, st_param);
449
450         /* external loopback test requires that the link is up and the duplex is
451          * full, do external test first to reduce the whole test time
452          */
453         if (eth_test->flags & ETH_TEST_FL_EXTERNAL_LB) {
454                 hns3_external_lb_prepare(ndev, if_running);
455                 hns3_do_external_lb(ndev, eth_test, data);
456                 hns3_external_lb_restore(ndev, if_running);
457         }
458
459         hns3_selftest_prepare(ndev, if_running);
460         hns3_do_selftest(ndev, st_param, eth_test, data);
461         hns3_selftest_restore(ndev, if_running);
462
463         if (netif_msg_ifdown(h))
464                 netdev_info(ndev, "self test end\n");
465         return;
466
467 failure:
468         eth_test->flags |= ETH_TEST_FL_FAILED;
469 }
470
471 static void hns3_update_limit_promisc_mode(struct net_device *netdev,
472                                            bool enable)
473 {
474         struct hnae3_handle *handle = hns3_get_handle(netdev);
475
476         if (enable)
477                 set_bit(HNAE3_PFLAG_LIMIT_PROMISC, &handle->priv_flags);
478         else
479                 clear_bit(HNAE3_PFLAG_LIMIT_PROMISC, &handle->priv_flags);
480
481         hns3_request_update_promisc_mode(handle);
482 }
483
484 static const struct hns3_pflag_desc hns3_priv_flags[HNAE3_PFLAG_MAX] = {
485         { "limit_promisc",      hns3_update_limit_promisc_mode }
486 };
487
488 static int hns3_get_sset_count(struct net_device *netdev, int stringset)
489 {
490         struct hnae3_handle *h = hns3_get_handle(netdev);
491         const struct hnae3_ae_ops *ops = h->ae_algo->ops;
492
493         if (!ops->get_sset_count)
494                 return -EOPNOTSUPP;
495
496         switch (stringset) {
497         case ETH_SS_STATS:
498                 return ((HNS3_TQP_STATS_COUNT * h->kinfo.num_tqps) +
499                         ops->get_sset_count(h, stringset));
500
501         case ETH_SS_TEST:
502                 return ops->get_sset_count(h, stringset);
503
504         case ETH_SS_PRIV_FLAGS:
505                 return HNAE3_PFLAG_MAX;
506
507         default:
508                 return -EOPNOTSUPP;
509         }
510 }
511
512 static void *hns3_update_strings(u8 *data, const struct hns3_stats *stats,
513                 u32 stat_count, u32 num_tqps, const char *prefix)
514 {
515 #define MAX_PREFIX_SIZE (6 + 4)
516         u32 size_left;
517         u32 i, j;
518         u32 n1;
519
520         for (i = 0; i < num_tqps; i++) {
521                 for (j = 0; j < stat_count; j++) {
522                         data[ETH_GSTRING_LEN - 1] = '\0';
523
524                         /* first, prepend the prefix string */
525                         n1 = scnprintf(data, MAX_PREFIX_SIZE, "%s%u_",
526                                        prefix, i);
527                         size_left = (ETH_GSTRING_LEN - 1) - n1;
528
529                         /* now, concatenate the stats string to it */
530                         strncat(data, stats[j].stats_string, size_left);
531                         data += ETH_GSTRING_LEN;
532                 }
533         }
534
535         return data;
536 }
537
538 static u8 *hns3_get_strings_tqps(struct hnae3_handle *handle, u8 *data)
539 {
540         struct hnae3_knic_private_info *kinfo = &handle->kinfo;
541         const char tx_prefix[] = "txq";
542         const char rx_prefix[] = "rxq";
543
544         /* get strings for Tx */
545         data = hns3_update_strings(data, hns3_txq_stats, HNS3_TXQ_STATS_COUNT,
546                                    kinfo->num_tqps, tx_prefix);
547
548         /* get strings for Rx */
549         data = hns3_update_strings(data, hns3_rxq_stats, HNS3_RXQ_STATS_COUNT,
550                                    kinfo->num_tqps, rx_prefix);
551
552         return data;
553 }
554
555 static void hns3_get_strings(struct net_device *netdev, u32 stringset, u8 *data)
556 {
557         struct hnae3_handle *h = hns3_get_handle(netdev);
558         const struct hnae3_ae_ops *ops = h->ae_algo->ops;
559         char *buff = (char *)data;
560         int i;
561
562         if (!ops->get_strings)
563                 return;
564
565         switch (stringset) {
566         case ETH_SS_STATS:
567                 buff = hns3_get_strings_tqps(h, buff);
568                 ops->get_strings(h, stringset, (u8 *)buff);
569                 break;
570         case ETH_SS_TEST:
571                 ops->get_strings(h, stringset, data);
572                 break;
573         case ETH_SS_PRIV_FLAGS:
574                 for (i = 0; i < HNS3_PRIV_FLAGS_LEN; i++) {
575                         snprintf(buff, ETH_GSTRING_LEN, "%s",
576                                  hns3_priv_flags[i].name);
577                         buff += ETH_GSTRING_LEN;
578                 }
579                 break;
580         default:
581                 break;
582         }
583 }
584
585 static u64 *hns3_get_stats_tqps(struct hnae3_handle *handle, u64 *data)
586 {
587         struct hnae3_knic_private_info *kinfo = &handle->kinfo;
588         struct hns3_nic_priv *nic_priv = handle->priv;
589         struct hns3_enet_ring *ring;
590         u8 *stat;
591         int i, j;
592
593         /* get stats for Tx */
594         for (i = 0; i < kinfo->num_tqps; i++) {
595                 ring = &nic_priv->ring[i];
596                 for (j = 0; j < HNS3_TXQ_STATS_COUNT; j++) {
597                         stat = (u8 *)ring + hns3_txq_stats[j].stats_offset;
598                         *data++ = *(u64 *)stat;
599                 }
600         }
601
602         /* get stats for Rx */
603         for (i = 0; i < kinfo->num_tqps; i++) {
604                 ring = &nic_priv->ring[i + kinfo->num_tqps];
605                 for (j = 0; j < HNS3_RXQ_STATS_COUNT; j++) {
606                         stat = (u8 *)ring + hns3_rxq_stats[j].stats_offset;
607                         *data++ = *(u64 *)stat;
608                 }
609         }
610
611         return data;
612 }
613
614 /* hns3_get_stats - get detail statistics.
615  * @netdev: net device
616  * @stats: statistics info.
617  * @data: statistics data.
618  */
619 static void hns3_get_stats(struct net_device *netdev,
620                            struct ethtool_stats *stats, u64 *data)
621 {
622         struct hnae3_handle *h = hns3_get_handle(netdev);
623         u64 *p = data;
624
625         if (hns3_nic_resetting(netdev)) {
626                 netdev_err(netdev, "dev resetting, could not get stats\n");
627                 return;
628         }
629
630         if (!h->ae_algo->ops->get_stats || !h->ae_algo->ops->update_stats) {
631                 netdev_err(netdev, "could not get any statistics\n");
632                 return;
633         }
634
635         h->ae_algo->ops->update_stats(h);
636
637         /* get per-queue stats */
638         p = hns3_get_stats_tqps(h, p);
639
640         /* get MAC & other misc hardware stats */
641         h->ae_algo->ops->get_stats(h, p);
642 }
643
644 static void hns3_get_drvinfo(struct net_device *netdev,
645                              struct ethtool_drvinfo *drvinfo)
646 {
647         struct hns3_nic_priv *priv = netdev_priv(netdev);
648         struct hnae3_handle *h = priv->ae_handle;
649         u32 fw_version;
650
651         if (!h->ae_algo->ops->get_fw_version) {
652                 netdev_err(netdev, "could not get fw version!\n");
653                 return;
654         }
655
656         strscpy(drvinfo->driver, dev_driver_string(&h->pdev->dev),
657                 sizeof(drvinfo->driver));
658
659         strscpy(drvinfo->bus_info, pci_name(h->pdev),
660                 sizeof(drvinfo->bus_info));
661
662         fw_version = priv->ae_handle->ae_algo->ops->get_fw_version(h);
663
664         snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version),
665                  "%lu.%lu.%lu.%lu",
666                  hnae3_get_field(fw_version, HNAE3_FW_VERSION_BYTE3_MASK,
667                                  HNAE3_FW_VERSION_BYTE3_SHIFT),
668                  hnae3_get_field(fw_version, HNAE3_FW_VERSION_BYTE2_MASK,
669                                  HNAE3_FW_VERSION_BYTE2_SHIFT),
670                  hnae3_get_field(fw_version, HNAE3_FW_VERSION_BYTE1_MASK,
671                                  HNAE3_FW_VERSION_BYTE1_SHIFT),
672                  hnae3_get_field(fw_version, HNAE3_FW_VERSION_BYTE0_MASK,
673                                  HNAE3_FW_VERSION_BYTE0_SHIFT));
674 }
675
676 static u32 hns3_get_link(struct net_device *netdev)
677 {
678         struct hnae3_handle *h = hns3_get_handle(netdev);
679
680         if (h->ae_algo->ops->get_status)
681                 return h->ae_algo->ops->get_status(h);
682         else
683                 return 0;
684 }
685
686 static void hns3_get_ringparam(struct net_device *netdev,
687                                struct ethtool_ringparam *param,
688                                struct kernel_ethtool_ringparam *kernel_param,
689                                struct netlink_ext_ack *extack)
690 {
691         struct hns3_nic_priv *priv = netdev_priv(netdev);
692         struct hnae3_handle *h = priv->ae_handle;
693         int rx_queue_index = h->kinfo.num_tqps;
694
695         if (hns3_nic_resetting(netdev) || !priv->ring) {
696                 netdev_err(netdev, "failed to get ringparam value, due to dev resetting or uninited\n");
697                 return;
698         }
699
700         param->tx_max_pending = HNS3_RING_MAX_PENDING;
701         param->rx_max_pending = HNS3_RING_MAX_PENDING;
702
703         param->tx_pending = priv->ring[0].desc_num;
704         param->rx_pending = priv->ring[rx_queue_index].desc_num;
705         kernel_param->rx_buf_len = priv->ring[rx_queue_index].buf_size;
706         kernel_param->tx_push = test_bit(HNS3_NIC_STATE_TX_PUSH_ENABLE,
707                                          &priv->state);
708 }
709
710 static void hns3_get_pauseparam(struct net_device *netdev,
711                                 struct ethtool_pauseparam *param)
712 {
713         struct hnae3_handle *h = hns3_get_handle(netdev);
714         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(h->pdev);
715
716         if (!test_bit(HNAE3_DEV_SUPPORT_PAUSE_B, ae_dev->caps))
717                 return;
718
719         if (h->ae_algo->ops->get_pauseparam)
720                 h->ae_algo->ops->get_pauseparam(h, &param->autoneg,
721                         &param->rx_pause, &param->tx_pause);
722 }
723
724 static int hns3_set_pauseparam(struct net_device *netdev,
725                                struct ethtool_pauseparam *param)
726 {
727         struct hnae3_handle *h = hns3_get_handle(netdev);
728         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(h->pdev);
729
730         if (!test_bit(HNAE3_DEV_SUPPORT_PAUSE_B, ae_dev->caps))
731                 return -EOPNOTSUPP;
732
733         netif_dbg(h, drv, netdev,
734                   "set pauseparam: autoneg=%u, rx:%u, tx:%u\n",
735                   param->autoneg, param->rx_pause, param->tx_pause);
736
737         if (h->ae_algo->ops->set_pauseparam)
738                 return h->ae_algo->ops->set_pauseparam(h, param->autoneg,
739                                                        param->rx_pause,
740                                                        param->tx_pause);
741         return -EOPNOTSUPP;
742 }
743
744 static void hns3_get_ksettings(struct hnae3_handle *h,
745                                struct ethtool_link_ksettings *cmd)
746 {
747         const struct hnae3_ae_ops *ops = h->ae_algo->ops;
748
749         /* 1.auto_neg & speed & duplex from cmd */
750         if (ops->get_ksettings_an_result)
751                 ops->get_ksettings_an_result(h,
752                                              &cmd->base.autoneg,
753                                              &cmd->base.speed,
754                                              &cmd->base.duplex,
755                                              &cmd->lanes);
756
757         /* 2.get link mode */
758         if (ops->get_link_mode)
759                 ops->get_link_mode(h,
760                                    cmd->link_modes.supported,
761                                    cmd->link_modes.advertising);
762
763         /* 3.mdix_ctrl&mdix get from phy reg */
764         if (ops->get_mdix_mode)
765                 ops->get_mdix_mode(h, &cmd->base.eth_tp_mdix_ctrl,
766                                    &cmd->base.eth_tp_mdix);
767 }
768
769 static int hns3_get_link_ksettings(struct net_device *netdev,
770                                    struct ethtool_link_ksettings *cmd)
771 {
772         struct hnae3_handle *h = hns3_get_handle(netdev);
773         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(h->pdev);
774         const struct hnae3_ae_ops *ops;
775         u8 module_type;
776         u8 media_type;
777         u8 link_stat;
778
779         ops = h->ae_algo->ops;
780         if (ops->get_media_type)
781                 ops->get_media_type(h, &media_type, &module_type);
782         else
783                 return -EOPNOTSUPP;
784
785         switch (media_type) {
786         case HNAE3_MEDIA_TYPE_NONE:
787                 cmd->base.port = PORT_NONE;
788                 hns3_get_ksettings(h, cmd);
789                 break;
790         case HNAE3_MEDIA_TYPE_FIBER:
791                 if (module_type == HNAE3_MODULE_TYPE_UNKNOWN)
792                         cmd->base.port = PORT_OTHER;
793                 else if (module_type == HNAE3_MODULE_TYPE_CR)
794                         cmd->base.port = PORT_DA;
795                 else
796                         cmd->base.port = PORT_FIBRE;
797
798                 hns3_get_ksettings(h, cmd);
799                 break;
800         case HNAE3_MEDIA_TYPE_BACKPLANE:
801                 cmd->base.port = PORT_NONE;
802                 hns3_get_ksettings(h, cmd);
803                 break;
804         case HNAE3_MEDIA_TYPE_COPPER:
805                 cmd->base.port = PORT_TP;
806                 if (test_bit(HNAE3_DEV_SUPPORT_PHY_IMP_B, ae_dev->caps) &&
807                     ops->get_phy_link_ksettings)
808                         ops->get_phy_link_ksettings(h, cmd);
809                 else if (!netdev->phydev)
810                         hns3_get_ksettings(h, cmd);
811                 else
812                         phy_ethtool_ksettings_get(netdev->phydev, cmd);
813                 break;
814         default:
815
816                 netdev_warn(netdev, "Unknown media type");
817                 return 0;
818         }
819
820         /* mdio_support */
821         cmd->base.mdio_support = ETH_MDIO_SUPPORTS_C22;
822
823         link_stat = hns3_get_link(netdev);
824         if (!link_stat) {
825                 cmd->base.speed = SPEED_UNKNOWN;
826                 cmd->base.duplex = DUPLEX_UNKNOWN;
827         }
828
829         return 0;
830 }
831
832 static int hns3_check_ksettings_param(const struct net_device *netdev,
833                                       const struct ethtool_link_ksettings *cmd)
834 {
835         struct hnae3_handle *handle = hns3_get_handle(netdev);
836         const struct hnae3_ae_ops *ops = handle->ae_algo->ops;
837         u8 module_type = HNAE3_MODULE_TYPE_UNKNOWN;
838         u8 media_type = HNAE3_MEDIA_TYPE_UNKNOWN;
839         u32 lane_num;
840         u8 autoneg;
841         u32 speed;
842         u8 duplex;
843         int ret;
844
845         /* hw doesn't support use specified speed and duplex to negotiate,
846          * unnecessary to check them when autoneg on.
847          */
848         if (cmd->base.autoneg)
849                 return 0;
850
851         if (ops->get_ksettings_an_result) {
852                 ops->get_ksettings_an_result(handle, &autoneg, &speed, &duplex, &lane_num);
853                 if (cmd->base.autoneg == autoneg && cmd->base.speed == speed &&
854                     cmd->base.duplex == duplex && cmd->lanes == lane_num)
855                         return 0;
856         }
857
858         if (ops->get_media_type)
859                 ops->get_media_type(handle, &media_type, &module_type);
860
861         if (cmd->base.duplex == DUPLEX_HALF &&
862             media_type != HNAE3_MEDIA_TYPE_COPPER) {
863                 netdev_err(netdev,
864                            "only copper port supports half duplex!");
865                 return -EINVAL;
866         }
867
868         if (ops->check_port_speed) {
869                 ret = ops->check_port_speed(handle, cmd->base.speed);
870                 if (ret) {
871                         netdev_err(netdev, "unsupported speed\n");
872                         return ret;
873                 }
874         }
875
876         return 0;
877 }
878
879 static int hns3_set_link_ksettings(struct net_device *netdev,
880                                    const struct ethtool_link_ksettings *cmd)
881 {
882         struct hnae3_handle *handle = hns3_get_handle(netdev);
883         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(handle->pdev);
884         const struct hnae3_ae_ops *ops = handle->ae_algo->ops;
885         int ret;
886
887         /* Chip don't support this mode. */
888         if (cmd->base.speed == SPEED_1000 && cmd->base.duplex == DUPLEX_HALF)
889                 return -EINVAL;
890
891         if (cmd->lanes && !hnae3_ae_dev_lane_num_supported(ae_dev))
892                 return -EOPNOTSUPP;
893
894         netif_dbg(handle, drv, netdev,
895                   "set link(%s): autoneg=%u, speed=%u, duplex=%u, lanes=%u\n",
896                   netdev->phydev ? "phy" : "mac",
897                   cmd->base.autoneg, cmd->base.speed, cmd->base.duplex,
898                   cmd->lanes);
899
900         /* Only support ksettings_set for netdev with phy attached for now */
901         if (netdev->phydev) {
902                 if (cmd->base.speed == SPEED_1000 &&
903                     cmd->base.autoneg == AUTONEG_DISABLE)
904                         return -EINVAL;
905
906                 return phy_ethtool_ksettings_set(netdev->phydev, cmd);
907         } else if (test_bit(HNAE3_DEV_SUPPORT_PHY_IMP_B, ae_dev->caps) &&
908                    ops->set_phy_link_ksettings) {
909                 return ops->set_phy_link_ksettings(handle, cmd);
910         }
911
912         if (ae_dev->dev_version < HNAE3_DEVICE_VERSION_V2)
913                 return -EOPNOTSUPP;
914
915         ret = hns3_check_ksettings_param(netdev, cmd);
916         if (ret)
917                 return ret;
918
919         if (ops->set_autoneg) {
920                 ret = ops->set_autoneg(handle, cmd->base.autoneg);
921                 if (ret)
922                         return ret;
923         }
924
925         /* hw doesn't support use specified speed and duplex to negotiate,
926          * ignore them when autoneg on.
927          */
928         if (cmd->base.autoneg) {
929                 netdev_info(netdev,
930                             "autoneg is on, ignore the speed and duplex\n");
931                 return 0;
932         }
933
934         if (ops->cfg_mac_speed_dup_h)
935                 ret = ops->cfg_mac_speed_dup_h(handle, cmd->base.speed,
936                                                cmd->base.duplex, (u8)(cmd->lanes));
937
938         return ret;
939 }
940
941 static u32 hns3_get_rss_key_size(struct net_device *netdev)
942 {
943         struct hnae3_handle *h = hns3_get_handle(netdev);
944
945         if (!h->ae_algo->ops->get_rss_key_size)
946                 return 0;
947
948         return h->ae_algo->ops->get_rss_key_size(h);
949 }
950
951 static u32 hns3_get_rss_indir_size(struct net_device *netdev)
952 {
953         struct hnae3_handle *h = hns3_get_handle(netdev);
954         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(h->pdev);
955
956         return ae_dev->dev_specs.rss_ind_tbl_size;
957 }
958
959 static int hns3_get_rss(struct net_device *netdev,
960                         struct ethtool_rxfh_param *rxfh)
961 {
962         struct hnae3_handle *h = hns3_get_handle(netdev);
963
964         if (!h->ae_algo->ops->get_rss)
965                 return -EOPNOTSUPP;
966
967         return h->ae_algo->ops->get_rss(h, rxfh->indir, rxfh->key,
968                                         &rxfh->hfunc);
969 }
970
971 static int hns3_set_rss(struct net_device *netdev,
972                         struct ethtool_rxfh_param *rxfh,
973                         struct netlink_ext_ack *extack)
974 {
975         struct hnae3_handle *h = hns3_get_handle(netdev);
976         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(h->pdev);
977
978         if (!h->ae_algo->ops->set_rss)
979                 return -EOPNOTSUPP;
980
981         if ((ae_dev->dev_version < HNAE3_DEVICE_VERSION_V2 &&
982              rxfh->hfunc != ETH_RSS_HASH_TOP) ||
983             (rxfh->hfunc != ETH_RSS_HASH_NO_CHANGE &&
984              rxfh->hfunc != ETH_RSS_HASH_TOP &&
985              rxfh->hfunc != ETH_RSS_HASH_XOR)) {
986                 netdev_err(netdev, "hash func not supported\n");
987                 return -EOPNOTSUPP;
988         }
989
990         if (!rxfh->indir) {
991                 netdev_err(netdev,
992                            "set rss failed for indir is empty\n");
993                 return -EOPNOTSUPP;
994         }
995
996         return h->ae_algo->ops->set_rss(h, rxfh->indir, rxfh->key,
997                                         rxfh->hfunc);
998 }
999
1000 static int hns3_get_rxnfc(struct net_device *netdev,
1001                           struct ethtool_rxnfc *cmd,
1002                           u32 *rule_locs)
1003 {
1004         struct hnae3_handle *h = hns3_get_handle(netdev);
1005
1006         switch (cmd->cmd) {
1007         case ETHTOOL_GRXRINGS:
1008                 cmd->data = h->kinfo.num_tqps;
1009                 return 0;
1010         case ETHTOOL_GRXFH:
1011                 if (h->ae_algo->ops->get_rss_tuple)
1012                         return h->ae_algo->ops->get_rss_tuple(h, cmd);
1013                 return -EOPNOTSUPP;
1014         case ETHTOOL_GRXCLSRLCNT:
1015                 if (h->ae_algo->ops->get_fd_rule_cnt)
1016                         return h->ae_algo->ops->get_fd_rule_cnt(h, cmd);
1017                 return -EOPNOTSUPP;
1018         case ETHTOOL_GRXCLSRULE:
1019                 if (h->ae_algo->ops->get_fd_rule_info)
1020                         return h->ae_algo->ops->get_fd_rule_info(h, cmd);
1021                 return -EOPNOTSUPP;
1022         case ETHTOOL_GRXCLSRLALL:
1023                 if (h->ae_algo->ops->get_fd_all_rules)
1024                         return h->ae_algo->ops->get_fd_all_rules(h, cmd,
1025                                                                  rule_locs);
1026                 return -EOPNOTSUPP;
1027         default:
1028                 return -EOPNOTSUPP;
1029         }
1030 }
1031
1032 static const struct hns3_reset_type_map hns3_reset_type[] = {
1033         {ETH_RESET_MGMT, HNAE3_IMP_RESET},
1034         {ETH_RESET_ALL, HNAE3_GLOBAL_RESET},
1035         {ETH_RESET_DEDICATED, HNAE3_FUNC_RESET},
1036 };
1037
1038 static const struct hns3_reset_type_map hns3vf_reset_type[] = {
1039         {ETH_RESET_DEDICATED, HNAE3_VF_FUNC_RESET},
1040 };
1041
1042 static int hns3_set_reset(struct net_device *netdev, u32 *flags)
1043 {
1044         enum hnae3_reset_type rst_type = HNAE3_NONE_RESET;
1045         struct hnae3_handle *h = hns3_get_handle(netdev);
1046         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(h->pdev);
1047         const struct hnae3_ae_ops *ops = h->ae_algo->ops;
1048         const struct hns3_reset_type_map *rst_type_map;
1049         enum ethtool_reset_flags rst_flags;
1050         u32 i, size;
1051
1052         if (ops->ae_dev_resetting && ops->ae_dev_resetting(h))
1053                 return -EBUSY;
1054
1055         if (!ops->set_default_reset_request || !ops->reset_event)
1056                 return -EOPNOTSUPP;
1057
1058         if (h->flags & HNAE3_SUPPORT_VF) {
1059                 rst_type_map = hns3vf_reset_type;
1060                 size = ARRAY_SIZE(hns3vf_reset_type);
1061         } else {
1062                 rst_type_map = hns3_reset_type;
1063                 size = ARRAY_SIZE(hns3_reset_type);
1064         }
1065
1066         for (i = 0; i < size; i++) {
1067                 if (rst_type_map[i].rst_flags == *flags) {
1068                         rst_type = rst_type_map[i].rst_type;
1069                         rst_flags = rst_type_map[i].rst_flags;
1070                         break;
1071                 }
1072         }
1073
1074         if (rst_type == HNAE3_NONE_RESET ||
1075             (rst_type == HNAE3_IMP_RESET &&
1076              ae_dev->dev_version <= HNAE3_DEVICE_VERSION_V2))
1077                 return -EOPNOTSUPP;
1078
1079         netdev_info(netdev, "Setting reset type %d\n", rst_type);
1080
1081         ops->set_default_reset_request(ae_dev, rst_type);
1082
1083         ops->reset_event(h->pdev, h);
1084
1085         *flags &= ~rst_flags;
1086
1087         return 0;
1088 }
1089
1090 static void hns3_change_all_ring_bd_num(struct hns3_nic_priv *priv,
1091                                         u32 tx_desc_num, u32 rx_desc_num)
1092 {
1093         struct hnae3_handle *h = priv->ae_handle;
1094         int i;
1095
1096         h->kinfo.num_tx_desc = tx_desc_num;
1097         h->kinfo.num_rx_desc = rx_desc_num;
1098
1099         for (i = 0; i < h->kinfo.num_tqps; i++) {
1100                 priv->ring[i].desc_num = tx_desc_num;
1101                 priv->ring[i + h->kinfo.num_tqps].desc_num = rx_desc_num;
1102         }
1103 }
1104
1105 static struct hns3_enet_ring *hns3_backup_ringparam(struct hns3_nic_priv *priv)
1106 {
1107         struct hnae3_handle *handle = priv->ae_handle;
1108         struct hns3_enet_ring *tmp_rings;
1109         int i;
1110
1111         tmp_rings = kcalloc(handle->kinfo.num_tqps * 2,
1112                             sizeof(struct hns3_enet_ring), GFP_KERNEL);
1113         if (!tmp_rings)
1114                 return NULL;
1115
1116         for (i = 0; i < handle->kinfo.num_tqps * 2; i++) {
1117                 memcpy(&tmp_rings[i], &priv->ring[i],
1118                        sizeof(struct hns3_enet_ring));
1119                 tmp_rings[i].skb = NULL;
1120         }
1121
1122         return tmp_rings;
1123 }
1124
1125 static int hns3_check_ringparam(struct net_device *ndev,
1126                                 struct ethtool_ringparam *param,
1127                                 struct kernel_ethtool_ringparam *kernel_param)
1128 {
1129 #define RX_BUF_LEN_2K 2048
1130 #define RX_BUF_LEN_4K 4096
1131
1132         struct hns3_nic_priv *priv = netdev_priv(ndev);
1133
1134         if (hns3_nic_resetting(ndev) || !priv->ring) {
1135                 netdev_err(ndev, "failed to set ringparam value, due to dev resetting or uninited\n");
1136                 return -EBUSY;
1137         }
1138
1139
1140         if (param->rx_mini_pending || param->rx_jumbo_pending)
1141                 return -EINVAL;
1142
1143         if (kernel_param->rx_buf_len != RX_BUF_LEN_2K &&
1144             kernel_param->rx_buf_len != RX_BUF_LEN_4K) {
1145                 netdev_err(ndev, "Rx buf len only support 2048 and 4096\n");
1146                 return -EINVAL;
1147         }
1148
1149         if (param->tx_pending > HNS3_RING_MAX_PENDING ||
1150             param->tx_pending < HNS3_RING_MIN_PENDING ||
1151             param->rx_pending > HNS3_RING_MAX_PENDING ||
1152             param->rx_pending < HNS3_RING_MIN_PENDING) {
1153                 netdev_err(ndev, "Queue depth out of range [%d-%d]\n",
1154                            HNS3_RING_MIN_PENDING, HNS3_RING_MAX_PENDING);
1155                 return -EINVAL;
1156         }
1157
1158         return 0;
1159 }
1160
1161 static bool
1162 hns3_is_ringparam_changed(struct net_device *ndev,
1163                           struct ethtool_ringparam *param,
1164                           struct kernel_ethtool_ringparam *kernel_param,
1165                           struct hns3_ring_param *old_ringparam,
1166                           struct hns3_ring_param *new_ringparam)
1167 {
1168         struct hns3_nic_priv *priv = netdev_priv(ndev);
1169         struct hnae3_handle *h = priv->ae_handle;
1170         u16 queue_num = h->kinfo.num_tqps;
1171
1172         new_ringparam->tx_desc_num = ALIGN(param->tx_pending,
1173                                            HNS3_RING_BD_MULTIPLE);
1174         new_ringparam->rx_desc_num = ALIGN(param->rx_pending,
1175                                            HNS3_RING_BD_MULTIPLE);
1176         old_ringparam->tx_desc_num = priv->ring[0].desc_num;
1177         old_ringparam->rx_desc_num = priv->ring[queue_num].desc_num;
1178         old_ringparam->rx_buf_len = priv->ring[queue_num].buf_size;
1179         new_ringparam->rx_buf_len = kernel_param->rx_buf_len;
1180
1181         if (old_ringparam->tx_desc_num == new_ringparam->tx_desc_num &&
1182             old_ringparam->rx_desc_num == new_ringparam->rx_desc_num &&
1183             old_ringparam->rx_buf_len == new_ringparam->rx_buf_len) {
1184                 netdev_info(ndev, "descriptor number and rx buffer length not changed\n");
1185                 return false;
1186         }
1187
1188         return true;
1189 }
1190
1191 static int hns3_change_rx_buf_len(struct net_device *ndev, u32 rx_buf_len)
1192 {
1193         struct hns3_nic_priv *priv = netdev_priv(ndev);
1194         struct hnae3_handle *h = priv->ae_handle;
1195         int i;
1196
1197         h->kinfo.rx_buf_len = rx_buf_len;
1198
1199         for (i = 0; i < h->kinfo.num_tqps; i++) {
1200                 h->kinfo.tqp[i]->buf_size = rx_buf_len;
1201                 priv->ring[i + h->kinfo.num_tqps].buf_size = rx_buf_len;
1202         }
1203
1204         return 0;
1205 }
1206
1207 static int hns3_set_tx_push(struct net_device *netdev, u32 tx_push)
1208 {
1209         struct hns3_nic_priv *priv = netdev_priv(netdev);
1210         struct hnae3_handle *h = hns3_get_handle(netdev);
1211         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(h->pdev);
1212         u32 old_state = test_bit(HNS3_NIC_STATE_TX_PUSH_ENABLE, &priv->state);
1213
1214         if (!test_bit(HNAE3_DEV_SUPPORT_TX_PUSH_B, ae_dev->caps) && tx_push)
1215                 return -EOPNOTSUPP;
1216
1217         if (tx_push == old_state)
1218                 return 0;
1219
1220         netdev_dbg(netdev, "Changing tx push from %s to %s\n",
1221                    old_state ? "on" : "off", tx_push ? "on" : "off");
1222
1223         if (tx_push)
1224                 set_bit(HNS3_NIC_STATE_TX_PUSH_ENABLE, &priv->state);
1225         else
1226                 clear_bit(HNS3_NIC_STATE_TX_PUSH_ENABLE, &priv->state);
1227
1228         return 0;
1229 }
1230
1231 static int hns3_set_ringparam(struct net_device *ndev,
1232                               struct ethtool_ringparam *param,
1233                               struct kernel_ethtool_ringparam *kernel_param,
1234                               struct netlink_ext_ack *extack)
1235 {
1236         struct hns3_ring_param old_ringparam, new_ringparam;
1237         struct hns3_nic_priv *priv = netdev_priv(ndev);
1238         struct hnae3_handle *h = priv->ae_handle;
1239         struct hns3_enet_ring *tmp_rings;
1240         bool if_running = netif_running(ndev);
1241         int ret, i;
1242
1243         ret = hns3_check_ringparam(ndev, param, kernel_param);
1244         if (ret)
1245                 return ret;
1246
1247         ret = hns3_set_tx_push(ndev, kernel_param->tx_push);
1248         if (ret)
1249                 return ret;
1250
1251         if (!hns3_is_ringparam_changed(ndev, param, kernel_param,
1252                                        &old_ringparam, &new_ringparam))
1253                 return 0;
1254
1255         tmp_rings = hns3_backup_ringparam(priv);
1256         if (!tmp_rings) {
1257                 netdev_err(ndev, "backup ring param failed by allocating memory fail\n");
1258                 return -ENOMEM;
1259         }
1260
1261         netdev_info(ndev,
1262                     "Changing Tx/Rx ring depth from %u/%u to %u/%u, Changing rx buffer len from %u to %u\n",
1263                     old_ringparam.tx_desc_num, old_ringparam.rx_desc_num,
1264                     new_ringparam.tx_desc_num, new_ringparam.rx_desc_num,
1265                     old_ringparam.rx_buf_len, new_ringparam.rx_buf_len);
1266
1267         if (if_running)
1268                 ndev->netdev_ops->ndo_stop(ndev);
1269
1270         hns3_change_all_ring_bd_num(priv, new_ringparam.tx_desc_num,
1271                                     new_ringparam.rx_desc_num);
1272         hns3_change_rx_buf_len(ndev, new_ringparam.rx_buf_len);
1273         ret = hns3_init_all_ring(priv);
1274         if (ret) {
1275                 netdev_err(ndev, "set ringparam fail, revert to old value(%d)\n",
1276                            ret);
1277
1278                 hns3_change_rx_buf_len(ndev, old_ringparam.rx_buf_len);
1279                 hns3_change_all_ring_bd_num(priv, old_ringparam.tx_desc_num,
1280                                             old_ringparam.rx_desc_num);
1281                 for (i = 0; i < h->kinfo.num_tqps * 2; i++)
1282                         memcpy(&priv->ring[i], &tmp_rings[i],
1283                                sizeof(struct hns3_enet_ring));
1284         } else {
1285                 for (i = 0; i < h->kinfo.num_tqps * 2; i++)
1286                         hns3_fini_ring(&tmp_rings[i]);
1287         }
1288
1289         kfree(tmp_rings);
1290
1291         if (if_running)
1292                 ret = ndev->netdev_ops->ndo_open(ndev);
1293
1294         return ret;
1295 }
1296
1297 static int hns3_set_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *cmd)
1298 {
1299         struct hnae3_handle *h = hns3_get_handle(netdev);
1300
1301         switch (cmd->cmd) {
1302         case ETHTOOL_SRXFH:
1303                 if (h->ae_algo->ops->set_rss_tuple)
1304                         return h->ae_algo->ops->set_rss_tuple(h, cmd);
1305                 return -EOPNOTSUPP;
1306         case ETHTOOL_SRXCLSRLINS:
1307                 if (h->ae_algo->ops->add_fd_entry)
1308                         return h->ae_algo->ops->add_fd_entry(h, cmd);
1309                 return -EOPNOTSUPP;
1310         case ETHTOOL_SRXCLSRLDEL:
1311                 if (h->ae_algo->ops->del_fd_entry)
1312                         return h->ae_algo->ops->del_fd_entry(h, cmd);
1313                 return -EOPNOTSUPP;
1314         default:
1315                 return -EOPNOTSUPP;
1316         }
1317 }
1318
1319 static int hns3_nway_reset(struct net_device *netdev)
1320 {
1321         struct hnae3_handle *handle = hns3_get_handle(netdev);
1322         const struct hnae3_ae_ops *ops = handle->ae_algo->ops;
1323         struct phy_device *phy = netdev->phydev;
1324         int autoneg;
1325
1326         if (!netif_running(netdev))
1327                 return 0;
1328
1329         if (hns3_nic_resetting(netdev)) {
1330                 netdev_err(netdev, "dev resetting!");
1331                 return -EBUSY;
1332         }
1333
1334         if (!ops->get_autoneg || !ops->restart_autoneg)
1335                 return -EOPNOTSUPP;
1336
1337         autoneg = ops->get_autoneg(handle);
1338         if (autoneg != AUTONEG_ENABLE) {
1339                 netdev_err(netdev,
1340                            "Autoneg is off, don't support to restart it\n");
1341                 return -EINVAL;
1342         }
1343
1344         netif_dbg(handle, drv, netdev,
1345                   "nway reset (using %s)\n", phy ? "phy" : "mac");
1346
1347         if (phy)
1348                 return genphy_restart_aneg(phy);
1349
1350         return ops->restart_autoneg(handle);
1351 }
1352
1353 static void hns3_get_channels(struct net_device *netdev,
1354                               struct ethtool_channels *ch)
1355 {
1356         struct hnae3_handle *h = hns3_get_handle(netdev);
1357
1358         if (h->ae_algo->ops->get_channels)
1359                 h->ae_algo->ops->get_channels(h, ch);
1360 }
1361
1362 static int hns3_get_coalesce(struct net_device *netdev,
1363                              struct ethtool_coalesce *cmd,
1364                              struct kernel_ethtool_coalesce *kernel_coal,
1365                              struct netlink_ext_ack *extack)
1366 {
1367         struct hns3_nic_priv *priv = netdev_priv(netdev);
1368         struct hns3_enet_coalesce *tx_coal = &priv->tx_coal;
1369         struct hns3_enet_coalesce *rx_coal = &priv->rx_coal;
1370         struct hnae3_handle *h = priv->ae_handle;
1371
1372         if (hns3_nic_resetting(netdev))
1373                 return -EBUSY;
1374
1375         cmd->use_adaptive_tx_coalesce = tx_coal->adapt_enable;
1376         cmd->use_adaptive_rx_coalesce = rx_coal->adapt_enable;
1377
1378         cmd->tx_coalesce_usecs = tx_coal->int_gl;
1379         cmd->rx_coalesce_usecs = rx_coal->int_gl;
1380
1381         cmd->tx_coalesce_usecs_high = h->kinfo.int_rl_setting;
1382         cmd->rx_coalesce_usecs_high = h->kinfo.int_rl_setting;
1383
1384         cmd->tx_max_coalesced_frames = tx_coal->int_ql;
1385         cmd->rx_max_coalesced_frames = rx_coal->int_ql;
1386
1387         kernel_coal->use_cqe_mode_tx = (priv->tx_cqe_mode ==
1388                                         DIM_CQ_PERIOD_MODE_START_FROM_CQE);
1389         kernel_coal->use_cqe_mode_rx = (priv->rx_cqe_mode ==
1390                                         DIM_CQ_PERIOD_MODE_START_FROM_CQE);
1391
1392         return 0;
1393 }
1394
1395 static int hns3_check_gl_coalesce_para(struct net_device *netdev,
1396                                        struct ethtool_coalesce *cmd)
1397 {
1398         struct hnae3_handle *handle = hns3_get_handle(netdev);
1399         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(handle->pdev);
1400         u32 rx_gl, tx_gl;
1401
1402         if (cmd->rx_coalesce_usecs > ae_dev->dev_specs.max_int_gl) {
1403                 netdev_err(netdev,
1404                            "invalid rx-usecs value, rx-usecs range is 0-%u\n",
1405                            ae_dev->dev_specs.max_int_gl);
1406                 return -EINVAL;
1407         }
1408
1409         if (cmd->tx_coalesce_usecs > ae_dev->dev_specs.max_int_gl) {
1410                 netdev_err(netdev,
1411                            "invalid tx-usecs value, tx-usecs range is 0-%u\n",
1412                            ae_dev->dev_specs.max_int_gl);
1413                 return -EINVAL;
1414         }
1415
1416         /* device version above V3(include V3), GL uses 1us unit,
1417          * so the round down is not needed.
1418          */
1419         if (ae_dev->dev_version >= HNAE3_DEVICE_VERSION_V3)
1420                 return 0;
1421
1422         rx_gl = hns3_gl_round_down(cmd->rx_coalesce_usecs);
1423         if (rx_gl != cmd->rx_coalesce_usecs) {
1424                 netdev_info(netdev,
1425                             "rx_usecs(%u) rounded down to %u, because it must be multiple of 2.\n",
1426                             cmd->rx_coalesce_usecs, rx_gl);
1427         }
1428
1429         tx_gl = hns3_gl_round_down(cmd->tx_coalesce_usecs);
1430         if (tx_gl != cmd->tx_coalesce_usecs) {
1431                 netdev_info(netdev,
1432                             "tx_usecs(%u) rounded down to %u, because it must be multiple of 2.\n",
1433                             cmd->tx_coalesce_usecs, tx_gl);
1434         }
1435
1436         return 0;
1437 }
1438
1439 static int hns3_check_rl_coalesce_para(struct net_device *netdev,
1440                                        struct ethtool_coalesce *cmd)
1441 {
1442         u32 rl;
1443
1444         if (cmd->tx_coalesce_usecs_high != cmd->rx_coalesce_usecs_high) {
1445                 netdev_err(netdev,
1446                            "tx_usecs_high must be same as rx_usecs_high.\n");
1447                 return -EINVAL;
1448         }
1449
1450         if (cmd->rx_coalesce_usecs_high > HNS3_INT_RL_MAX) {
1451                 netdev_err(netdev,
1452                            "Invalid usecs_high value, usecs_high range is 0-%d\n",
1453                            HNS3_INT_RL_MAX);
1454                 return -EINVAL;
1455         }
1456
1457         rl = hns3_rl_round_down(cmd->rx_coalesce_usecs_high);
1458         if (rl != cmd->rx_coalesce_usecs_high) {
1459                 netdev_info(netdev,
1460                             "usecs_high(%u) rounded down to %u, because it must be multiple of 4.\n",
1461                             cmd->rx_coalesce_usecs_high, rl);
1462         }
1463
1464         return 0;
1465 }
1466
1467 static int hns3_check_ql_coalesce_param(struct net_device *netdev,
1468                                         struct ethtool_coalesce *cmd)
1469 {
1470         struct hnae3_handle *handle = hns3_get_handle(netdev);
1471         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(handle->pdev);
1472
1473         if ((cmd->tx_max_coalesced_frames || cmd->rx_max_coalesced_frames) &&
1474             !ae_dev->dev_specs.int_ql_max) {
1475                 netdev_err(netdev, "coalesced frames is not supported\n");
1476                 return -EOPNOTSUPP;
1477         }
1478
1479         if (cmd->tx_max_coalesced_frames > ae_dev->dev_specs.int_ql_max ||
1480             cmd->rx_max_coalesced_frames > ae_dev->dev_specs.int_ql_max) {
1481                 netdev_err(netdev,
1482                            "invalid coalesced_frames value, range is 0-%u\n",
1483                            ae_dev->dev_specs.int_ql_max);
1484                 return -ERANGE;
1485         }
1486
1487         return 0;
1488 }
1489
1490 static int
1491 hns3_check_cqe_coalesce_param(struct net_device *netdev,
1492                               struct kernel_ethtool_coalesce *kernel_coal)
1493 {
1494         struct hnae3_handle *handle = hns3_get_handle(netdev);
1495         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(handle->pdev);
1496
1497         if ((kernel_coal->use_cqe_mode_tx || kernel_coal->use_cqe_mode_rx) &&
1498             !hnae3_ae_dev_cq_supported(ae_dev)) {
1499                 netdev_err(netdev, "coalesced cqe mode is not supported\n");
1500                 return -EOPNOTSUPP;
1501         }
1502
1503         return 0;
1504 }
1505
1506 static int
1507 hns3_check_coalesce_para(struct net_device *netdev,
1508                          struct ethtool_coalesce *cmd,
1509                          struct kernel_ethtool_coalesce *kernel_coal)
1510 {
1511         int ret;
1512
1513         ret = hns3_check_cqe_coalesce_param(netdev, kernel_coal);
1514         if (ret)
1515                 return ret;
1516
1517         ret = hns3_check_gl_coalesce_para(netdev, cmd);
1518         if (ret) {
1519                 netdev_err(netdev,
1520                            "Check gl coalesce param fail. ret = %d\n", ret);
1521                 return ret;
1522         }
1523
1524         ret = hns3_check_rl_coalesce_para(netdev, cmd);
1525         if (ret) {
1526                 netdev_err(netdev,
1527                            "Check rl coalesce param fail. ret = %d\n", ret);
1528                 return ret;
1529         }
1530
1531         return hns3_check_ql_coalesce_param(netdev, cmd);
1532 }
1533
1534 static void hns3_set_coalesce_per_queue(struct net_device *netdev,
1535                                         struct ethtool_coalesce *cmd,
1536                                         u32 queue)
1537 {
1538         struct hns3_enet_tqp_vector *tx_vector, *rx_vector;
1539         struct hns3_nic_priv *priv = netdev_priv(netdev);
1540         struct hnae3_handle *h = priv->ae_handle;
1541         int queue_num = h->kinfo.num_tqps;
1542
1543         tx_vector = priv->ring[queue].tqp_vector;
1544         rx_vector = priv->ring[queue_num + queue].tqp_vector;
1545
1546         tx_vector->tx_group.coal.adapt_enable =
1547                                 cmd->use_adaptive_tx_coalesce;
1548         rx_vector->rx_group.coal.adapt_enable =
1549                                 cmd->use_adaptive_rx_coalesce;
1550
1551         tx_vector->tx_group.coal.int_gl = cmd->tx_coalesce_usecs;
1552         rx_vector->rx_group.coal.int_gl = cmd->rx_coalesce_usecs;
1553
1554         tx_vector->tx_group.coal.int_ql = cmd->tx_max_coalesced_frames;
1555         rx_vector->rx_group.coal.int_ql = cmd->rx_max_coalesced_frames;
1556
1557         hns3_set_vector_coalesce_tx_gl(tx_vector,
1558                                        tx_vector->tx_group.coal.int_gl);
1559         hns3_set_vector_coalesce_rx_gl(rx_vector,
1560                                        rx_vector->rx_group.coal.int_gl);
1561
1562         hns3_set_vector_coalesce_rl(tx_vector, h->kinfo.int_rl_setting);
1563         hns3_set_vector_coalesce_rl(rx_vector, h->kinfo.int_rl_setting);
1564
1565         if (tx_vector->tx_group.coal.ql_enable)
1566                 hns3_set_vector_coalesce_tx_ql(tx_vector,
1567                                                tx_vector->tx_group.coal.int_ql);
1568         if (rx_vector->rx_group.coal.ql_enable)
1569                 hns3_set_vector_coalesce_rx_ql(rx_vector,
1570                                                rx_vector->rx_group.coal.int_ql);
1571 }
1572
1573 static int hns3_set_coalesce(struct net_device *netdev,
1574                              struct ethtool_coalesce *cmd,
1575                              struct kernel_ethtool_coalesce *kernel_coal,
1576                              struct netlink_ext_ack *extack)
1577 {
1578         struct hnae3_handle *h = hns3_get_handle(netdev);
1579         struct hns3_nic_priv *priv = netdev_priv(netdev);
1580         struct hns3_enet_coalesce *tx_coal = &priv->tx_coal;
1581         struct hns3_enet_coalesce *rx_coal = &priv->rx_coal;
1582         u16 queue_num = h->kinfo.num_tqps;
1583         enum dim_cq_period_mode tx_mode;
1584         enum dim_cq_period_mode rx_mode;
1585         int ret;
1586         int i;
1587
1588         if (hns3_nic_resetting(netdev))
1589                 return -EBUSY;
1590
1591         ret = hns3_check_coalesce_para(netdev, cmd, kernel_coal);
1592         if (ret)
1593                 return ret;
1594
1595         h->kinfo.int_rl_setting =
1596                 hns3_rl_round_down(cmd->rx_coalesce_usecs_high);
1597
1598         tx_coal->adapt_enable = cmd->use_adaptive_tx_coalesce;
1599         rx_coal->adapt_enable = cmd->use_adaptive_rx_coalesce;
1600
1601         tx_coal->int_gl = cmd->tx_coalesce_usecs;
1602         rx_coal->int_gl = cmd->rx_coalesce_usecs;
1603
1604         tx_coal->int_ql = cmd->tx_max_coalesced_frames;
1605         rx_coal->int_ql = cmd->rx_max_coalesced_frames;
1606
1607         for (i = 0; i < queue_num; i++)
1608                 hns3_set_coalesce_per_queue(netdev, cmd, i);
1609
1610         tx_mode = kernel_coal->use_cqe_mode_tx ?
1611                   DIM_CQ_PERIOD_MODE_START_FROM_CQE :
1612                   DIM_CQ_PERIOD_MODE_START_FROM_EQE;
1613         rx_mode = kernel_coal->use_cqe_mode_rx ?
1614                   DIM_CQ_PERIOD_MODE_START_FROM_CQE :
1615                   DIM_CQ_PERIOD_MODE_START_FROM_EQE;
1616         hns3_cq_period_mode_init(priv, tx_mode, rx_mode);
1617
1618         return 0;
1619 }
1620
1621 static int hns3_get_regs_len(struct net_device *netdev)
1622 {
1623         struct hnae3_handle *h = hns3_get_handle(netdev);
1624
1625         if (!h->ae_algo->ops->get_regs_len)
1626                 return -EOPNOTSUPP;
1627
1628         return h->ae_algo->ops->get_regs_len(h);
1629 }
1630
1631 static void hns3_get_regs(struct net_device *netdev,
1632                           struct ethtool_regs *cmd, void *data)
1633 {
1634         struct hnae3_handle *h = hns3_get_handle(netdev);
1635
1636         if (!h->ae_algo->ops->get_regs)
1637                 return;
1638
1639         h->ae_algo->ops->get_regs(h, &cmd->version, data);
1640 }
1641
1642 static int hns3_set_phys_id(struct net_device *netdev,
1643                             enum ethtool_phys_id_state state)
1644 {
1645         struct hnae3_handle *h = hns3_get_handle(netdev);
1646
1647         if (!h->ae_algo->ops->set_led_id)
1648                 return -EOPNOTSUPP;
1649
1650         return h->ae_algo->ops->set_led_id(h, state);
1651 }
1652
1653 static u32 hns3_get_msglevel(struct net_device *netdev)
1654 {
1655         struct hnae3_handle *h = hns3_get_handle(netdev);
1656
1657         return h->msg_enable;
1658 }
1659
1660 static void hns3_set_msglevel(struct net_device *netdev, u32 msg_level)
1661 {
1662         struct hnae3_handle *h = hns3_get_handle(netdev);
1663
1664         h->msg_enable = msg_level;
1665 }
1666
1667 static void hns3_get_fec_stats(struct net_device *netdev,
1668                                struct ethtool_fec_stats *fec_stats)
1669 {
1670         struct hnae3_handle *handle = hns3_get_handle(netdev);
1671         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(handle->pdev);
1672         const struct hnae3_ae_ops *ops = handle->ae_algo->ops;
1673
1674         if (!hnae3_ae_dev_fec_stats_supported(ae_dev) || !ops->get_fec_stats)
1675                 return;
1676
1677         ops->get_fec_stats(handle, fec_stats);
1678 }
1679
1680 /* Translate local fec value into ethtool value. */
1681 static unsigned int loc_to_eth_fec(u8 loc_fec)
1682 {
1683         u32 eth_fec = 0;
1684
1685         if (loc_fec & BIT(HNAE3_FEC_AUTO))
1686                 eth_fec |= ETHTOOL_FEC_AUTO;
1687         if (loc_fec & BIT(HNAE3_FEC_RS))
1688                 eth_fec |= ETHTOOL_FEC_RS;
1689         if (loc_fec & BIT(HNAE3_FEC_LLRS))
1690                 eth_fec |= ETHTOOL_FEC_LLRS;
1691         if (loc_fec & BIT(HNAE3_FEC_BASER))
1692                 eth_fec |= ETHTOOL_FEC_BASER;
1693         if (loc_fec & BIT(HNAE3_FEC_NONE))
1694                 eth_fec |= ETHTOOL_FEC_OFF;
1695
1696         return eth_fec;
1697 }
1698
1699 /* Translate ethtool fec value into local value. */
1700 static unsigned int eth_to_loc_fec(unsigned int eth_fec)
1701 {
1702         u32 loc_fec = 0;
1703
1704         if (eth_fec & ETHTOOL_FEC_OFF)
1705                 loc_fec |= BIT(HNAE3_FEC_NONE);
1706         if (eth_fec & ETHTOOL_FEC_AUTO)
1707                 loc_fec |= BIT(HNAE3_FEC_AUTO);
1708         if (eth_fec & ETHTOOL_FEC_RS)
1709                 loc_fec |= BIT(HNAE3_FEC_RS);
1710         if (eth_fec & ETHTOOL_FEC_LLRS)
1711                 loc_fec |= BIT(HNAE3_FEC_LLRS);
1712         if (eth_fec & ETHTOOL_FEC_BASER)
1713                 loc_fec |= BIT(HNAE3_FEC_BASER);
1714
1715         return loc_fec;
1716 }
1717
1718 static int hns3_get_fecparam(struct net_device *netdev,
1719                              struct ethtool_fecparam *fec)
1720 {
1721         struct hnae3_handle *handle = hns3_get_handle(netdev);
1722         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(handle->pdev);
1723         const struct hnae3_ae_ops *ops = handle->ae_algo->ops;
1724         u8 fec_ability;
1725         u8 fec_mode;
1726
1727         if (!test_bit(HNAE3_DEV_SUPPORT_FEC_B, ae_dev->caps))
1728                 return -EOPNOTSUPP;
1729
1730         if (!ops->get_fec)
1731                 return -EOPNOTSUPP;
1732
1733         ops->get_fec(handle, &fec_ability, &fec_mode);
1734
1735         fec->fec = loc_to_eth_fec(fec_ability);
1736         fec->active_fec = loc_to_eth_fec(fec_mode);
1737         if (!fec->active_fec)
1738                 fec->active_fec = ETHTOOL_FEC_OFF;
1739
1740         return 0;
1741 }
1742
1743 static int hns3_set_fecparam(struct net_device *netdev,
1744                              struct ethtool_fecparam *fec)
1745 {
1746         struct hnae3_handle *handle = hns3_get_handle(netdev);
1747         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(handle->pdev);
1748         const struct hnae3_ae_ops *ops = handle->ae_algo->ops;
1749         u32 fec_mode;
1750
1751         if (!test_bit(HNAE3_DEV_SUPPORT_FEC_B, ae_dev->caps))
1752                 return -EOPNOTSUPP;
1753
1754         if (!ops->set_fec)
1755                 return -EOPNOTSUPP;
1756         fec_mode = eth_to_loc_fec(fec->fec);
1757
1758         netif_dbg(handle, drv, netdev, "set fecparam: mode=%u\n", fec_mode);
1759
1760         return ops->set_fec(handle, fec_mode);
1761 }
1762
1763 static int hns3_get_module_info(struct net_device *netdev,
1764                                 struct ethtool_modinfo *modinfo)
1765 {
1766 #define HNS3_SFF_8636_V1_3 0x03
1767
1768         struct hnae3_handle *handle = hns3_get_handle(netdev);
1769         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(handle->pdev);
1770         const struct hnae3_ae_ops *ops = handle->ae_algo->ops;
1771         struct hns3_sfp_type sfp_type;
1772         int ret;
1773
1774         if (ae_dev->dev_version < HNAE3_DEVICE_VERSION_V2 ||
1775             !ops->get_module_eeprom)
1776                 return -EOPNOTSUPP;
1777
1778         memset(&sfp_type, 0, sizeof(sfp_type));
1779         ret = ops->get_module_eeprom(handle, 0, sizeof(sfp_type) / sizeof(u8),
1780                                      (u8 *)&sfp_type);
1781         if (ret)
1782                 return ret;
1783
1784         switch (sfp_type.type) {
1785         case SFF8024_ID_SFP:
1786                 modinfo->type = ETH_MODULE_SFF_8472;
1787                 modinfo->eeprom_len = ETH_MODULE_SFF_8472_LEN;
1788                 break;
1789         case SFF8024_ID_QSFP_8438:
1790                 modinfo->type = ETH_MODULE_SFF_8436;
1791                 modinfo->eeprom_len = ETH_MODULE_SFF_8436_MAX_LEN;
1792                 break;
1793         case SFF8024_ID_QSFP_8436_8636:
1794                 if (sfp_type.ext_type < HNS3_SFF_8636_V1_3) {
1795                         modinfo->type = ETH_MODULE_SFF_8436;
1796                         modinfo->eeprom_len = ETH_MODULE_SFF_8436_MAX_LEN;
1797                 } else {
1798                         modinfo->type = ETH_MODULE_SFF_8636;
1799                         modinfo->eeprom_len = ETH_MODULE_SFF_8636_MAX_LEN;
1800                 }
1801                 break;
1802         case SFF8024_ID_QSFP28_8636:
1803                 modinfo->type = ETH_MODULE_SFF_8636;
1804                 modinfo->eeprom_len = ETH_MODULE_SFF_8636_MAX_LEN;
1805                 break;
1806         default:
1807                 netdev_err(netdev, "Optical module unknown: %#x\n",
1808                            sfp_type.type);
1809                 return -EINVAL;
1810         }
1811
1812         return 0;
1813 }
1814
1815 static int hns3_get_module_eeprom(struct net_device *netdev,
1816                                   struct ethtool_eeprom *ee, u8 *data)
1817 {
1818         struct hnae3_handle *handle = hns3_get_handle(netdev);
1819         struct hnae3_ae_dev *ae_dev = pci_get_drvdata(handle->pdev);
1820         const struct hnae3_ae_ops *ops = handle->ae_algo->ops;
1821
1822         if (ae_dev->dev_version < HNAE3_DEVICE_VERSION_V2 ||
1823             !ops->get_module_eeprom)
1824                 return -EOPNOTSUPP;
1825
1826         if (!ee->len)
1827                 return -EINVAL;
1828
1829         memset(data, 0, ee->len);
1830
1831         return ops->get_module_eeprom(handle, ee->offset, ee->len, data);
1832 }
1833
1834 static u32 hns3_get_priv_flags(struct net_device *netdev)
1835 {
1836         struct hnae3_handle *handle = hns3_get_handle(netdev);
1837
1838         return handle->priv_flags;
1839 }
1840
1841 static int hns3_check_priv_flags(struct hnae3_handle *h, u32 changed)
1842 {
1843         u32 i;
1844
1845         for (i = 0; i < HNAE3_PFLAG_MAX; i++)
1846                 if ((changed & BIT(i)) && !test_bit(i, &h->supported_pflags)) {
1847                         netdev_err(h->netdev, "%s is unsupported\n",
1848                                    hns3_priv_flags[i].name);
1849                         return -EOPNOTSUPP;
1850                 }
1851
1852         return 0;
1853 }
1854
1855 static int hns3_set_priv_flags(struct net_device *netdev, u32 pflags)
1856 {
1857         struct hnae3_handle *handle = hns3_get_handle(netdev);
1858         u32 changed = pflags ^ handle->priv_flags;
1859         int ret;
1860         u32 i;
1861
1862         ret = hns3_check_priv_flags(handle, changed);
1863         if (ret)
1864                 return ret;
1865
1866         for (i = 0; i < HNAE3_PFLAG_MAX; i++) {
1867                 if (changed & BIT(i)) {
1868                         bool enable = !(handle->priv_flags & BIT(i));
1869
1870                         if (enable)
1871                                 handle->priv_flags |= BIT(i);
1872                         else
1873                                 handle->priv_flags &= ~BIT(i);
1874                         hns3_priv_flags[i].handler(netdev, enable);
1875                 }
1876         }
1877
1878         return 0;
1879 }
1880
1881 static int hns3_get_tunable(struct net_device *netdev,
1882                             const struct ethtool_tunable *tuna,
1883                             void *data)
1884 {
1885         struct hns3_nic_priv *priv = netdev_priv(netdev);
1886         struct hnae3_handle *h = priv->ae_handle;
1887         int ret = 0;
1888
1889         switch (tuna->id) {
1890         case ETHTOOL_TX_COPYBREAK:
1891                 /* all the tx rings have the same tx_copybreak */
1892                 *(u32 *)data = priv->tx_copybreak;
1893                 break;
1894         case ETHTOOL_RX_COPYBREAK:
1895                 *(u32 *)data = priv->rx_copybreak;
1896                 break;
1897         case ETHTOOL_TX_COPYBREAK_BUF_SIZE:
1898                 *(u32 *)data = h->kinfo.tx_spare_buf_size;
1899                 break;
1900         default:
1901                 ret = -EOPNOTSUPP;
1902                 break;
1903         }
1904
1905         return ret;
1906 }
1907
1908 static int hns3_set_tx_spare_buf_size(struct net_device *netdev,
1909                                       u32 data)
1910 {
1911         struct hns3_nic_priv *priv = netdev_priv(netdev);
1912         struct hnae3_handle *h = priv->ae_handle;
1913         int ret;
1914
1915         h->kinfo.tx_spare_buf_size = data;
1916
1917         ret = hns3_reset_notify(h, HNAE3_DOWN_CLIENT);
1918         if (ret)
1919                 return ret;
1920
1921         ret = hns3_reset_notify(h, HNAE3_UNINIT_CLIENT);
1922         if (ret)
1923                 return ret;
1924
1925         ret = hns3_reset_notify(h, HNAE3_INIT_CLIENT);
1926         if (ret)
1927                 return ret;
1928
1929         ret = hns3_reset_notify(h, HNAE3_UP_CLIENT);
1930         if (ret)
1931                 hns3_reset_notify(h, HNAE3_UNINIT_CLIENT);
1932
1933         return ret;
1934 }
1935
1936 static int hns3_set_tunable(struct net_device *netdev,
1937                             const struct ethtool_tunable *tuna,
1938                             const void *data)
1939 {
1940         struct hns3_nic_priv *priv = netdev_priv(netdev);
1941         u32 old_tx_spare_buf_size, new_tx_spare_buf_size;
1942         struct hnae3_handle *h = priv->ae_handle;
1943         int i, ret = 0;
1944
1945         if (hns3_nic_resetting(netdev) || !priv->ring) {
1946                 netdev_err(netdev, "failed to set tunable value, dev resetting!");
1947                 return -EBUSY;
1948         }
1949
1950         switch (tuna->id) {
1951         case ETHTOOL_TX_COPYBREAK:
1952                 priv->tx_copybreak = *(u32 *)data;
1953
1954                 for (i = 0; i < h->kinfo.num_tqps; i++)
1955                         priv->ring[i].tx_copybreak = priv->tx_copybreak;
1956
1957                 break;
1958         case ETHTOOL_RX_COPYBREAK:
1959                 priv->rx_copybreak = *(u32 *)data;
1960
1961                 for (i = h->kinfo.num_tqps; i < h->kinfo.num_tqps * 2; i++)
1962                         priv->ring[i].rx_copybreak = priv->rx_copybreak;
1963
1964                 break;
1965         case ETHTOOL_TX_COPYBREAK_BUF_SIZE:
1966                 old_tx_spare_buf_size = h->kinfo.tx_spare_buf_size;
1967                 new_tx_spare_buf_size = *(u32 *)data;
1968                 netdev_info(netdev, "request to set tx spare buf size from %u to %u\n",
1969                             old_tx_spare_buf_size, new_tx_spare_buf_size);
1970                 ret = hns3_set_tx_spare_buf_size(netdev, new_tx_spare_buf_size);
1971                 if (ret ||
1972                     (!priv->ring->tx_spare && new_tx_spare_buf_size != 0)) {
1973                         int ret1;
1974
1975                         netdev_warn(netdev, "change tx spare buf size fail, revert to old value\n");
1976                         ret1 = hns3_set_tx_spare_buf_size(netdev,
1977                                                           old_tx_spare_buf_size);
1978                         if (ret1) {
1979                                 netdev_err(netdev, "revert to old tx spare buf size fail\n");
1980                                 return ret1;
1981                         }
1982
1983                         return ret;
1984                 }
1985
1986                 if (!priv->ring->tx_spare)
1987                         netdev_info(netdev, "the active tx spare buf size is 0, disable tx spare buffer\n");
1988                 else
1989                         netdev_info(netdev, "the active tx spare buf size is %u, due to page order\n",
1990                                     priv->ring->tx_spare->len);
1991
1992                 break;
1993         default:
1994                 ret = -EOPNOTSUPP;
1995                 break;
1996         }
1997
1998         return ret;
1999 }
2000
2001 #define HNS3_ETHTOOL_COALESCE   (ETHTOOL_COALESCE_USECS |               \
2002                                  ETHTOOL_COALESCE_USE_ADAPTIVE |        \
2003                                  ETHTOOL_COALESCE_RX_USECS_HIGH |       \
2004                                  ETHTOOL_COALESCE_TX_USECS_HIGH |       \
2005                                  ETHTOOL_COALESCE_MAX_FRAMES |          \
2006                                  ETHTOOL_COALESCE_USE_CQE)
2007
2008 #define HNS3_ETHTOOL_RING       (ETHTOOL_RING_USE_RX_BUF_LEN |          \
2009                                  ETHTOOL_RING_USE_TX_PUSH)
2010
2011 static int hns3_get_ts_info(struct net_device *netdev,
2012                             struct ethtool_ts_info *info)
2013 {
2014         struct hnae3_handle *handle = hns3_get_handle(netdev);
2015
2016         if (handle->ae_algo->ops->get_ts_info)
2017                 return handle->ae_algo->ops->get_ts_info(handle, info);
2018
2019         return ethtool_op_get_ts_info(netdev, info);
2020 }
2021
2022 static const struct hns3_ethtool_link_ext_state_mapping
2023 hns3_link_ext_state_map[] = {
2024         {1, ETHTOOL_LINK_EXT_STATE_AUTONEG,
2025                 ETHTOOL_LINK_EXT_SUBSTATE_AN_NO_HCD},
2026         {2, ETHTOOL_LINK_EXT_STATE_AUTONEG,
2027                 ETHTOOL_LINK_EXT_SUBSTATE_AN_ACK_NOT_RECEIVED},
2028
2029         {256, ETHTOOL_LINK_EXT_STATE_LINK_TRAINING_FAILURE,
2030                 ETHTOOL_LINK_EXT_SUBSTATE_LT_KR_LINK_INHIBIT_TIMEOUT},
2031         {257, ETHTOOL_LINK_EXT_STATE_LINK_TRAINING_FAILURE,
2032                 ETHTOOL_LINK_EXT_SUBSTATE_LT_KR_LINK_PARTNER_DID_NOT_SET_RECEIVER_READY},
2033         {512, ETHTOOL_LINK_EXT_STATE_LINK_TRAINING_FAILURE,
2034                 ETHTOOL_LINK_EXT_SUBSTATE_LT_REMOTE_FAULT},
2035
2036         {513, ETHTOOL_LINK_EXT_STATE_LINK_LOGICAL_MISMATCH,
2037                 ETHTOOL_LINK_EXT_SUBSTATE_LLM_PCS_DID_NOT_ACQUIRE_BLOCK_LOCK},
2038         {514, ETHTOOL_LINK_EXT_STATE_LINK_LOGICAL_MISMATCH,
2039                 ETHTOOL_LINK_EXT_SUBSTATE_LLM_FC_FEC_IS_NOT_LOCKED},
2040         {515, ETHTOOL_LINK_EXT_STATE_LINK_LOGICAL_MISMATCH,
2041                 ETHTOOL_LINK_EXT_SUBSTATE_LLM_RS_FEC_IS_NOT_LOCKED},
2042
2043         {768, ETHTOOL_LINK_EXT_STATE_BAD_SIGNAL_INTEGRITY,
2044                 ETHTOOL_LINK_EXT_SUBSTATE_BSI_LARGE_NUMBER_OF_PHYSICAL_ERRORS},
2045         {769, ETHTOOL_LINK_EXT_STATE_BAD_SIGNAL_INTEGRITY,
2046                 ETHTOOL_LINK_EXT_SUBSTATE_BSI_SERDES_REFERENCE_CLOCK_LOST},
2047         {770, ETHTOOL_LINK_EXT_STATE_BAD_SIGNAL_INTEGRITY,
2048                 ETHTOOL_LINK_EXT_SUBSTATE_BSI_SERDES_ALOS},
2049
2050         {1024, ETHTOOL_LINK_EXT_STATE_NO_CABLE, 0},
2051         {1025, ETHTOOL_LINK_EXT_STATE_CABLE_ISSUE,
2052                 ETHTOOL_LINK_EXT_SUBSTATE_CI_UNSUPPORTED_CABLE},
2053
2054         {1026, ETHTOOL_LINK_EXT_STATE_EEPROM_ISSUE, 0},
2055 };
2056
2057 static int hns3_get_link_ext_state(struct net_device *netdev,
2058                                    struct ethtool_link_ext_state_info *info)
2059 {
2060         const struct hns3_ethtool_link_ext_state_mapping *map;
2061         struct hnae3_handle *h = hns3_get_handle(netdev);
2062         u32 status_code, i;
2063         int ret;
2064
2065         if (netif_carrier_ok(netdev))
2066                 return -ENODATA;
2067
2068         if (!h->ae_algo->ops->get_link_diagnosis_info)
2069                 return -EOPNOTSUPP;
2070
2071         ret = h->ae_algo->ops->get_link_diagnosis_info(h, &status_code);
2072         if (ret)
2073                 return ret;
2074
2075         for (i = 0; i < ARRAY_SIZE(hns3_link_ext_state_map); i++) {
2076                 map = &hns3_link_ext_state_map[i];
2077                 if (map->status_code == status_code) {
2078                         info->link_ext_state = map->link_ext_state;
2079                         info->__link_ext_substate = map->link_ext_substate;
2080                         return 0;
2081                 }
2082         }
2083
2084         return -ENODATA;
2085 }
2086
2087 static void hns3_get_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
2088 {
2089         struct hnae3_handle *handle = hns3_get_handle(netdev);
2090         const struct hnae3_ae_ops *ops = hns3_get_ops(handle);
2091         struct hnae3_ae_dev *ae_dev = hns3_get_ae_dev(handle);
2092
2093         if (!hnae3_ae_dev_wol_supported(ae_dev))
2094                 return;
2095
2096         ops->get_wol(handle, wol);
2097 }
2098
2099 static int hns3_set_wol(struct net_device *netdev,
2100                         struct ethtool_wolinfo *wol)
2101 {
2102         struct hnae3_handle *handle = hns3_get_handle(netdev);
2103         const struct hnae3_ae_ops *ops = hns3_get_ops(handle);
2104         struct hnae3_ae_dev *ae_dev = hns3_get_ae_dev(handle);
2105
2106         if (!hnae3_ae_dev_wol_supported(ae_dev))
2107                 return -EOPNOTSUPP;
2108
2109         return ops->set_wol(handle, wol);
2110 }
2111
2112 static const struct ethtool_ops hns3vf_ethtool_ops = {
2113         .supported_coalesce_params = HNS3_ETHTOOL_COALESCE,
2114         .supported_ring_params = HNS3_ETHTOOL_RING,
2115         .get_drvinfo = hns3_get_drvinfo,
2116         .get_ringparam = hns3_get_ringparam,
2117         .set_ringparam = hns3_set_ringparam,
2118         .get_strings = hns3_get_strings,
2119         .get_ethtool_stats = hns3_get_stats,
2120         .get_sset_count = hns3_get_sset_count,
2121         .get_rxnfc = hns3_get_rxnfc,
2122         .set_rxnfc = hns3_set_rxnfc,
2123         .get_rxfh_key_size = hns3_get_rss_key_size,
2124         .get_rxfh_indir_size = hns3_get_rss_indir_size,
2125         .get_rxfh = hns3_get_rss,
2126         .set_rxfh = hns3_set_rss,
2127         .get_link_ksettings = hns3_get_link_ksettings,
2128         .get_channels = hns3_get_channels,
2129         .set_channels = hns3_set_channels,
2130         .get_coalesce = hns3_get_coalesce,
2131         .set_coalesce = hns3_set_coalesce,
2132         .get_regs_len = hns3_get_regs_len,
2133         .get_regs = hns3_get_regs,
2134         .get_link = hns3_get_link,
2135         .get_msglevel = hns3_get_msglevel,
2136         .set_msglevel = hns3_set_msglevel,
2137         .get_priv_flags = hns3_get_priv_flags,
2138         .set_priv_flags = hns3_set_priv_flags,
2139         .get_tunable = hns3_get_tunable,
2140         .set_tunable = hns3_set_tunable,
2141         .reset = hns3_set_reset,
2142 };
2143
2144 static const struct ethtool_ops hns3_ethtool_ops = {
2145         .supported_coalesce_params = HNS3_ETHTOOL_COALESCE,
2146         .supported_ring_params = HNS3_ETHTOOL_RING,
2147         .cap_link_lanes_supported = true,
2148         .self_test = hns3_self_test,
2149         .get_drvinfo = hns3_get_drvinfo,
2150         .get_link = hns3_get_link,
2151         .get_ringparam = hns3_get_ringparam,
2152         .set_ringparam = hns3_set_ringparam,
2153         .get_pauseparam = hns3_get_pauseparam,
2154         .set_pauseparam = hns3_set_pauseparam,
2155         .get_strings = hns3_get_strings,
2156         .get_ethtool_stats = hns3_get_stats,
2157         .get_sset_count = hns3_get_sset_count,
2158         .get_rxnfc = hns3_get_rxnfc,
2159         .set_rxnfc = hns3_set_rxnfc,
2160         .get_rxfh_key_size = hns3_get_rss_key_size,
2161         .get_rxfh_indir_size = hns3_get_rss_indir_size,
2162         .get_rxfh = hns3_get_rss,
2163         .set_rxfh = hns3_set_rss,
2164         .get_link_ksettings = hns3_get_link_ksettings,
2165         .set_link_ksettings = hns3_set_link_ksettings,
2166         .nway_reset = hns3_nway_reset,
2167         .get_channels = hns3_get_channels,
2168         .set_channels = hns3_set_channels,
2169         .get_coalesce = hns3_get_coalesce,
2170         .set_coalesce = hns3_set_coalesce,
2171         .get_regs_len = hns3_get_regs_len,
2172         .get_regs = hns3_get_regs,
2173         .set_phys_id = hns3_set_phys_id,
2174         .get_msglevel = hns3_get_msglevel,
2175         .set_msglevel = hns3_set_msglevel,
2176         .get_fecparam = hns3_get_fecparam,
2177         .set_fecparam = hns3_set_fecparam,
2178         .get_fec_stats = hns3_get_fec_stats,
2179         .get_module_info = hns3_get_module_info,
2180         .get_module_eeprom = hns3_get_module_eeprom,
2181         .get_priv_flags = hns3_get_priv_flags,
2182         .set_priv_flags = hns3_set_priv_flags,
2183         .get_ts_info = hns3_get_ts_info,
2184         .get_tunable = hns3_get_tunable,
2185         .set_tunable = hns3_set_tunable,
2186         .reset = hns3_set_reset,
2187         .get_link_ext_state = hns3_get_link_ext_state,
2188         .get_wol = hns3_get_wol,
2189         .set_wol = hns3_set_wol,
2190 };
2191
2192 void hns3_ethtool_set_ops(struct net_device *netdev)
2193 {
2194         struct hnae3_handle *h = hns3_get_handle(netdev);
2195
2196         if (h->flags & HNAE3_SUPPORT_VF)
2197                 netdev->ethtool_ops = &hns3vf_ethtool_ops;
2198         else
2199                 netdev->ethtool_ops = &hns3_ethtool_ops;
2200 }