Merge tag 'trace-v6.5' of git://git.kernel.org/pub/scm/linux/kernel/git/trace/linux...
[linux-block.git] / drivers / net / ethernet / sfc / nic.c
CommitLineData
d2912cb1 1// SPDX-License-Identifier: GPL-2.0-only
8e730c15 2/****************************************************************************
f7a6d2c4 3 * Driver for Solarflare network controllers and boards
8e730c15 4 * Copyright 2005-2006 Fen Systems Ltd.
f7a6d2c4 5 * Copyright 2006-2013 Solarflare Communications Inc.
8e730c15
BH
6 */
7
8#include <linux/bitops.h>
9#include <linux/delay.h>
a6b7a407 10#include <linux/interrupt.h>
8e730c15
BH
11#include <linux/pci.h>
12#include <linux/module.h>
13#include <linux/seq_file.h>
1899c111 14#include <linux/cpu_rmap.h>
8e730c15
BH
15#include "net_driver.h"
16#include "bitfield.h"
17#include "efx.h"
18#include "nic.h"
137b7922 19#include "ef10_regs.h"
8b8a95a1 20#include "farch_regs.h"
8e730c15
BH
21#include "io.h"
22#include "workarounds.h"
d3142c19 23#include "mcdi_pcol.h"
8e730c15 24
8e730c15
BH
25/**************************************************************************
26 *
27 * Generic buffer handling
f7251a9c 28 * These buffers are used for interrupt status, MAC stats, etc.
8e730c15
BH
29 *
30 **************************************************************************/
31
32int efx_nic_alloc_buffer(struct efx_nic *efx, struct efx_buffer *buffer,
0d19a540 33 unsigned int len, gfp_t gfp_flags)
8e730c15 34{
750afb08
LC
35 buffer->addr = dma_alloc_coherent(&efx->pci_dev->dev, len,
36 &buffer->dma_addr, gfp_flags);
8e730c15
BH
37 if (!buffer->addr)
38 return -ENOMEM;
39 buffer->len = len;
8e730c15
BH
40 return 0;
41}
42
43void efx_nic_free_buffer(struct efx_nic *efx, struct efx_buffer *buffer)
44{
45 if (buffer->addr) {
0e33d870
BH
46 dma_free_coherent(&efx->pci_dev->dev, buffer->len,
47 buffer->addr, buffer->dma_addr);
8e730c15
BH
48 buffer->addr = NULL;
49 }
50}
51
d4fabcc8
BH
52/* Check whether an event is present in the eventq at the current
53 * read pointer. Only useful for self-test.
54 */
55bool efx_nic_event_present(struct efx_channel *channel)
56{
57 return efx_event_present(efx_event(channel, channel->eventq_read_ptr));
58}
8e730c15 59
eee6f6a9 60void efx_nic_event_test_start(struct efx_channel *channel)
8e730c15 61{
dd40781e 62 channel->event_test_cpu = -1;
eee6f6a9 63 smp_wmb();
86094f7f 64 channel->efx->type->ev_test_generate(channel);
8e730c15
BH
65}
66
942e298e 67int efx_nic_irq_test_start(struct efx_nic *efx)
8e730c15 68{
eee6f6a9
BH
69 efx->last_irq_cpu = -1;
70 smp_wmb();
942e298e 71 return efx->type->irq_test_generate(efx);
8e730c15
BH
72}
73
74/* Hook interrupt handler(s)
75 * Try MSI and then legacy interrupts.
76 */
77int efx_nic_init_interrupt(struct efx_nic *efx)
78{
79 struct efx_channel *channel;
1899c111 80 unsigned int n_irqs;
8e730c15
BH
81 int rc;
82
83 if (!EFX_INT_MODE_USE_MSI(efx)) {
86094f7f
BH
84 rc = request_irq(efx->legacy_irq,
85 efx->type->irq_handle_legacy, IRQF_SHARED,
8e730c15
BH
86 efx->name, efx);
87 if (rc) {
62776d03
BH
88 netif_err(efx, drv, efx->net_dev,
89 "failed to hook legacy IRQ %d\n",
90 efx->pci_dev->irq);
8e730c15
BH
91 goto fail1;
92 }
8f03eeb6 93 efx->irqs_hooked = true;
8e730c15
BH
94 return 0;
95 }
96
1899c111
BH
97#ifdef CONFIG_RFS_ACCEL
98 if (efx->interrupt_mode == EFX_INT_MODE_MSIX) {
99 efx->net_dev->rx_cpu_rmap =
100 alloc_irq_cpu_rmap(efx->n_rx_channels);
101 if (!efx->net_dev->rx_cpu_rmap) {
102 rc = -ENOMEM;
103 goto fail1;
104 }
105 }
106#endif
107
8e730c15 108 /* Hook MSI or MSI-X interrupt */
1899c111 109 n_irqs = 0;
8e730c15 110 efx_for_each_channel(channel, efx) {
86094f7f 111 rc = request_irq(channel->irq, efx->type->irq_handle_msi,
8e730c15 112 IRQF_PROBE_SHARED, /* Not shared */
d8291187
BH
113 efx->msi_context[channel->channel].name,
114 &efx->msi_context[channel->channel]);
8e730c15 115 if (rc) {
62776d03
BH
116 netif_err(efx, drv, efx->net_dev,
117 "failed to hook IRQ %d\n", channel->irq);
8e730c15
BH
118 goto fail2;
119 }
1899c111
BH
120 ++n_irqs;
121
122#ifdef CONFIG_RFS_ACCEL
123 if (efx->interrupt_mode == EFX_INT_MODE_MSIX &&
124 channel->channel < efx->n_rx_channels) {
125 rc = irq_cpu_rmap_add(efx->net_dev->rx_cpu_rmap,
126 channel->irq);
127 if (rc)
128 goto fail2;
129 }
130#endif
8e730c15
BH
131 }
132
e6a43910 133 efx->irqs_hooked = true;
8e730c15
BH
134 return 0;
135
136 fail2:
1899c111
BH
137#ifdef CONFIG_RFS_ACCEL
138 free_irq_cpu_rmap(efx->net_dev->rx_cpu_rmap);
139 efx->net_dev->rx_cpu_rmap = NULL;
140#endif
141 efx_for_each_channel(channel, efx) {
142 if (n_irqs-- == 0)
143 break;
d8291187 144 free_irq(channel->irq, &efx->msi_context[channel->channel]);
1899c111 145 }
8e730c15
BH
146 fail1:
147 return rc;
148}
149
150void efx_nic_fini_interrupt(struct efx_nic *efx)
151{
152 struct efx_channel *channel;
8e730c15 153
1899c111
BH
154#ifdef CONFIG_RFS_ACCEL
155 free_irq_cpu_rmap(efx->net_dev->rx_cpu_rmap);
156 efx->net_dev->rx_cpu_rmap = NULL;
157#endif
158
e6a43910
EC
159 if (!efx->irqs_hooked)
160 return;
1c363900
NA
161 if (EFX_INT_MODE_USE_MSI(efx)) {
162 /* Disable MSI/MSI-X interrupts */
163 efx_for_each_channel(channel, efx)
164 free_irq(channel->irq,
165 &efx->msi_context[channel->channel]);
166 } else {
167 /* Disable legacy interrupt */
8e730c15 168 free_irq(efx->legacy_irq, efx);
1c363900 169 }
e6a43910 170 efx->irqs_hooked = false;
8e730c15
BH
171}
172
5b98c1bf
BH
173/* Register dump */
174
137b7922
BH
175#define REGISTER_REVISION_FA 1
176#define REGISTER_REVISION_FB 2
177#define REGISTER_REVISION_FC 3
178#define REGISTER_REVISION_FZ 3 /* last Falcon arch revision */
179#define REGISTER_REVISION_ED 4
180#define REGISTER_REVISION_EZ 4 /* latest EF10 revision */
5b98c1bf
BH
181
182struct efx_nic_reg {
183 u32 offset:24;
137b7922 184 u32 min_revision:3, max_revision:3;
5b98c1bf
BH
185};
186
137b7922
BH
187#define REGISTER(name, arch, min_rev, max_rev) { \
188 arch ## R_ ## min_rev ## max_rev ## _ ## name, \
189 REGISTER_REVISION_ ## arch ## min_rev, \
190 REGISTER_REVISION_ ## arch ## max_rev \
5b98c1bf 191}
137b7922
BH
192#define REGISTER_AA(name) REGISTER(name, F, A, A)
193#define REGISTER_AB(name) REGISTER(name, F, A, B)
194#define REGISTER_AZ(name) REGISTER(name, F, A, Z)
195#define REGISTER_BB(name) REGISTER(name, F, B, B)
196#define REGISTER_BZ(name) REGISTER(name, F, B, Z)
197#define REGISTER_CZ(name) REGISTER(name, F, C, Z)
198#define REGISTER_DZ(name) REGISTER(name, E, D, Z)
5b98c1bf
BH
199
200static const struct efx_nic_reg efx_nic_regs[] = {
201 REGISTER_AZ(ADR_REGION),
202 REGISTER_AZ(INT_EN_KER),
203 REGISTER_BZ(INT_EN_CHAR),
204 REGISTER_AZ(INT_ADR_KER),
205 REGISTER_BZ(INT_ADR_CHAR),
206 /* INT_ACK_KER is WO */
207 /* INT_ISR0 is RC */
208 REGISTER_AZ(HW_INIT),
209 REGISTER_CZ(USR_EV_CFG),
210 REGISTER_AB(EE_SPI_HCMD),
211 REGISTER_AB(EE_SPI_HADR),
212 REGISTER_AB(EE_SPI_HDATA),
213 REGISTER_AB(EE_BASE_PAGE),
214 REGISTER_AB(EE_VPD_CFG0),
215 /* EE_VPD_SW_CNTL and EE_VPD_SW_DATA are not used */
216 /* PMBX_DBG_IADDR and PBMX_DBG_IDATA are indirect */
217 /* PCIE_CORE_INDIRECT is indirect */
218 REGISTER_AB(NIC_STAT),
219 REGISTER_AB(GPIO_CTL),
220 REGISTER_AB(GLB_CTL),
221 /* FATAL_INTR_KER and FATAL_INTR_CHAR are partly RC */
222 REGISTER_BZ(DP_CTRL),
223 REGISTER_AZ(MEM_STAT),
224 REGISTER_AZ(CS_DEBUG),
225 REGISTER_AZ(ALTERA_BUILD),
226 REGISTER_AZ(CSR_SPARE),
227 REGISTER_AB(PCIE_SD_CTL0123),
228 REGISTER_AB(PCIE_SD_CTL45),
229 REGISTER_AB(PCIE_PCS_CTL_STAT),
230 /* DEBUG_DATA_OUT is not used */
231 /* DRV_EV is WO */
232 REGISTER_AZ(EVQ_CTL),
233 REGISTER_AZ(EVQ_CNT1),
234 REGISTER_AZ(EVQ_CNT2),
235 REGISTER_AZ(BUF_TBL_CFG),
236 REGISTER_AZ(SRM_RX_DC_CFG),
237 REGISTER_AZ(SRM_TX_DC_CFG),
238 REGISTER_AZ(SRM_CFG),
239 /* BUF_TBL_UPD is WO */
240 REGISTER_AZ(SRM_UPD_EVQ),
241 REGISTER_AZ(SRAM_PARITY),
242 REGISTER_AZ(RX_CFG),
243 REGISTER_BZ(RX_FILTER_CTL),
244 /* RX_FLUSH_DESCQ is WO */
245 REGISTER_AZ(RX_DC_CFG),
246 REGISTER_AZ(RX_DC_PF_WM),
247 REGISTER_BZ(RX_RSS_TKEY),
248 /* RX_NODESC_DROP is RC */
249 REGISTER_AA(RX_SELF_RST),
250 /* RX_DEBUG, RX_PUSH_DROP are not used */
251 REGISTER_CZ(RX_RSS_IPV6_REG1),
252 REGISTER_CZ(RX_RSS_IPV6_REG2),
253 REGISTER_CZ(RX_RSS_IPV6_REG3),
254 /* TX_FLUSH_DESCQ is WO */
255 REGISTER_AZ(TX_DC_CFG),
256 REGISTER_AA(TX_CHKSM_CFG),
257 REGISTER_AZ(TX_CFG),
258 /* TX_PUSH_DROP is not used */
259 REGISTER_AZ(TX_RESERVED),
260 REGISTER_BZ(TX_PACE),
261 /* TX_PACE_DROP_QID is RC */
262 REGISTER_BB(TX_VLAN),
263 REGISTER_BZ(TX_IPFIL_PORTEN),
264 REGISTER_AB(MD_TXD),
265 REGISTER_AB(MD_RXD),
266 REGISTER_AB(MD_CS),
267 REGISTER_AB(MD_PHY_ADR),
268 REGISTER_AB(MD_ID),
269 /* MD_STAT is RC */
270 REGISTER_AB(MAC_STAT_DMA),
271 REGISTER_AB(MAC_CTRL),
272 REGISTER_BB(GEN_MODE),
273 REGISTER_AB(MAC_MC_HASH_REG0),
274 REGISTER_AB(MAC_MC_HASH_REG1),
275 REGISTER_AB(GM_CFG1),
276 REGISTER_AB(GM_CFG2),
277 /* GM_IPG and GM_HD are not used */
278 REGISTER_AB(GM_MAX_FLEN),
279 /* GM_TEST is not used */
280 REGISTER_AB(GM_ADR1),
281 REGISTER_AB(GM_ADR2),
282 REGISTER_AB(GMF_CFG0),
283 REGISTER_AB(GMF_CFG1),
284 REGISTER_AB(GMF_CFG2),
285 REGISTER_AB(GMF_CFG3),
286 REGISTER_AB(GMF_CFG4),
287 REGISTER_AB(GMF_CFG5),
288 REGISTER_BB(TX_SRC_MAC_CTL),
289 REGISTER_AB(XM_ADR_LO),
290 REGISTER_AB(XM_ADR_HI),
291 REGISTER_AB(XM_GLB_CFG),
292 REGISTER_AB(XM_TX_CFG),
293 REGISTER_AB(XM_RX_CFG),
294 REGISTER_AB(XM_MGT_INT_MASK),
295 REGISTER_AB(XM_FC),
296 REGISTER_AB(XM_PAUSE_TIME),
297 REGISTER_AB(XM_TX_PARAM),
298 REGISTER_AB(XM_RX_PARAM),
299 /* XM_MGT_INT_MSK (note no 'A') is RC */
300 REGISTER_AB(XX_PWR_RST),
301 REGISTER_AB(XX_SD_CTL),
302 REGISTER_AB(XX_TXDRV_CTL),
303 /* XX_PRBS_CTL, XX_PRBS_CHK and XX_PRBS_ERR are not used */
304 /* XX_CORE_STAT is partly RC */
137b7922
BH
305 REGISTER_DZ(BIU_HW_REV_ID),
306 REGISTER_DZ(MC_DB_LWRD),
307 REGISTER_DZ(MC_DB_HWRD),
5b98c1bf
BH
308};
309
310struct efx_nic_reg_table {
311 u32 offset:24;
137b7922 312 u32 min_revision:3, max_revision:3;
5b98c1bf
BH
313 u32 step:6, rows:21;
314};
315
137b7922 316#define REGISTER_TABLE_DIMENSIONS(_, offset, arch, min_rev, max_rev, step, rows) { \
5b98c1bf 317 offset, \
137b7922
BH
318 REGISTER_REVISION_ ## arch ## min_rev, \
319 REGISTER_REVISION_ ## arch ## max_rev, \
5b98c1bf
BH
320 step, rows \
321}
137b7922 322#define REGISTER_TABLE(name, arch, min_rev, max_rev) \
5b98c1bf 323 REGISTER_TABLE_DIMENSIONS( \
137b7922
BH
324 name, arch ## R_ ## min_rev ## max_rev ## _ ## name, \
325 arch, min_rev, max_rev, \
326 arch ## R_ ## min_rev ## max_rev ## _ ## name ## _STEP, \
327 arch ## R_ ## min_rev ## max_rev ## _ ## name ## _ROWS)
328#define REGISTER_TABLE_AA(name) REGISTER_TABLE(name, F, A, A)
329#define REGISTER_TABLE_AZ(name) REGISTER_TABLE(name, F, A, Z)
330#define REGISTER_TABLE_BB(name) REGISTER_TABLE(name, F, B, B)
331#define REGISTER_TABLE_BZ(name) REGISTER_TABLE(name, F, B, Z)
5b98c1bf 332#define REGISTER_TABLE_BB_CZ(name) \
137b7922 333 REGISTER_TABLE_DIMENSIONS(name, FR_BZ_ ## name, F, B, B, \
5b98c1bf
BH
334 FR_BZ_ ## name ## _STEP, \
335 FR_BB_ ## name ## _ROWS), \
137b7922 336 REGISTER_TABLE_DIMENSIONS(name, FR_BZ_ ## name, F, C, Z, \
5b98c1bf
BH
337 FR_BZ_ ## name ## _STEP, \
338 FR_CZ_ ## name ## _ROWS)
137b7922
BH
339#define REGISTER_TABLE_CZ(name) REGISTER_TABLE(name, F, C, Z)
340#define REGISTER_TABLE_DZ(name) REGISTER_TABLE(name, E, D, Z)
5b98c1bf
BH
341
342static const struct efx_nic_reg_table efx_nic_reg_tables[] = {
343 /* DRIVER is not used */
344 /* EVQ_RPTR, TIMER_COMMAND, USR_EV and {RX,TX}_DESC_UPD are WO */
345 REGISTER_TABLE_BB(TX_IPFIL_TBL),
346 REGISTER_TABLE_BB(TX_SRC_MAC_TBL),
347 REGISTER_TABLE_AA(RX_DESC_PTR_TBL_KER),
348 REGISTER_TABLE_BB_CZ(RX_DESC_PTR_TBL),
349 REGISTER_TABLE_AA(TX_DESC_PTR_TBL_KER),
350 REGISTER_TABLE_BB_CZ(TX_DESC_PTR_TBL),
351 REGISTER_TABLE_AA(EVQ_PTR_TBL_KER),
352 REGISTER_TABLE_BB_CZ(EVQ_PTR_TBL),
75abc51c 353 /* We can't reasonably read all of the buffer table (up to 8MB!).
5b98c1bf
BH
354 * However this driver will only use a few entries. Reading
355 * 1K entries allows for some expansion of queue count and
356 * size before we need to change the version. */
357 REGISTER_TABLE_DIMENSIONS(BUF_FULL_TBL_KER, FR_AA_BUF_FULL_TBL_KER,
137b7922 358 F, A, A, 8, 1024),
5b98c1bf 359 REGISTER_TABLE_DIMENSIONS(BUF_FULL_TBL, FR_BZ_BUF_FULL_TBL,
137b7922 360 F, B, Z, 8, 1024),
5b98c1bf
BH
361 REGISTER_TABLE_CZ(RX_MAC_FILTER_TBL0),
362 REGISTER_TABLE_BB_CZ(TIMER_TBL),
363 REGISTER_TABLE_BB_CZ(TX_PACE_TBL),
364 REGISTER_TABLE_BZ(RX_INDIRECTION_TBL),
365 /* TX_FILTER_TBL0 is huge and not used by this driver */
366 REGISTER_TABLE_CZ(TX_MAC_FILTER_TBL0),
367 REGISTER_TABLE_CZ(MC_TREG_SMEM),
368 /* MSIX_PBA_TABLE is not mapped */
369 /* SRM_DBG is not mapped (and is redundant with BUF_FLL_TBL) */
75abc51c 370 REGISTER_TABLE_BZ(RX_FILTER_TBL0),
137b7922 371 REGISTER_TABLE_DZ(BIU_MC_SFT_STATUS),
5b98c1bf
BH
372};
373
374size_t efx_nic_get_regs_len(struct efx_nic *efx)
375{
376 const struct efx_nic_reg *reg;
377 const struct efx_nic_reg_table *table;
378 size_t len = 0;
379
380 for (reg = efx_nic_regs;
381 reg < efx_nic_regs + ARRAY_SIZE(efx_nic_regs);
382 reg++)
383 if (efx->type->revision >= reg->min_revision &&
384 efx->type->revision <= reg->max_revision)
385 len += sizeof(efx_oword_t);
386
387 for (table = efx_nic_reg_tables;
388 table < efx_nic_reg_tables + ARRAY_SIZE(efx_nic_reg_tables);
389 table++)
390 if (efx->type->revision >= table->min_revision &&
391 efx->type->revision <= table->max_revision)
392 len += table->rows * min_t(size_t, table->step, 16);
393
394 return len;
395}
396
397void efx_nic_get_regs(struct efx_nic *efx, void *buf)
398{
399 const struct efx_nic_reg *reg;
400 const struct efx_nic_reg_table *table;
401
402 for (reg = efx_nic_regs;
403 reg < efx_nic_regs + ARRAY_SIZE(efx_nic_regs);
404 reg++) {
405 if (efx->type->revision >= reg->min_revision &&
406 efx->type->revision <= reg->max_revision) {
407 efx_reado(efx, (efx_oword_t *)buf, reg->offset);
408 buf += sizeof(efx_oword_t);
409 }
410 }
411
412 for (table = efx_nic_reg_tables;
413 table < efx_nic_reg_tables + ARRAY_SIZE(efx_nic_reg_tables);
414 table++) {
415 size_t size, i;
416
417 if (!(efx->type->revision >= table->min_revision &&
418 efx->type->revision <= table->max_revision))
419 continue;
420
421 size = min_t(size_t, table->step, 16);
422
423 for (i = 0; i < table->rows; i++) {
424 switch (table->step) {
778cdaf6
BH
425 case 4: /* 32-bit SRAM */
426 efx_readd(efx, buf, table->offset + 4 * i);
5b98c1bf
BH
427 break;
428 case 8: /* 64-bit SRAM */
429 efx_sram_readq(efx,
430 efx->membase + table->offset,
431 buf, i);
432 break;
778cdaf6 433 case 16: /* 128-bit-readable register */
5b98c1bf
BH
434 efx_reado_table(efx, buf, table->offset, i);
435 break;
436 case 32: /* 128-bit register, interleaved */
437 efx_reado_table(efx, buf, table->offset, 2 * i);
438 break;
439 default:
440 WARN_ON(1);
441 return;
442 }
443 buf += size;
444 }
445 }
446}
cd0ecc9a
BH
447
448/**
449 * efx_nic_describe_stats - Describe supported statistics for ethtool
450 * @desc: Array of &struct efx_hw_stat_desc describing the statistics
451 * @count: Length of the @desc array
452 * @mask: Bitmask of which elements of @desc are enabled
453 * @names: Buffer to copy names to, or %NULL. The names are copied
454 * starting at intervals of %ETH_GSTRING_LEN bytes.
455 *
456 * Returns the number of visible statistics, i.e. the number of set
457 * bits in the first @count bits of @mask for which a name is defined.
458 */
459size_t efx_nic_describe_stats(const struct efx_hw_stat_desc *desc, size_t count,
460 const unsigned long *mask, u8 *names)
461{
462 size_t visible = 0;
463 size_t index;
464
465 for_each_set_bit(index, mask, count) {
466 if (desc[index].name) {
467 if (names) {
f029c781 468 strscpy(names, desc[index].name,
cd0ecc9a
BH
469 ETH_GSTRING_LEN);
470 names += ETH_GSTRING_LEN;
471 }
472 ++visible;
473 }
474 }
475
476 return visible;
477}
478
d3142c19
EC
479/**
480 * efx_nic_copy_stats - Copy stats from the DMA buffer in to an
481 * intermediate buffer. This is used to get a consistent
482 * set of stats while the DMA buffer can be written at any time
483 * by the NIC.
484 * @efx: The associated NIC.
485 * @dest: Destination buffer. Must be the same size as the DMA buffer.
486 */
487int efx_nic_copy_stats(struct efx_nic *efx, __le64 *dest)
488{
489 __le64 *dma_stats = efx->stats_buffer.addr;
490 __le64 generation_start, generation_end;
491 int rc = 0, retry;
492
493 if (!dest)
494 return 0;
495
496 if (!dma_stats)
497 goto return_zeroes;
498
499 /* If we're unlucky enough to read statistics during the DMA, wait
500 * up to 10ms for it to finish (typically takes <500us)
501 */
502 for (retry = 0; retry < 100; ++retry) {
503 generation_end = dma_stats[efx->num_mac_stats - 1];
504 if (generation_end == EFX_MC_STATS_GENERATION_INVALID)
505 goto return_zeroes;
506 rmb();
507 memcpy(dest, dma_stats, efx->num_mac_stats * sizeof(__le64));
508 rmb();
509 generation_start = dma_stats[MC_CMD_MAC_GENERATION_START];
510 if (generation_end == generation_start)
511 return 0; /* return good data */
512 udelay(100);
513 }
514
515 rc = -EIO;
516
517return_zeroes:
518 memset(dest, 0, efx->num_mac_stats * sizeof(u64));
519 return rc;
520}
521
cd0ecc9a
BH
522/**
523 * efx_nic_update_stats - Convert statistics DMA buffer to array of u64
524 * @desc: Array of &struct efx_hw_stat_desc describing the DMA buffer
525 * layout. DMA widths of 0, 16, 32 and 64 are supported; where
526 * the width is specified as 0 the corresponding element of
527 * @stats is not updated.
528 * @count: Length of the @desc array
529 * @mask: Bitmask of which elements of @desc are enabled
530 * @stats: Buffer to update with the converted statistics. The length
87648cc9 531 * of this array must be at least @count.
cd0ecc9a
BH
532 * @dma_buf: DMA buffer containing hardware statistics
533 * @accumulate: If set, the converted values will be added rather than
534 * directly stored to the corresponding elements of @stats
535 */
536void efx_nic_update_stats(const struct efx_hw_stat_desc *desc, size_t count,
537 const unsigned long *mask,
538 u64 *stats, const void *dma_buf, bool accumulate)
539{
540 size_t index;
541
542 for_each_set_bit(index, mask, count) {
543 if (desc[index].dma_width) {
544 const void *addr = dma_buf + desc[index].offset;
545 u64 val;
546
547 switch (desc[index].dma_width) {
548 case 16:
549 val = le16_to_cpup((__le16 *)addr);
550 break;
551 case 32:
552 val = le32_to_cpup((__le32 *)addr);
553 break;
554 case 64:
555 val = le64_to_cpup((__le64 *)addr);
556 break;
557 default:
558 WARN_ON(1);
559 val = 0;
560 break;
561 }
562
563 if (accumulate)
87648cc9 564 stats[index] += val;
cd0ecc9a 565 else
87648cc9 566 stats[index] = val;
cd0ecc9a 567 }
cd0ecc9a
BH
568 }
569}
f8f3b5ae
JC
570
571void efx_nic_fix_nodesc_drop_stat(struct efx_nic *efx, u64 *rx_nodesc_drops)
572{
573 /* if down, or this is the first update after coming up */
574 if (!(efx->net_dev->flags & IFF_UP) || !efx->rx_nodesc_drops_prev_state)
575 efx->rx_nodesc_drops_while_down +=
576 *rx_nodesc_drops - efx->rx_nodesc_drops_total;
577 efx->rx_nodesc_drops_total = *rx_nodesc_drops;
578 efx->rx_nodesc_drops_prev_state = !!(efx->net_dev->flags & IFF_UP);
579 *rx_nodesc_drops -= efx->rx_nodesc_drops_while_down;
580}