1 /*
2  * Copyright 2015 Amazon.com, Inc. or its affiliates.
3  *
4  * This software is available to you under a choice of one of two
5  * licenses.  You may choose to be licensed under the terms of the GNU
6  * General Public License (GPL) Version 2, available from the file
7  * COPYING in the main directory of this source tree, or the
8  * BSD license below:
9  *
10  *     Redistribution and use in source and binary forms, with or
11  *     without modification, are permitted provided that the following
12  *     conditions are met:
13  *
14  *      - Redistributions of source code must retain the above
15  *        copyright notice, this list of conditions and the following
16  *        disclaimer.
17  *
18  *      - Redistributions in binary form must reproduce the above
19  *        copyright notice, this list of conditions and the following
20  *        disclaimer in the documentation and/or other materials
21  *        provided with the distribution.
22  *
23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30  * SOFTWARE.
31  */
32 
33 #include <linux/pci.h>
34 
35 #include "ena_netdev.h"
36 
37 struct ena_stats {
38 	char name[ETH_GSTRING_LEN];
39 	int stat_offset;
40 };
41 
42 #define ENA_STAT_ENA_COM_ENTRY(stat) { \
43 	.name = #stat, \
44 	.stat_offset = offsetof(struct ena_com_stats_admin, stat) \
45 }
46 
47 #define ENA_STAT_ENTRY(stat, stat_type) { \
48 	.name = #stat, \
49 	.stat_offset = offsetof(struct ena_stats_##stat_type, stat) \
50 }
51 
52 #define ENA_STAT_RX_ENTRY(stat) \
53 	ENA_STAT_ENTRY(stat, rx)
54 
55 #define ENA_STAT_TX_ENTRY(stat) \
56 	ENA_STAT_ENTRY(stat, tx)
57 
58 #define ENA_STAT_GLOBAL_ENTRY(stat) \
59 	ENA_STAT_ENTRY(stat, dev)
60 
61 static const struct ena_stats ena_stats_global_strings[] = {
62 	ENA_STAT_GLOBAL_ENTRY(tx_timeout),
63 	ENA_STAT_GLOBAL_ENTRY(suspend),
64 	ENA_STAT_GLOBAL_ENTRY(resume),
65 	ENA_STAT_GLOBAL_ENTRY(wd_expired),
66 	ENA_STAT_GLOBAL_ENTRY(interface_up),
67 	ENA_STAT_GLOBAL_ENTRY(interface_down),
68 	ENA_STAT_GLOBAL_ENTRY(admin_q_pause),
69 };
70 
71 static const struct ena_stats ena_stats_tx_strings[] = {
72 	ENA_STAT_TX_ENTRY(cnt),
73 	ENA_STAT_TX_ENTRY(bytes),
74 	ENA_STAT_TX_ENTRY(queue_stop),
75 	ENA_STAT_TX_ENTRY(queue_wakeup),
76 	ENA_STAT_TX_ENTRY(dma_mapping_err),
77 	ENA_STAT_TX_ENTRY(linearize),
78 	ENA_STAT_TX_ENTRY(linearize_failed),
79 	ENA_STAT_TX_ENTRY(napi_comp),
80 	ENA_STAT_TX_ENTRY(tx_poll),
81 	ENA_STAT_TX_ENTRY(doorbells),
82 	ENA_STAT_TX_ENTRY(prepare_ctx_err),
83 	ENA_STAT_TX_ENTRY(bad_req_id),
84 	ENA_STAT_TX_ENTRY(llq_buffer_copy),
85 	ENA_STAT_TX_ENTRY(missed_tx),
86 };
87 
88 static const struct ena_stats ena_stats_rx_strings[] = {
89 	ENA_STAT_RX_ENTRY(cnt),
90 	ENA_STAT_RX_ENTRY(bytes),
91 	ENA_STAT_RX_ENTRY(rx_copybreak_pkt),
92 	ENA_STAT_RX_ENTRY(csum_good),
93 	ENA_STAT_RX_ENTRY(refil_partial),
94 	ENA_STAT_RX_ENTRY(bad_csum),
95 	ENA_STAT_RX_ENTRY(page_alloc_fail),
96 	ENA_STAT_RX_ENTRY(skb_alloc_fail),
97 	ENA_STAT_RX_ENTRY(dma_mapping_err),
98 	ENA_STAT_RX_ENTRY(bad_desc_num),
99 	ENA_STAT_RX_ENTRY(bad_req_id),
100 	ENA_STAT_RX_ENTRY(empty_rx_ring),
101 	ENA_STAT_RX_ENTRY(csum_unchecked),
102 };
103 
104 static const struct ena_stats ena_stats_ena_com_strings[] = {
105 	ENA_STAT_ENA_COM_ENTRY(aborted_cmd),
106 	ENA_STAT_ENA_COM_ENTRY(submitted_cmd),
107 	ENA_STAT_ENA_COM_ENTRY(completed_cmd),
108 	ENA_STAT_ENA_COM_ENTRY(out_of_space),
109 	ENA_STAT_ENA_COM_ENTRY(no_completion),
110 };
111 
112 #define ENA_STATS_ARRAY_GLOBAL	ARRAY_SIZE(ena_stats_global_strings)
113 #define ENA_STATS_ARRAY_TX	ARRAY_SIZE(ena_stats_tx_strings)
114 #define ENA_STATS_ARRAY_RX	ARRAY_SIZE(ena_stats_rx_strings)
115 #define ENA_STATS_ARRAY_ENA_COM	ARRAY_SIZE(ena_stats_ena_com_strings)
116 
117 static void ena_safe_update_stat(u64 *src, u64 *dst,
118 				 struct u64_stats_sync *syncp)
119 {
120 	unsigned int start;
121 
122 	do {
123 		start = u64_stats_fetch_begin_irq(syncp);
124 		*(dst) = *src;
125 	} while (u64_stats_fetch_retry_irq(syncp, start));
126 }
127 
128 static void ena_queue_stats(struct ena_adapter *adapter, u64 **data)
129 {
130 	const struct ena_stats *ena_stats;
131 	struct ena_ring *ring;
132 
133 	u64 *ptr;
134 	int i, j;
135 
136 	for (i = 0; i < adapter->num_queues; i++) {
137 		/* Tx stats */
138 		ring = &adapter->tx_ring[i];
139 
140 		for (j = 0; j < ENA_STATS_ARRAY_TX; j++) {
141 			ena_stats = &ena_stats_tx_strings[j];
142 
143 			ptr = (u64 *)((uintptr_t)&ring->tx_stats +
144 				(uintptr_t)ena_stats->stat_offset);
145 
146 			ena_safe_update_stat(ptr, (*data)++, &ring->syncp);
147 		}
148 
149 		/* Rx stats */
150 		ring = &adapter->rx_ring[i];
151 
152 		for (j = 0; j < ENA_STATS_ARRAY_RX; j++) {
153 			ena_stats = &ena_stats_rx_strings[j];
154 
155 			ptr = (u64 *)((uintptr_t)&ring->rx_stats +
156 				(uintptr_t)ena_stats->stat_offset);
157 
158 			ena_safe_update_stat(ptr, (*data)++, &ring->syncp);
159 		}
160 	}
161 }
162 
163 static void ena_dev_admin_queue_stats(struct ena_adapter *adapter, u64 **data)
164 {
165 	const struct ena_stats *ena_stats;
166 	u32 *ptr;
167 	int i;
168 
169 	for (i = 0; i < ENA_STATS_ARRAY_ENA_COM; i++) {
170 		ena_stats = &ena_stats_ena_com_strings[i];
171 
172 		ptr = (u32 *)((uintptr_t)&adapter->ena_dev->admin_queue.stats +
173 			(uintptr_t)ena_stats->stat_offset);
174 
175 		*(*data)++ = *ptr;
176 	}
177 }
178 
179 static void ena_get_ethtool_stats(struct net_device *netdev,
180 				  struct ethtool_stats *stats,
181 				  u64 *data)
182 {
183 	struct ena_adapter *adapter = netdev_priv(netdev);
184 	const struct ena_stats *ena_stats;
185 	u64 *ptr;
186 	int i;
187 
188 	for (i = 0; i < ENA_STATS_ARRAY_GLOBAL; i++) {
189 		ena_stats = &ena_stats_global_strings[i];
190 
191 		ptr = (u64 *)((uintptr_t)&adapter->dev_stats +
192 			(uintptr_t)ena_stats->stat_offset);
193 
194 		ena_safe_update_stat(ptr, data++, &adapter->syncp);
195 	}
196 
197 	ena_queue_stats(adapter, &data);
198 	ena_dev_admin_queue_stats(adapter, &data);
199 }
200 
201 int ena_get_sset_count(struct net_device *netdev, int sset)
202 {
203 	struct ena_adapter *adapter = netdev_priv(netdev);
204 
205 	if (sset != ETH_SS_STATS)
206 		return -EOPNOTSUPP;
207 
208 	return  adapter->num_queues * (ENA_STATS_ARRAY_TX + ENA_STATS_ARRAY_RX)
209 		+ ENA_STATS_ARRAY_GLOBAL + ENA_STATS_ARRAY_ENA_COM;
210 }
211 
212 static void ena_queue_strings(struct ena_adapter *adapter, u8 **data)
213 {
214 	const struct ena_stats *ena_stats;
215 	int i, j;
216 
217 	for (i = 0; i < adapter->num_queues; i++) {
218 		/* Tx stats */
219 		for (j = 0; j < ENA_STATS_ARRAY_TX; j++) {
220 			ena_stats = &ena_stats_tx_strings[j];
221 
222 			snprintf(*data, ETH_GSTRING_LEN,
223 				 "queue_%u_tx_%s", i, ena_stats->name);
224 			 (*data) += ETH_GSTRING_LEN;
225 		}
226 		/* Rx stats */
227 		for (j = 0; j < ENA_STATS_ARRAY_RX; j++) {
228 			ena_stats = &ena_stats_rx_strings[j];
229 
230 			snprintf(*data, ETH_GSTRING_LEN,
231 				 "queue_%u_rx_%s", i, ena_stats->name);
232 			(*data) += ETH_GSTRING_LEN;
233 		}
234 	}
235 }
236 
237 static void ena_com_dev_strings(u8 **data)
238 {
239 	const struct ena_stats *ena_stats;
240 	int i;
241 
242 	for (i = 0; i < ENA_STATS_ARRAY_ENA_COM; i++) {
243 		ena_stats = &ena_stats_ena_com_strings[i];
244 
245 		snprintf(*data, ETH_GSTRING_LEN,
246 			 "ena_admin_q_%s", ena_stats->name);
247 		(*data) += ETH_GSTRING_LEN;
248 	}
249 }
250 
251 static void ena_get_strings(struct net_device *netdev, u32 sset, u8 *data)
252 {
253 	struct ena_adapter *adapter = netdev_priv(netdev);
254 	const struct ena_stats *ena_stats;
255 	int i;
256 
257 	if (sset != ETH_SS_STATS)
258 		return;
259 
260 	for (i = 0; i < ENA_STATS_ARRAY_GLOBAL; i++) {
261 		ena_stats = &ena_stats_global_strings[i];
262 
263 		memcpy(data, ena_stats->name, ETH_GSTRING_LEN);
264 		data += ETH_GSTRING_LEN;
265 	}
266 
267 	ena_queue_strings(adapter, &data);
268 	ena_com_dev_strings(&data);
269 }
270 
271 static int ena_get_link_ksettings(struct net_device *netdev,
272 				  struct ethtool_link_ksettings *link_ksettings)
273 {
274 	struct ena_adapter *adapter = netdev_priv(netdev);
275 	struct ena_com_dev *ena_dev = adapter->ena_dev;
276 	struct ena_admin_get_feature_link_desc *link;
277 	struct ena_admin_get_feat_resp feat_resp;
278 	int rc;
279 
280 	rc = ena_com_get_link_params(ena_dev, &feat_resp);
281 	if (rc)
282 		return rc;
283 
284 	link = &feat_resp.u.link;
285 	link_ksettings->base.speed = link->speed;
286 
287 	if (link->flags & ENA_ADMIN_GET_FEATURE_LINK_DESC_AUTONEG_MASK) {
288 		ethtool_link_ksettings_add_link_mode(link_ksettings,
289 						     supported, Autoneg);
290 		ethtool_link_ksettings_add_link_mode(link_ksettings,
291 						     supported, Autoneg);
292 	}
293 
294 	link_ksettings->base.autoneg =
295 		(link->flags & ENA_ADMIN_GET_FEATURE_LINK_DESC_AUTONEG_MASK) ?
296 		AUTONEG_ENABLE : AUTONEG_DISABLE;
297 
298 	link_ksettings->base.duplex = DUPLEX_FULL;
299 
300 	return 0;
301 }
302 
303 static int ena_get_coalesce(struct net_device *net_dev,
304 			    struct ethtool_coalesce *coalesce)
305 {
306 	struct ena_adapter *adapter = netdev_priv(net_dev);
307 	struct ena_com_dev *ena_dev = adapter->ena_dev;
308 
309 	if (!ena_com_interrupt_moderation_supported(ena_dev)) {
310 		/* the devie doesn't support interrupt moderation */
311 		return -EOPNOTSUPP;
312 	}
313 
314 	coalesce->tx_coalesce_usecs =
315 		ena_com_get_nonadaptive_moderation_interval_tx(ena_dev) *
316 			ena_dev->intr_delay_resolution;
317 
318 	if (!ena_com_get_adaptive_moderation_enabled(ena_dev))
319 		coalesce->rx_coalesce_usecs =
320 			ena_com_get_nonadaptive_moderation_interval_rx(ena_dev)
321 			* ena_dev->intr_delay_resolution;
322 
323 	coalesce->use_adaptive_rx_coalesce =
324 		ena_com_get_adaptive_moderation_enabled(ena_dev);
325 
326 	return 0;
327 }
328 
329 static void ena_update_tx_rings_intr_moderation(struct ena_adapter *adapter)
330 {
331 	unsigned int val;
332 	int i;
333 
334 	val = ena_com_get_nonadaptive_moderation_interval_tx(adapter->ena_dev);
335 
336 	for (i = 0; i < adapter->num_queues; i++)
337 		adapter->tx_ring[i].smoothed_interval = val;
338 }
339 
340 static void ena_update_rx_rings_intr_moderation(struct ena_adapter *adapter)
341 {
342 	unsigned int val;
343 	int i;
344 
345 	val = ena_com_get_nonadaptive_moderation_interval_rx(adapter->ena_dev);
346 
347 	for (i = 0; i < adapter->num_queues; i++)
348 		adapter->rx_ring[i].smoothed_interval = val;
349 }
350 
351 static int ena_set_coalesce(struct net_device *net_dev,
352 			    struct ethtool_coalesce *coalesce)
353 {
354 	struct ena_adapter *adapter = netdev_priv(net_dev);
355 	struct ena_com_dev *ena_dev = adapter->ena_dev;
356 	int rc;
357 
358 	if (!ena_com_interrupt_moderation_supported(ena_dev)) {
359 		/* the devie doesn't support interrupt moderation */
360 		return -EOPNOTSUPP;
361 	}
362 
363 	rc = ena_com_update_nonadaptive_moderation_interval_tx(ena_dev,
364 							       coalesce->tx_coalesce_usecs);
365 	if (rc)
366 		return rc;
367 
368 	ena_update_tx_rings_intr_moderation(adapter);
369 
370 	if (coalesce->use_adaptive_rx_coalesce) {
371 		if (!ena_com_get_adaptive_moderation_enabled(ena_dev))
372 			ena_com_enable_adaptive_moderation(ena_dev);
373 		return 0;
374 	}
375 
376 	rc = ena_com_update_nonadaptive_moderation_interval_rx(ena_dev,
377 							       coalesce->rx_coalesce_usecs);
378 	if (rc)
379 		return rc;
380 
381 	ena_update_rx_rings_intr_moderation(adapter);
382 
383 	if (!coalesce->use_adaptive_rx_coalesce) {
384 		if (ena_com_get_adaptive_moderation_enabled(ena_dev))
385 			ena_com_disable_adaptive_moderation(ena_dev);
386 	}
387 
388 	return 0;
389 }
390 
391 static u32 ena_get_msglevel(struct net_device *netdev)
392 {
393 	struct ena_adapter *adapter = netdev_priv(netdev);
394 
395 	return adapter->msg_enable;
396 }
397 
398 static void ena_set_msglevel(struct net_device *netdev, u32 value)
399 {
400 	struct ena_adapter *adapter = netdev_priv(netdev);
401 
402 	adapter->msg_enable = value;
403 }
404 
405 static void ena_get_drvinfo(struct net_device *dev,
406 			    struct ethtool_drvinfo *info)
407 {
408 	struct ena_adapter *adapter = netdev_priv(dev);
409 
410 	strlcpy(info->driver, DRV_MODULE_NAME, sizeof(info->driver));
411 	strlcpy(info->version, DRV_MODULE_VERSION, sizeof(info->version));
412 	strlcpy(info->bus_info, pci_name(adapter->pdev),
413 		sizeof(info->bus_info));
414 }
415 
416 static void ena_get_ringparam(struct net_device *netdev,
417 			      struct ethtool_ringparam *ring)
418 {
419 	struct ena_adapter *adapter = netdev_priv(netdev);
420 
421 	ring->tx_max_pending = adapter->max_tx_ring_size;
422 	ring->rx_max_pending = adapter->max_rx_ring_size;
423 	ring->tx_pending = adapter->tx_ring[0].ring_size;
424 	ring->rx_pending = adapter->rx_ring[0].ring_size;
425 }
426 
427 static int ena_set_ringparam(struct net_device *netdev,
428 			     struct ethtool_ringparam *ring)
429 {
430 	struct ena_adapter *adapter = netdev_priv(netdev);
431 	u32 new_tx_size, new_rx_size;
432 
433 	new_tx_size = ring->tx_pending < ENA_MIN_RING_SIZE ?
434 			ENA_MIN_RING_SIZE : ring->tx_pending;
435 	new_tx_size = rounddown_pow_of_two(new_tx_size);
436 
437 	new_rx_size = ring->rx_pending < ENA_MIN_RING_SIZE ?
438 			ENA_MIN_RING_SIZE : ring->rx_pending;
439 	new_rx_size = rounddown_pow_of_two(new_rx_size);
440 
441 	if (new_tx_size == adapter->requested_tx_ring_size &&
442 	    new_rx_size == adapter->requested_rx_ring_size)
443 		return 0;
444 
445 	return ena_update_queue_sizes(adapter, new_tx_size, new_rx_size);
446 }
447 
448 static u32 ena_flow_hash_to_flow_type(u16 hash_fields)
449 {
450 	u32 data = 0;
451 
452 	if (hash_fields & ENA_ADMIN_RSS_L2_DA)
453 		data |= RXH_L2DA;
454 
455 	if (hash_fields & ENA_ADMIN_RSS_L3_DA)
456 		data |= RXH_IP_DST;
457 
458 	if (hash_fields & ENA_ADMIN_RSS_L3_SA)
459 		data |= RXH_IP_SRC;
460 
461 	if (hash_fields & ENA_ADMIN_RSS_L4_DP)
462 		data |= RXH_L4_B_2_3;
463 
464 	if (hash_fields & ENA_ADMIN_RSS_L4_SP)
465 		data |= RXH_L4_B_0_1;
466 
467 	return data;
468 }
469 
470 static u16 ena_flow_data_to_flow_hash(u32 hash_fields)
471 {
472 	u16 data = 0;
473 
474 	if (hash_fields & RXH_L2DA)
475 		data |= ENA_ADMIN_RSS_L2_DA;
476 
477 	if (hash_fields & RXH_IP_DST)
478 		data |= ENA_ADMIN_RSS_L3_DA;
479 
480 	if (hash_fields & RXH_IP_SRC)
481 		data |= ENA_ADMIN_RSS_L3_SA;
482 
483 	if (hash_fields & RXH_L4_B_2_3)
484 		data |= ENA_ADMIN_RSS_L4_DP;
485 
486 	if (hash_fields & RXH_L4_B_0_1)
487 		data |= ENA_ADMIN_RSS_L4_SP;
488 
489 	return data;
490 }
491 
492 static int ena_get_rss_hash(struct ena_com_dev *ena_dev,
493 			    struct ethtool_rxnfc *cmd)
494 {
495 	enum ena_admin_flow_hash_proto proto;
496 	u16 hash_fields;
497 	int rc;
498 
499 	cmd->data = 0;
500 
501 	switch (cmd->flow_type) {
502 	case TCP_V4_FLOW:
503 		proto = ENA_ADMIN_RSS_TCP4;
504 		break;
505 	case UDP_V4_FLOW:
506 		proto = ENA_ADMIN_RSS_UDP4;
507 		break;
508 	case TCP_V6_FLOW:
509 		proto = ENA_ADMIN_RSS_TCP6;
510 		break;
511 	case UDP_V6_FLOW:
512 		proto = ENA_ADMIN_RSS_UDP6;
513 		break;
514 	case IPV4_FLOW:
515 		proto = ENA_ADMIN_RSS_IP4;
516 		break;
517 	case IPV6_FLOW:
518 		proto = ENA_ADMIN_RSS_IP6;
519 		break;
520 	case ETHER_FLOW:
521 		proto = ENA_ADMIN_RSS_NOT_IP;
522 		break;
523 	case AH_V4_FLOW:
524 	case ESP_V4_FLOW:
525 	case AH_V6_FLOW:
526 	case ESP_V6_FLOW:
527 	case SCTP_V4_FLOW:
528 	case AH_ESP_V4_FLOW:
529 		return -EOPNOTSUPP;
530 	default:
531 		return -EINVAL;
532 	}
533 
534 	rc = ena_com_get_hash_ctrl(ena_dev, proto, &hash_fields);
535 	if (rc)
536 		return rc;
537 
538 	cmd->data = ena_flow_hash_to_flow_type(hash_fields);
539 
540 	return 0;
541 }
542 
543 static int ena_set_rss_hash(struct ena_com_dev *ena_dev,
544 			    struct ethtool_rxnfc *cmd)
545 {
546 	enum ena_admin_flow_hash_proto proto;
547 	u16 hash_fields;
548 
549 	switch (cmd->flow_type) {
550 	case TCP_V4_FLOW:
551 		proto = ENA_ADMIN_RSS_TCP4;
552 		break;
553 	case UDP_V4_FLOW:
554 		proto = ENA_ADMIN_RSS_UDP4;
555 		break;
556 	case TCP_V6_FLOW:
557 		proto = ENA_ADMIN_RSS_TCP6;
558 		break;
559 	case UDP_V6_FLOW:
560 		proto = ENA_ADMIN_RSS_UDP6;
561 		break;
562 	case IPV4_FLOW:
563 		proto = ENA_ADMIN_RSS_IP4;
564 		break;
565 	case IPV6_FLOW:
566 		proto = ENA_ADMIN_RSS_IP6;
567 		break;
568 	case ETHER_FLOW:
569 		proto = ENA_ADMIN_RSS_NOT_IP;
570 		break;
571 	case AH_V4_FLOW:
572 	case ESP_V4_FLOW:
573 	case AH_V6_FLOW:
574 	case ESP_V6_FLOW:
575 	case SCTP_V4_FLOW:
576 	case AH_ESP_V4_FLOW:
577 		return -EOPNOTSUPP;
578 	default:
579 		return -EINVAL;
580 	}
581 
582 	hash_fields = ena_flow_data_to_flow_hash(cmd->data);
583 
584 	return ena_com_fill_hash_ctrl(ena_dev, proto, hash_fields);
585 }
586 
587 static int ena_set_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *info)
588 {
589 	struct ena_adapter *adapter = netdev_priv(netdev);
590 	int rc = 0;
591 
592 	switch (info->cmd) {
593 	case ETHTOOL_SRXFH:
594 		rc = ena_set_rss_hash(adapter->ena_dev, info);
595 		break;
596 	case ETHTOOL_SRXCLSRLDEL:
597 	case ETHTOOL_SRXCLSRLINS:
598 	default:
599 		netif_err(adapter, drv, netdev,
600 			  "Command parameter %d is not supported\n", info->cmd);
601 		rc = -EOPNOTSUPP;
602 	}
603 
604 	return rc;
605 }
606 
607 static int ena_get_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *info,
608 			 u32 *rules)
609 {
610 	struct ena_adapter *adapter = netdev_priv(netdev);
611 	int rc = 0;
612 
613 	switch (info->cmd) {
614 	case ETHTOOL_GRXRINGS:
615 		info->data = adapter->num_queues;
616 		rc = 0;
617 		break;
618 	case ETHTOOL_GRXFH:
619 		rc = ena_get_rss_hash(adapter->ena_dev, info);
620 		break;
621 	case ETHTOOL_GRXCLSRLCNT:
622 	case ETHTOOL_GRXCLSRULE:
623 	case ETHTOOL_GRXCLSRLALL:
624 	default:
625 		netif_err(adapter, drv, netdev,
626 			  "Command parameter %d is not supported\n", info->cmd);
627 		rc = -EOPNOTSUPP;
628 	}
629 
630 	return rc;
631 }
632 
633 static u32 ena_get_rxfh_indir_size(struct net_device *netdev)
634 {
635 	return ENA_RX_RSS_TABLE_SIZE;
636 }
637 
638 static u32 ena_get_rxfh_key_size(struct net_device *netdev)
639 {
640 	return ENA_HASH_KEY_SIZE;
641 }
642 
643 static int ena_get_rxfh(struct net_device *netdev, u32 *indir, u8 *key,
644 			u8 *hfunc)
645 {
646 	struct ena_adapter *adapter = netdev_priv(netdev);
647 	enum ena_admin_hash_functions ena_func;
648 	u8 func;
649 	int rc;
650 
651 	rc = ena_com_indirect_table_get(adapter->ena_dev, indir);
652 	if (rc)
653 		return rc;
654 
655 	rc = ena_com_get_hash_function(adapter->ena_dev, &ena_func, key);
656 	if (rc)
657 		return rc;
658 
659 	switch (ena_func) {
660 	case ENA_ADMIN_TOEPLITZ:
661 		func = ETH_RSS_HASH_TOP;
662 		break;
663 	case ENA_ADMIN_CRC32:
664 		func = ETH_RSS_HASH_XOR;
665 		break;
666 	default:
667 		netif_err(adapter, drv, netdev,
668 			  "Command parameter is not supported\n");
669 		return -EOPNOTSUPP;
670 	}
671 
672 	if (hfunc)
673 		*hfunc = func;
674 
675 	return rc;
676 }
677 
678 static int ena_set_rxfh(struct net_device *netdev, const u32 *indir,
679 			const u8 *key, const u8 hfunc)
680 {
681 	struct ena_adapter *adapter = netdev_priv(netdev);
682 	struct ena_com_dev *ena_dev = adapter->ena_dev;
683 	enum ena_admin_hash_functions func;
684 	int rc, i;
685 
686 	if (indir) {
687 		for (i = 0; i < ENA_RX_RSS_TABLE_SIZE; i++) {
688 			rc = ena_com_indirect_table_fill_entry(ena_dev,
689 							       i,
690 							       ENA_IO_RXQ_IDX(indir[i]));
691 			if (unlikely(rc)) {
692 				netif_err(adapter, drv, netdev,
693 					  "Cannot fill indirect table (index is too large)\n");
694 				return rc;
695 			}
696 		}
697 
698 		rc = ena_com_indirect_table_set(ena_dev);
699 		if (rc) {
700 			netif_err(adapter, drv, netdev,
701 				  "Cannot set indirect table\n");
702 			return rc == -EPERM ? -EOPNOTSUPP : rc;
703 		}
704 	}
705 
706 	switch (hfunc) {
707 	case ETH_RSS_HASH_TOP:
708 		func = ENA_ADMIN_TOEPLITZ;
709 		break;
710 	case ETH_RSS_HASH_XOR:
711 		func = ENA_ADMIN_CRC32;
712 		break;
713 	default:
714 		netif_err(adapter, drv, netdev, "Unsupported hfunc %d\n",
715 			  hfunc);
716 		return -EOPNOTSUPP;
717 	}
718 
719 	if (key) {
720 		rc = ena_com_fill_hash_function(ena_dev, func, key,
721 						ENA_HASH_KEY_SIZE,
722 						0xFFFFFFFF);
723 		if (unlikely(rc)) {
724 			netif_err(adapter, drv, netdev, "Cannot fill key\n");
725 			return rc == -EPERM ? -EOPNOTSUPP : rc;
726 		}
727 	}
728 
729 	return 0;
730 }
731 
732 static void ena_get_channels(struct net_device *netdev,
733 			     struct ethtool_channels *channels)
734 {
735 	struct ena_adapter *adapter = netdev_priv(netdev);
736 
737 	channels->max_rx = adapter->num_queues;
738 	channels->max_tx = adapter->num_queues;
739 	channels->max_other = 0;
740 	channels->max_combined = 0;
741 	channels->rx_count = adapter->num_queues;
742 	channels->tx_count = adapter->num_queues;
743 	channels->other_count = 0;
744 	channels->combined_count = 0;
745 }
746 
747 static int ena_get_tunable(struct net_device *netdev,
748 			   const struct ethtool_tunable *tuna, void *data)
749 {
750 	struct ena_adapter *adapter = netdev_priv(netdev);
751 	int ret = 0;
752 
753 	switch (tuna->id) {
754 	case ETHTOOL_RX_COPYBREAK:
755 		*(u32 *)data = adapter->rx_copybreak;
756 		break;
757 	default:
758 		ret = -EINVAL;
759 		break;
760 	}
761 
762 	return ret;
763 }
764 
765 static int ena_set_tunable(struct net_device *netdev,
766 			   const struct ethtool_tunable *tuna,
767 			   const void *data)
768 {
769 	struct ena_adapter *adapter = netdev_priv(netdev);
770 	int ret = 0;
771 	u32 len;
772 
773 	switch (tuna->id) {
774 	case ETHTOOL_RX_COPYBREAK:
775 		len = *(u32 *)data;
776 		if (len > adapter->netdev->mtu) {
777 			ret = -EINVAL;
778 			break;
779 		}
780 		adapter->rx_copybreak = len;
781 		break;
782 	default:
783 		ret = -EINVAL;
784 		break;
785 	}
786 
787 	return ret;
788 }
789 
790 static const struct ethtool_ops ena_ethtool_ops = {
791 	.get_link_ksettings	= ena_get_link_ksettings,
792 	.get_drvinfo		= ena_get_drvinfo,
793 	.get_msglevel		= ena_get_msglevel,
794 	.set_msglevel		= ena_set_msglevel,
795 	.get_link		= ethtool_op_get_link,
796 	.get_coalesce		= ena_get_coalesce,
797 	.set_coalesce		= ena_set_coalesce,
798 	.get_ringparam		= ena_get_ringparam,
799 	.set_ringparam		= ena_set_ringparam,
800 	.get_sset_count         = ena_get_sset_count,
801 	.get_strings		= ena_get_strings,
802 	.get_ethtool_stats      = ena_get_ethtool_stats,
803 	.get_rxnfc		= ena_get_rxnfc,
804 	.set_rxnfc		= ena_set_rxnfc,
805 	.get_rxfh_indir_size    = ena_get_rxfh_indir_size,
806 	.get_rxfh_key_size	= ena_get_rxfh_key_size,
807 	.get_rxfh		= ena_get_rxfh,
808 	.set_rxfh		= ena_set_rxfh,
809 	.get_channels		= ena_get_channels,
810 	.get_tunable		= ena_get_tunable,
811 	.set_tunable		= ena_set_tunable,
812 };
813 
814 void ena_set_ethtool_ops(struct net_device *netdev)
815 {
816 	netdev->ethtool_ops = &ena_ethtool_ops;
817 }
818 
819 static void ena_dump_stats_ex(struct ena_adapter *adapter, u8 *buf)
820 {
821 	struct net_device *netdev = adapter->netdev;
822 	u8 *strings_buf;
823 	u64 *data_buf;
824 	int strings_num;
825 	int i, rc;
826 
827 	strings_num = ena_get_sset_count(netdev, ETH_SS_STATS);
828 	if (strings_num <= 0) {
829 		netif_err(adapter, drv, netdev, "Can't get stats num\n");
830 		return;
831 	}
832 
833 	strings_buf = devm_kcalloc(&adapter->pdev->dev,
834 				   ETH_GSTRING_LEN, strings_num,
835 				   GFP_ATOMIC);
836 	if (!strings_buf) {
837 		netif_err(adapter, drv, netdev,
838 			  "failed to alloc strings_buf\n");
839 		return;
840 	}
841 
842 	data_buf = devm_kcalloc(&adapter->pdev->dev,
843 				strings_num, sizeof(u64),
844 				GFP_ATOMIC);
845 	if (!data_buf) {
846 		netif_err(adapter, drv, netdev,
847 			  "failed to allocate data buf\n");
848 		devm_kfree(&adapter->pdev->dev, strings_buf);
849 		return;
850 	}
851 
852 	ena_get_strings(netdev, ETH_SS_STATS, strings_buf);
853 	ena_get_ethtool_stats(netdev, NULL, data_buf);
854 
855 	/* If there is a buffer, dump stats, otherwise print them to dmesg */
856 	if (buf)
857 		for (i = 0; i < strings_num; i++) {
858 			rc = snprintf(buf, ETH_GSTRING_LEN + sizeof(u64),
859 				      "%s %llu\n",
860 				      strings_buf + i * ETH_GSTRING_LEN,
861 				      data_buf[i]);
862 			buf += rc;
863 		}
864 	else
865 		for (i = 0; i < strings_num; i++)
866 			netif_err(adapter, drv, netdev, "%s: %llu\n",
867 				  strings_buf + i * ETH_GSTRING_LEN,
868 				  data_buf[i]);
869 
870 	devm_kfree(&adapter->pdev->dev, strings_buf);
871 	devm_kfree(&adapter->pdev->dev, data_buf);
872 }
873 
874 void ena_dump_stats_to_buf(struct ena_adapter *adapter, u8 *buf)
875 {
876 	if (!buf)
877 		return;
878 
879 	ena_dump_stats_ex(adapter, buf);
880 }
881 
882 void ena_dump_stats_to_dmesg(struct ena_adapter *adapter)
883 {
884 	ena_dump_stats_ex(adapter, NULL);
885 }
886