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 
hns3_lp_setup(struct net_device * ndev,enum hnae3_loop loop,bool en)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 
hns3_lp_up(struct net_device * ndev,enum hnae3_loop loop_mode)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 
hns3_lp_down(struct net_device * ndev,enum hnae3_loop loop_mode)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 
hns3_lp_setup_skb(struct sk_buff * skb)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 
hns3_lb_check_skb_data(struct hns3_enet_ring * ring,struct sk_buff * skb)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 
hns3_lb_check_rx_ring(struct hns3_nic_priv * priv,u32 budget)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 
hns3_lb_clear_tx_ring(struct hns3_nic_priv * priv,u32 start_ringid,u32 end_ringid)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  */
hns3_lp_run_test(struct net_device * ndev,enum hnae3_loop mode)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 
hns3_set_selftest_param(struct hnae3_handle * h,int (* st_param)[2])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 
hns3_selftest_prepare(struct net_device * ndev,bool if_running)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 
hns3_selftest_restore(struct net_device * ndev,bool if_running)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 
hns3_do_selftest(struct net_device * ndev,int (* st_param)[2],struct ethtool_test * eth_test,u64 * data)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 
hns3_do_external_lb(struct net_device * ndev,struct ethtool_test * eth_test,u64 * data)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  */
hns3_self_test(struct net_device * ndev,struct ethtool_test * eth_test,u64 * data)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 
hns3_update_limit_promisc_mode(struct net_device * netdev,bool enable)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 
hns3_get_sset_count(struct net_device * netdev,int stringset)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 
hns3_update_strings(u8 * data,const struct hns3_stats * stats,u32 stat_count,u32 num_tqps,const char * prefix)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 
hns3_get_strings_tqps(struct hnae3_handle * handle,u8 * data)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 
hns3_get_strings(struct net_device * netdev,u32 stringset,u8 * data)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 
hns3_get_stats_tqps(struct hnae3_handle * handle,u64 * data)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  */
hns3_get_stats(struct net_device * netdev,struct ethtool_stats * stats,u64 * data)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 
hns3_get_drvinfo(struct net_device * netdev,struct ethtool_drvinfo * drvinfo)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 
hns3_get_link(struct net_device * netdev)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 
hns3_get_ringparam(struct net_device * netdev,struct ethtool_ringparam * param,struct kernel_ethtool_ringparam * kernel_param,struct netlink_ext_ack * extack)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 
hns3_get_pauseparam(struct net_device * netdev,struct ethtool_pauseparam * param)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 
hns3_set_pauseparam(struct net_device * netdev,struct ethtool_pauseparam * param)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 
hns3_get_ksettings(struct hnae3_handle * h,struct ethtool_link_ksettings * cmd)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 
hns3_get_link_ksettings(struct net_device * netdev,struct ethtool_link_ksettings * cmd)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 
hns3_check_ksettings_param(const struct net_device * netdev,const struct ethtool_link_ksettings * cmd)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 
hns3_set_link_ksettings(struct net_device * netdev,const struct ethtool_link_ksettings * cmd)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 
hns3_get_rss_key_size(struct net_device * netdev)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 
hns3_get_rss_indir_size(struct net_device * netdev)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 
hns3_get_rss(struct net_device * netdev,struct ethtool_rxfh_param * rxfh)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 
hns3_set_rss(struct net_device * netdev,struct ethtool_rxfh_param * rxfh,struct netlink_ext_ack * extack)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 
hns3_get_rxnfc(struct net_device * netdev,struct ethtool_rxnfc * cmd,u32 * rule_locs)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 
hns3_set_reset(struct net_device * netdev,u32 * flags)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 
hns3_change_all_ring_bd_num(struct hns3_nic_priv * priv,u32 tx_desc_num,u32 rx_desc_num)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 
hns3_backup_ringparam(struct hns3_nic_priv * priv)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 
hns3_check_ringparam(struct net_device * ndev,struct ethtool_ringparam * param,struct kernel_ethtool_ringparam * kernel_param)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
hns3_is_ringparam_changed(struct net_device * ndev,struct ethtool_ringparam * param,struct kernel_ethtool_ringparam * kernel_param,struct hns3_ring_param * old_ringparam,struct hns3_ring_param * new_ringparam)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 
hns3_change_rx_buf_len(struct net_device * ndev,u32 rx_buf_len)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 
hns3_set_tx_push(struct net_device * netdev,u32 tx_push)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 
hns3_set_ringparam(struct net_device * ndev,struct ethtool_ringparam * param,struct kernel_ethtool_ringparam * kernel_param,struct netlink_ext_ack * extack)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 
hns3_set_rxnfc(struct net_device * netdev,struct ethtool_rxnfc * cmd)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 
hns3_nway_reset(struct net_device * netdev)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 
hns3_get_channels(struct net_device * netdev,struct ethtool_channels * ch)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 
hns3_get_coalesce(struct net_device * netdev,struct ethtool_coalesce * cmd,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)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 
hns3_check_gl_coalesce_para(struct net_device * netdev,struct ethtool_coalesce * cmd)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 
hns3_check_rl_coalesce_para(struct net_device * netdev,struct ethtool_coalesce * cmd)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 
hns3_check_ql_coalesce_param(struct net_device * netdev,struct ethtool_coalesce * cmd)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
hns3_check_cqe_coalesce_param(struct net_device * netdev,struct kernel_ethtool_coalesce * kernel_coal)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
hns3_check_coalesce_para(struct net_device * netdev,struct ethtool_coalesce * cmd,struct kernel_ethtool_coalesce * kernel_coal)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 
hns3_set_coalesce_per_queue(struct net_device * netdev,struct ethtool_coalesce * cmd,u32 queue)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 
hns3_set_coalesce(struct net_device * netdev,struct ethtool_coalesce * cmd,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)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 
hns3_get_regs_len(struct net_device * netdev)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 
hns3_get_regs(struct net_device * netdev,struct ethtool_regs * cmd,void * data)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 
hns3_set_phys_id(struct net_device * netdev,enum ethtool_phys_id_state state)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 
hns3_get_msglevel(struct net_device * netdev)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 
hns3_set_msglevel(struct net_device * netdev,u32 msg_level)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 
hns3_get_fec_stats(struct net_device * netdev,struct ethtool_fec_stats * fec_stats)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. */
loc_to_eth_fec(u8 loc_fec)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. */
eth_to_loc_fec(unsigned int eth_fec)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 
hns3_get_fecparam(struct net_device * netdev,struct ethtool_fecparam * fec)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 
hns3_set_fecparam(struct net_device * netdev,struct ethtool_fecparam * fec)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 
hns3_get_module_info(struct net_device * netdev,struct ethtool_modinfo * modinfo)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 
hns3_get_module_eeprom(struct net_device * netdev,struct ethtool_eeprom * ee,u8 * data)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 
hns3_get_priv_flags(struct net_device * netdev)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 
hns3_check_priv_flags(struct hnae3_handle * h,u32 changed)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 
hns3_set_priv_flags(struct net_device * netdev,u32 pflags)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 
hns3_get_tunable(struct net_device * netdev,const struct ethtool_tunable * tuna,void * data)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 
hns3_set_tx_spare_buf_size(struct net_device * netdev,u32 data)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 
hns3_set_tunable(struct net_device * netdev,const struct ethtool_tunable * tuna,const void * data)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 
hns3_get_ts_info(struct net_device * netdev,struct kernel_ethtool_ts_info * info)2011 static int hns3_get_ts_info(struct net_device *netdev,
2012 			    struct kernel_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 
hns3_get_link_ext_state(struct net_device * netdev,struct ethtool_link_ext_state_info * info)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 
hns3_get_wol(struct net_device * netdev,struct ethtool_wolinfo * wol)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 
hns3_set_wol(struct net_device * netdev,struct ethtool_wolinfo * wol)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 
hns3_ethtool_set_ops(struct net_device * netdev)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 }
2201