Loading...
1// SPDX-License-Identifier: GPL-2.0
2/* Copyright(c) 2013 - 2019 Intel Corporation. */
3
4#include <linux/ethtool.h>
5#include <linux/vmalloc.h>
6
7#include "fm10k.h"
8
9struct fm10k_stats {
10 /* The stat_string is expected to be a format string formatted using
11 * vsnprintf by fm10k_add_stat_strings. Every member of a stats array
12 * should use the same format specifiers as they will be formatted
13 * using the same variadic arguments.
14 */
15 char stat_string[ETH_GSTRING_LEN];
16 int sizeof_stat;
17 int stat_offset;
18};
19
20#define FM10K_STAT_FIELDS(_type, _name, _stat) { \
21 .stat_string = _name, \
22 .sizeof_stat = sizeof_field(_type, _stat), \
23 .stat_offset = offsetof(_type, _stat) \
24}
25
26/* netdevice statistics */
27#define FM10K_NETDEV_STAT(_net_stat) \
28 FM10K_STAT_FIELDS(struct net_device_stats, __stringify(_net_stat), \
29 _net_stat)
30
31static const struct fm10k_stats fm10k_gstrings_net_stats[] = {
32 FM10K_NETDEV_STAT(tx_packets),
33 FM10K_NETDEV_STAT(tx_bytes),
34 FM10K_NETDEV_STAT(tx_errors),
35 FM10K_NETDEV_STAT(rx_packets),
36 FM10K_NETDEV_STAT(rx_bytes),
37 FM10K_NETDEV_STAT(rx_errors),
38 FM10K_NETDEV_STAT(rx_dropped),
39
40 /* detailed Rx errors */
41 FM10K_NETDEV_STAT(rx_length_errors),
42 FM10K_NETDEV_STAT(rx_crc_errors),
43 FM10K_NETDEV_STAT(rx_fifo_errors),
44};
45
46#define FM10K_NETDEV_STATS_LEN ARRAY_SIZE(fm10k_gstrings_net_stats)
47
48/* General interface statistics */
49#define FM10K_STAT(_name, _stat) \
50 FM10K_STAT_FIELDS(struct fm10k_intfc, _name, _stat)
51
52static const struct fm10k_stats fm10k_gstrings_global_stats[] = {
53 FM10K_STAT("tx_restart_queue", restart_queue),
54 FM10K_STAT("tx_busy", tx_busy),
55 FM10K_STAT("tx_csum_errors", tx_csum_errors),
56 FM10K_STAT("rx_alloc_failed", alloc_failed),
57 FM10K_STAT("rx_csum_errors", rx_csum_errors),
58
59 FM10K_STAT("tx_packets_nic", tx_packets_nic),
60 FM10K_STAT("tx_bytes_nic", tx_bytes_nic),
61 FM10K_STAT("rx_packets_nic", rx_packets_nic),
62 FM10K_STAT("rx_bytes_nic", rx_bytes_nic),
63 FM10K_STAT("rx_drops_nic", rx_drops_nic),
64 FM10K_STAT("rx_overrun_pf", rx_overrun_pf),
65 FM10K_STAT("rx_overrun_vf", rx_overrun_vf),
66
67 FM10K_STAT("swapi_status", hw.swapi.status),
68 FM10K_STAT("mac_rules_used", hw.swapi.mac.used),
69 FM10K_STAT("mac_rules_avail", hw.swapi.mac.avail),
70
71 FM10K_STAT("reset_while_pending", hw.mac.reset_while_pending),
72
73 FM10K_STAT("tx_hang_count", tx_timeout_count),
74};
75
76static const struct fm10k_stats fm10k_gstrings_pf_stats[] = {
77 FM10K_STAT("timeout", stats.timeout.count),
78 FM10K_STAT("ur", stats.ur.count),
79 FM10K_STAT("ca", stats.ca.count),
80 FM10K_STAT("um", stats.um.count),
81 FM10K_STAT("xec", stats.xec.count),
82 FM10K_STAT("vlan_drop", stats.vlan_drop.count),
83 FM10K_STAT("loopback_drop", stats.loopback_drop.count),
84 FM10K_STAT("nodesc_drop", stats.nodesc_drop.count),
85};
86
87/* mailbox statistics */
88#define FM10K_MBX_STAT(_name, _stat) \
89 FM10K_STAT_FIELDS(struct fm10k_mbx_info, _name, _stat)
90
91static const struct fm10k_stats fm10k_gstrings_mbx_stats[] = {
92 FM10K_MBX_STAT("mbx_tx_busy", tx_busy),
93 FM10K_MBX_STAT("mbx_tx_dropped", tx_dropped),
94 FM10K_MBX_STAT("mbx_tx_messages", tx_messages),
95 FM10K_MBX_STAT("mbx_tx_dwords", tx_dwords),
96 FM10K_MBX_STAT("mbx_tx_mbmem_pulled", tx_mbmem_pulled),
97 FM10K_MBX_STAT("mbx_rx_messages", rx_messages),
98 FM10K_MBX_STAT("mbx_rx_dwords", rx_dwords),
99 FM10K_MBX_STAT("mbx_rx_parse_err", rx_parse_err),
100 FM10K_MBX_STAT("mbx_rx_mbmem_pushed", rx_mbmem_pushed),
101};
102
103/* per-queue ring statistics */
104#define FM10K_QUEUE_STAT(_name, _stat) \
105 FM10K_STAT_FIELDS(struct fm10k_ring, _name, _stat)
106
107static const struct fm10k_stats fm10k_gstrings_queue_stats[] = {
108 FM10K_QUEUE_STAT("%s_queue_%u_packets", stats.packets),
109 FM10K_QUEUE_STAT("%s_queue_%u_bytes", stats.bytes),
110};
111
112#define FM10K_GLOBAL_STATS_LEN ARRAY_SIZE(fm10k_gstrings_global_stats)
113#define FM10K_PF_STATS_LEN ARRAY_SIZE(fm10k_gstrings_pf_stats)
114#define FM10K_MBX_STATS_LEN ARRAY_SIZE(fm10k_gstrings_mbx_stats)
115#define FM10K_QUEUE_STATS_LEN ARRAY_SIZE(fm10k_gstrings_queue_stats)
116
117#define FM10K_STATIC_STATS_LEN (FM10K_GLOBAL_STATS_LEN + \
118 FM10K_NETDEV_STATS_LEN + \
119 FM10K_MBX_STATS_LEN)
120
121static const char fm10k_gstrings_test[][ETH_GSTRING_LEN] = {
122 "Mailbox test (on/offline)"
123};
124
125#define FM10K_TEST_LEN (sizeof(fm10k_gstrings_test) / ETH_GSTRING_LEN)
126
127enum fm10k_self_test_types {
128 FM10K_TEST_MBX,
129 FM10K_TEST_MAX = FM10K_TEST_LEN
130};
131
132enum {
133 FM10K_PRV_FLAG_LEN,
134};
135
136static const char fm10k_prv_flags[FM10K_PRV_FLAG_LEN][ETH_GSTRING_LEN] = {
137};
138
139static void __fm10k_add_stat_strings(u8 **p, const struct fm10k_stats stats[],
140 const unsigned int size, ...)
141{
142 unsigned int i;
143
144 for (i = 0; i < size; i++) {
145 va_list args;
146
147 va_start(args, size);
148 vsnprintf(*p, ETH_GSTRING_LEN, stats[i].stat_string, args);
149 *p += ETH_GSTRING_LEN;
150 va_end(args);
151 }
152}
153
154#define fm10k_add_stat_strings(p, stats, ...) \
155 __fm10k_add_stat_strings(p, stats, ARRAY_SIZE(stats), ## __VA_ARGS__)
156
157static void fm10k_get_stat_strings(struct net_device *dev, u8 *data)
158{
159 struct fm10k_intfc *interface = netdev_priv(dev);
160 unsigned int i;
161
162 fm10k_add_stat_strings(&data, fm10k_gstrings_net_stats);
163
164 fm10k_add_stat_strings(&data, fm10k_gstrings_global_stats);
165
166 fm10k_add_stat_strings(&data, fm10k_gstrings_mbx_stats);
167
168 if (interface->hw.mac.type != fm10k_mac_vf)
169 fm10k_add_stat_strings(&data, fm10k_gstrings_pf_stats);
170
171 for (i = 0; i < interface->hw.mac.max_queues; i++) {
172 fm10k_add_stat_strings(&data, fm10k_gstrings_queue_stats,
173 "tx", i);
174
175 fm10k_add_stat_strings(&data, fm10k_gstrings_queue_stats,
176 "rx", i);
177 }
178}
179
180static void fm10k_get_strings(struct net_device *dev,
181 u32 stringset, u8 *data)
182{
183 switch (stringset) {
184 case ETH_SS_TEST:
185 memcpy(data, fm10k_gstrings_test,
186 FM10K_TEST_LEN * ETH_GSTRING_LEN);
187 break;
188 case ETH_SS_STATS:
189 fm10k_get_stat_strings(dev, data);
190 break;
191 case ETH_SS_PRIV_FLAGS:
192 memcpy(data, fm10k_prv_flags,
193 FM10K_PRV_FLAG_LEN * ETH_GSTRING_LEN);
194 break;
195 }
196}
197
198static int fm10k_get_sset_count(struct net_device *dev, int sset)
199{
200 struct fm10k_intfc *interface = netdev_priv(dev);
201 struct fm10k_hw *hw = &interface->hw;
202 int stats_len = FM10K_STATIC_STATS_LEN;
203
204 switch (sset) {
205 case ETH_SS_TEST:
206 return FM10K_TEST_LEN;
207 case ETH_SS_STATS:
208 stats_len += hw->mac.max_queues * 2 * FM10K_QUEUE_STATS_LEN;
209
210 if (hw->mac.type != fm10k_mac_vf)
211 stats_len += FM10K_PF_STATS_LEN;
212
213 return stats_len;
214 case ETH_SS_PRIV_FLAGS:
215 return FM10K_PRV_FLAG_LEN;
216 default:
217 return -EOPNOTSUPP;
218 }
219}
220
221static void __fm10k_add_ethtool_stats(u64 **data, void *pointer,
222 const struct fm10k_stats stats[],
223 const unsigned int size)
224{
225 unsigned int i;
226
227 if (!pointer) {
228 /* memory is not zero allocated so we have to clear it */
229 for (i = 0; i < size; i++)
230 *((*data)++) = 0;
231 return;
232 }
233
234 for (i = 0; i < size; i++) {
235 char *p = (char *)pointer + stats[i].stat_offset;
236
237 switch (stats[i].sizeof_stat) {
238 case sizeof(u64):
239 *((*data)++) = *(u64 *)p;
240 break;
241 case sizeof(u32):
242 *((*data)++) = *(u32 *)p;
243 break;
244 case sizeof(u16):
245 *((*data)++) = *(u16 *)p;
246 break;
247 case sizeof(u8):
248 *((*data)++) = *(u8 *)p;
249 break;
250 default:
251 WARN_ONCE(1, "unexpected stat size for %s",
252 stats[i].stat_string);
253 *((*data)++) = 0;
254 }
255 }
256}
257
258#define fm10k_add_ethtool_stats(data, pointer, stats) \
259 __fm10k_add_ethtool_stats(data, pointer, stats, ARRAY_SIZE(stats))
260
261static void fm10k_get_ethtool_stats(struct net_device *netdev,
262 struct ethtool_stats __always_unused *stats,
263 u64 *data)
264{
265 struct fm10k_intfc *interface = netdev_priv(netdev);
266 struct net_device_stats *net_stats = &netdev->stats;
267 int i;
268
269 fm10k_update_stats(interface);
270
271 fm10k_add_ethtool_stats(&data, net_stats, fm10k_gstrings_net_stats);
272
273 fm10k_add_ethtool_stats(&data, interface, fm10k_gstrings_global_stats);
274
275 fm10k_add_ethtool_stats(&data, &interface->hw.mbx,
276 fm10k_gstrings_mbx_stats);
277
278 if (interface->hw.mac.type != fm10k_mac_vf) {
279 fm10k_add_ethtool_stats(&data, interface,
280 fm10k_gstrings_pf_stats);
281 }
282
283 for (i = 0; i < interface->hw.mac.max_queues; i++) {
284 struct fm10k_ring *ring;
285
286 ring = interface->tx_ring[i];
287 fm10k_add_ethtool_stats(&data, ring,
288 fm10k_gstrings_queue_stats);
289
290 ring = interface->rx_ring[i];
291 fm10k_add_ethtool_stats(&data, ring,
292 fm10k_gstrings_queue_stats);
293 }
294}
295
296/* If function below adds more registers this define needs to be updated */
297#define FM10K_REGS_LEN_Q 29
298
299static void fm10k_get_reg_q(struct fm10k_hw *hw, u32 *buff, int i)
300{
301 int idx = 0;
302
303 buff[idx++] = fm10k_read_reg(hw, FM10K_RDBAL(i));
304 buff[idx++] = fm10k_read_reg(hw, FM10K_RDBAH(i));
305 buff[idx++] = fm10k_read_reg(hw, FM10K_RDLEN(i));
306 buff[idx++] = fm10k_read_reg(hw, FM10K_TPH_RXCTRL(i));
307 buff[idx++] = fm10k_read_reg(hw, FM10K_RDH(i));
308 buff[idx++] = fm10k_read_reg(hw, FM10K_RDT(i));
309 buff[idx++] = fm10k_read_reg(hw, FM10K_RXQCTL(i));
310 buff[idx++] = fm10k_read_reg(hw, FM10K_RXDCTL(i));
311 buff[idx++] = fm10k_read_reg(hw, FM10K_RXINT(i));
312 buff[idx++] = fm10k_read_reg(hw, FM10K_SRRCTL(i));
313 buff[idx++] = fm10k_read_reg(hw, FM10K_QPRC(i));
314 buff[idx++] = fm10k_read_reg(hw, FM10K_QPRDC(i));
315 buff[idx++] = fm10k_read_reg(hw, FM10K_QBRC_L(i));
316 buff[idx++] = fm10k_read_reg(hw, FM10K_QBRC_H(i));
317 buff[idx++] = fm10k_read_reg(hw, FM10K_TDBAL(i));
318 buff[idx++] = fm10k_read_reg(hw, FM10K_TDBAH(i));
319 buff[idx++] = fm10k_read_reg(hw, FM10K_TDLEN(i));
320 buff[idx++] = fm10k_read_reg(hw, FM10K_TPH_TXCTRL(i));
321 buff[idx++] = fm10k_read_reg(hw, FM10K_TDH(i));
322 buff[idx++] = fm10k_read_reg(hw, FM10K_TDT(i));
323 buff[idx++] = fm10k_read_reg(hw, FM10K_TXDCTL(i));
324 buff[idx++] = fm10k_read_reg(hw, FM10K_TXQCTL(i));
325 buff[idx++] = fm10k_read_reg(hw, FM10K_TXINT(i));
326 buff[idx++] = fm10k_read_reg(hw, FM10K_QPTC(i));
327 buff[idx++] = fm10k_read_reg(hw, FM10K_QBTC_L(i));
328 buff[idx++] = fm10k_read_reg(hw, FM10K_QBTC_H(i));
329 buff[idx++] = fm10k_read_reg(hw, FM10K_TQDLOC(i));
330 buff[idx++] = fm10k_read_reg(hw, FM10K_TX_SGLORT(i));
331 buff[idx++] = fm10k_read_reg(hw, FM10K_PFVTCTL(i));
332
333 BUG_ON(idx != FM10K_REGS_LEN_Q);
334}
335
336/* If function above adds more registers this define needs to be updated */
337#define FM10K_REGS_LEN_VSI 43
338
339static void fm10k_get_reg_vsi(struct fm10k_hw *hw, u32 *buff, int i)
340{
341 int idx = 0, j;
342
343 buff[idx++] = fm10k_read_reg(hw, FM10K_MRQC(i));
344 for (j = 0; j < 10; j++)
345 buff[idx++] = fm10k_read_reg(hw, FM10K_RSSRK(i, j));
346 for (j = 0; j < 32; j++)
347 buff[idx++] = fm10k_read_reg(hw, FM10K_RETA(i, j));
348
349 BUG_ON(idx != FM10K_REGS_LEN_VSI);
350}
351
352static void fm10k_get_regs(struct net_device *netdev,
353 struct ethtool_regs *regs, void *p)
354{
355 struct fm10k_intfc *interface = netdev_priv(netdev);
356 struct fm10k_hw *hw = &interface->hw;
357 u32 *buff = p;
358 u16 i;
359
360 regs->version = BIT(24) | (hw->revision_id << 16) | hw->device_id;
361
362 switch (hw->mac.type) {
363 case fm10k_mac_pf:
364 /* General PF Registers */
365 *(buff++) = fm10k_read_reg(hw, FM10K_CTRL);
366 *(buff++) = fm10k_read_reg(hw, FM10K_CTRL_EXT);
367 *(buff++) = fm10k_read_reg(hw, FM10K_GCR);
368 *(buff++) = fm10k_read_reg(hw, FM10K_GCR_EXT);
369
370 for (i = 0; i < 8; i++) {
371 *(buff++) = fm10k_read_reg(hw, FM10K_DGLORTMAP(i));
372 *(buff++) = fm10k_read_reg(hw, FM10K_DGLORTDEC(i));
373 }
374
375 for (i = 0; i < 65; i++) {
376 fm10k_get_reg_vsi(hw, buff, i);
377 buff += FM10K_REGS_LEN_VSI;
378 }
379
380 *(buff++) = fm10k_read_reg(hw, FM10K_DMA_CTRL);
381 *(buff++) = fm10k_read_reg(hw, FM10K_DMA_CTRL2);
382
383 for (i = 0; i < FM10K_MAX_QUEUES_PF; i++) {
384 fm10k_get_reg_q(hw, buff, i);
385 buff += FM10K_REGS_LEN_Q;
386 }
387
388 *(buff++) = fm10k_read_reg(hw, FM10K_TPH_CTRL);
389
390 for (i = 0; i < 8; i++)
391 *(buff++) = fm10k_read_reg(hw, FM10K_INT_MAP(i));
392
393 /* Interrupt Throttling Registers */
394 for (i = 0; i < 130; i++)
395 *(buff++) = fm10k_read_reg(hw, FM10K_ITR(i));
396
397 break;
398 case fm10k_mac_vf:
399 /* General VF registers */
400 *(buff++) = fm10k_read_reg(hw, FM10K_VFCTRL);
401 *(buff++) = fm10k_read_reg(hw, FM10K_VFINT_MAP);
402 *(buff++) = fm10k_read_reg(hw, FM10K_VFSYSTIME);
403
404 /* Interrupt Throttling Registers */
405 for (i = 0; i < 8; i++)
406 *(buff++) = fm10k_read_reg(hw, FM10K_VFITR(i));
407
408 fm10k_get_reg_vsi(hw, buff, 0);
409 buff += FM10K_REGS_LEN_VSI;
410
411 for (i = 0; i < FM10K_MAX_QUEUES_POOL; i++) {
412 if (i < hw->mac.max_queues)
413 fm10k_get_reg_q(hw, buff, i);
414 else
415 memset(buff, 0, sizeof(u32) * FM10K_REGS_LEN_Q);
416 buff += FM10K_REGS_LEN_Q;
417 }
418
419 break;
420 default:
421 return;
422 }
423}
424
425/* If function above adds more registers these define need to be updated */
426#define FM10K_REGS_LEN_PF \
427(162 + (65 * FM10K_REGS_LEN_VSI) + (FM10K_MAX_QUEUES_PF * FM10K_REGS_LEN_Q))
428#define FM10K_REGS_LEN_VF \
429(11 + FM10K_REGS_LEN_VSI + (FM10K_MAX_QUEUES_POOL * FM10K_REGS_LEN_Q))
430
431static int fm10k_get_regs_len(struct net_device *netdev)
432{
433 struct fm10k_intfc *interface = netdev_priv(netdev);
434 struct fm10k_hw *hw = &interface->hw;
435
436 switch (hw->mac.type) {
437 case fm10k_mac_pf:
438 return FM10K_REGS_LEN_PF * sizeof(u32);
439 case fm10k_mac_vf:
440 return FM10K_REGS_LEN_VF * sizeof(u32);
441 default:
442 return 0;
443 }
444}
445
446static void fm10k_get_drvinfo(struct net_device *dev,
447 struct ethtool_drvinfo *info)
448{
449 struct fm10k_intfc *interface = netdev_priv(dev);
450
451 strscpy(info->driver, fm10k_driver_name,
452 sizeof(info->driver));
453 strscpy(info->bus_info, pci_name(interface->pdev),
454 sizeof(info->bus_info));
455}
456
457static void fm10k_get_pauseparam(struct net_device *dev,
458 struct ethtool_pauseparam *pause)
459{
460 struct fm10k_intfc *interface = netdev_priv(dev);
461
462 /* record fixed values for autoneg and tx pause */
463 pause->autoneg = 0;
464 pause->tx_pause = 1;
465
466 pause->rx_pause = interface->rx_pause ? 1 : 0;
467}
468
469static int fm10k_set_pauseparam(struct net_device *dev,
470 struct ethtool_pauseparam *pause)
471{
472 struct fm10k_intfc *interface = netdev_priv(dev);
473 struct fm10k_hw *hw = &interface->hw;
474
475 if (pause->autoneg || !pause->tx_pause)
476 return -EINVAL;
477
478 /* we can only support pause on the PF to avoid head-of-line blocking */
479 if (hw->mac.type == fm10k_mac_pf)
480 interface->rx_pause = pause->rx_pause ? ~0 : 0;
481 else if (pause->rx_pause)
482 return -EINVAL;
483
484 if (netif_running(dev))
485 fm10k_update_rx_drop_en(interface);
486
487 return 0;
488}
489
490static u32 fm10k_get_msglevel(struct net_device *netdev)
491{
492 struct fm10k_intfc *interface = netdev_priv(netdev);
493
494 return interface->msg_enable;
495}
496
497static void fm10k_set_msglevel(struct net_device *netdev, u32 data)
498{
499 struct fm10k_intfc *interface = netdev_priv(netdev);
500
501 interface->msg_enable = data;
502}
503
504static void fm10k_get_ringparam(struct net_device *netdev,
505 struct ethtool_ringparam *ring,
506 struct kernel_ethtool_ringparam *kernel_ring,
507 struct netlink_ext_ack *extack)
508{
509 struct fm10k_intfc *interface = netdev_priv(netdev);
510
511 ring->rx_max_pending = FM10K_MAX_RXD;
512 ring->tx_max_pending = FM10K_MAX_TXD;
513 ring->rx_mini_max_pending = 0;
514 ring->rx_jumbo_max_pending = 0;
515 ring->rx_pending = interface->rx_ring_count;
516 ring->tx_pending = interface->tx_ring_count;
517 ring->rx_mini_pending = 0;
518 ring->rx_jumbo_pending = 0;
519}
520
521static int fm10k_set_ringparam(struct net_device *netdev,
522 struct ethtool_ringparam *ring,
523 struct kernel_ethtool_ringparam *kernel_ring,
524 struct netlink_ext_ack *extack)
525{
526 struct fm10k_intfc *interface = netdev_priv(netdev);
527 struct fm10k_ring *temp_ring;
528 int i, err = 0;
529 u32 new_rx_count, new_tx_count;
530
531 if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending))
532 return -EINVAL;
533
534 new_tx_count = clamp_t(u32, ring->tx_pending,
535 FM10K_MIN_TXD, FM10K_MAX_TXD);
536 new_tx_count = ALIGN(new_tx_count, FM10K_REQ_TX_DESCRIPTOR_MULTIPLE);
537
538 new_rx_count = clamp_t(u32, ring->rx_pending,
539 FM10K_MIN_RXD, FM10K_MAX_RXD);
540 new_rx_count = ALIGN(new_rx_count, FM10K_REQ_RX_DESCRIPTOR_MULTIPLE);
541
542 if ((new_tx_count == interface->tx_ring_count) &&
543 (new_rx_count == interface->rx_ring_count)) {
544 /* nothing to do */
545 return 0;
546 }
547
548 while (test_and_set_bit(__FM10K_RESETTING, interface->state))
549 usleep_range(1000, 2000);
550
551 if (!netif_running(interface->netdev)) {
552 for (i = 0; i < interface->num_tx_queues; i++)
553 interface->tx_ring[i]->count = new_tx_count;
554 for (i = 0; i < interface->num_rx_queues; i++)
555 interface->rx_ring[i]->count = new_rx_count;
556 interface->tx_ring_count = new_tx_count;
557 interface->rx_ring_count = new_rx_count;
558 goto clear_reset;
559 }
560
561 /* allocate temporary buffer to store rings in */
562 i = max_t(int, interface->num_tx_queues, interface->num_rx_queues);
563 temp_ring = vmalloc(array_size(i, sizeof(struct fm10k_ring)));
564
565 if (!temp_ring) {
566 err = -ENOMEM;
567 goto clear_reset;
568 }
569
570 fm10k_down(interface);
571
572 /* Setup new Tx resources and free the old Tx resources in that order.
573 * We can then assign the new resources to the rings via a memcpy.
574 * The advantage to this approach is that we are guaranteed to still
575 * have resources even in the case of an allocation failure.
576 */
577 if (new_tx_count != interface->tx_ring_count) {
578 for (i = 0; i < interface->num_tx_queues; i++) {
579 memcpy(&temp_ring[i], interface->tx_ring[i],
580 sizeof(struct fm10k_ring));
581
582 temp_ring[i].count = new_tx_count;
583 err = fm10k_setup_tx_resources(&temp_ring[i]);
584 if (err) {
585 while (i) {
586 i--;
587 fm10k_free_tx_resources(&temp_ring[i]);
588 }
589 goto err_setup;
590 }
591 }
592
593 for (i = 0; i < interface->num_tx_queues; i++) {
594 fm10k_free_tx_resources(interface->tx_ring[i]);
595
596 memcpy(interface->tx_ring[i], &temp_ring[i],
597 sizeof(struct fm10k_ring));
598 }
599
600 interface->tx_ring_count = new_tx_count;
601 }
602
603 /* Repeat the process for the Rx rings if needed */
604 if (new_rx_count != interface->rx_ring_count) {
605 for (i = 0; i < interface->num_rx_queues; i++) {
606 memcpy(&temp_ring[i], interface->rx_ring[i],
607 sizeof(struct fm10k_ring));
608
609 temp_ring[i].count = new_rx_count;
610 err = fm10k_setup_rx_resources(&temp_ring[i]);
611 if (err) {
612 while (i) {
613 i--;
614 fm10k_free_rx_resources(&temp_ring[i]);
615 }
616 goto err_setup;
617 }
618 }
619
620 for (i = 0; i < interface->num_rx_queues; i++) {
621 fm10k_free_rx_resources(interface->rx_ring[i]);
622
623 memcpy(interface->rx_ring[i], &temp_ring[i],
624 sizeof(struct fm10k_ring));
625 }
626
627 interface->rx_ring_count = new_rx_count;
628 }
629
630err_setup:
631 fm10k_up(interface);
632 vfree(temp_ring);
633clear_reset:
634 clear_bit(__FM10K_RESETTING, interface->state);
635 return err;
636}
637
638static int fm10k_get_coalesce(struct net_device *dev,
639 struct ethtool_coalesce *ec,
640 struct kernel_ethtool_coalesce *kernel_coal,
641 struct netlink_ext_ack *extack)
642{
643 struct fm10k_intfc *interface = netdev_priv(dev);
644
645 ec->use_adaptive_tx_coalesce = ITR_IS_ADAPTIVE(interface->tx_itr);
646 ec->tx_coalesce_usecs = interface->tx_itr & ~FM10K_ITR_ADAPTIVE;
647
648 ec->use_adaptive_rx_coalesce = ITR_IS_ADAPTIVE(interface->rx_itr);
649 ec->rx_coalesce_usecs = interface->rx_itr & ~FM10K_ITR_ADAPTIVE;
650
651 return 0;
652}
653
654static int fm10k_set_coalesce(struct net_device *dev,
655 struct ethtool_coalesce *ec,
656 struct kernel_ethtool_coalesce *kernel_coal,
657 struct netlink_ext_ack *extack)
658{
659 struct fm10k_intfc *interface = netdev_priv(dev);
660 u16 tx_itr, rx_itr;
661 int i;
662
663 /* verify limits */
664 if ((ec->rx_coalesce_usecs > FM10K_ITR_MAX) ||
665 (ec->tx_coalesce_usecs > FM10K_ITR_MAX))
666 return -EINVAL;
667
668 /* record settings */
669 tx_itr = ec->tx_coalesce_usecs;
670 rx_itr = ec->rx_coalesce_usecs;
671
672 /* set initial values for adaptive ITR */
673 if (ec->use_adaptive_tx_coalesce)
674 tx_itr = FM10K_ITR_ADAPTIVE | FM10K_TX_ITR_DEFAULT;
675
676 if (ec->use_adaptive_rx_coalesce)
677 rx_itr = FM10K_ITR_ADAPTIVE | FM10K_RX_ITR_DEFAULT;
678
679 /* update interface */
680 interface->tx_itr = tx_itr;
681 interface->rx_itr = rx_itr;
682
683 /* update q_vectors */
684 for (i = 0; i < interface->num_q_vectors; i++) {
685 struct fm10k_q_vector *qv = interface->q_vector[i];
686
687 qv->tx.itr = tx_itr;
688 qv->rx.itr = rx_itr;
689 }
690
691 return 0;
692}
693
694static int fm10k_get_rss_hash_opts(struct fm10k_intfc *interface,
695 struct ethtool_rxnfc *cmd)
696{
697 cmd->data = 0;
698
699 /* Report default options for RSS on fm10k */
700 switch (cmd->flow_type) {
701 case TCP_V4_FLOW:
702 case TCP_V6_FLOW:
703 cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
704 fallthrough;
705 case UDP_V4_FLOW:
706 if (test_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
707 interface->flags))
708 cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
709 fallthrough;
710 case SCTP_V4_FLOW:
711 case SCTP_V6_FLOW:
712 case AH_ESP_V4_FLOW:
713 case AH_ESP_V6_FLOW:
714 case AH_V4_FLOW:
715 case AH_V6_FLOW:
716 case ESP_V4_FLOW:
717 case ESP_V6_FLOW:
718 case IPV4_FLOW:
719 case IPV6_FLOW:
720 cmd->data |= RXH_IP_SRC | RXH_IP_DST;
721 break;
722 case UDP_V6_FLOW:
723 if (test_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
724 interface->flags))
725 cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
726 cmd->data |= RXH_IP_SRC | RXH_IP_DST;
727 break;
728 default:
729 return -EINVAL;
730 }
731
732 return 0;
733}
734
735static int fm10k_get_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd,
736 u32 __always_unused *rule_locs)
737{
738 struct fm10k_intfc *interface = netdev_priv(dev);
739 int ret = -EOPNOTSUPP;
740
741 switch (cmd->cmd) {
742 case ETHTOOL_GRXRINGS:
743 cmd->data = interface->num_rx_queues;
744 ret = 0;
745 break;
746 case ETHTOOL_GRXFH:
747 ret = fm10k_get_rss_hash_opts(interface, cmd);
748 break;
749 default:
750 break;
751 }
752
753 return ret;
754}
755
756static int fm10k_set_rss_hash_opt(struct fm10k_intfc *interface,
757 struct ethtool_rxnfc *nfc)
758{
759 int rss_ipv4_udp = test_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
760 interface->flags);
761 int rss_ipv6_udp = test_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
762 interface->flags);
763
764 /* RSS does not support anything other than hashing
765 * to queues on src and dst IPs and ports
766 */
767 if (nfc->data & ~(RXH_IP_SRC | RXH_IP_DST |
768 RXH_L4_B_0_1 | RXH_L4_B_2_3))
769 return -EINVAL;
770
771 switch (nfc->flow_type) {
772 case TCP_V4_FLOW:
773 case TCP_V6_FLOW:
774 if (!(nfc->data & RXH_IP_SRC) ||
775 !(nfc->data & RXH_IP_DST) ||
776 !(nfc->data & RXH_L4_B_0_1) ||
777 !(nfc->data & RXH_L4_B_2_3))
778 return -EINVAL;
779 break;
780 case UDP_V4_FLOW:
781 if (!(nfc->data & RXH_IP_SRC) ||
782 !(nfc->data & RXH_IP_DST))
783 return -EINVAL;
784 switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
785 case 0:
786 clear_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
787 interface->flags);
788 break;
789 case (RXH_L4_B_0_1 | RXH_L4_B_2_3):
790 set_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
791 interface->flags);
792 break;
793 default:
794 return -EINVAL;
795 }
796 break;
797 case UDP_V6_FLOW:
798 if (!(nfc->data & RXH_IP_SRC) ||
799 !(nfc->data & RXH_IP_DST))
800 return -EINVAL;
801 switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
802 case 0:
803 clear_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
804 interface->flags);
805 break;
806 case (RXH_L4_B_0_1 | RXH_L4_B_2_3):
807 set_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
808 interface->flags);
809 break;
810 default:
811 return -EINVAL;
812 }
813 break;
814 case AH_ESP_V4_FLOW:
815 case AH_V4_FLOW:
816 case ESP_V4_FLOW:
817 case SCTP_V4_FLOW:
818 case AH_ESP_V6_FLOW:
819 case AH_V6_FLOW:
820 case ESP_V6_FLOW:
821 case SCTP_V6_FLOW:
822 if (!(nfc->data & RXH_IP_SRC) ||
823 !(nfc->data & RXH_IP_DST) ||
824 (nfc->data & RXH_L4_B_0_1) ||
825 (nfc->data & RXH_L4_B_2_3))
826 return -EINVAL;
827 break;
828 default:
829 return -EINVAL;
830 }
831
832 /* If something changed we need to update the MRQC register. Note that
833 * test_bit() is guaranteed to return strictly 0 or 1, so testing for
834 * equality is safe.
835 */
836 if ((rss_ipv4_udp != test_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
837 interface->flags)) ||
838 (rss_ipv6_udp != test_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
839 interface->flags))) {
840 struct fm10k_hw *hw = &interface->hw;
841 bool warn = false;
842 u32 mrqc;
843
844 /* Perform hash on these packet types */
845 mrqc = FM10K_MRQC_IPV4 |
846 FM10K_MRQC_TCP_IPV4 |
847 FM10K_MRQC_IPV6 |
848 FM10K_MRQC_TCP_IPV6;
849
850 if (test_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
851 interface->flags)) {
852 mrqc |= FM10K_MRQC_UDP_IPV4;
853 warn = true;
854 }
855 if (test_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
856 interface->flags)) {
857 mrqc |= FM10K_MRQC_UDP_IPV6;
858 warn = true;
859 }
860
861 /* If we enable UDP RSS display a warning that this may cause
862 * fragmented UDP packets to arrive out of order.
863 */
864 if (warn)
865 netif_warn(interface, drv, interface->netdev,
866 "enabling UDP RSS: fragmented packets may arrive out of order to the stack above\n");
867
868 fm10k_write_reg(hw, FM10K_MRQC(0), mrqc);
869 }
870
871 return 0;
872}
873
874static int fm10k_set_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd)
875{
876 struct fm10k_intfc *interface = netdev_priv(dev);
877 int ret = -EOPNOTSUPP;
878
879 switch (cmd->cmd) {
880 case ETHTOOL_SRXFH:
881 ret = fm10k_set_rss_hash_opt(interface, cmd);
882 break;
883 default:
884 break;
885 }
886
887 return ret;
888}
889
890static int fm10k_mbx_test(struct fm10k_intfc *interface, u64 *data)
891{
892 struct fm10k_hw *hw = &interface->hw;
893 struct fm10k_mbx_info *mbx = &hw->mbx;
894 u32 attr_flag, test_msg[6];
895 unsigned long timeout;
896 int err = -EINVAL;
897
898 /* For now this is a VF only feature */
899 if (hw->mac.type != fm10k_mac_vf)
900 return 0;
901
902 /* loop through both nested and unnested attribute types */
903 for (attr_flag = BIT(FM10K_TEST_MSG_UNSET);
904 attr_flag < BIT(2 * FM10K_TEST_MSG_NESTED);
905 attr_flag += attr_flag) {
906 /* generate message to be tested */
907 fm10k_tlv_msg_test_create(test_msg, attr_flag);
908
909 fm10k_mbx_lock(interface);
910 mbx->test_result = FM10K_NOT_IMPLEMENTED;
911 err = mbx->ops.enqueue_tx(hw, mbx, test_msg);
912 fm10k_mbx_unlock(interface);
913
914 /* wait up to 1 second for response */
915 timeout = jiffies + HZ;
916 do {
917 if (err < 0)
918 goto err_out;
919
920 usleep_range(500, 1000);
921
922 fm10k_mbx_lock(interface);
923 mbx->ops.process(hw, mbx);
924 fm10k_mbx_unlock(interface);
925
926 err = mbx->test_result;
927 if (!err)
928 break;
929 } while (time_is_after_jiffies(timeout));
930
931 /* reporting errors */
932 if (err)
933 goto err_out;
934 }
935
936err_out:
937 *data = err < 0 ? (attr_flag) : (err > 0);
938 return err;
939}
940
941static void fm10k_self_test(struct net_device *dev,
942 struct ethtool_test *eth_test, u64 *data)
943{
944 struct fm10k_intfc *interface = netdev_priv(dev);
945 struct fm10k_hw *hw = &interface->hw;
946
947 memset(data, 0, sizeof(*data) * FM10K_TEST_LEN);
948
949 if (FM10K_REMOVED(hw->hw_addr)) {
950 netif_err(interface, drv, dev,
951 "Interface removed - test blocked\n");
952 eth_test->flags |= ETH_TEST_FL_FAILED;
953 return;
954 }
955
956 if (fm10k_mbx_test(interface, &data[FM10K_TEST_MBX]))
957 eth_test->flags |= ETH_TEST_FL_FAILED;
958}
959
960static u32 fm10k_get_priv_flags(struct net_device *netdev)
961{
962 return 0;
963}
964
965static int fm10k_set_priv_flags(struct net_device *netdev, u32 priv_flags)
966{
967 if (priv_flags >= BIT(FM10K_PRV_FLAG_LEN))
968 return -EINVAL;
969
970 return 0;
971}
972
973static u32 fm10k_get_reta_size(struct net_device __always_unused *netdev)
974{
975 return FM10K_RETA_SIZE * FM10K_RETA_ENTRIES_PER_REG;
976}
977
978void fm10k_write_reta(struct fm10k_intfc *interface, const u32 *indir)
979{
980 u16 rss_i = interface->ring_feature[RING_F_RSS].indices;
981 struct fm10k_hw *hw = &interface->hw;
982 u32 table[4];
983 int i, j;
984
985 /* record entries to reta table */
986 for (i = 0; i < FM10K_RETA_SIZE; i++) {
987 u32 reta, n;
988
989 /* generate a new table if we weren't given one */
990 for (j = 0; j < 4; j++) {
991 if (indir)
992 n = indir[4 * i + j];
993 else
994 n = ethtool_rxfh_indir_default(4 * i + j,
995 rss_i);
996
997 table[j] = n;
998 }
999
1000 reta = table[0] |
1001 (table[1] << 8) |
1002 (table[2] << 16) |
1003 (table[3] << 24);
1004
1005 if (interface->reta[i] == reta)
1006 continue;
1007
1008 interface->reta[i] = reta;
1009 fm10k_write_reg(hw, FM10K_RETA(0, i), reta);
1010 }
1011}
1012
1013static int fm10k_get_reta(struct net_device *netdev, u32 *indir)
1014{
1015 struct fm10k_intfc *interface = netdev_priv(netdev);
1016 int i;
1017
1018 if (!indir)
1019 return 0;
1020
1021 for (i = 0; i < FM10K_RETA_SIZE; i++, indir += 4) {
1022 u32 reta = interface->reta[i];
1023
1024 indir[0] = (reta << 24) >> 24;
1025 indir[1] = (reta << 16) >> 24;
1026 indir[2] = (reta << 8) >> 24;
1027 indir[3] = (reta) >> 24;
1028 }
1029
1030 return 0;
1031}
1032
1033static int fm10k_set_reta(struct net_device *netdev, const u32 *indir)
1034{
1035 struct fm10k_intfc *interface = netdev_priv(netdev);
1036 int i;
1037 u16 rss_i;
1038
1039 if (!indir)
1040 return 0;
1041
1042 /* Verify user input. */
1043 rss_i = interface->ring_feature[RING_F_RSS].indices;
1044 for (i = fm10k_get_reta_size(netdev); i--;) {
1045 if (indir[i] < rss_i)
1046 continue;
1047 return -EINVAL;
1048 }
1049
1050 fm10k_write_reta(interface, indir);
1051
1052 return 0;
1053}
1054
1055static u32 fm10k_get_rssrk_size(struct net_device __always_unused *netdev)
1056{
1057 return FM10K_RSSRK_SIZE * FM10K_RSSRK_ENTRIES_PER_REG;
1058}
1059
1060static int fm10k_get_rssh(struct net_device *netdev,
1061 struct ethtool_rxfh_param *rxfh)
1062{
1063 struct fm10k_intfc *interface = netdev_priv(netdev);
1064 u8 *key = rxfh->key;
1065 int i, err;
1066
1067 rxfh->hfunc = ETH_RSS_HASH_TOP;
1068
1069 err = fm10k_get_reta(netdev, rxfh->indir);
1070 if (err || !key)
1071 return err;
1072
1073 for (i = 0; i < FM10K_RSSRK_SIZE; i++, key += 4)
1074 *(__le32 *)key = cpu_to_le32(interface->rssrk[i]);
1075
1076 return 0;
1077}
1078
1079static int fm10k_set_rssh(struct net_device *netdev,
1080 struct ethtool_rxfh_param *rxfh,
1081 struct netlink_ext_ack *extack)
1082{
1083 struct fm10k_intfc *interface = netdev_priv(netdev);
1084 struct fm10k_hw *hw = &interface->hw;
1085 int i, err;
1086
1087 /* We do not allow change in unsupported parameters */
1088 if (rxfh->hfunc != ETH_RSS_HASH_NO_CHANGE &&
1089 rxfh->hfunc != ETH_RSS_HASH_TOP)
1090 return -EOPNOTSUPP;
1091
1092 err = fm10k_set_reta(netdev, rxfh->indir);
1093 if (err || !rxfh->key)
1094 return err;
1095
1096 for (i = 0; i < FM10K_RSSRK_SIZE; i++, rxfh->key += 4) {
1097 u32 rssrk = le32_to_cpu(*(__le32 *)rxfh->key);
1098
1099 if (interface->rssrk[i] == rssrk)
1100 continue;
1101
1102 interface->rssrk[i] = rssrk;
1103 fm10k_write_reg(hw, FM10K_RSSRK(0, i), rssrk);
1104 }
1105
1106 return 0;
1107}
1108
1109static unsigned int fm10k_max_channels(struct net_device *dev)
1110{
1111 struct fm10k_intfc *interface = netdev_priv(dev);
1112 unsigned int max_combined = interface->hw.mac.max_queues;
1113 u8 tcs = netdev_get_num_tc(dev);
1114
1115 /* For QoS report channels per traffic class */
1116 if (tcs > 1)
1117 max_combined = BIT((fls(max_combined / tcs) - 1));
1118
1119 return max_combined;
1120}
1121
1122static void fm10k_get_channels(struct net_device *dev,
1123 struct ethtool_channels *ch)
1124{
1125 struct fm10k_intfc *interface = netdev_priv(dev);
1126
1127 /* report maximum channels */
1128 ch->max_combined = fm10k_max_channels(dev);
1129
1130 /* report info for other vector */
1131 ch->max_other = NON_Q_VECTORS;
1132 ch->other_count = ch->max_other;
1133
1134 /* record RSS queues */
1135 ch->combined_count = interface->ring_feature[RING_F_RSS].indices;
1136}
1137
1138static int fm10k_set_channels(struct net_device *dev,
1139 struct ethtool_channels *ch)
1140{
1141 struct fm10k_intfc *interface = netdev_priv(dev);
1142 unsigned int count = ch->combined_count;
1143
1144 /* verify they are not requesting separate vectors */
1145 if (!count || ch->rx_count || ch->tx_count)
1146 return -EINVAL;
1147
1148 /* verify other_count has not changed */
1149 if (ch->other_count != NON_Q_VECTORS)
1150 return -EINVAL;
1151
1152 /* verify the number of channels does not exceed hardware limits */
1153 if (count > fm10k_max_channels(dev))
1154 return -EINVAL;
1155
1156 interface->ring_feature[RING_F_RSS].limit = count;
1157
1158 /* use setup TC to update any traffic class queue mapping */
1159 return fm10k_setup_tc(dev, netdev_get_num_tc(dev));
1160}
1161
1162static const struct ethtool_ops fm10k_ethtool_ops = {
1163 .supported_coalesce_params = ETHTOOL_COALESCE_USECS |
1164 ETHTOOL_COALESCE_USE_ADAPTIVE,
1165 .get_strings = fm10k_get_strings,
1166 .get_sset_count = fm10k_get_sset_count,
1167 .get_ethtool_stats = fm10k_get_ethtool_stats,
1168 .get_drvinfo = fm10k_get_drvinfo,
1169 .get_link = ethtool_op_get_link,
1170 .get_pauseparam = fm10k_get_pauseparam,
1171 .set_pauseparam = fm10k_set_pauseparam,
1172 .get_msglevel = fm10k_get_msglevel,
1173 .set_msglevel = fm10k_set_msglevel,
1174 .get_ringparam = fm10k_get_ringparam,
1175 .set_ringparam = fm10k_set_ringparam,
1176 .get_coalesce = fm10k_get_coalesce,
1177 .set_coalesce = fm10k_set_coalesce,
1178 .get_rxnfc = fm10k_get_rxnfc,
1179 .set_rxnfc = fm10k_set_rxnfc,
1180 .get_regs = fm10k_get_regs,
1181 .get_regs_len = fm10k_get_regs_len,
1182 .self_test = fm10k_self_test,
1183 .get_priv_flags = fm10k_get_priv_flags,
1184 .set_priv_flags = fm10k_set_priv_flags,
1185 .get_rxfh_indir_size = fm10k_get_reta_size,
1186 .get_rxfh_key_size = fm10k_get_rssrk_size,
1187 .get_rxfh = fm10k_get_rssh,
1188 .set_rxfh = fm10k_set_rssh,
1189 .get_channels = fm10k_get_channels,
1190 .set_channels = fm10k_set_channels,
1191 .get_ts_info = ethtool_op_get_ts_info,
1192};
1193
1194void fm10k_set_ethtool_ops(struct net_device *dev)
1195{
1196 dev->ethtool_ops = &fm10k_ethtool_ops;
1197}
1// SPDX-License-Identifier: GPL-2.0
2/* Intel(R) Ethernet Switch Host Interface Driver
3 * Copyright(c) 2013 - 2017 Intel Corporation.
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms and conditions of the GNU General Public License,
7 * version 2, as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * The full GNU General Public License is included in this distribution in
15 * the file called "COPYING".
16 *
17 * Contact Information:
18 * e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
19 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
20 */
21
22#include <linux/vmalloc.h>
23
24#include "fm10k.h"
25
26struct fm10k_stats {
27 char stat_string[ETH_GSTRING_LEN];
28 int sizeof_stat;
29 int stat_offset;
30};
31
32#define FM10K_NETDEV_STAT(_net_stat) { \
33 .stat_string = #_net_stat, \
34 .sizeof_stat = FIELD_SIZEOF(struct net_device_stats, _net_stat), \
35 .stat_offset = offsetof(struct net_device_stats, _net_stat) \
36}
37
38static const struct fm10k_stats fm10k_gstrings_net_stats[] = {
39 FM10K_NETDEV_STAT(tx_packets),
40 FM10K_NETDEV_STAT(tx_bytes),
41 FM10K_NETDEV_STAT(tx_errors),
42 FM10K_NETDEV_STAT(rx_packets),
43 FM10K_NETDEV_STAT(rx_bytes),
44 FM10K_NETDEV_STAT(rx_errors),
45 FM10K_NETDEV_STAT(rx_dropped),
46
47 /* detailed Rx errors */
48 FM10K_NETDEV_STAT(rx_length_errors),
49 FM10K_NETDEV_STAT(rx_crc_errors),
50 FM10K_NETDEV_STAT(rx_fifo_errors),
51};
52
53#define FM10K_NETDEV_STATS_LEN ARRAY_SIZE(fm10k_gstrings_net_stats)
54
55#define FM10K_STAT(_name, _stat) { \
56 .stat_string = _name, \
57 .sizeof_stat = FIELD_SIZEOF(struct fm10k_intfc, _stat), \
58 .stat_offset = offsetof(struct fm10k_intfc, _stat) \
59}
60
61static const struct fm10k_stats fm10k_gstrings_global_stats[] = {
62 FM10K_STAT("tx_restart_queue", restart_queue),
63 FM10K_STAT("tx_busy", tx_busy),
64 FM10K_STAT("tx_csum_errors", tx_csum_errors),
65 FM10K_STAT("rx_alloc_failed", alloc_failed),
66 FM10K_STAT("rx_csum_errors", rx_csum_errors),
67
68 FM10K_STAT("tx_packets_nic", tx_packets_nic),
69 FM10K_STAT("tx_bytes_nic", tx_bytes_nic),
70 FM10K_STAT("rx_packets_nic", rx_packets_nic),
71 FM10K_STAT("rx_bytes_nic", rx_bytes_nic),
72 FM10K_STAT("rx_drops_nic", rx_drops_nic),
73 FM10K_STAT("rx_overrun_pf", rx_overrun_pf),
74 FM10K_STAT("rx_overrun_vf", rx_overrun_vf),
75
76 FM10K_STAT("swapi_status", hw.swapi.status),
77 FM10K_STAT("mac_rules_used", hw.swapi.mac.used),
78 FM10K_STAT("mac_rules_avail", hw.swapi.mac.avail),
79
80 FM10K_STAT("reset_while_pending", hw.mac.reset_while_pending),
81
82 FM10K_STAT("tx_hang_count", tx_timeout_count),
83};
84
85static const struct fm10k_stats fm10k_gstrings_pf_stats[] = {
86 FM10K_STAT("timeout", stats.timeout.count),
87 FM10K_STAT("ur", stats.ur.count),
88 FM10K_STAT("ca", stats.ca.count),
89 FM10K_STAT("um", stats.um.count),
90 FM10K_STAT("xec", stats.xec.count),
91 FM10K_STAT("vlan_drop", stats.vlan_drop.count),
92 FM10K_STAT("loopback_drop", stats.loopback_drop.count),
93 FM10K_STAT("nodesc_drop", stats.nodesc_drop.count),
94};
95
96#define FM10K_MBX_STAT(_name, _stat) { \
97 .stat_string = _name, \
98 .sizeof_stat = FIELD_SIZEOF(struct fm10k_mbx_info, _stat), \
99 .stat_offset = offsetof(struct fm10k_mbx_info, _stat) \
100}
101
102static const struct fm10k_stats fm10k_gstrings_mbx_stats[] = {
103 FM10K_MBX_STAT("mbx_tx_busy", tx_busy),
104 FM10K_MBX_STAT("mbx_tx_dropped", tx_dropped),
105 FM10K_MBX_STAT("mbx_tx_messages", tx_messages),
106 FM10K_MBX_STAT("mbx_tx_dwords", tx_dwords),
107 FM10K_MBX_STAT("mbx_tx_mbmem_pulled", tx_mbmem_pulled),
108 FM10K_MBX_STAT("mbx_rx_messages", rx_messages),
109 FM10K_MBX_STAT("mbx_rx_dwords", rx_dwords),
110 FM10K_MBX_STAT("mbx_rx_parse_err", rx_parse_err),
111 FM10K_MBX_STAT("mbx_rx_mbmem_pushed", rx_mbmem_pushed),
112};
113
114#define FM10K_QUEUE_STAT(_name, _stat) { \
115 .stat_string = _name, \
116 .sizeof_stat = FIELD_SIZEOF(struct fm10k_ring, _stat), \
117 .stat_offset = offsetof(struct fm10k_ring, _stat) \
118}
119
120static const struct fm10k_stats fm10k_gstrings_queue_stats[] = {
121 FM10K_QUEUE_STAT("packets", stats.packets),
122 FM10K_QUEUE_STAT("bytes", stats.bytes),
123};
124
125#define FM10K_GLOBAL_STATS_LEN ARRAY_SIZE(fm10k_gstrings_global_stats)
126#define FM10K_PF_STATS_LEN ARRAY_SIZE(fm10k_gstrings_pf_stats)
127#define FM10K_MBX_STATS_LEN ARRAY_SIZE(fm10k_gstrings_mbx_stats)
128#define FM10K_QUEUE_STATS_LEN ARRAY_SIZE(fm10k_gstrings_queue_stats)
129
130#define FM10K_STATIC_STATS_LEN (FM10K_GLOBAL_STATS_LEN + \
131 FM10K_NETDEV_STATS_LEN + \
132 FM10K_MBX_STATS_LEN)
133
134static const char fm10k_gstrings_test[][ETH_GSTRING_LEN] = {
135 "Mailbox test (on/offline)"
136};
137
138#define FM10K_TEST_LEN (sizeof(fm10k_gstrings_test) / ETH_GSTRING_LEN)
139
140enum fm10k_self_test_types {
141 FM10K_TEST_MBX,
142 FM10K_TEST_MAX = FM10K_TEST_LEN
143};
144
145enum {
146 FM10K_PRV_FLAG_LEN,
147};
148
149static const char fm10k_prv_flags[FM10K_PRV_FLAG_LEN][ETH_GSTRING_LEN] = {
150};
151
152static void fm10k_add_stat_strings(u8 **p, const char *prefix,
153 const struct fm10k_stats stats[],
154 const unsigned int size)
155{
156 unsigned int i;
157
158 for (i = 0; i < size; i++) {
159 snprintf(*p, ETH_GSTRING_LEN, "%s%s",
160 prefix, stats[i].stat_string);
161 *p += ETH_GSTRING_LEN;
162 }
163}
164
165static void fm10k_get_stat_strings(struct net_device *dev, u8 *data)
166{
167 struct fm10k_intfc *interface = netdev_priv(dev);
168 unsigned int i;
169
170 fm10k_add_stat_strings(&data, "", fm10k_gstrings_net_stats,
171 FM10K_NETDEV_STATS_LEN);
172
173 fm10k_add_stat_strings(&data, "", fm10k_gstrings_global_stats,
174 FM10K_GLOBAL_STATS_LEN);
175
176 fm10k_add_stat_strings(&data, "", fm10k_gstrings_mbx_stats,
177 FM10K_MBX_STATS_LEN);
178
179 if (interface->hw.mac.type != fm10k_mac_vf)
180 fm10k_add_stat_strings(&data, "", fm10k_gstrings_pf_stats,
181 FM10K_PF_STATS_LEN);
182
183 for (i = 0; i < interface->hw.mac.max_queues; i++) {
184 char prefix[ETH_GSTRING_LEN];
185
186 snprintf(prefix, ETH_GSTRING_LEN, "tx_queue_%u_", i);
187 fm10k_add_stat_strings(&data, prefix,
188 fm10k_gstrings_queue_stats,
189 FM10K_QUEUE_STATS_LEN);
190
191 snprintf(prefix, ETH_GSTRING_LEN, "rx_queue_%u_", i);
192 fm10k_add_stat_strings(&data, prefix,
193 fm10k_gstrings_queue_stats,
194 FM10K_QUEUE_STATS_LEN);
195 }
196}
197
198static void fm10k_get_strings(struct net_device *dev,
199 u32 stringset, u8 *data)
200{
201 switch (stringset) {
202 case ETH_SS_TEST:
203 memcpy(data, fm10k_gstrings_test,
204 FM10K_TEST_LEN * ETH_GSTRING_LEN);
205 break;
206 case ETH_SS_STATS:
207 fm10k_get_stat_strings(dev, data);
208 break;
209 case ETH_SS_PRIV_FLAGS:
210 memcpy(data, fm10k_prv_flags,
211 FM10K_PRV_FLAG_LEN * ETH_GSTRING_LEN);
212 break;
213 }
214}
215
216static int fm10k_get_sset_count(struct net_device *dev, int sset)
217{
218 struct fm10k_intfc *interface = netdev_priv(dev);
219 struct fm10k_hw *hw = &interface->hw;
220 int stats_len = FM10K_STATIC_STATS_LEN;
221
222 switch (sset) {
223 case ETH_SS_TEST:
224 return FM10K_TEST_LEN;
225 case ETH_SS_STATS:
226 stats_len += hw->mac.max_queues * 2 * FM10K_QUEUE_STATS_LEN;
227
228 if (hw->mac.type != fm10k_mac_vf)
229 stats_len += FM10K_PF_STATS_LEN;
230
231 return stats_len;
232 case ETH_SS_PRIV_FLAGS:
233 return FM10K_PRV_FLAG_LEN;
234 default:
235 return -EOPNOTSUPP;
236 }
237}
238
239static void fm10k_add_ethtool_stats(u64 **data, void *pointer,
240 const struct fm10k_stats stats[],
241 const unsigned int size)
242{
243 unsigned int i;
244 char *p;
245
246 if (!pointer) {
247 /* memory is not zero allocated so we have to clear it */
248 for (i = 0; i < size; i++)
249 *((*data)++) = 0;
250 return;
251 }
252
253 for (i = 0; i < size; i++) {
254 p = (char *)pointer + stats[i].stat_offset;
255
256 switch (stats[i].sizeof_stat) {
257 case sizeof(u64):
258 *((*data)++) = *(u64 *)p;
259 break;
260 case sizeof(u32):
261 *((*data)++) = *(u32 *)p;
262 break;
263 case sizeof(u16):
264 *((*data)++) = *(u16 *)p;
265 break;
266 case sizeof(u8):
267 *((*data)++) = *(u8 *)p;
268 break;
269 default:
270 *((*data)++) = 0;
271 }
272 }
273}
274
275static void fm10k_get_ethtool_stats(struct net_device *netdev,
276 struct ethtool_stats __always_unused *stats,
277 u64 *data)
278{
279 struct fm10k_intfc *interface = netdev_priv(netdev);
280 struct net_device_stats *net_stats = &netdev->stats;
281 int i;
282
283 fm10k_update_stats(interface);
284
285 fm10k_add_ethtool_stats(&data, net_stats, fm10k_gstrings_net_stats,
286 FM10K_NETDEV_STATS_LEN);
287
288 fm10k_add_ethtool_stats(&data, interface, fm10k_gstrings_global_stats,
289 FM10K_GLOBAL_STATS_LEN);
290
291 fm10k_add_ethtool_stats(&data, &interface->hw.mbx,
292 fm10k_gstrings_mbx_stats,
293 FM10K_MBX_STATS_LEN);
294
295 if (interface->hw.mac.type != fm10k_mac_vf) {
296 fm10k_add_ethtool_stats(&data, interface,
297 fm10k_gstrings_pf_stats,
298 FM10K_PF_STATS_LEN);
299 }
300
301 for (i = 0; i < interface->hw.mac.max_queues; i++) {
302 struct fm10k_ring *ring;
303
304 ring = interface->tx_ring[i];
305 fm10k_add_ethtool_stats(&data, ring,
306 fm10k_gstrings_queue_stats,
307 FM10K_QUEUE_STATS_LEN);
308
309 ring = interface->rx_ring[i];
310 fm10k_add_ethtool_stats(&data, ring,
311 fm10k_gstrings_queue_stats,
312 FM10K_QUEUE_STATS_LEN);
313 }
314}
315
316/* If function below adds more registers this define needs to be updated */
317#define FM10K_REGS_LEN_Q 29
318
319static void fm10k_get_reg_q(struct fm10k_hw *hw, u32 *buff, int i)
320{
321 int idx = 0;
322
323 buff[idx++] = fm10k_read_reg(hw, FM10K_RDBAL(i));
324 buff[idx++] = fm10k_read_reg(hw, FM10K_RDBAH(i));
325 buff[idx++] = fm10k_read_reg(hw, FM10K_RDLEN(i));
326 buff[idx++] = fm10k_read_reg(hw, FM10K_TPH_RXCTRL(i));
327 buff[idx++] = fm10k_read_reg(hw, FM10K_RDH(i));
328 buff[idx++] = fm10k_read_reg(hw, FM10K_RDT(i));
329 buff[idx++] = fm10k_read_reg(hw, FM10K_RXQCTL(i));
330 buff[idx++] = fm10k_read_reg(hw, FM10K_RXDCTL(i));
331 buff[idx++] = fm10k_read_reg(hw, FM10K_RXINT(i));
332 buff[idx++] = fm10k_read_reg(hw, FM10K_SRRCTL(i));
333 buff[idx++] = fm10k_read_reg(hw, FM10K_QPRC(i));
334 buff[idx++] = fm10k_read_reg(hw, FM10K_QPRDC(i));
335 buff[idx++] = fm10k_read_reg(hw, FM10K_QBRC_L(i));
336 buff[idx++] = fm10k_read_reg(hw, FM10K_QBRC_H(i));
337 buff[idx++] = fm10k_read_reg(hw, FM10K_TDBAL(i));
338 buff[idx++] = fm10k_read_reg(hw, FM10K_TDBAH(i));
339 buff[idx++] = fm10k_read_reg(hw, FM10K_TDLEN(i));
340 buff[idx++] = fm10k_read_reg(hw, FM10K_TPH_TXCTRL(i));
341 buff[idx++] = fm10k_read_reg(hw, FM10K_TDH(i));
342 buff[idx++] = fm10k_read_reg(hw, FM10K_TDT(i));
343 buff[idx++] = fm10k_read_reg(hw, FM10K_TXDCTL(i));
344 buff[idx++] = fm10k_read_reg(hw, FM10K_TXQCTL(i));
345 buff[idx++] = fm10k_read_reg(hw, FM10K_TXINT(i));
346 buff[idx++] = fm10k_read_reg(hw, FM10K_QPTC(i));
347 buff[idx++] = fm10k_read_reg(hw, FM10K_QBTC_L(i));
348 buff[idx++] = fm10k_read_reg(hw, FM10K_QBTC_H(i));
349 buff[idx++] = fm10k_read_reg(hw, FM10K_TQDLOC(i));
350 buff[idx++] = fm10k_read_reg(hw, FM10K_TX_SGLORT(i));
351 buff[idx++] = fm10k_read_reg(hw, FM10K_PFVTCTL(i));
352
353 BUG_ON(idx != FM10K_REGS_LEN_Q);
354}
355
356/* If function above adds more registers this define needs to be updated */
357#define FM10K_REGS_LEN_VSI 43
358
359static void fm10k_get_reg_vsi(struct fm10k_hw *hw, u32 *buff, int i)
360{
361 int idx = 0, j;
362
363 buff[idx++] = fm10k_read_reg(hw, FM10K_MRQC(i));
364 for (j = 0; j < 10; j++)
365 buff[idx++] = fm10k_read_reg(hw, FM10K_RSSRK(i, j));
366 for (j = 0; j < 32; j++)
367 buff[idx++] = fm10k_read_reg(hw, FM10K_RETA(i, j));
368
369 BUG_ON(idx != FM10K_REGS_LEN_VSI);
370}
371
372static void fm10k_get_regs(struct net_device *netdev,
373 struct ethtool_regs *regs, void *p)
374{
375 struct fm10k_intfc *interface = netdev_priv(netdev);
376 struct fm10k_hw *hw = &interface->hw;
377 u32 *buff = p;
378 u16 i;
379
380 regs->version = BIT(24) | (hw->revision_id << 16) | hw->device_id;
381
382 switch (hw->mac.type) {
383 case fm10k_mac_pf:
384 /* General PF Registers */
385 *(buff++) = fm10k_read_reg(hw, FM10K_CTRL);
386 *(buff++) = fm10k_read_reg(hw, FM10K_CTRL_EXT);
387 *(buff++) = fm10k_read_reg(hw, FM10K_GCR);
388 *(buff++) = fm10k_read_reg(hw, FM10K_GCR_EXT);
389
390 for (i = 0; i < 8; i++) {
391 *(buff++) = fm10k_read_reg(hw, FM10K_DGLORTMAP(i));
392 *(buff++) = fm10k_read_reg(hw, FM10K_DGLORTDEC(i));
393 }
394
395 for (i = 0; i < 65; i++) {
396 fm10k_get_reg_vsi(hw, buff, i);
397 buff += FM10K_REGS_LEN_VSI;
398 }
399
400 *(buff++) = fm10k_read_reg(hw, FM10K_DMA_CTRL);
401 *(buff++) = fm10k_read_reg(hw, FM10K_DMA_CTRL2);
402
403 for (i = 0; i < FM10K_MAX_QUEUES_PF; i++) {
404 fm10k_get_reg_q(hw, buff, i);
405 buff += FM10K_REGS_LEN_Q;
406 }
407
408 *(buff++) = fm10k_read_reg(hw, FM10K_TPH_CTRL);
409
410 for (i = 0; i < 8; i++)
411 *(buff++) = fm10k_read_reg(hw, FM10K_INT_MAP(i));
412
413 /* Interrupt Throttling Registers */
414 for (i = 0; i < 130; i++)
415 *(buff++) = fm10k_read_reg(hw, FM10K_ITR(i));
416
417 break;
418 case fm10k_mac_vf:
419 /* General VF registers */
420 *(buff++) = fm10k_read_reg(hw, FM10K_VFCTRL);
421 *(buff++) = fm10k_read_reg(hw, FM10K_VFINT_MAP);
422 *(buff++) = fm10k_read_reg(hw, FM10K_VFSYSTIME);
423
424 /* Interrupt Throttling Registers */
425 for (i = 0; i < 8; i++)
426 *(buff++) = fm10k_read_reg(hw, FM10K_VFITR(i));
427
428 fm10k_get_reg_vsi(hw, buff, 0);
429 buff += FM10K_REGS_LEN_VSI;
430
431 for (i = 0; i < FM10K_MAX_QUEUES_POOL; i++) {
432 if (i < hw->mac.max_queues)
433 fm10k_get_reg_q(hw, buff, i);
434 else
435 memset(buff, 0, sizeof(u32) * FM10K_REGS_LEN_Q);
436 buff += FM10K_REGS_LEN_Q;
437 }
438
439 break;
440 default:
441 return;
442 }
443}
444
445/* If function above adds more registers these define need to be updated */
446#define FM10K_REGS_LEN_PF \
447(162 + (65 * FM10K_REGS_LEN_VSI) + (FM10K_MAX_QUEUES_PF * FM10K_REGS_LEN_Q))
448#define FM10K_REGS_LEN_VF \
449(11 + FM10K_REGS_LEN_VSI + (FM10K_MAX_QUEUES_POOL * FM10K_REGS_LEN_Q))
450
451static int fm10k_get_regs_len(struct net_device *netdev)
452{
453 struct fm10k_intfc *interface = netdev_priv(netdev);
454 struct fm10k_hw *hw = &interface->hw;
455
456 switch (hw->mac.type) {
457 case fm10k_mac_pf:
458 return FM10K_REGS_LEN_PF * sizeof(u32);
459 case fm10k_mac_vf:
460 return FM10K_REGS_LEN_VF * sizeof(u32);
461 default:
462 return 0;
463 }
464}
465
466static void fm10k_get_drvinfo(struct net_device *dev,
467 struct ethtool_drvinfo *info)
468{
469 struct fm10k_intfc *interface = netdev_priv(dev);
470
471 strncpy(info->driver, fm10k_driver_name,
472 sizeof(info->driver) - 1);
473 strncpy(info->version, fm10k_driver_version,
474 sizeof(info->version) - 1);
475 strncpy(info->bus_info, pci_name(interface->pdev),
476 sizeof(info->bus_info) - 1);
477}
478
479static void fm10k_get_pauseparam(struct net_device *dev,
480 struct ethtool_pauseparam *pause)
481{
482 struct fm10k_intfc *interface = netdev_priv(dev);
483
484 /* record fixed values for autoneg and tx pause */
485 pause->autoneg = 0;
486 pause->tx_pause = 1;
487
488 pause->rx_pause = interface->rx_pause ? 1 : 0;
489}
490
491static int fm10k_set_pauseparam(struct net_device *dev,
492 struct ethtool_pauseparam *pause)
493{
494 struct fm10k_intfc *interface = netdev_priv(dev);
495 struct fm10k_hw *hw = &interface->hw;
496
497 if (pause->autoneg || !pause->tx_pause)
498 return -EINVAL;
499
500 /* we can only support pause on the PF to avoid head-of-line blocking */
501 if (hw->mac.type == fm10k_mac_pf)
502 interface->rx_pause = pause->rx_pause ? ~0 : 0;
503 else if (pause->rx_pause)
504 return -EINVAL;
505
506 if (netif_running(dev))
507 fm10k_update_rx_drop_en(interface);
508
509 return 0;
510}
511
512static u32 fm10k_get_msglevel(struct net_device *netdev)
513{
514 struct fm10k_intfc *interface = netdev_priv(netdev);
515
516 return interface->msg_enable;
517}
518
519static void fm10k_set_msglevel(struct net_device *netdev, u32 data)
520{
521 struct fm10k_intfc *interface = netdev_priv(netdev);
522
523 interface->msg_enable = data;
524}
525
526static void fm10k_get_ringparam(struct net_device *netdev,
527 struct ethtool_ringparam *ring)
528{
529 struct fm10k_intfc *interface = netdev_priv(netdev);
530
531 ring->rx_max_pending = FM10K_MAX_RXD;
532 ring->tx_max_pending = FM10K_MAX_TXD;
533 ring->rx_mini_max_pending = 0;
534 ring->rx_jumbo_max_pending = 0;
535 ring->rx_pending = interface->rx_ring_count;
536 ring->tx_pending = interface->tx_ring_count;
537 ring->rx_mini_pending = 0;
538 ring->rx_jumbo_pending = 0;
539}
540
541static int fm10k_set_ringparam(struct net_device *netdev,
542 struct ethtool_ringparam *ring)
543{
544 struct fm10k_intfc *interface = netdev_priv(netdev);
545 struct fm10k_ring *temp_ring;
546 int i, err = 0;
547 u32 new_rx_count, new_tx_count;
548
549 if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending))
550 return -EINVAL;
551
552 new_tx_count = clamp_t(u32, ring->tx_pending,
553 FM10K_MIN_TXD, FM10K_MAX_TXD);
554 new_tx_count = ALIGN(new_tx_count, FM10K_REQ_TX_DESCRIPTOR_MULTIPLE);
555
556 new_rx_count = clamp_t(u32, ring->rx_pending,
557 FM10K_MIN_RXD, FM10K_MAX_RXD);
558 new_rx_count = ALIGN(new_rx_count, FM10K_REQ_RX_DESCRIPTOR_MULTIPLE);
559
560 if ((new_tx_count == interface->tx_ring_count) &&
561 (new_rx_count == interface->rx_ring_count)) {
562 /* nothing to do */
563 return 0;
564 }
565
566 while (test_and_set_bit(__FM10K_RESETTING, interface->state))
567 usleep_range(1000, 2000);
568
569 if (!netif_running(interface->netdev)) {
570 for (i = 0; i < interface->num_tx_queues; i++)
571 interface->tx_ring[i]->count = new_tx_count;
572 for (i = 0; i < interface->num_rx_queues; i++)
573 interface->rx_ring[i]->count = new_rx_count;
574 interface->tx_ring_count = new_tx_count;
575 interface->rx_ring_count = new_rx_count;
576 goto clear_reset;
577 }
578
579 /* allocate temporary buffer to store rings in */
580 i = max_t(int, interface->num_tx_queues, interface->num_rx_queues);
581 temp_ring = vmalloc(i * sizeof(struct fm10k_ring));
582
583 if (!temp_ring) {
584 err = -ENOMEM;
585 goto clear_reset;
586 }
587
588 fm10k_down(interface);
589
590 /* Setup new Tx resources and free the old Tx resources in that order.
591 * We can then assign the new resources to the rings via a memcpy.
592 * The advantage to this approach is that we are guaranteed to still
593 * have resources even in the case of an allocation failure.
594 */
595 if (new_tx_count != interface->tx_ring_count) {
596 for (i = 0; i < interface->num_tx_queues; i++) {
597 memcpy(&temp_ring[i], interface->tx_ring[i],
598 sizeof(struct fm10k_ring));
599
600 temp_ring[i].count = new_tx_count;
601 err = fm10k_setup_tx_resources(&temp_ring[i]);
602 if (err) {
603 while (i) {
604 i--;
605 fm10k_free_tx_resources(&temp_ring[i]);
606 }
607 goto err_setup;
608 }
609 }
610
611 for (i = 0; i < interface->num_tx_queues; i++) {
612 fm10k_free_tx_resources(interface->tx_ring[i]);
613
614 memcpy(interface->tx_ring[i], &temp_ring[i],
615 sizeof(struct fm10k_ring));
616 }
617
618 interface->tx_ring_count = new_tx_count;
619 }
620
621 /* Repeat the process for the Rx rings if needed */
622 if (new_rx_count != interface->rx_ring_count) {
623 for (i = 0; i < interface->num_rx_queues; i++) {
624 memcpy(&temp_ring[i], interface->rx_ring[i],
625 sizeof(struct fm10k_ring));
626
627 temp_ring[i].count = new_rx_count;
628 err = fm10k_setup_rx_resources(&temp_ring[i]);
629 if (err) {
630 while (i) {
631 i--;
632 fm10k_free_rx_resources(&temp_ring[i]);
633 }
634 goto err_setup;
635 }
636 }
637
638 for (i = 0; i < interface->num_rx_queues; i++) {
639 fm10k_free_rx_resources(interface->rx_ring[i]);
640
641 memcpy(interface->rx_ring[i], &temp_ring[i],
642 sizeof(struct fm10k_ring));
643 }
644
645 interface->rx_ring_count = new_rx_count;
646 }
647
648err_setup:
649 fm10k_up(interface);
650 vfree(temp_ring);
651clear_reset:
652 clear_bit(__FM10K_RESETTING, interface->state);
653 return err;
654}
655
656static int fm10k_get_coalesce(struct net_device *dev,
657 struct ethtool_coalesce *ec)
658{
659 struct fm10k_intfc *interface = netdev_priv(dev);
660
661 ec->use_adaptive_tx_coalesce = ITR_IS_ADAPTIVE(interface->tx_itr);
662 ec->tx_coalesce_usecs = interface->tx_itr & ~FM10K_ITR_ADAPTIVE;
663
664 ec->use_adaptive_rx_coalesce = ITR_IS_ADAPTIVE(interface->rx_itr);
665 ec->rx_coalesce_usecs = interface->rx_itr & ~FM10K_ITR_ADAPTIVE;
666
667 return 0;
668}
669
670static int fm10k_set_coalesce(struct net_device *dev,
671 struct ethtool_coalesce *ec)
672{
673 struct fm10k_intfc *interface = netdev_priv(dev);
674 struct fm10k_q_vector *qv;
675 u16 tx_itr, rx_itr;
676 int i;
677
678 /* verify limits */
679 if ((ec->rx_coalesce_usecs > FM10K_ITR_MAX) ||
680 (ec->tx_coalesce_usecs > FM10K_ITR_MAX))
681 return -EINVAL;
682
683 /* record settings */
684 tx_itr = ec->tx_coalesce_usecs;
685 rx_itr = ec->rx_coalesce_usecs;
686
687 /* set initial values for adaptive ITR */
688 if (ec->use_adaptive_tx_coalesce)
689 tx_itr = FM10K_ITR_ADAPTIVE | FM10K_TX_ITR_DEFAULT;
690
691 if (ec->use_adaptive_rx_coalesce)
692 rx_itr = FM10K_ITR_ADAPTIVE | FM10K_RX_ITR_DEFAULT;
693
694 /* update interface */
695 interface->tx_itr = tx_itr;
696 interface->rx_itr = rx_itr;
697
698 /* update q_vectors */
699 for (i = 0; i < interface->num_q_vectors; i++) {
700 qv = interface->q_vector[i];
701 qv->tx.itr = tx_itr;
702 qv->rx.itr = rx_itr;
703 }
704
705 return 0;
706}
707
708static int fm10k_get_rss_hash_opts(struct fm10k_intfc *interface,
709 struct ethtool_rxnfc *cmd)
710{
711 cmd->data = 0;
712
713 /* Report default options for RSS on fm10k */
714 switch (cmd->flow_type) {
715 case TCP_V4_FLOW:
716 case TCP_V6_FLOW:
717 cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
718 /* fall through */
719 case UDP_V4_FLOW:
720 if (test_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
721 interface->flags))
722 cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
723 /* fall through */
724 case SCTP_V4_FLOW:
725 case SCTP_V6_FLOW:
726 case AH_ESP_V4_FLOW:
727 case AH_ESP_V6_FLOW:
728 case AH_V4_FLOW:
729 case AH_V6_FLOW:
730 case ESP_V4_FLOW:
731 case ESP_V6_FLOW:
732 case IPV4_FLOW:
733 case IPV6_FLOW:
734 cmd->data |= RXH_IP_SRC | RXH_IP_DST;
735 break;
736 case UDP_V6_FLOW:
737 if (test_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
738 interface->flags))
739 cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
740 cmd->data |= RXH_IP_SRC | RXH_IP_DST;
741 break;
742 default:
743 return -EINVAL;
744 }
745
746 return 0;
747}
748
749static int fm10k_get_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd,
750 u32 __always_unused *rule_locs)
751{
752 struct fm10k_intfc *interface = netdev_priv(dev);
753 int ret = -EOPNOTSUPP;
754
755 switch (cmd->cmd) {
756 case ETHTOOL_GRXRINGS:
757 cmd->data = interface->num_rx_queues;
758 ret = 0;
759 break;
760 case ETHTOOL_GRXFH:
761 ret = fm10k_get_rss_hash_opts(interface, cmd);
762 break;
763 default:
764 break;
765 }
766
767 return ret;
768}
769
770static int fm10k_set_rss_hash_opt(struct fm10k_intfc *interface,
771 struct ethtool_rxnfc *nfc)
772{
773 int rss_ipv4_udp = test_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
774 interface->flags);
775 int rss_ipv6_udp = test_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
776 interface->flags);
777
778 /* RSS does not support anything other than hashing
779 * to queues on src and dst IPs and ports
780 */
781 if (nfc->data & ~(RXH_IP_SRC | RXH_IP_DST |
782 RXH_L4_B_0_1 | RXH_L4_B_2_3))
783 return -EINVAL;
784
785 switch (nfc->flow_type) {
786 case TCP_V4_FLOW:
787 case TCP_V6_FLOW:
788 if (!(nfc->data & RXH_IP_SRC) ||
789 !(nfc->data & RXH_IP_DST) ||
790 !(nfc->data & RXH_L4_B_0_1) ||
791 !(nfc->data & RXH_L4_B_2_3))
792 return -EINVAL;
793 break;
794 case UDP_V4_FLOW:
795 if (!(nfc->data & RXH_IP_SRC) ||
796 !(nfc->data & RXH_IP_DST))
797 return -EINVAL;
798 switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
799 case 0:
800 clear_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
801 interface->flags);
802 break;
803 case (RXH_L4_B_0_1 | RXH_L4_B_2_3):
804 set_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
805 interface->flags);
806 break;
807 default:
808 return -EINVAL;
809 }
810 break;
811 case UDP_V6_FLOW:
812 if (!(nfc->data & RXH_IP_SRC) ||
813 !(nfc->data & RXH_IP_DST))
814 return -EINVAL;
815 switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
816 case 0:
817 clear_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
818 interface->flags);
819 break;
820 case (RXH_L4_B_0_1 | RXH_L4_B_2_3):
821 set_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
822 interface->flags);
823 break;
824 default:
825 return -EINVAL;
826 }
827 break;
828 case AH_ESP_V4_FLOW:
829 case AH_V4_FLOW:
830 case ESP_V4_FLOW:
831 case SCTP_V4_FLOW:
832 case AH_ESP_V6_FLOW:
833 case AH_V6_FLOW:
834 case ESP_V6_FLOW:
835 case SCTP_V6_FLOW:
836 if (!(nfc->data & RXH_IP_SRC) ||
837 !(nfc->data & RXH_IP_DST) ||
838 (nfc->data & RXH_L4_B_0_1) ||
839 (nfc->data & RXH_L4_B_2_3))
840 return -EINVAL;
841 break;
842 default:
843 return -EINVAL;
844 }
845
846 /* If something changed we need to update the MRQC register. Note that
847 * test_bit() is guaranteed to return strictly 0 or 1, so testing for
848 * equality is safe.
849 */
850 if ((rss_ipv4_udp != test_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
851 interface->flags)) ||
852 (rss_ipv6_udp != test_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
853 interface->flags))) {
854 struct fm10k_hw *hw = &interface->hw;
855 bool warn = false;
856 u32 mrqc;
857
858 /* Perform hash on these packet types */
859 mrqc = FM10K_MRQC_IPV4 |
860 FM10K_MRQC_TCP_IPV4 |
861 FM10K_MRQC_IPV6 |
862 FM10K_MRQC_TCP_IPV6;
863
864 if (test_bit(FM10K_FLAG_RSS_FIELD_IPV4_UDP,
865 interface->flags)) {
866 mrqc |= FM10K_MRQC_UDP_IPV4;
867 warn = true;
868 }
869 if (test_bit(FM10K_FLAG_RSS_FIELD_IPV6_UDP,
870 interface->flags)) {
871 mrqc |= FM10K_MRQC_UDP_IPV6;
872 warn = true;
873 }
874
875 /* If we enable UDP RSS display a warning that this may cause
876 * fragmented UDP packets to arrive out of order.
877 */
878 if (warn)
879 netif_warn(interface, drv, interface->netdev,
880 "enabling UDP RSS: fragmented packets may arrive out of order to the stack above\n");
881
882 fm10k_write_reg(hw, FM10K_MRQC(0), mrqc);
883 }
884
885 return 0;
886}
887
888static int fm10k_set_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd)
889{
890 struct fm10k_intfc *interface = netdev_priv(dev);
891 int ret = -EOPNOTSUPP;
892
893 switch (cmd->cmd) {
894 case ETHTOOL_SRXFH:
895 ret = fm10k_set_rss_hash_opt(interface, cmd);
896 break;
897 default:
898 break;
899 }
900
901 return ret;
902}
903
904static int fm10k_mbx_test(struct fm10k_intfc *interface, u64 *data)
905{
906 struct fm10k_hw *hw = &interface->hw;
907 struct fm10k_mbx_info *mbx = &hw->mbx;
908 u32 attr_flag, test_msg[6];
909 unsigned long timeout;
910 int err = -EINVAL;
911
912 /* For now this is a VF only feature */
913 if (hw->mac.type != fm10k_mac_vf)
914 return 0;
915
916 /* loop through both nested and unnested attribute types */
917 for (attr_flag = BIT(FM10K_TEST_MSG_UNSET);
918 attr_flag < BIT(2 * FM10K_TEST_MSG_NESTED);
919 attr_flag += attr_flag) {
920 /* generate message to be tested */
921 fm10k_tlv_msg_test_create(test_msg, attr_flag);
922
923 fm10k_mbx_lock(interface);
924 mbx->test_result = FM10K_NOT_IMPLEMENTED;
925 err = mbx->ops.enqueue_tx(hw, mbx, test_msg);
926 fm10k_mbx_unlock(interface);
927
928 /* wait up to 1 second for response */
929 timeout = jiffies + HZ;
930 do {
931 if (err < 0)
932 goto err_out;
933
934 usleep_range(500, 1000);
935
936 fm10k_mbx_lock(interface);
937 mbx->ops.process(hw, mbx);
938 fm10k_mbx_unlock(interface);
939
940 err = mbx->test_result;
941 if (!err)
942 break;
943 } while (time_is_after_jiffies(timeout));
944
945 /* reporting errors */
946 if (err)
947 goto err_out;
948 }
949
950err_out:
951 *data = err < 0 ? (attr_flag) : (err > 0);
952 return err;
953}
954
955static void fm10k_self_test(struct net_device *dev,
956 struct ethtool_test *eth_test, u64 *data)
957{
958 struct fm10k_intfc *interface = netdev_priv(dev);
959 struct fm10k_hw *hw = &interface->hw;
960
961 memset(data, 0, sizeof(*data) * FM10K_TEST_LEN);
962
963 if (FM10K_REMOVED(hw->hw_addr)) {
964 netif_err(interface, drv, dev,
965 "Interface removed - test blocked\n");
966 eth_test->flags |= ETH_TEST_FL_FAILED;
967 return;
968 }
969
970 if (fm10k_mbx_test(interface, &data[FM10K_TEST_MBX]))
971 eth_test->flags |= ETH_TEST_FL_FAILED;
972}
973
974static u32 fm10k_get_priv_flags(struct net_device *netdev)
975{
976 return 0;
977}
978
979static int fm10k_set_priv_flags(struct net_device *netdev, u32 priv_flags)
980{
981 if (priv_flags >= BIT(FM10K_PRV_FLAG_LEN))
982 return -EINVAL;
983
984 return 0;
985}
986
987static u32 fm10k_get_reta_size(struct net_device __always_unused *netdev)
988{
989 return FM10K_RETA_SIZE * FM10K_RETA_ENTRIES_PER_REG;
990}
991
992void fm10k_write_reta(struct fm10k_intfc *interface, const u32 *indir)
993{
994 u16 rss_i = interface->ring_feature[RING_F_RSS].indices;
995 struct fm10k_hw *hw = &interface->hw;
996 u32 table[4];
997 int i, j;
998
999 /* record entries to reta table */
1000 for (i = 0; i < FM10K_RETA_SIZE; i++) {
1001 u32 reta, n;
1002
1003 /* generate a new table if we weren't given one */
1004 for (j = 0; j < 4; j++) {
1005 if (indir)
1006 n = indir[4 * i + j];
1007 else
1008 n = ethtool_rxfh_indir_default(4 * i + j,
1009 rss_i);
1010
1011 table[j] = n;
1012 }
1013
1014 reta = table[0] |
1015 (table[1] << 8) |
1016 (table[2] << 16) |
1017 (table[3] << 24);
1018
1019 if (interface->reta[i] == reta)
1020 continue;
1021
1022 interface->reta[i] = reta;
1023 fm10k_write_reg(hw, FM10K_RETA(0, i), reta);
1024 }
1025}
1026
1027static int fm10k_get_reta(struct net_device *netdev, u32 *indir)
1028{
1029 struct fm10k_intfc *interface = netdev_priv(netdev);
1030 int i;
1031
1032 if (!indir)
1033 return 0;
1034
1035 for (i = 0; i < FM10K_RETA_SIZE; i++, indir += 4) {
1036 u32 reta = interface->reta[i];
1037
1038 indir[0] = (reta << 24) >> 24;
1039 indir[1] = (reta << 16) >> 24;
1040 indir[2] = (reta << 8) >> 24;
1041 indir[3] = (reta) >> 24;
1042 }
1043
1044 return 0;
1045}
1046
1047static int fm10k_set_reta(struct net_device *netdev, const u32 *indir)
1048{
1049 struct fm10k_intfc *interface = netdev_priv(netdev);
1050 int i;
1051 u16 rss_i;
1052
1053 if (!indir)
1054 return 0;
1055
1056 /* Verify user input. */
1057 rss_i = interface->ring_feature[RING_F_RSS].indices;
1058 for (i = fm10k_get_reta_size(netdev); i--;) {
1059 if (indir[i] < rss_i)
1060 continue;
1061 return -EINVAL;
1062 }
1063
1064 fm10k_write_reta(interface, indir);
1065
1066 return 0;
1067}
1068
1069static u32 fm10k_get_rssrk_size(struct net_device __always_unused *netdev)
1070{
1071 return FM10K_RSSRK_SIZE * FM10K_RSSRK_ENTRIES_PER_REG;
1072}
1073
1074static int fm10k_get_rssh(struct net_device *netdev, u32 *indir, u8 *key,
1075 u8 *hfunc)
1076{
1077 struct fm10k_intfc *interface = netdev_priv(netdev);
1078 int i, err;
1079
1080 if (hfunc)
1081 *hfunc = ETH_RSS_HASH_TOP;
1082
1083 err = fm10k_get_reta(netdev, indir);
1084 if (err || !key)
1085 return err;
1086
1087 for (i = 0; i < FM10K_RSSRK_SIZE; i++, key += 4)
1088 *(__le32 *)key = cpu_to_le32(interface->rssrk[i]);
1089
1090 return 0;
1091}
1092
1093static int fm10k_set_rssh(struct net_device *netdev, const u32 *indir,
1094 const u8 *key, const u8 hfunc)
1095{
1096 struct fm10k_intfc *interface = netdev_priv(netdev);
1097 struct fm10k_hw *hw = &interface->hw;
1098 int i, err;
1099
1100 /* We do not allow change in unsupported parameters */
1101 if (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP)
1102 return -EOPNOTSUPP;
1103
1104 err = fm10k_set_reta(netdev, indir);
1105 if (err || !key)
1106 return err;
1107
1108 for (i = 0; i < FM10K_RSSRK_SIZE; i++, key += 4) {
1109 u32 rssrk = le32_to_cpu(*(__le32 *)key);
1110
1111 if (interface->rssrk[i] == rssrk)
1112 continue;
1113
1114 interface->rssrk[i] = rssrk;
1115 fm10k_write_reg(hw, FM10K_RSSRK(0, i), rssrk);
1116 }
1117
1118 return 0;
1119}
1120
1121static unsigned int fm10k_max_channels(struct net_device *dev)
1122{
1123 struct fm10k_intfc *interface = netdev_priv(dev);
1124 unsigned int max_combined = interface->hw.mac.max_queues;
1125 u8 tcs = netdev_get_num_tc(dev);
1126
1127 /* For QoS report channels per traffic class */
1128 if (tcs > 1)
1129 max_combined = BIT((fls(max_combined / tcs) - 1));
1130
1131 return max_combined;
1132}
1133
1134static void fm10k_get_channels(struct net_device *dev,
1135 struct ethtool_channels *ch)
1136{
1137 struct fm10k_intfc *interface = netdev_priv(dev);
1138 struct fm10k_hw *hw = &interface->hw;
1139
1140 /* report maximum channels */
1141 ch->max_combined = fm10k_max_channels(dev);
1142
1143 /* report info for other vector */
1144 ch->max_other = NON_Q_VECTORS(hw);
1145 ch->other_count = ch->max_other;
1146
1147 /* record RSS queues */
1148 ch->combined_count = interface->ring_feature[RING_F_RSS].indices;
1149}
1150
1151static int fm10k_set_channels(struct net_device *dev,
1152 struct ethtool_channels *ch)
1153{
1154 struct fm10k_intfc *interface = netdev_priv(dev);
1155 unsigned int count = ch->combined_count;
1156 struct fm10k_hw *hw = &interface->hw;
1157
1158 /* verify they are not requesting separate vectors */
1159 if (!count || ch->rx_count || ch->tx_count)
1160 return -EINVAL;
1161
1162 /* verify other_count has not changed */
1163 if (ch->other_count != NON_Q_VECTORS(hw))
1164 return -EINVAL;
1165
1166 /* verify the number of channels does not exceed hardware limits */
1167 if (count > fm10k_max_channels(dev))
1168 return -EINVAL;
1169
1170 interface->ring_feature[RING_F_RSS].limit = count;
1171
1172 /* use setup TC to update any traffic class queue mapping */
1173 return fm10k_setup_tc(dev, netdev_get_num_tc(dev));
1174}
1175
1176static const struct ethtool_ops fm10k_ethtool_ops = {
1177 .get_strings = fm10k_get_strings,
1178 .get_sset_count = fm10k_get_sset_count,
1179 .get_ethtool_stats = fm10k_get_ethtool_stats,
1180 .get_drvinfo = fm10k_get_drvinfo,
1181 .get_link = ethtool_op_get_link,
1182 .get_pauseparam = fm10k_get_pauseparam,
1183 .set_pauseparam = fm10k_set_pauseparam,
1184 .get_msglevel = fm10k_get_msglevel,
1185 .set_msglevel = fm10k_set_msglevel,
1186 .get_ringparam = fm10k_get_ringparam,
1187 .set_ringparam = fm10k_set_ringparam,
1188 .get_coalesce = fm10k_get_coalesce,
1189 .set_coalesce = fm10k_set_coalesce,
1190 .get_rxnfc = fm10k_get_rxnfc,
1191 .set_rxnfc = fm10k_set_rxnfc,
1192 .get_regs = fm10k_get_regs,
1193 .get_regs_len = fm10k_get_regs_len,
1194 .self_test = fm10k_self_test,
1195 .get_priv_flags = fm10k_get_priv_flags,
1196 .set_priv_flags = fm10k_set_priv_flags,
1197 .get_rxfh_indir_size = fm10k_get_reta_size,
1198 .get_rxfh_key_size = fm10k_get_rssrk_size,
1199 .get_rxfh = fm10k_get_rssh,
1200 .set_rxfh = fm10k_set_rssh,
1201 .get_channels = fm10k_get_channels,
1202 .set_channels = fm10k_set_channels,
1203 .get_ts_info = ethtool_op_get_ts_info,
1204};
1205
1206void fm10k_set_ethtool_ops(struct net_device *dev)
1207{
1208 dev->ethtool_ops = &fm10k_ethtool_ops;
1209}