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