[linux-2.6-block.git] / drivers / net / ethernet / sfc / nic.c

/****************************************************************************
 * Driver for Solarflare Solarstorm network controllers and boards
 * Copyright 2005-2006 Fen Systems Ltd.
 * Copyright 2006-2011 Solarflare Communications Inc.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published
 * by the Free Software Foundation, incorporated herein by reference.
 */

#include <linux/bitops.h>
#include <linux/delay.h>
#include <linux/interrupt.h>
#include <linux/pci.h>
#include <linux/module.h>
#include <linux/seq_file.h>
#include <linux/cpu_rmap.h>
#include "net_driver.h"
#include "bitfield.h"
#include "efx.h"
#include "nic.h"
#include "farch_regs.h"
#include "io.h"
#include "workarounds.h"

/**************************************************************************
 *
 * Generic buffer handling
 * These buffers are used for interrupt status, MAC stats, etc.
 *
 **************************************************************************/

int efx_nic_alloc_buffer(struct efx_nic *efx, struct efx_buffer *buffer,
			 unsigned int len, gfp_t gfp_flags)
{
	buffer->addr = dma_alloc_coherent(&efx->pci_dev->dev, len,
					  &buffer->dma_addr,
					  gfp_flags | __GFP_ZERO);
	if (!buffer->addr)
		return -ENOMEM;
	buffer->len = len;
	return 0;
}

void efx_nic_free_buffer(struct efx_nic *efx, struct efx_buffer *buffer)
{
	if (buffer->addr) {
		dma_free_coherent(&efx->pci_dev->dev, buffer->len,
				  buffer->addr, buffer->dma_addr);
		buffer->addr = NULL;
	}
}

/* Check whether an event is present in the eventq at the current
 * read pointer.  Only useful for self-test.
 */
bool efx_nic_event_present(struct efx_channel *channel)
{
	return efx_event_present(efx_event(channel, channel->eventq_read_ptr));
}

void efx_nic_event_test_start(struct efx_channel *channel)
{
	channel->event_test_cpu = -1;
	smp_wmb();
	channel->efx->type->ev_test_generate(channel);
}

void efx_nic_irq_test_start(struct efx_nic *efx)
{
	efx->last_irq_cpu = -1;
	smp_wmb();
	efx->type->irq_test_generate(efx);
}

/* Hook interrupt handler(s)
 * Try MSI and then legacy interrupts.
 */
int efx_nic_init_interrupt(struct efx_nic *efx)
{
	struct efx_channel *channel;
	unsigned int n_irqs;
	int rc;

	if (!EFX_INT_MODE_USE_MSI(efx)) {
		rc = request_irq(efx->legacy_irq,
				 efx->type->irq_handle_legacy, IRQF_SHARED,
				 efx->name, efx);
		if (rc) {
			netif_err(efx, drv, efx->net_dev,
				  "failed to hook legacy IRQ %d\n",
				  efx->pci_dev->irq);
			goto fail1;
		}
		return 0;
	}

#ifdef CONFIG_RFS_ACCEL
	if (efx->interrupt_mode == EFX_INT_MODE_MSIX) {
		efx->net_dev->rx_cpu_rmap =
			alloc_irq_cpu_rmap(efx->n_rx_channels);
		if (!efx->net_dev->rx_cpu_rmap) {
			rc = -ENOMEM;
			goto fail1;
		}
	}
#endif

	/* Hook MSI or MSI-X interrupt */
	n_irqs = 0;
	efx_for_each_channel(channel, efx) {
		rc = request_irq(channel->irq, efx->type->irq_handle_msi,
				 IRQF_PROBE_SHARED, /* Not shared */
				 efx->msi_context[channel->channel].name,
				 &efx->msi_context[channel->channel]);
		if (rc) {
			netif_err(efx, drv, efx->net_dev,
				  "failed to hook IRQ %d\n", channel->irq);
			goto fail2;
		}
		++n_irqs;

#ifdef CONFIG_RFS_ACCEL
		if (efx->interrupt_mode == EFX_INT_MODE_MSIX &&
		    channel->channel < efx->n_rx_channels) {
			rc = irq_cpu_rmap_add(efx->net_dev->rx_cpu_rmap,
					      channel->irq);
			if (rc)
				goto fail2;
		}
#endif
	}

	return 0;

 fail2:
#ifdef CONFIG_RFS_ACCEL
	free_irq_cpu_rmap(efx->net_dev->rx_cpu_rmap);
	efx->net_dev->rx_cpu_rmap = NULL;
#endif
	efx_for_each_channel(channel, efx) {
		if (n_irqs-- == 0)
			break;
		free_irq(channel->irq, &efx->msi_context[channel->channel]);
	}
 fail1:
	return rc;
}

void efx_nic_fini_interrupt(struct efx_nic *efx)
{
	struct efx_channel *channel;

#ifdef CONFIG_RFS_ACCEL
	free_irq_cpu_rmap(efx->net_dev->rx_cpu_rmap);
	efx->net_dev->rx_cpu_rmap = NULL;
#endif

	/* Disable MSI/MSI-X interrupts */
	efx_for_each_channel(channel, efx)
		free_irq(channel->irq, &efx->msi_context[channel->channel]);

	/* Disable legacy interrupt */
	if (efx->legacy_irq)
		free_irq(efx->legacy_irq, efx);
}

/* Register dump */

#define REGISTER_REVISION_A	1
#define REGISTER_REVISION_B	2
#define REGISTER_REVISION_C	3
#define REGISTER_REVISION_Z	3	/* latest revision */

struct efx_nic_reg {
	u32 offset:24;
	u32 min_revision:2, max_revision:2;
};

#define REGISTER(name, min_rev, max_rev) {				\
	FR_ ## min_rev ## max_rev ## _ ## name,				\
	REGISTER_REVISION_ ## min_rev, REGISTER_REVISION_ ## max_rev	\
}
#define REGISTER_AA(name) REGISTER(name, A, A)
#define REGISTER_AB(name) REGISTER(name, A, B)
#define REGISTER_AZ(name) REGISTER(name, A, Z)
#define REGISTER_BB(name) REGISTER(name, B, B)
#define REGISTER_BZ(name) REGISTER(name, B, Z)
#define REGISTER_CZ(name) REGISTER(name, C, Z)

static const struct efx_nic_reg efx_nic_regs[] = {
	REGISTER_AZ(ADR_REGION),
	REGISTER_AZ(INT_EN_KER),
	REGISTER_BZ(INT_EN_CHAR),
	REGISTER_AZ(INT_ADR_KER),
	REGISTER_BZ(INT_ADR_CHAR),
	/* INT_ACK_KER is WO */
	/* INT_ISR0 is RC */
	REGISTER_AZ(HW_INIT),
	REGISTER_CZ(USR_EV_CFG),
	REGISTER_AB(EE_SPI_HCMD),
	REGISTER_AB(EE_SPI_HADR),
	REGISTER_AB(EE_SPI_HDATA),
	REGISTER_AB(EE_BASE_PAGE),
	REGISTER_AB(EE_VPD_CFG0),
	/* EE_VPD_SW_CNTL and EE_VPD_SW_DATA are not used */
	/* PMBX_DBG_IADDR and PBMX_DBG_IDATA are indirect */
	/* PCIE_CORE_INDIRECT is indirect */
	REGISTER_AB(NIC_STAT),
	REGISTER_AB(GPIO_CTL),
	REGISTER_AB(GLB_CTL),
	/* FATAL_INTR_KER and FATAL_INTR_CHAR are partly RC */
	REGISTER_BZ(DP_CTRL),
	REGISTER_AZ(MEM_STAT),
	REGISTER_AZ(CS_DEBUG),
	REGISTER_AZ(ALTERA_BUILD),
	REGISTER_AZ(CSR_SPARE),
	REGISTER_AB(PCIE_SD_CTL0123),
	REGISTER_AB(PCIE_SD_CTL45),
	REGISTER_AB(PCIE_PCS_CTL_STAT),
	/* DEBUG_DATA_OUT is not used */
	/* DRV_EV is WO */
	REGISTER_AZ(EVQ_CTL),
	REGISTER_AZ(EVQ_CNT1),
	REGISTER_AZ(EVQ_CNT2),
	REGISTER_AZ(BUF_TBL_CFG),
	REGISTER_AZ(SRM_RX_DC_CFG),
	REGISTER_AZ(SRM_TX_DC_CFG),
	REGISTER_AZ(SRM_CFG),
	/* BUF_TBL_UPD is WO */
	REGISTER_AZ(SRM_UPD_EVQ),
	REGISTER_AZ(SRAM_PARITY),
	REGISTER_AZ(RX_CFG),
	REGISTER_BZ(RX_FILTER_CTL),
	/* RX_FLUSH_DESCQ is WO */
	REGISTER_AZ(RX_DC_CFG),
	REGISTER_AZ(RX_DC_PF_WM),
	REGISTER_BZ(RX_RSS_TKEY),
	/* RX_NODESC_DROP is RC */
	REGISTER_AA(RX_SELF_RST),
	/* RX_DEBUG, RX_PUSH_DROP are not used */
	REGISTER_CZ(RX_RSS_IPV6_REG1),
	REGISTER_CZ(RX_RSS_IPV6_REG2),
	REGISTER_CZ(RX_RSS_IPV6_REG3),
	/* TX_FLUSH_DESCQ is WO */
	REGISTER_AZ(TX_DC_CFG),
	REGISTER_AA(TX_CHKSM_CFG),
	REGISTER_AZ(TX_CFG),
	/* TX_PUSH_DROP is not used */
	REGISTER_AZ(TX_RESERVED),
	REGISTER_BZ(TX_PACE),
	/* TX_PACE_DROP_QID is RC */
	REGISTER_BB(TX_VLAN),
	REGISTER_BZ(TX_IPFIL_PORTEN),
	REGISTER_AB(MD_TXD),
	REGISTER_AB(MD_RXD),
	REGISTER_AB(MD_CS),
	REGISTER_AB(MD_PHY_ADR),
	REGISTER_AB(MD_ID),
	/* MD_STAT is RC */
	REGISTER_AB(MAC_STAT_DMA),
	REGISTER_AB(MAC_CTRL),
	REGISTER_BB(GEN_MODE),
	REGISTER_AB(MAC_MC_HASH_REG0),
	REGISTER_AB(MAC_MC_HASH_REG1),
	REGISTER_AB(GM_CFG1),
	REGISTER_AB(GM_CFG2),
	/* GM_IPG and GM_HD are not used */
	REGISTER_AB(GM_MAX_FLEN),
	/* GM_TEST is not used */
	REGISTER_AB(GM_ADR1),
	REGISTER_AB(GM_ADR2),
	REGISTER_AB(GMF_CFG0),
	REGISTER_AB(GMF_CFG1),
	REGISTER_AB(GMF_CFG2),
	REGISTER_AB(GMF_CFG3),
	REGISTER_AB(GMF_CFG4),
	REGISTER_AB(GMF_CFG5),
	REGISTER_BB(TX_SRC_MAC_CTL),
	REGISTER_AB(XM_ADR_LO),
	REGISTER_AB(XM_ADR_HI),
	REGISTER_AB(XM_GLB_CFG),
	REGISTER_AB(XM_TX_CFG),
	REGISTER_AB(XM_RX_CFG),
	REGISTER_AB(XM_MGT_INT_MASK),
	REGISTER_AB(XM_FC),
	REGISTER_AB(XM_PAUSE_TIME),
	REGISTER_AB(XM_TX_PARAM),
	REGISTER_AB(XM_RX_PARAM),
	/* XM_MGT_INT_MSK (note no 'A') is RC */
	REGISTER_AB(XX_PWR_RST),
	REGISTER_AB(XX_SD_CTL),
	REGISTER_AB(XX_TXDRV_CTL),
	/* XX_PRBS_CTL, XX_PRBS_CHK and XX_PRBS_ERR are not used */
	/* XX_CORE_STAT is partly RC */
};

struct efx_nic_reg_table {
	u32 offset:24;
	u32 min_revision:2, max_revision:2;
	u32 step:6, rows:21;
};

#define REGISTER_TABLE_DIMENSIONS(_, offset, min_rev, max_rev, step, rows) { \
	offset,								\
	REGISTER_REVISION_ ## min_rev, REGISTER_REVISION_ ## max_rev,	\
	step, rows							\
}
#define REGISTER_TABLE(name, min_rev, max_rev)				\
	REGISTER_TABLE_DIMENSIONS(					\
		name, FR_ ## min_rev ## max_rev ## _ ## name,		\
		min_rev, max_rev,					\
		FR_ ## min_rev ## max_rev ## _ ## name ## _STEP,	\
		FR_ ## min_rev ## max_rev ## _ ## name ## _ROWS)
#define REGISTER_TABLE_AA(name) REGISTER_TABLE(name, A, A)
#define REGISTER_TABLE_AZ(name) REGISTER_TABLE(name, A, Z)
#define REGISTER_TABLE_BB(name) REGISTER_TABLE(name, B, B)
#define REGISTER_TABLE_BZ(name) REGISTER_TABLE(name, B, Z)
#define REGISTER_TABLE_BB_CZ(name)					\
	REGISTER_TABLE_DIMENSIONS(name, FR_BZ_ ## name, B, B,		\
				  FR_BZ_ ## name ## _STEP,		\
				  FR_BB_ ## name ## _ROWS),		\
	REGISTER_TABLE_DIMENSIONS(name, FR_BZ_ ## name, C, Z,		\
				  FR_BZ_ ## name ## _STEP,		\
				  FR_CZ_ ## name ## _ROWS)
#define REGISTER_TABLE_CZ(name) REGISTER_TABLE(name, C, Z)

static const struct efx_nic_reg_table efx_nic_reg_tables[] = {
	/* DRIVER is not used */
	/* EVQ_RPTR, TIMER_COMMAND, USR_EV and {RX,TX}_DESC_UPD are WO */
	REGISTER_TABLE_BB(TX_IPFIL_TBL),
	REGISTER_TABLE_BB(TX_SRC_MAC_TBL),
	REGISTER_TABLE_AA(RX_DESC_PTR_TBL_KER),
	REGISTER_TABLE_BB_CZ(RX_DESC_PTR_TBL),
	REGISTER_TABLE_AA(TX_DESC_PTR_TBL_KER),
	REGISTER_TABLE_BB_CZ(TX_DESC_PTR_TBL),
	REGISTER_TABLE_AA(EVQ_PTR_TBL_KER),
	REGISTER_TABLE_BB_CZ(EVQ_PTR_TBL),
	/* We can't reasonably read all of the buffer table (up to 8MB!).
	 * However this driver will only use a few entries.  Reading
	 * 1K entries allows for some expansion of queue count and
	 * size before we need to change the version. */
	REGISTER_TABLE_DIMENSIONS(BUF_FULL_TBL_KER, FR_AA_BUF_FULL_TBL_KER,
				  A, A, 8, 1024),
	REGISTER_TABLE_DIMENSIONS(BUF_FULL_TBL, FR_BZ_BUF_FULL_TBL,
				  B, Z, 8, 1024),
	REGISTER_TABLE_CZ(RX_MAC_FILTER_TBL0),
	REGISTER_TABLE_BB_CZ(TIMER_TBL),
	REGISTER_TABLE_BB_CZ(TX_PACE_TBL),
	REGISTER_TABLE_BZ(RX_INDIRECTION_TBL),
	/* TX_FILTER_TBL0 is huge and not used by this driver */
	REGISTER_TABLE_CZ(TX_MAC_FILTER_TBL0),
	REGISTER_TABLE_CZ(MC_TREG_SMEM),
	/* MSIX_PBA_TABLE is not mapped */
	/* SRM_DBG is not mapped (and is redundant with BUF_FLL_TBL) */
	REGISTER_TABLE_BZ(RX_FILTER_TBL0),
};

size_t efx_nic_get_regs_len(struct efx_nic *efx)
{
	const struct efx_nic_reg *reg;
	const struct efx_nic_reg_table *table;
	size_t len = 0;

	for (reg = efx_nic_regs;
	     reg < efx_nic_regs + ARRAY_SIZE(efx_nic_regs);
	     reg++)
		if (efx->type->revision >= reg->min_revision &&
		    efx->type->revision <= reg->max_revision)
			len += sizeof(efx_oword_t);

	for (table = efx_nic_reg_tables;
	     table < efx_nic_reg_tables + ARRAY_SIZE(efx_nic_reg_tables);
	     table++)
		if (efx->type->revision >= table->min_revision &&
		    efx->type->revision <= table->max_revision)
			len += table->rows * min_t(size_t, table->step, 16);

	return len;
}

void efx_nic_get_regs(struct efx_nic *efx, void *buf)
{
	const struct efx_nic_reg *reg;
	const struct efx_nic_reg_table *table;

	for (reg = efx_nic_regs;
	     reg < efx_nic_regs + ARRAY_SIZE(efx_nic_regs);
	     reg++) {
		if (efx->type->revision >= reg->min_revision &&
		    efx->type->revision <= reg->max_revision) {
			efx_reado(efx, (efx_oword_t *)buf, reg->offset);
			buf += sizeof(efx_oword_t);
		}
	}

	for (table = efx_nic_reg_tables;
	     table < efx_nic_reg_tables + ARRAY_SIZE(efx_nic_reg_tables);
	     table++) {
		size_t size, i;

		if (!(efx->type->revision >= table->min_revision &&
		      efx->type->revision <= table->max_revision))
			continue;

		size = min_t(size_t, table->step, 16);

		for (i = 0; i < table->rows; i++) {
			switch (table->step) {
			case 4: /* 32-bit SRAM */
				efx_readd(efx, buf, table->offset + 4 * i);
				break;
			case 8: /* 64-bit SRAM */
				efx_sram_readq(efx,
					       efx->membase + table->offset,
					       buf, i);
				break;
			case 16: /* 128-bit-readable register */
				efx_reado_table(efx, buf, table->offset, i);
				break;
			case 32: /* 128-bit register, interleaved */
				efx_reado_table(efx, buf, table->offset, 2 * i);
				break;
			default:
				WARN_ON(1);
				return;
			}
			buf += size;
		}
	}
}

/**
 * efx_nic_describe_stats - Describe supported statistics for ethtool
 * @desc: Array of &struct efx_hw_stat_desc describing the statistics
 * @count: Length of the @desc array
 * @mask: Bitmask of which elements of @desc are enabled
 * @names: Buffer to copy names to, or %NULL.  The names are copied
 *	starting at intervals of %ETH_GSTRING_LEN bytes.
 *
 * Returns the number of visible statistics, i.e. the number of set
 * bits in the first @count bits of @mask for which a name is defined.
 */
size_t efx_nic_describe_stats(const struct efx_hw_stat_desc *desc, size_t count,
			      const unsigned long *mask, u8 *names)
{
	size_t visible = 0;
	size_t index;

	for_each_set_bit(index, mask, count) {
		if (desc[index].name) {
			if (names) {
				strlcpy(names, desc[index].name,
					ETH_GSTRING_LEN);
				names += ETH_GSTRING_LEN;
			}
			++visible;
		}
	}

	return visible;
}

/**
 * efx_nic_update_stats - Convert statistics DMA buffer to array of u64
 * @desc: Array of &struct efx_hw_stat_desc describing the DMA buffer
 *	layout.  DMA widths of 0, 16, 32 and 64 are supported; where
 *	the width is specified as 0 the corresponding element of
 *	@stats is not updated.
 * @count: Length of the @desc array
 * @mask: Bitmask of which elements of @desc are enabled
 * @stats: Buffer to update with the converted statistics.  The length
 *	of this array must be at least the number of set bits in the
 *	first @count bits of @mask.
 * @dma_buf: DMA buffer containing hardware statistics
 * @accumulate: If set, the converted values will be added rather than
 *	directly stored to the corresponding elements of @stats
 */
void efx_nic_update_stats(const struct efx_hw_stat_desc *desc, size_t count,
			  const unsigned long *mask,
			  u64 *stats, const void *dma_buf, bool accumulate)
{
	size_t index;

	for_each_set_bit(index, mask, count) {
		if (desc[index].dma_width) {
			const void *addr = dma_buf + desc[index].offset;
			u64 val;

			switch (desc[index].dma_width) {
			case 16:
				val = le16_to_cpup((__le16 *)addr);
				break;
			case 32:
				val = le32_to_cpup((__le32 *)addr);
				break;
			case 64:
				val = le64_to_cpup((__le64 *)addr);
				break;
			default:
				WARN_ON(1);
				val = 0;
				break;
			}

			if (accumulate)
				*stats += val;
			else
				*stats = val;
		}

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