1 // SPDX-License-Identifier: (GPL-2.0 OR MIT)
2 /* Google virtual Ethernet (gve) driver
3  *
4  * Copyright (C) 2015-2024 Google LLC
5  */
6 
7 #include <linux/rtnetlink.h>
8 #include "gve.h"
9 #include "gve_adminq.h"
10 #include "gve_dqo.h"
11 #include "gve_utils.h"
12 
gve_get_drvinfo(struct net_device * netdev,struct ethtool_drvinfo * info)13 static void gve_get_drvinfo(struct net_device *netdev,
14 			    struct ethtool_drvinfo *info)
15 {
16 	struct gve_priv *priv = netdev_priv(netdev);
17 
18 	strscpy(info->driver, gve_driver_name, sizeof(info->driver));
19 	strscpy(info->version, gve_version_str, sizeof(info->version));
20 	strscpy(info->bus_info, pci_name(priv->pdev), sizeof(info->bus_info));
21 }
22 
gve_set_msglevel(struct net_device * netdev,u32 value)23 static void gve_set_msglevel(struct net_device *netdev, u32 value)
24 {
25 	struct gve_priv *priv = netdev_priv(netdev);
26 
27 	priv->msg_enable = value;
28 }
29 
gve_get_msglevel(struct net_device * netdev)30 static u32 gve_get_msglevel(struct net_device *netdev)
31 {
32 	struct gve_priv *priv = netdev_priv(netdev);
33 
34 	return priv->msg_enable;
35 }
36 
37 /* For the following stats column string names, make sure the order
38  * matches how it is filled in the code. For xdp_aborted, xdp_drop,
39  * xdp_pass, xdp_tx, xdp_redirect, make sure it also matches the order
40  * as declared in enum xdp_action inside file uapi/linux/bpf.h .
41  */
42 static const char gve_gstrings_main_stats[][ETH_GSTRING_LEN] = {
43 	"rx_packets", "rx_hsplit_pkt", "tx_packets", "rx_bytes",
44 	"tx_bytes", "rx_dropped", "tx_dropped", "tx_timeouts",
45 	"rx_skb_alloc_fail", "rx_buf_alloc_fail", "rx_desc_err_dropped_pkt",
46 	"rx_hsplit_unsplit_pkt",
47 	"interface_up_cnt", "interface_down_cnt", "reset_cnt",
48 	"page_alloc_fail", "dma_mapping_error", "stats_report_trigger_cnt",
49 };
50 
51 static const char gve_gstrings_rx_stats[][ETH_GSTRING_LEN] = {
52 	"rx_posted_desc[%u]", "rx_completed_desc[%u]", "rx_consumed_desc[%u]",
53 	"rx_bytes[%u]", "rx_hsplit_bytes[%u]", "rx_cont_packet_cnt[%u]",
54 	"rx_frag_flip_cnt[%u]", "rx_frag_copy_cnt[%u]", "rx_frag_alloc_cnt[%u]",
55 	"rx_dropped_pkt[%u]", "rx_copybreak_pkt[%u]", "rx_copied_pkt[%u]",
56 	"rx_queue_drop_cnt[%u]", "rx_no_buffers_posted[%u]",
57 	"rx_drops_packet_over_mru[%u]", "rx_drops_invalid_checksum[%u]",
58 	"rx_xdp_aborted[%u]", "rx_xdp_drop[%u]", "rx_xdp_pass[%u]",
59 	"rx_xdp_tx[%u]", "rx_xdp_redirect[%u]",
60 	"rx_xdp_tx_errors[%u]", "rx_xdp_redirect_errors[%u]", "rx_xdp_alloc_fails[%u]",
61 };
62 
63 static const char gve_gstrings_tx_stats[][ETH_GSTRING_LEN] = {
64 	"tx_posted_desc[%u]", "tx_completed_desc[%u]", "tx_consumed_desc[%u]", "tx_bytes[%u]",
65 	"tx_wake[%u]", "tx_stop[%u]", "tx_event_counter[%u]",
66 	"tx_dma_mapping_error[%u]", "tx_xsk_wakeup[%u]",
67 	"tx_xsk_done[%u]", "tx_xsk_sent[%u]", "tx_xdp_xmit[%u]", "tx_xdp_xmit_errors[%u]"
68 };
69 
70 static const char gve_gstrings_adminq_stats[][ETH_GSTRING_LEN] = {
71 	"adminq_prod_cnt", "adminq_cmd_fail", "adminq_timeouts",
72 	"adminq_describe_device_cnt", "adminq_cfg_device_resources_cnt",
73 	"adminq_register_page_list_cnt", "adminq_unregister_page_list_cnt",
74 	"adminq_create_tx_queue_cnt", "adminq_create_rx_queue_cnt",
75 	"adminq_destroy_tx_queue_cnt", "adminq_destroy_rx_queue_cnt",
76 	"adminq_dcfg_device_resources_cnt", "adminq_set_driver_parameter_cnt",
77 	"adminq_report_stats_cnt", "adminq_report_link_speed_cnt", "adminq_get_ptype_map_cnt",
78 	"adminq_query_flow_rules", "adminq_cfg_flow_rule", "adminq_cfg_rss_cnt",
79 	"adminq_query_rss_cnt",
80 };
81 
82 static const char gve_gstrings_priv_flags[][ETH_GSTRING_LEN] = {
83 	"report-stats",
84 };
85 
86 #define GVE_MAIN_STATS_LEN  ARRAY_SIZE(gve_gstrings_main_stats)
87 #define GVE_ADMINQ_STATS_LEN  ARRAY_SIZE(gve_gstrings_adminq_stats)
88 #define NUM_GVE_TX_CNTS	ARRAY_SIZE(gve_gstrings_tx_stats)
89 #define NUM_GVE_RX_CNTS	ARRAY_SIZE(gve_gstrings_rx_stats)
90 #define GVE_PRIV_FLAGS_STR_LEN ARRAY_SIZE(gve_gstrings_priv_flags)
91 
gve_get_strings(struct net_device * netdev,u32 stringset,u8 * data)92 static void gve_get_strings(struct net_device *netdev, u32 stringset, u8 *data)
93 {
94 	struct gve_priv *priv = netdev_priv(netdev);
95 	u8 *s = (char *)data;
96 	int num_tx_queues;
97 	int i, j;
98 
99 	num_tx_queues = gve_num_tx_queues(priv);
100 	switch (stringset) {
101 	case ETH_SS_STATS:
102 		for (i = 0; i < ARRAY_SIZE(gve_gstrings_main_stats); i++)
103 			ethtool_puts(&s, gve_gstrings_main_stats[i]);
104 
105 		for (i = 0; i < priv->rx_cfg.num_queues; i++)
106 			for (j = 0; j < NUM_GVE_RX_CNTS; j++)
107 				ethtool_sprintf(&s, gve_gstrings_rx_stats[j],
108 						i);
109 
110 		for (i = 0; i < num_tx_queues; i++)
111 			for (j = 0; j < NUM_GVE_TX_CNTS; j++)
112 				ethtool_sprintf(&s, gve_gstrings_tx_stats[j],
113 						i);
114 
115 		for (i = 0; i < ARRAY_SIZE(gve_gstrings_adminq_stats); i++)
116 			ethtool_puts(&s, gve_gstrings_adminq_stats[i]);
117 
118 		break;
119 
120 	case ETH_SS_PRIV_FLAGS:
121 		for (i = 0; i < ARRAY_SIZE(gve_gstrings_priv_flags); i++)
122 			ethtool_puts(&s, gve_gstrings_priv_flags[i]);
123 		break;
124 
125 	default:
126 		break;
127 	}
128 }
129 
gve_get_sset_count(struct net_device * netdev,int sset)130 static int gve_get_sset_count(struct net_device *netdev, int sset)
131 {
132 	struct gve_priv *priv = netdev_priv(netdev);
133 	int num_tx_queues;
134 
135 	num_tx_queues = gve_num_tx_queues(priv);
136 	switch (sset) {
137 	case ETH_SS_STATS:
138 		return GVE_MAIN_STATS_LEN + GVE_ADMINQ_STATS_LEN +
139 		       (priv->rx_cfg.num_queues * NUM_GVE_RX_CNTS) +
140 		       (num_tx_queues * NUM_GVE_TX_CNTS);
141 	case ETH_SS_PRIV_FLAGS:
142 		return GVE_PRIV_FLAGS_STR_LEN;
143 	default:
144 		return -EOPNOTSUPP;
145 	}
146 }
147 
148 static void
gve_get_ethtool_stats(struct net_device * netdev,struct ethtool_stats * stats,u64 * data)149 gve_get_ethtool_stats(struct net_device *netdev,
150 		      struct ethtool_stats *stats, u64 *data)
151 {
152 	u64 tmp_rx_pkts, tmp_rx_hsplit_pkt, tmp_rx_bytes, tmp_rx_hsplit_bytes,
153 		tmp_rx_skb_alloc_fail, tmp_rx_buf_alloc_fail,
154 		tmp_rx_desc_err_dropped_pkt, tmp_rx_hsplit_unsplit_pkt,
155 		tmp_tx_pkts, tmp_tx_bytes;
156 	u64 rx_buf_alloc_fail, rx_desc_err_dropped_pkt, rx_hsplit_unsplit_pkt,
157 		rx_pkts, rx_hsplit_pkt, rx_skb_alloc_fail, rx_bytes, tx_pkts, tx_bytes,
158 		tx_dropped;
159 	int stats_idx, base_stats_idx, max_stats_idx;
160 	struct stats *report_stats;
161 	int *rx_qid_to_stats_idx;
162 	int *tx_qid_to_stats_idx;
163 	int num_stopped_rxqs = 0;
164 	int num_stopped_txqs = 0;
165 	struct gve_priv *priv;
166 	bool skip_nic_stats;
167 	unsigned int start;
168 	int num_tx_queues;
169 	int ring;
170 	int i, j;
171 
172 	ASSERT_RTNL();
173 
174 	priv = netdev_priv(netdev);
175 	num_tx_queues = gve_num_tx_queues(priv);
176 	report_stats = priv->stats_report->stats;
177 	rx_qid_to_stats_idx = kmalloc_array(priv->rx_cfg.num_queues,
178 					    sizeof(int), GFP_KERNEL);
179 	if (!rx_qid_to_stats_idx)
180 		return;
181 	for (ring = 0; ring < priv->rx_cfg.num_queues; ring++) {
182 		rx_qid_to_stats_idx[ring] = -1;
183 		if (!gve_rx_was_added_to_block(priv, ring))
184 			num_stopped_rxqs++;
185 	}
186 	tx_qid_to_stats_idx = kmalloc_array(num_tx_queues,
187 					    sizeof(int), GFP_KERNEL);
188 	if (!tx_qid_to_stats_idx) {
189 		kfree(rx_qid_to_stats_idx);
190 		return;
191 	}
192 	for (ring = 0; ring < num_tx_queues; ring++) {
193 		tx_qid_to_stats_idx[ring] = -1;
194 		if (!gve_tx_was_added_to_block(priv, ring))
195 			num_stopped_txqs++;
196 	}
197 
198 	for (rx_pkts = 0, rx_bytes = 0, rx_hsplit_pkt = 0,
199 	     rx_skb_alloc_fail = 0, rx_buf_alloc_fail = 0,
200 	     rx_desc_err_dropped_pkt = 0, rx_hsplit_unsplit_pkt = 0,
201 	     ring = 0;
202 	     ring < priv->rx_cfg.num_queues; ring++) {
203 		if (priv->rx) {
204 			do {
205 				struct gve_rx_ring *rx = &priv->rx[ring];
206 
207 				start =
208 				  u64_stats_fetch_begin(&priv->rx[ring].statss);
209 				tmp_rx_pkts = rx->rpackets;
210 				tmp_rx_hsplit_pkt = rx->rx_hsplit_pkt;
211 				tmp_rx_bytes = rx->rbytes;
212 				tmp_rx_skb_alloc_fail = rx->rx_skb_alloc_fail;
213 				tmp_rx_buf_alloc_fail = rx->rx_buf_alloc_fail;
214 				tmp_rx_desc_err_dropped_pkt =
215 					rx->rx_desc_err_dropped_pkt;
216 				tmp_rx_hsplit_unsplit_pkt =
217 					rx->rx_hsplit_unsplit_pkt;
218 			} while (u64_stats_fetch_retry(&priv->rx[ring].statss,
219 						       start));
220 			rx_pkts += tmp_rx_pkts;
221 			rx_hsplit_pkt += tmp_rx_hsplit_pkt;
222 			rx_bytes += tmp_rx_bytes;
223 			rx_skb_alloc_fail += tmp_rx_skb_alloc_fail;
224 			rx_buf_alloc_fail += tmp_rx_buf_alloc_fail;
225 			rx_desc_err_dropped_pkt += tmp_rx_desc_err_dropped_pkt;
226 			rx_hsplit_unsplit_pkt += tmp_rx_hsplit_unsplit_pkt;
227 		}
228 	}
229 	for (tx_pkts = 0, tx_bytes = 0, tx_dropped = 0, ring = 0;
230 	     ring < num_tx_queues; ring++) {
231 		if (priv->tx) {
232 			do {
233 				start =
234 				  u64_stats_fetch_begin(&priv->tx[ring].statss);
235 				tmp_tx_pkts = priv->tx[ring].pkt_done;
236 				tmp_tx_bytes = priv->tx[ring].bytes_done;
237 			} while (u64_stats_fetch_retry(&priv->tx[ring].statss,
238 						       start));
239 			tx_pkts += tmp_tx_pkts;
240 			tx_bytes += tmp_tx_bytes;
241 			tx_dropped += priv->tx[ring].dropped_pkt;
242 		}
243 	}
244 
245 	i = 0;
246 	data[i++] = rx_pkts;
247 	data[i++] = rx_hsplit_pkt;
248 	data[i++] = tx_pkts;
249 	data[i++] = rx_bytes;
250 	data[i++] = tx_bytes;
251 	/* total rx dropped packets */
252 	data[i++] = rx_skb_alloc_fail + rx_buf_alloc_fail +
253 		    rx_desc_err_dropped_pkt;
254 	data[i++] = tx_dropped;
255 	data[i++] = priv->tx_timeo_cnt;
256 	data[i++] = rx_skb_alloc_fail;
257 	data[i++] = rx_buf_alloc_fail;
258 	data[i++] = rx_desc_err_dropped_pkt;
259 	data[i++] = rx_hsplit_unsplit_pkt;
260 	data[i++] = priv->interface_up_cnt;
261 	data[i++] = priv->interface_down_cnt;
262 	data[i++] = priv->reset_cnt;
263 	data[i++] = priv->page_alloc_fail;
264 	data[i++] = priv->dma_mapping_error;
265 	data[i++] = priv->stats_report_trigger_cnt;
266 	i = GVE_MAIN_STATS_LEN;
267 
268 	/* For rx cross-reporting stats, start from nic rx stats in report */
269 	base_stats_idx = GVE_TX_STATS_REPORT_NUM * num_tx_queues +
270 		GVE_RX_STATS_REPORT_NUM * priv->rx_cfg.num_queues;
271 	/* The boundary between driver stats and NIC stats shifts if there are
272 	 * stopped queues.
273 	 */
274 	base_stats_idx += NIC_RX_STATS_REPORT_NUM * num_stopped_rxqs +
275 		NIC_TX_STATS_REPORT_NUM * num_stopped_txqs;
276 	max_stats_idx = NIC_RX_STATS_REPORT_NUM *
277 		(priv->rx_cfg.num_queues - num_stopped_rxqs) +
278 		base_stats_idx;
279 	/* Preprocess the stats report for rx, map queue id to start index */
280 	skip_nic_stats = false;
281 	for (stats_idx = base_stats_idx; stats_idx < max_stats_idx;
282 		stats_idx += NIC_RX_STATS_REPORT_NUM) {
283 		u32 stat_name = be32_to_cpu(report_stats[stats_idx].stat_name);
284 		u32 queue_id = be32_to_cpu(report_stats[stats_idx].queue_id);
285 
286 		if (stat_name == 0) {
287 			/* no stats written by NIC yet */
288 			skip_nic_stats = true;
289 			break;
290 		}
291 		if (queue_id < 0 || queue_id >= priv->rx_cfg.num_queues) {
292 			net_err_ratelimited("Invalid rxq id in NIC stats\n");
293 			continue;
294 		}
295 		rx_qid_to_stats_idx[queue_id] = stats_idx;
296 	}
297 	/* walk RX rings */
298 	if (priv->rx) {
299 		for (ring = 0; ring < priv->rx_cfg.num_queues; ring++) {
300 			struct gve_rx_ring *rx = &priv->rx[ring];
301 
302 			data[i++] = rx->fill_cnt;
303 			data[i++] = rx->cnt;
304 			data[i++] = rx->fill_cnt - rx->cnt;
305 			do {
306 				start =
307 				  u64_stats_fetch_begin(&priv->rx[ring].statss);
308 				tmp_rx_bytes = rx->rbytes;
309 				tmp_rx_hsplit_bytes = rx->rx_hsplit_bytes;
310 				tmp_rx_skb_alloc_fail = rx->rx_skb_alloc_fail;
311 				tmp_rx_buf_alloc_fail = rx->rx_buf_alloc_fail;
312 				tmp_rx_desc_err_dropped_pkt =
313 					rx->rx_desc_err_dropped_pkt;
314 			} while (u64_stats_fetch_retry(&priv->rx[ring].statss,
315 						       start));
316 			data[i++] = tmp_rx_bytes;
317 			data[i++] = tmp_rx_hsplit_bytes;
318 			data[i++] = rx->rx_cont_packet_cnt;
319 			data[i++] = rx->rx_frag_flip_cnt;
320 			data[i++] = rx->rx_frag_copy_cnt;
321 			data[i++] = rx->rx_frag_alloc_cnt;
322 			/* rx dropped packets */
323 			data[i++] = tmp_rx_skb_alloc_fail +
324 				tmp_rx_buf_alloc_fail +
325 				tmp_rx_desc_err_dropped_pkt;
326 			data[i++] = rx->rx_copybreak_pkt;
327 			data[i++] = rx->rx_copied_pkt;
328 			/* stats from NIC */
329 			stats_idx = rx_qid_to_stats_idx[ring];
330 			if (skip_nic_stats || stats_idx < 0) {
331 				/* skip NIC rx stats */
332 				i += NIC_RX_STATS_REPORT_NUM;
333 			} else {
334 				for (j = 0; j < NIC_RX_STATS_REPORT_NUM; j++) {
335 					u64 value =
336 						be64_to_cpu(report_stats[stats_idx + j].value);
337 
338 					data[i++] = value;
339 				}
340 			}
341 			/* XDP rx counters */
342 			do {
343 				start =	u64_stats_fetch_begin(&priv->rx[ring].statss);
344 				for (j = 0; j < GVE_XDP_ACTIONS; j++)
345 					data[i + j] = rx->xdp_actions[j];
346 				data[i + j++] = rx->xdp_tx_errors;
347 				data[i + j++] = rx->xdp_redirect_errors;
348 				data[i + j++] = rx->xdp_alloc_fails;
349 			} while (u64_stats_fetch_retry(&priv->rx[ring].statss,
350 						       start));
351 			i += GVE_XDP_ACTIONS + 3; /* XDP rx counters */
352 		}
353 	} else {
354 		i += priv->rx_cfg.num_queues * NUM_GVE_RX_CNTS;
355 	}
356 
357 	/* For tx cross-reporting stats, start from nic tx stats in report */
358 	base_stats_idx = max_stats_idx;
359 	max_stats_idx = NIC_TX_STATS_REPORT_NUM *
360 		(num_tx_queues - num_stopped_txqs) +
361 		max_stats_idx;
362 	/* Preprocess the stats report for tx, map queue id to start index */
363 	skip_nic_stats = false;
364 	for (stats_idx = base_stats_idx; stats_idx < max_stats_idx;
365 		stats_idx += NIC_TX_STATS_REPORT_NUM) {
366 		u32 stat_name = be32_to_cpu(report_stats[stats_idx].stat_name);
367 		u32 queue_id = be32_to_cpu(report_stats[stats_idx].queue_id);
368 
369 		if (stat_name == 0) {
370 			/* no stats written by NIC yet */
371 			skip_nic_stats = true;
372 			break;
373 		}
374 		if (queue_id < 0 || queue_id >= num_tx_queues) {
375 			net_err_ratelimited("Invalid txq id in NIC stats\n");
376 			continue;
377 		}
378 		tx_qid_to_stats_idx[queue_id] = stats_idx;
379 	}
380 	/* walk TX rings */
381 	if (priv->tx) {
382 		for (ring = 0; ring < num_tx_queues; ring++) {
383 			struct gve_tx_ring *tx = &priv->tx[ring];
384 
385 			if (gve_is_gqi(priv)) {
386 				data[i++] = tx->req;
387 				data[i++] = tx->done;
388 				data[i++] = tx->req - tx->done;
389 			} else {
390 				/* DQO doesn't currently support
391 				 * posted/completed descriptor counts;
392 				 */
393 				data[i++] = 0;
394 				data[i++] = 0;
395 				data[i++] =
396 					(tx->dqo_tx.tail - tx->dqo_tx.head) &
397 					tx->mask;
398 			}
399 			do {
400 				start =
401 				  u64_stats_fetch_begin(&priv->tx[ring].statss);
402 				tmp_tx_bytes = tx->bytes_done;
403 			} while (u64_stats_fetch_retry(&priv->tx[ring].statss,
404 						       start));
405 			data[i++] = tmp_tx_bytes;
406 			data[i++] = tx->wake_queue;
407 			data[i++] = tx->stop_queue;
408 			data[i++] = gve_tx_load_event_counter(priv, tx);
409 			data[i++] = tx->dma_mapping_error;
410 			/* stats from NIC */
411 			stats_idx = tx_qid_to_stats_idx[ring];
412 			if (skip_nic_stats || stats_idx < 0) {
413 				/* skip NIC tx stats */
414 				i += NIC_TX_STATS_REPORT_NUM;
415 			} else {
416 				for (j = 0; j < NIC_TX_STATS_REPORT_NUM; j++) {
417 					u64 value =
418 						be64_to_cpu(report_stats[stats_idx + j].value);
419 					data[i++] = value;
420 				}
421 			}
422 			/* XDP xsk counters */
423 			data[i++] = tx->xdp_xsk_wakeup;
424 			data[i++] = tx->xdp_xsk_done;
425 			do {
426 				start = u64_stats_fetch_begin(&priv->tx[ring].statss);
427 				data[i] = tx->xdp_xsk_sent;
428 				data[i + 1] = tx->xdp_xmit;
429 				data[i + 2] = tx->xdp_xmit_errors;
430 			} while (u64_stats_fetch_retry(&priv->tx[ring].statss,
431 						       start));
432 			i += 3; /* XDP tx counters */
433 		}
434 	} else {
435 		i += num_tx_queues * NUM_GVE_TX_CNTS;
436 	}
437 
438 	kfree(rx_qid_to_stats_idx);
439 	kfree(tx_qid_to_stats_idx);
440 	/* AQ Stats */
441 	data[i++] = priv->adminq_prod_cnt;
442 	data[i++] = priv->adminq_cmd_fail;
443 	data[i++] = priv->adminq_timeouts;
444 	data[i++] = priv->adminq_describe_device_cnt;
445 	data[i++] = priv->adminq_cfg_device_resources_cnt;
446 	data[i++] = priv->adminq_register_page_list_cnt;
447 	data[i++] = priv->adminq_unregister_page_list_cnt;
448 	data[i++] = priv->adminq_create_tx_queue_cnt;
449 	data[i++] = priv->adminq_create_rx_queue_cnt;
450 	data[i++] = priv->adminq_destroy_tx_queue_cnt;
451 	data[i++] = priv->adminq_destroy_rx_queue_cnt;
452 	data[i++] = priv->adminq_dcfg_device_resources_cnt;
453 	data[i++] = priv->adminq_set_driver_parameter_cnt;
454 	data[i++] = priv->adminq_report_stats_cnt;
455 	data[i++] = priv->adminq_report_link_speed_cnt;
456 	data[i++] = priv->adminq_get_ptype_map_cnt;
457 	data[i++] = priv->adminq_query_flow_rules_cnt;
458 	data[i++] = priv->adminq_cfg_flow_rule_cnt;
459 	data[i++] = priv->adminq_cfg_rss_cnt;
460 	data[i++] = priv->adminq_query_rss_cnt;
461 }
462 
gve_get_channels(struct net_device * netdev,struct ethtool_channels * cmd)463 static void gve_get_channels(struct net_device *netdev,
464 			     struct ethtool_channels *cmd)
465 {
466 	struct gve_priv *priv = netdev_priv(netdev);
467 
468 	cmd->max_rx = priv->rx_cfg.max_queues;
469 	cmd->max_tx = priv->tx_cfg.max_queues;
470 	cmd->max_other = 0;
471 	cmd->max_combined = 0;
472 	cmd->rx_count = priv->rx_cfg.num_queues;
473 	cmd->tx_count = priv->tx_cfg.num_queues;
474 	cmd->other_count = 0;
475 	cmd->combined_count = 0;
476 }
477 
gve_set_channels(struct net_device * netdev,struct ethtool_channels * cmd)478 static int gve_set_channels(struct net_device *netdev,
479 			    struct ethtool_channels *cmd)
480 {
481 	struct gve_priv *priv = netdev_priv(netdev);
482 	struct gve_queue_config new_tx_cfg = priv->tx_cfg;
483 	struct gve_queue_config new_rx_cfg = priv->rx_cfg;
484 	struct ethtool_channels old_settings;
485 	int new_tx = cmd->tx_count;
486 	int new_rx = cmd->rx_count;
487 
488 	gve_get_channels(netdev, &old_settings);
489 
490 	/* Changing combined is not allowed */
491 	if (cmd->combined_count != old_settings.combined_count)
492 		return -EINVAL;
493 
494 	if (!new_rx || !new_tx)
495 		return -EINVAL;
496 
497 	if (priv->num_xdp_queues &&
498 	    (new_tx != new_rx || (2 * new_tx > priv->tx_cfg.max_queues))) {
499 		dev_err(&priv->pdev->dev, "XDP load failed: The number of configured RX queues should be equal to the number of configured TX queues and the number of configured RX/TX queues should be less than or equal to half the maximum number of RX/TX queues");
500 		return -EINVAL;
501 	}
502 
503 	if (!netif_running(netdev)) {
504 		priv->tx_cfg.num_queues = new_tx;
505 		priv->rx_cfg.num_queues = new_rx;
506 		return 0;
507 	}
508 
509 	new_tx_cfg.num_queues = new_tx;
510 	new_rx_cfg.num_queues = new_rx;
511 
512 	return gve_adjust_queues(priv, new_rx_cfg, new_tx_cfg);
513 }
514 
gve_get_ringparam(struct net_device * netdev,struct ethtool_ringparam * cmd,struct kernel_ethtool_ringparam * kernel_cmd,struct netlink_ext_ack * extack)515 static void gve_get_ringparam(struct net_device *netdev,
516 			      struct ethtool_ringparam *cmd,
517 			      struct kernel_ethtool_ringparam *kernel_cmd,
518 			      struct netlink_ext_ack *extack)
519 {
520 	struct gve_priv *priv = netdev_priv(netdev);
521 
522 	cmd->rx_max_pending = priv->max_rx_desc_cnt;
523 	cmd->tx_max_pending = priv->max_tx_desc_cnt;
524 	cmd->rx_pending = priv->rx_desc_cnt;
525 	cmd->tx_pending = priv->tx_desc_cnt;
526 
527 	if (!gve_header_split_supported(priv))
528 		kernel_cmd->tcp_data_split = ETHTOOL_TCP_DATA_SPLIT_UNKNOWN;
529 	else if (priv->header_split_enabled)
530 		kernel_cmd->tcp_data_split = ETHTOOL_TCP_DATA_SPLIT_ENABLED;
531 	else
532 		kernel_cmd->tcp_data_split = ETHTOOL_TCP_DATA_SPLIT_DISABLED;
533 }
534 
gve_adjust_ring_sizes(struct gve_priv * priv,u16 new_tx_desc_cnt,u16 new_rx_desc_cnt)535 static int gve_adjust_ring_sizes(struct gve_priv *priv,
536 				 u16 new_tx_desc_cnt,
537 				 u16 new_rx_desc_cnt)
538 {
539 	struct gve_tx_alloc_rings_cfg tx_alloc_cfg = {0};
540 	struct gve_rx_alloc_rings_cfg rx_alloc_cfg = {0};
541 	int err;
542 
543 	/* get current queue configuration */
544 	gve_get_curr_alloc_cfgs(priv, &tx_alloc_cfg, &rx_alloc_cfg);
545 
546 	/* copy over the new ring_size from ethtool */
547 	tx_alloc_cfg.ring_size = new_tx_desc_cnt;
548 	rx_alloc_cfg.ring_size = new_rx_desc_cnt;
549 
550 	if (netif_running(priv->dev)) {
551 		err = gve_adjust_config(priv, &tx_alloc_cfg, &rx_alloc_cfg);
552 		if (err)
553 			return err;
554 	}
555 
556 	/* Set new ring_size for the next up */
557 	priv->tx_desc_cnt = new_tx_desc_cnt;
558 	priv->rx_desc_cnt = new_rx_desc_cnt;
559 
560 	return 0;
561 }
562 
gve_validate_req_ring_size(struct gve_priv * priv,u16 new_tx_desc_cnt,u16 new_rx_desc_cnt)563 static int gve_validate_req_ring_size(struct gve_priv *priv, u16 new_tx_desc_cnt,
564 				      u16 new_rx_desc_cnt)
565 {
566 	/* check for valid range */
567 	if (new_tx_desc_cnt < priv->min_tx_desc_cnt ||
568 	    new_tx_desc_cnt > priv->max_tx_desc_cnt ||
569 	    new_rx_desc_cnt < priv->min_rx_desc_cnt ||
570 	    new_rx_desc_cnt > priv->max_rx_desc_cnt) {
571 		dev_err(&priv->pdev->dev, "Requested descriptor count out of range\n");
572 		return -EINVAL;
573 	}
574 
575 	if (!is_power_of_2(new_tx_desc_cnt) || !is_power_of_2(new_rx_desc_cnt)) {
576 		dev_err(&priv->pdev->dev, "Requested descriptor count has to be a power of 2\n");
577 		return -EINVAL;
578 	}
579 	return 0;
580 }
581 
gve_set_ringparam(struct net_device * netdev,struct ethtool_ringparam * cmd,struct kernel_ethtool_ringparam * kernel_cmd,struct netlink_ext_ack * extack)582 static int gve_set_ringparam(struct net_device *netdev,
583 			     struct ethtool_ringparam *cmd,
584 			     struct kernel_ethtool_ringparam *kernel_cmd,
585 			     struct netlink_ext_ack *extack)
586 {
587 	struct gve_priv *priv = netdev_priv(netdev);
588 	u16 new_tx_cnt, new_rx_cnt;
589 	int err;
590 
591 	err = gve_set_hsplit_config(priv, kernel_cmd->tcp_data_split);
592 	if (err)
593 		return err;
594 
595 	if (cmd->tx_pending == priv->tx_desc_cnt && cmd->rx_pending == priv->rx_desc_cnt)
596 		return 0;
597 
598 	if (!priv->modify_ring_size_enabled) {
599 		dev_err(&priv->pdev->dev, "Modify ring size is not supported.\n");
600 		return -EOPNOTSUPP;
601 	}
602 
603 	new_tx_cnt = cmd->tx_pending;
604 	new_rx_cnt = cmd->rx_pending;
605 
606 	if (gve_validate_req_ring_size(priv, new_tx_cnt, new_rx_cnt))
607 		return -EINVAL;
608 
609 	return gve_adjust_ring_sizes(priv, new_tx_cnt, new_rx_cnt);
610 }
611 
gve_user_reset(struct net_device * netdev,u32 * flags)612 static int gve_user_reset(struct net_device *netdev, u32 *flags)
613 {
614 	struct gve_priv *priv = netdev_priv(netdev);
615 
616 	if (*flags == ETH_RESET_ALL) {
617 		*flags = 0;
618 		return gve_reset(priv, true);
619 	}
620 
621 	return -EOPNOTSUPP;
622 }
623 
gve_get_tunable(struct net_device * netdev,const struct ethtool_tunable * etuna,void * value)624 static int gve_get_tunable(struct net_device *netdev,
625 			   const struct ethtool_tunable *etuna, void *value)
626 {
627 	struct gve_priv *priv = netdev_priv(netdev);
628 
629 	switch (etuna->id) {
630 	case ETHTOOL_RX_COPYBREAK:
631 		*(u32 *)value = priv->rx_copybreak;
632 		return 0;
633 	default:
634 		return -EOPNOTSUPP;
635 	}
636 }
637 
gve_set_tunable(struct net_device * netdev,const struct ethtool_tunable * etuna,const void * value)638 static int gve_set_tunable(struct net_device *netdev,
639 			   const struct ethtool_tunable *etuna,
640 			   const void *value)
641 {
642 	struct gve_priv *priv = netdev_priv(netdev);
643 	u32 len;
644 
645 	switch (etuna->id) {
646 	case ETHTOOL_RX_COPYBREAK:
647 	{
648 		u32 max_copybreak = gve_is_gqi(priv) ?
649 			GVE_DEFAULT_RX_BUFFER_SIZE : priv->data_buffer_size_dqo;
650 
651 		len = *(u32 *)value;
652 		if (len > max_copybreak)
653 			return -EINVAL;
654 		priv->rx_copybreak = len;
655 		return 0;
656 	}
657 	default:
658 		return -EOPNOTSUPP;
659 	}
660 }
661 
gve_get_priv_flags(struct net_device * netdev)662 static u32 gve_get_priv_flags(struct net_device *netdev)
663 {
664 	struct gve_priv *priv = netdev_priv(netdev);
665 	u32 ret_flags = 0;
666 
667 	/* Only 1 flag exists currently: report-stats (BIT(O)), so set that flag. */
668 	if (priv->ethtool_flags & BIT(0))
669 		ret_flags |= BIT(0);
670 	return ret_flags;
671 }
672 
gve_set_priv_flags(struct net_device * netdev,u32 flags)673 static int gve_set_priv_flags(struct net_device *netdev, u32 flags)
674 {
675 	struct gve_priv *priv = netdev_priv(netdev);
676 	u64 ori_flags, new_flags;
677 	int num_tx_queues;
678 
679 	num_tx_queues = gve_num_tx_queues(priv);
680 	ori_flags = READ_ONCE(priv->ethtool_flags);
681 	new_flags = ori_flags;
682 
683 	/* Only one priv flag exists: report-stats (BIT(0))*/
684 	if (flags & BIT(0))
685 		new_flags |= BIT(0);
686 	else
687 		new_flags &= ~(BIT(0));
688 	priv->ethtool_flags = new_flags;
689 	/* start report-stats timer when user turns report stats on. */
690 	if (flags & BIT(0)) {
691 		mod_timer(&priv->stats_report_timer,
692 			  round_jiffies(jiffies +
693 					msecs_to_jiffies(priv->stats_report_timer_period)));
694 	}
695 	/* Zero off gve stats when report-stats turned off and */
696 	/* delete report stats timer. */
697 	if (!(flags & BIT(0)) && (ori_flags & BIT(0))) {
698 		int tx_stats_num = GVE_TX_STATS_REPORT_NUM *
699 			num_tx_queues;
700 		int rx_stats_num = GVE_RX_STATS_REPORT_NUM *
701 			priv->rx_cfg.num_queues;
702 
703 		memset(priv->stats_report->stats, 0, (tx_stats_num + rx_stats_num) *
704 				   sizeof(struct stats));
705 		del_timer_sync(&priv->stats_report_timer);
706 	}
707 	return 0;
708 }
709 
gve_get_link_ksettings(struct net_device * netdev,struct ethtool_link_ksettings * cmd)710 static int gve_get_link_ksettings(struct net_device *netdev,
711 				  struct ethtool_link_ksettings *cmd)
712 {
713 	struct gve_priv *priv = netdev_priv(netdev);
714 	int err = 0;
715 
716 	if (priv->link_speed == 0)
717 		err = gve_adminq_report_link_speed(priv);
718 
719 	cmd->base.speed = priv->link_speed;
720 
721 	cmd->base.duplex = DUPLEX_FULL;
722 
723 	return err;
724 }
725 
gve_get_coalesce(struct net_device * netdev,struct ethtool_coalesce * ec,struct kernel_ethtool_coalesce * kernel_ec,struct netlink_ext_ack * extack)726 static int gve_get_coalesce(struct net_device *netdev,
727 			    struct ethtool_coalesce *ec,
728 			    struct kernel_ethtool_coalesce *kernel_ec,
729 			    struct netlink_ext_ack *extack)
730 {
731 	struct gve_priv *priv = netdev_priv(netdev);
732 
733 	if (gve_is_gqi(priv))
734 		return -EOPNOTSUPP;
735 	ec->tx_coalesce_usecs = priv->tx_coalesce_usecs;
736 	ec->rx_coalesce_usecs = priv->rx_coalesce_usecs;
737 
738 	return 0;
739 }
740 
gve_set_coalesce(struct net_device * netdev,struct ethtool_coalesce * ec,struct kernel_ethtool_coalesce * kernel_ec,struct netlink_ext_ack * extack)741 static int gve_set_coalesce(struct net_device *netdev,
742 			    struct ethtool_coalesce *ec,
743 			    struct kernel_ethtool_coalesce *kernel_ec,
744 			    struct netlink_ext_ack *extack)
745 {
746 	struct gve_priv *priv = netdev_priv(netdev);
747 	u32 tx_usecs_orig = priv->tx_coalesce_usecs;
748 	u32 rx_usecs_orig = priv->rx_coalesce_usecs;
749 	int idx;
750 
751 	if (gve_is_gqi(priv))
752 		return -EOPNOTSUPP;
753 
754 	if (ec->tx_coalesce_usecs > GVE_MAX_ITR_INTERVAL_DQO ||
755 	    ec->rx_coalesce_usecs > GVE_MAX_ITR_INTERVAL_DQO)
756 		return -EINVAL;
757 	priv->tx_coalesce_usecs = ec->tx_coalesce_usecs;
758 	priv->rx_coalesce_usecs = ec->rx_coalesce_usecs;
759 
760 	if (tx_usecs_orig != priv->tx_coalesce_usecs) {
761 		for (idx = 0; idx < priv->tx_cfg.num_queues; idx++) {
762 			int ntfy_idx = gve_tx_idx_to_ntfy(priv, idx);
763 			struct gve_notify_block *block = &priv->ntfy_blocks[ntfy_idx];
764 
765 			gve_set_itr_coalesce_usecs_dqo(priv, block,
766 						       priv->tx_coalesce_usecs);
767 		}
768 	}
769 
770 	if (rx_usecs_orig != priv->rx_coalesce_usecs) {
771 		for (idx = 0; idx < priv->rx_cfg.num_queues; idx++) {
772 			int ntfy_idx = gve_rx_idx_to_ntfy(priv, idx);
773 			struct gve_notify_block *block = &priv->ntfy_blocks[ntfy_idx];
774 
775 			gve_set_itr_coalesce_usecs_dqo(priv, block,
776 						       priv->rx_coalesce_usecs);
777 		}
778 	}
779 
780 	return 0;
781 }
782 
gve_set_rxnfc(struct net_device * netdev,struct ethtool_rxnfc * cmd)783 static int gve_set_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *cmd)
784 {
785 	struct gve_priv *priv = netdev_priv(netdev);
786 	int err = 0;
787 
788 	if (!(netdev->features & NETIF_F_NTUPLE))
789 		return -EOPNOTSUPP;
790 
791 	switch (cmd->cmd) {
792 	case ETHTOOL_SRXCLSRLINS:
793 		err = gve_add_flow_rule(priv, cmd);
794 		break;
795 	case ETHTOOL_SRXCLSRLDEL:
796 		err = gve_del_flow_rule(priv, cmd);
797 		break;
798 	case ETHTOOL_SRXFH:
799 		err = -EOPNOTSUPP;
800 		break;
801 	default:
802 		err = -EOPNOTSUPP;
803 		break;
804 	}
805 
806 	return err;
807 }
808 
gve_get_rxnfc(struct net_device * netdev,struct ethtool_rxnfc * cmd,u32 * rule_locs)809 static int gve_get_rxnfc(struct net_device *netdev, struct ethtool_rxnfc *cmd, u32 *rule_locs)
810 {
811 	struct gve_priv *priv = netdev_priv(netdev);
812 	int err = 0;
813 
814 	switch (cmd->cmd) {
815 	case ETHTOOL_GRXRINGS:
816 		cmd->data = priv->rx_cfg.num_queues;
817 		break;
818 	case ETHTOOL_GRXCLSRLCNT:
819 		if (!priv->max_flow_rules)
820 			return -EOPNOTSUPP;
821 
822 		err = gve_adminq_query_flow_rules(priv, GVE_FLOW_RULE_QUERY_STATS, 0);
823 		if (err)
824 			return err;
825 
826 		cmd->rule_cnt = priv->num_flow_rules;
827 		cmd->data = priv->max_flow_rules;
828 		break;
829 	case ETHTOOL_GRXCLSRULE:
830 		err = gve_get_flow_rule_entry(priv, cmd);
831 		break;
832 	case ETHTOOL_GRXCLSRLALL:
833 		err = gve_get_flow_rule_ids(priv, cmd, (u32 *)rule_locs);
834 		break;
835 	case ETHTOOL_GRXFH:
836 		err = -EOPNOTSUPP;
837 		break;
838 	default:
839 		err = -EOPNOTSUPP;
840 		break;
841 	}
842 
843 	return err;
844 }
845 
gve_get_rxfh_key_size(struct net_device * netdev)846 static u32 gve_get_rxfh_key_size(struct net_device *netdev)
847 {
848 	struct gve_priv *priv = netdev_priv(netdev);
849 
850 	return priv->rss_key_size;
851 }
852 
gve_get_rxfh_indir_size(struct net_device * netdev)853 static u32 gve_get_rxfh_indir_size(struct net_device *netdev)
854 {
855 	struct gve_priv *priv = netdev_priv(netdev);
856 
857 	return priv->rss_lut_size;
858 }
859 
gve_get_rxfh(struct net_device * netdev,struct ethtool_rxfh_param * rxfh)860 static int gve_get_rxfh(struct net_device *netdev, struct ethtool_rxfh_param *rxfh)
861 {
862 	struct gve_priv *priv = netdev_priv(netdev);
863 
864 	if (!priv->rss_key_size || !priv->rss_lut_size)
865 		return -EOPNOTSUPP;
866 
867 	return gve_adminq_query_rss_config(priv, rxfh);
868 }
869 
gve_set_rxfh(struct net_device * netdev,struct ethtool_rxfh_param * rxfh,struct netlink_ext_ack * extack)870 static int gve_set_rxfh(struct net_device *netdev, struct ethtool_rxfh_param *rxfh,
871 			struct netlink_ext_ack *extack)
872 {
873 	struct gve_priv *priv = netdev_priv(netdev);
874 
875 	if (!priv->rss_key_size || !priv->rss_lut_size)
876 		return -EOPNOTSUPP;
877 
878 	return gve_adminq_configure_rss(priv, rxfh);
879 }
880 
881 const struct ethtool_ops gve_ethtool_ops = {
882 	.supported_coalesce_params = ETHTOOL_COALESCE_USECS,
883 	.supported_ring_params = ETHTOOL_RING_USE_TCP_DATA_SPLIT,
884 	.get_drvinfo = gve_get_drvinfo,
885 	.get_strings = gve_get_strings,
886 	.get_sset_count = gve_get_sset_count,
887 	.get_ethtool_stats = gve_get_ethtool_stats,
888 	.set_msglevel = gve_set_msglevel,
889 	.get_msglevel = gve_get_msglevel,
890 	.set_channels = gve_set_channels,
891 	.get_channels = gve_get_channels,
892 	.set_rxnfc = gve_set_rxnfc,
893 	.get_rxnfc = gve_get_rxnfc,
894 	.get_rxfh_indir_size = gve_get_rxfh_indir_size,
895 	.get_rxfh_key_size = gve_get_rxfh_key_size,
896 	.get_rxfh = gve_get_rxfh,
897 	.set_rxfh = gve_set_rxfh,
898 	.get_link = ethtool_op_get_link,
899 	.get_coalesce = gve_get_coalesce,
900 	.set_coalesce = gve_set_coalesce,
901 	.get_ringparam = gve_get_ringparam,
902 	.set_ringparam = gve_set_ringparam,
903 	.reset = gve_user_reset,
904 	.get_tunable = gve_get_tunable,
905 	.set_tunable = gve_set_tunable,
906 	.get_priv_flags = gve_get_priv_flags,
907 	.set_priv_flags = gve_set_priv_flags,
908 	.get_link_ksettings = gve_get_link_ksettings,
909 	.get_ts_info = ethtool_op_get_ts_info,
910 };
911