stmmac: move the dma out from the main (aec7ff27) · Commits · e / devices / android_kernel_fairphone_FP3

drivers/net/stmmac/Makefile

+1 −1

Original line number	Original line	Diff line number	Diff line
	obj-$(CONFIG_STMMAC_ETH) += stmmac.o		obj-$(CONFIG_STMMAC_ETH) += stmmac.o
	stmmac-$(CONFIG_STMMAC_TIMER) += stmmac_timer.o		stmmac-$(CONFIG_STMMAC_TIMER) += stmmac_timer.o
	stmmac-objs:= stmmac_main.o stmmac_ethtool.o stmmac_mdio.o \		stmmac-objs:= stmmac_main.o stmmac_ethtool.o stmmac_mdio.o dwmac_lib.o \
	mac100.o gmac.o $(stmmac-y)		mac100.o gmac.o $(stmmac-y)

drivers/net/stmmac/common.h

+54 −155

Original line number	Original line	Diff line number	Diff line
	@@ -25,131 +25,6 @@
	#include "descs.h"		#include "descs.h"
	#include <linux/io.h>		#include <linux/io.h>

	/* *********************************************
	DMA CRS Control and Status Register Mapping
	* *********************************************/
	#define DMA_BUS_MODE 0x00001000 /* Bus Mode */
	#define DMA_XMT_POLL_DEMAND 0x00001004 /* Transmit Poll Demand */
	#define DMA_RCV_POLL_DEMAND 0x00001008 /* Received Poll Demand */
	#define DMA_RCV_BASE_ADDR 0x0000100c /* Receive List Base */
	#define DMA_TX_BASE_ADDR 0x00001010 /* Transmit List Base */
	#define DMA_STATUS 0x00001014 /* Status Register */
	#define DMA_CONTROL 0x00001018 /* Ctrl (Operational Mode) */
	#define DMA_INTR_ENA 0x0000101c /* Interrupt Enable */
	#define DMA_MISSED_FRAME_CTR 0x00001020 /* Missed Frame Counter */
	#define DMA_CUR_TX_BUF_ADDR 0x00001050 /* Current Host Tx Buffer */
	#define DMA_CUR_RX_BUF_ADDR 0x00001054 /* Current Host Rx Buffer */

	/* ********************************
	DMA Control register defines
	* ********************************/
	#define DMA_CONTROL_ST 0x00002000 /* Start/Stop Transmission */
	#define DMA_CONTROL_SR 0x00000002 /* Start/Stop Receive */

	/* **************************************
	DMA Interrupt Enable register defines
	* **************************************/
	/** NORMAL INTERRUPT **/
	#define DMA_INTR_ENA_NIE 0x00010000 /* Normal Summary */
	#define DMA_INTR_ENA_TIE 0x00000001 /* Transmit Interrupt */
	#define DMA_INTR_ENA_TUE 0x00000004 /* Transmit Buffer Unavailable */
	#define DMA_INTR_ENA_RIE 0x00000040 /* Receive Interrupt */
	#define DMA_INTR_ENA_ERE 0x00004000 /* Early Receive */

	#define DMA_INTR_NORMAL (DMA_INTR_ENA_NIE \| DMA_INTR_ENA_RIE \| \
	DMA_INTR_ENA_TIE)

	/** ABNORMAL INTERRUPT **/
	#define DMA_INTR_ENA_AIE 0x00008000 /* Abnormal Summary */
	#define DMA_INTR_ENA_FBE 0x00002000 /* Fatal Bus Error */
	#define DMA_INTR_ENA_ETE 0x00000400 /* Early Transmit */
	#define DMA_INTR_ENA_RWE 0x00000200 /* Receive Watchdog */
	#define DMA_INTR_ENA_RSE 0x00000100 /* Receive Stopped */
	#define DMA_INTR_ENA_RUE 0x00000080 /* Receive Buffer Unavailable */
	#define DMA_INTR_ENA_UNE 0x00000020 /* Tx Underflow */
	#define DMA_INTR_ENA_OVE 0x00000010 /* Receive Overflow */
	#define DMA_INTR_ENA_TJE 0x00000008 /* Transmit Jabber */
	#define DMA_INTR_ENA_TSE 0x00000002 /* Transmit Stopped */

	#define DMA_INTR_ABNORMAL (DMA_INTR_ENA_AIE \| DMA_INTR_ENA_FBE \| \
	DMA_INTR_ENA_UNE)

	/* DMA default interrupt mask */
	#define DMA_INTR_DEFAULT_MASK (DMA_INTR_NORMAL \| DMA_INTR_ABNORMAL)

	/* ****************************
	* DMA Status register defines
	* ****************************/
	#define DMA_STATUS_GPI 0x10000000 /* PMT interrupt */
	#define DMA_STATUS_GMI 0x08000000 /* MMC interrupt */
	#define DMA_STATUS_GLI 0x04000000 /* GMAC Line interface int. */
	#define DMA_STATUS_GMI 0x08000000
	#define DMA_STATUS_GLI 0x04000000
	#define DMA_STATUS_EB_MASK 0x00380000 /* Error Bits Mask */
	#define DMA_STATUS_EB_TX_ABORT 0x00080000 /* Error Bits - TX Abort */
	#define DMA_STATUS_EB_RX_ABORT 0x00100000 /* Error Bits - RX Abort */
	#define DMA_STATUS_TS_MASK 0x00700000 /* Transmit Process State */
	#define DMA_STATUS_TS_SHIFT 20
	#define DMA_STATUS_RS_MASK 0x000e0000 /* Receive Process State */
	#define DMA_STATUS_RS_SHIFT 17
	#define DMA_STATUS_NIS 0x00010000 /* Normal Interrupt Summary */
	#define DMA_STATUS_AIS 0x00008000 /* Abnormal Interrupt Summary */
	#define DMA_STATUS_ERI 0x00004000 /* Early Receive Interrupt */
	#define DMA_STATUS_FBI 0x00002000 /* Fatal Bus Error Interrupt */
	#define DMA_STATUS_ETI 0x00000400 /* Early Transmit Interrupt */
	#define DMA_STATUS_RWT 0x00000200 /* Receive Watchdog Timeout */
	#define DMA_STATUS_RPS 0x00000100 /* Receive Process Stopped */
	#define DMA_STATUS_RU 0x00000080 /* Receive Buffer Unavailable */
	#define DMA_STATUS_RI 0x00000040 /* Receive Interrupt */
	#define DMA_STATUS_UNF 0x00000020 /* Transmit Underflow */
	#define DMA_STATUS_OVF 0x00000010 /* Receive Overflow */
	#define DMA_STATUS_TJT 0x00000008 /* Transmit Jabber Timeout */
	#define DMA_STATUS_TU 0x00000004 /* Transmit Buffer Unavailable */
	#define DMA_STATUS_TPS 0x00000002 /* Transmit Process Stopped */
	#define DMA_STATUS_TI 0x00000001 /* Transmit Interrupt */

	/* Other defines */
	#define HASH_TABLE_SIZE 64
	#define PAUSE_TIME 0x200

	/* Flow Control defines */
	#define FLOW_OFF 0
	#define FLOW_RX 1
	#define FLOW_TX 2
	#define FLOW_AUTO (FLOW_TX \| FLOW_RX)

	/* DMA STORE-AND-FORWARD Operation Mode */
	#define SF_DMA_MODE 1

	#define HW_CSUM 1
	#define NO_HW_CSUM 0

	/* GMAC TX FIFO is 8K, Rx FIFO is 16K */
	#define BUF_SIZE_16KiB 16384
	#define BUF_SIZE_8KiB 8192
	#define BUF_SIZE_4KiB 4096
	#define BUF_SIZE_2KiB 2048

	/* Power Down and WOL */
	#define PMT_NOT_SUPPORTED 0
	#define PMT_SUPPORTED 1

	/* Common MAC defines */
	#define MAC_CTRL_REG 0x00000000 /* MAC Control */
	#define MAC_ENABLE_TX 0x00000008 /* Transmitter Enable */
	#define MAC_RNABLE_RX 0x00000004 /* Receiver Enable */

	/* MAC Management Counters register */
	#define MMC_CONTROL 0x00000100 /* MMC Control */
	#define MMC_HIGH_INTR 0x00000104 /* MMC High Interrupt */
	#define MMC_LOW_INTR 0x00000108 /* MMC Low Interrupt */
	#define MMC_HIGH_INTR_MASK 0x0000010c /* MMC High Interrupt Mask */
	#define MMC_LOW_INTR_MASK 0x00000110 /* MMC Low Interrupt Mask */

	#define MMC_CONTROL_MAX_FRM_MASK 0x0003ff8 /* Maximum Frame Size */
	#define MMC_CONTROL_MAX_FRM_SHIFT 3
	#define MMC_CONTROL_MAX_FRAME 0x7FF

	struct stmmac_extra_stats {		struct stmmac_extra_stats {
	/* Transmit errors */		/* Transmit errors */
	unsigned long tx_underflow ____cacheline_aligned;		unsigned long tx_underflow ____cacheline_aligned;
	@@ -198,46 +73,56 @@ struct stmmac_extra_stats {
	unsigned long normal_irq_n;		unsigned long normal_irq_n;
	};		};

	/* GMAC core can compute the checksums in HW. */		#define HASH_TABLE_SIZE 64
	enum rx_frame_status {		#define PAUSE_TIME 0x200

			/* Flow Control defines */
			#define FLOW_OFF 0
			#define FLOW_RX 1
			#define FLOW_TX 2
			#define FLOW_AUTO (FLOW_TX \| FLOW_RX)

			#define SF_DMA_MODE 1 /* DMA STORE-AND-FORWARD Operation Mode */

			#define HW_CSUM 1
			#define NO_HW_CSUM 0
			enum rx_frame_status { /* IPC status */
	good_frame = 0,		good_frame = 0,
	discard_frame = 1,		discard_frame = 1,
	csum_none = 2,		csum_none = 2,
	};		};

	static inline void stmmac_set_mac_addr(unsigned long ioaddr, u8 addr[6],		enum tx_dma_irq_status {
	unsigned int high, unsigned int low)		tx_hard_error = 1,
	{		tx_hard_error_bump_tc = 2,
	unsigned long data;		handle_tx_rx = 3,
			};
	data = (addr[5] << 8) \| addr[4];
	writel(data, ioaddr + high);
	data = (addr[3] << 24) \| (addr[2] << 16) \| (addr[1] << 8) \| addr[0];
	writel(data, ioaddr + low);

	return;		/* GMAC TX FIFO is 8K, Rx FIFO is 16K */
	}		#define BUF_SIZE_16KiB 16384
			#define BUF_SIZE_8KiB 8192
			#define BUF_SIZE_4KiB 4096
			#define BUF_SIZE_2KiB 2048

	static inline void stmmac_get_mac_addr(unsigned long ioaddr,		/* Power Down and WOL */
	unsigned char *addr, unsigned int high,		#define PMT_NOT_SUPPORTED 0
	unsigned int low)		#define PMT_SUPPORTED 1
	{
	unsigned int hi_addr, lo_addr;

	/* Read the MAC address from the hardware */		/* Common MAC defines */
	hi_addr = readl(ioaddr + high);		#define MAC_CTRL_REG 0x00000000 /* MAC Control */
	lo_addr = readl(ioaddr + low);		#define MAC_ENABLE_TX 0x00000008 /* Transmitter Enable */
			#define MAC_RNABLE_RX 0x00000004 /* Receiver Enable */

	/* Extract the MAC address from the high and low words */		/* MAC Management Counters register */
	addr[0] = lo_addr & 0xff;		#define MMC_CONTROL 0x00000100 /* MMC Control */
	addr[1] = (lo_addr >> 8) & 0xff;		#define MMC_HIGH_INTR 0x00000104 /* MMC High Interrupt */
	addr[2] = (lo_addr >> 16) & 0xff;		#define MMC_LOW_INTR 0x00000108 /* MMC Low Interrupt */
	addr[3] = (lo_addr >> 24) & 0xff;		#define MMC_HIGH_INTR_MASK 0x0000010c /* MMC High Interrupt Mask */
	addr[4] = hi_addr & 0xff;		#define MMC_LOW_INTR_MASK 0x00000110 /* MMC Low Interrupt Mask */
	addr[5] = (hi_addr >> 8) & 0xff;

	return;		#define MMC_CONTROL_MAX_FRM_MASK 0x0003ff8 /* Maximum Frame Size */
	}		#define MMC_CONTROL_MAX_FRM_SHIFT 3
			#define MMC_CONTROL_MAX_FRAME 0x7FF

	struct stmmac_desc_ops {		struct stmmac_desc_ops {
	/* DMA RX descriptor ring initialization */		/* DMA RX descriptor ring initialization */
	@@ -287,6 +172,15 @@ struct stmmac_dma_ops {
	/* To track extra statistic (if supported) */		/* To track extra statistic (if supported) */
	void (dma_diagnostic_fr) (void data, struct stmmac_extra_stats *x,		void (dma_diagnostic_fr) (void data, struct stmmac_extra_stats *x,
	unsigned long ioaddr);		unsigned long ioaddr);
			void (*enable_dma_transmission) (unsigned long ioaddr);
			void (*enable_dma_irq) (unsigned long ioaddr);
			void (*disable_dma_irq) (unsigned long ioaddr);
			void (*start_tx) (unsigned long ioaddr);
			void (*stop_tx) (unsigned long ioaddr);
			void (*start_rx) (unsigned long ioaddr);
			void (*stop_rx) (unsigned long ioaddr);
			int (*dma_interrupt) (unsigned long ioaddr,
			struct stmmac_extra_stats *x);
	};		};

	struct stmmac_ops {		struct stmmac_ops {
	@@ -332,3 +226,8 @@ struct mac_device_info {

	struct mac_device_info *gmac_setup(unsigned long addr);		struct mac_device_info *gmac_setup(unsigned long addr);
	struct mac_device_info *mac100_setup(unsigned long addr);		struct mac_device_info *mac100_setup(unsigned long addr);

			extern void stmmac_set_mac_addr(unsigned long ioaddr, u8 addr[6],
			unsigned int high, unsigned int low);
			extern void stmmac_get_mac_addr(unsigned long ioaddr, unsigned char *addr,
			unsigned int high, unsigned int low);

drivers/net/stmmac/dwmac_dma.h

0 → 100644

+107 −0

Original line number	Original line	Diff line number	Diff line
			/*******************************************************************************
			DWMAC DMA Header file.

			Copyright (C) 2007-2009 STMicroelectronics Ltd

			This program is free software; you can redistribute it and/or modify it
			under the terms and conditions of the GNU General Public License,
			version 2, as published by the Free Software Foundation.

			This program is distributed in the hope it will be useful, but WITHOUT
			ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
			FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
			more details.

			You should have received a copy of the GNU General Public License along with
			this program; if not, write to the Free Software Foundation, Inc.,
			51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.

			The full GNU General Public License is included in this distribution in
			the file called "COPYING".

			Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
			*******************************************************************************/

			/* DMA CRS Control and Status Register Mapping */
			#define DMA_BUS_MODE 0x00001000 /* Bus Mode */
			#define DMA_XMT_POLL_DEMAND 0x00001004 /* Transmit Poll Demand */
			#define DMA_RCV_POLL_DEMAND 0x00001008 /* Received Poll Demand */
			#define DMA_RCV_BASE_ADDR 0x0000100c /* Receive List Base */
			#define DMA_TX_BASE_ADDR 0x00001010 /* Transmit List Base */
			#define DMA_STATUS 0x00001014 /* Status Register */
			#define DMA_CONTROL 0x00001018 /* Ctrl (Operational Mode) */
			#define DMA_INTR_ENA 0x0000101c /* Interrupt Enable */
			#define DMA_MISSED_FRAME_CTR 0x00001020 /* Missed Frame Counter */
			#define DMA_CUR_TX_BUF_ADDR 0x00001050 /* Current Host Tx Buffer */
			#define DMA_CUR_RX_BUF_ADDR 0x00001054 /* Current Host Rx Buffer */

			/* DMA Control register defines */
			#define DMA_CONTROL_ST 0x00002000 /* Start/Stop Transmission */
			#define DMA_CONTROL_SR 0x00000002 /* Start/Stop Receive */

			/* DMA Normal interrupt */
			#define DMA_INTR_ENA_NIE 0x00010000 /* Normal Summary */
			#define DMA_INTR_ENA_TIE 0x00000001 /* Transmit Interrupt */
			#define DMA_INTR_ENA_TUE 0x00000004 /* Transmit Buffer Unavailable */
			#define DMA_INTR_ENA_RIE 0x00000040 /* Receive Interrupt */
			#define DMA_INTR_ENA_ERE 0x00004000 /* Early Receive */

			#define DMA_INTR_NORMAL (DMA_INTR_ENA_NIE \| DMA_INTR_ENA_RIE \| \
			DMA_INTR_ENA_TIE)

			/* DMA Abnormal interrupt */
			#define DMA_INTR_ENA_AIE 0x00008000 /* Abnormal Summary */
			#define DMA_INTR_ENA_FBE 0x00002000 /* Fatal Bus Error */
			#define DMA_INTR_ENA_ETE 0x00000400 /* Early Transmit */
			#define DMA_INTR_ENA_RWE 0x00000200 /* Receive Watchdog */
			#define DMA_INTR_ENA_RSE 0x00000100 /* Receive Stopped */
			#define DMA_INTR_ENA_RUE 0x00000080 /* Receive Buffer Unavailable */
			#define DMA_INTR_ENA_UNE 0x00000020 /* Tx Underflow */
			#define DMA_INTR_ENA_OVE 0x00000010 /* Receive Overflow */
			#define DMA_INTR_ENA_TJE 0x00000008 /* Transmit Jabber */
			#define DMA_INTR_ENA_TSE 0x00000002 /* Transmit Stopped */

			#define DMA_INTR_ABNORMAL (DMA_INTR_ENA_AIE \| DMA_INTR_ENA_FBE \| \
			DMA_INTR_ENA_UNE)

			/* DMA default interrupt mask */
			#define DMA_INTR_DEFAULT_MASK (DMA_INTR_NORMAL \| DMA_INTR_ABNORMAL)

			/* DMA Status register defines */
			#define DMA_STATUS_GPI 0x10000000 /* PMT interrupt */
			#define DMA_STATUS_GMI 0x08000000 /* MMC interrupt */
			#define DMA_STATUS_GLI 0x04000000 /* GMAC Line interface int */
			#define DMA_STATUS_GMI 0x08000000
			#define DMA_STATUS_GLI 0x04000000
			#define DMA_STATUS_EB_MASK 0x00380000 /* Error Bits Mask */
			#define DMA_STATUS_EB_TX_ABORT 0x00080000 /* Error Bits - TX Abort */
			#define DMA_STATUS_EB_RX_ABORT 0x00100000 /* Error Bits - RX Abort */
			#define DMA_STATUS_TS_MASK 0x00700000 /* Transmit Process State */
			#define DMA_STATUS_TS_SHIFT 20
			#define DMA_STATUS_RS_MASK 0x000e0000 /* Receive Process State */
			#define DMA_STATUS_RS_SHIFT 17
			#define DMA_STATUS_NIS 0x00010000 /* Normal Interrupt Summary */
			#define DMA_STATUS_AIS 0x00008000 /* Abnormal Interrupt Summary */
			#define DMA_STATUS_ERI 0x00004000 /* Early Receive Interrupt */
			#define DMA_STATUS_FBI 0x00002000 /* Fatal Bus Error Interrupt */
			#define DMA_STATUS_ETI 0x00000400 /* Early Transmit Interrupt */
			#define DMA_STATUS_RWT 0x00000200 /* Receive Watchdog Timeout */
			#define DMA_STATUS_RPS 0x00000100 /* Receive Process Stopped */
			#define DMA_STATUS_RU 0x00000080 /* Receive Buffer Unavailable */
			#define DMA_STATUS_RI 0x00000040 /* Receive Interrupt */
			#define DMA_STATUS_UNF 0x00000020 /* Transmit Underflow */
			#define DMA_STATUS_OVF 0x00000010 /* Receive Overflow */
			#define DMA_STATUS_TJT 0x00000008 /* Transmit Jabber Timeout */
			#define DMA_STATUS_TU 0x00000004 /* Transmit Buffer Unavailable */
			#define DMA_STATUS_TPS 0x00000002 /* Transmit Process Stopped */
			#define DMA_STATUS_TI 0x00000001 /* Transmit Interrupt */

			extern void dwmac_enable_dma_transmission(unsigned long ioaddr);
			extern void dwmac_enable_dma_irq(unsigned long ioaddr);
			extern void dwmac_disable_dma_irq(unsigned long ioaddr);
			extern void dwmac_dma_start_tx(unsigned long ioaddr);
			extern void dwmac_dma_stop_tx(unsigned long ioaddr);
			extern void dwmac_dma_start_rx(unsigned long ioaddr);
			extern void dwmac_dma_stop_rx(unsigned long ioaddr);
			extern int dwmac_dma_interrupt(unsigned long ioaddr,
			struct stmmac_extra_stats *x);

drivers/net/stmmac/dwmac_lib.c

0 → 100644

+263 −0

Original line number	Original line	Diff line number	Diff line
			/*******************************************************************************
			Copyright (C) 2007-2009 STMicroelectronics Ltd

			This program is free software; you can redistribute it and/or modify it
			under the terms and conditions of the GNU General Public License,
			version 2, as published by the Free Software Foundation.

			This program is distributed in the hope it will be useful, but WITHOUT
			ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
			FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
			more details.

			You should have received a copy of the GNU General Public License along with
			this program; if not, write to the Free Software Foundation, Inc.,
			51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.

			The full GNU General Public License is included in this distribution in
			the file called "COPYING".

			Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
			*******************************************************************************/

			#include <linux/io.h>
			#include "common.h"
			#include "dwmac_dma.h"

			#undef DWMAC_DMA_DEBUG
			#ifdef DWMAC_DMA_DEBUG
			#define DBG(fmt, args...) printk(fmt, ## args)
			#else
			#define DBG(fmt, args...) do { } while (0)
			#endif

			/* CSR1 enables the transmit DMA to check for new descriptor */
			void dwmac_enable_dma_transmission(unsigned long ioaddr)
			{
			writel(1, ioaddr + DMA_XMT_POLL_DEMAND);
			}

			void dwmac_enable_dma_irq(unsigned long ioaddr)
			{
			writel(DMA_INTR_DEFAULT_MASK, ioaddr + DMA_INTR_ENA);
			}

			void dwmac_disable_dma_irq(unsigned long ioaddr)
			{
			writel(0, ioaddr + DMA_INTR_ENA);
			}

			void dwmac_dma_start_tx(unsigned long ioaddr)
			{
			u32 value = readl(ioaddr + DMA_CONTROL);
			value \|= DMA_CONTROL_ST;
			writel(value, ioaddr + DMA_CONTROL);
			return;
			}

			void dwmac_dma_stop_tx(unsigned long ioaddr)
			{
			u32 value = readl(ioaddr + DMA_CONTROL);
			value &= ~DMA_CONTROL_ST;
			writel(value, ioaddr + DMA_CONTROL);
			return;
			}

			void dwmac_dma_start_rx(unsigned long ioaddr)
			{
			u32 value = readl(ioaddr + DMA_CONTROL);
			value \|= DMA_CONTROL_SR;
			writel(value, ioaddr + DMA_CONTROL);

			return;
			}

			void dwmac_dma_stop_rx(unsigned long ioaddr)
			{
			u32 value = readl(ioaddr + DMA_CONTROL);
			value &= ~DMA_CONTROL_SR;
			writel(value, ioaddr + DMA_CONTROL);

			return;
			}

			#ifdef DWMAC_DMA_DEBUG
			static void show_tx_process_state(unsigned int status)
			{
			unsigned int state;
			state = (status & DMA_STATUS_TS_MASK) >> DMA_STATUS_TS_SHIFT;

			switch (state) {
			case 0:
			pr_info("- TX (Stopped): Reset or Stop command\n");
			break;
			case 1:
			pr_info("- TX (Running):Fetching the Tx desc\n");
			break;
			case 2:
			pr_info("- TX (Running): Waiting for end of tx\n");
			break;
			case 3:
			pr_info("- TX (Running): Reading the data "
			"and queuing the data into the Tx buf\n");
			break;
			case 6:
			pr_info("- TX (Suspended): Tx Buff Underflow "
			"or an unavailable Transmit descriptor\n");
			break;
			case 7:
			pr_info("- TX (Running): Closing Tx descriptor\n");
			break;
			default:
			break;
			}
			return;
			}

			static void show_rx_process_state(unsigned int status)
			{
			unsigned int state;
			state = (status & DMA_STATUS_RS_MASK) >> DMA_STATUS_RS_SHIFT;

			switch (state) {
			case 0:
			pr_info("- RX (Stopped): Reset or Stop command\n");
			break;
			case 1:
			pr_info("- RX (Running): Fetching the Rx desc\n");
			break;
			case 2:
			pr_info("- RX (Running):Checking for end of pkt\n");
			break;
			case 3:
			pr_info("- RX (Running): Waiting for Rx pkt\n");
			break;
			case 4:
			pr_info("- RX (Suspended): Unavailable Rx buf\n");
			break;
			case 5:
			pr_info("- RX (Running): Closing Rx descriptor\n");
			break;
			case 6:
			pr_info("- RX(Running): Flushing the current frame"
			" from the Rx buf\n");
			break;
			case 7:
			pr_info("- RX (Running): Queuing the Rx frame"
			" from the Rx buf into memory\n");
			break;
			default:
			break;
			}
			return;
			}
			#endif

			int dwmac_dma_interrupt(unsigned long ioaddr,
			struct stmmac_extra_stats *x)
			{
			int ret = 0;
			/* read the status register (CSR5) */
			u32 intr_status = readl(ioaddr + DMA_STATUS);

			DBG(INFO, "%s: [CSR5: 0x%08x]\n", __func__, intr_status);
			#ifdef DWMAC_DMA_DEBUG
			/* It displays the DMA process states (CSR5 register) */
			show_tx_process_state(intr_status);
			show_rx_process_state(intr_status);
			#endif
			/* ABNORMAL interrupts */
			if (unlikely(intr_status & DMA_STATUS_AIS)) {
			DBG(INFO, "CSR5[15] DMA ABNORMAL IRQ: ");
			if (unlikely(intr_status & DMA_STATUS_UNF)) {
			DBG(INFO, "transmit underflow\n");
			ret = tx_hard_error_bump_tc;
			x->tx_undeflow_irq++;
			}
			if (unlikely(intr_status & DMA_STATUS_TJT)) {
			DBG(INFO, "transmit jabber\n");
			x->tx_jabber_irq++;
			}
			if (unlikely(intr_status & DMA_STATUS_OVF)) {
			DBG(INFO, "recv overflow\n");
			x->rx_overflow_irq++;
			}
			if (unlikely(intr_status & DMA_STATUS_RU)) {
			DBG(INFO, "receive buffer unavailable\n");
			x->rx_buf_unav_irq++;
			}
			if (unlikely(intr_status & DMA_STATUS_RPS)) {
			DBG(INFO, "receive process stopped\n");
			x->rx_process_stopped_irq++;
			}
			if (unlikely(intr_status & DMA_STATUS_RWT)) {
			DBG(INFO, "receive watchdog\n");
			x->rx_watchdog_irq++;
			}
			if (unlikely(intr_status & DMA_STATUS_ETI)) {
			DBG(INFO, "transmit early interrupt\n");
			x->tx_early_irq++;
			}
			if (unlikely(intr_status & DMA_STATUS_TPS)) {
			DBG(INFO, "transmit process stopped\n");
			x->tx_process_stopped_irq++;
			ret = tx_hard_error;
			}
			if (unlikely(intr_status & DMA_STATUS_FBI)) {
			DBG(INFO, "fatal bus error\n");
			x->fatal_bus_error_irq++;
			ret = tx_hard_error;
			}
			}
			/* TX/RX NORMAL interrupts */
			if (intr_status & DMA_STATUS_NIS) {
			x->normal_irq_n++;
			if (likely((intr_status & DMA_STATUS_RI) \|\|
			(intr_status & (DMA_STATUS_TI))))
			ret = handle_tx_rx;
			}
			/* Optional hardware blocks, interrupts should be disabled */
			if (unlikely(intr_status &
			(DMA_STATUS_GPI \| DMA_STATUS_GMI \| DMA_STATUS_GLI)))
			pr_info("%s: unexpected status %08x\n", __func__, intr_status);
			/* Clear the interrupt by writing a logic 1 to the CSR5[15-0] */
			writel((intr_status & 0x1ffff), ioaddr + DMA_STATUS);

			DBG(INFO, "\n\n");
			return ret;
			}


			void stmmac_set_mac_addr(unsigned long ioaddr, u8 addr[6],
			unsigned int high, unsigned int low)
			{
			unsigned long data;

			data = (addr[5] << 8) \| addr[4];
			writel(data, ioaddr + high);
			data = (addr[3] << 24) \| (addr[2] << 16) \| (addr[1] << 8) \| addr[0];
			writel(data, ioaddr + low);

			return;
			}

			void stmmac_get_mac_addr(unsigned long ioaddr, unsigned char *addr,
			unsigned int high, unsigned int low)
			{
			unsigned int hi_addr, lo_addr;

			/* Read the MAC address from the hardware */
			hi_addr = readl(ioaddr + high);
			lo_addr = readl(ioaddr + low);

			/* Extract the MAC address from the high and low words */
			addr[0] = lo_addr & 0xff;
			addr[1] = (lo_addr >> 8) & 0xff;
			addr[2] = (lo_addr >> 16) & 0xff;
			addr[3] = (lo_addr >> 24) & 0xff;
			addr[4] = hi_addr & 0xff;
			addr[5] = (hi_addr >> 8) & 0xff;

			return;
			}

drivers/net/stmmac/gmac.c

+9 −0

Original line number	Original line	Diff line number	Diff line
	@@ -31,6 +31,7 @@

	#include "stmmac.h"		#include "stmmac.h"
	#include "gmac.h"		#include "gmac.h"
			#include "dwmac_dma.h"

	#undef GMAC_DEBUG		#undef GMAC_DEBUG
	/#define GMAC_DEBUG/		/#define GMAC_DEBUG/
	@@ -646,6 +647,14 @@ struct stmmac_dma_ops gmac_dma_ops = {
	.dump_regs = gmac_dump_dma_regs,		.dump_regs = gmac_dump_dma_regs,
	.dma_mode = gmac_dma_operation_mode,		.dma_mode = gmac_dma_operation_mode,
	.dma_diagnostic_fr = gmac_dma_diagnostic_fr,		.dma_diagnostic_fr = gmac_dma_diagnostic_fr,
			.enable_dma_transmission = dwmac_enable_dma_transmission,
			.enable_dma_irq = dwmac_enable_dma_irq,
			.disable_dma_irq = dwmac_disable_dma_irq,
			.start_tx = dwmac_dma_start_tx,
			.stop_tx = dwmac_dma_stop_tx,
			.start_rx = dwmac_dma_start_rx,
			.stop_rx = dwmac_dma_stop_rx,
			.dma_interrupt = dwmac_dma_interrupt,
	};		};

	struct stmmac_desc_ops gmac_desc_ops = {		struct stmmac_desc_ops gmac_desc_ops = {