xilinx/ll_temac: Move the Xilinx drivers
Move the Xilinx drivers into drivers/net/ethernet/xilinx/ and make the necessary Kconfig and Makefile changes. CC: John Williams <john.williams@petalogix.com> CC: "David H. Lynch Jr." <dhlii@dlasys.net> Signed-off-by: Jeff Kirsher <jeffrey.t.kirsher@intel.com>
This commit is contained in:
Jeff Kirsher
35
drivers/net/ethernet/xilinx/Kconfig
Normal file
35
drivers/net/ethernet/xilinx/Kconfig
Normal file
@@ -0,0 +1,35 @@
|
||||
#
|
||||
# Xilink device configuration
|
||||
#
|
||||
|
||||
config NET_VENDOR_XILINX
|
||||
bool "Xilinx devices"
|
||||
depends on PPC || PPC32 || MICROBLAZE
|
||||
---help---
|
||||
If you have a network (Ethernet) card belonging to this class, say Y
|
||||
and read the Ethernet-HOWTO, available from
|
||||
<http://www.tldp.org/docs.html#howto>.
|
||||
|
||||
Note that the answer to this question doesn't directly affect the
|
||||
kernel: saying N will just cause the configurator to skip all
|
||||
the questions about Xilinx devices. If you say Y, you will be asked
|
||||
for your specific card in the following questions.
|
||||
|
||||
if NET_VENDOR_XILINX
|
||||
|
||||
config XILINX_EMACLITE
|
||||
tristate "Xilinx 10/100 Ethernet Lite support"
|
||||
depends on (PPC32 || MICROBLAZE)
|
||||
select PHYLIB
|
||||
---help---
|
||||
This driver supports the 10/100 Ethernet Lite from Xilinx.
|
||||
|
||||
config XILINX_LL_TEMAC
|
||||
tristate "Xilinx LL TEMAC (LocalLink Tri-mode Ethernet MAC) driver"
|
||||
depends on (PPC || MICROBLAZE)
|
||||
select PHYLIB
|
||||
---help---
|
||||
This driver supports the Xilinx 10/100/1000 LocalLink TEMAC
|
||||
core used in Xilinx Spartan and Virtex FPGAs
|
||||
|
||||
endif # NET_VENDOR_XILINX
|
||||
7
drivers/net/ethernet/xilinx/Makefile
Normal file
7
drivers/net/ethernet/xilinx/Makefile
Normal file
@@ -0,0 +1,7 @@
|
||||
#
|
||||
# Makefile for the Xilink network device drivers.
|
||||
#
|
||||
|
||||
ll_temac-objs := ll_temac_main.o ll_temac_mdio.o
|
||||
obj-$(CONFIG_XILINX_LL_TEMAC) += ll_temac.o
|
||||
obj-$(CONFIG_XILINX_EMACLITE) += xilinx_emaclite.o
|
||||
385
drivers/net/ethernet/xilinx/ll_temac.h
Normal file
385
drivers/net/ethernet/xilinx/ll_temac.h
Normal file
@@ -0,0 +1,385 @@
|
||||
|
||||
#ifndef XILINX_LL_TEMAC_H
|
||||
#define XILINX_LL_TEMAC_H
|
||||
|
||||
#include <linux/netdevice.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/spinlock.h>
|
||||
|
||||
#ifdef CONFIG_PPC_DCR
|
||||
#include <asm/dcr.h>
|
||||
#include <asm/dcr-regs.h>
|
||||
#endif
|
||||
|
||||
/* packet size info */
|
||||
#define XTE_HDR_SIZE 14 /* size of Ethernet header */
|
||||
#define XTE_TRL_SIZE 4 /* size of Ethernet trailer (FCS) */
|
||||
#define XTE_JUMBO_MTU 9000
|
||||
#define XTE_MAX_JUMBO_FRAME_SIZE (XTE_JUMBO_MTU + XTE_HDR_SIZE + XTE_TRL_SIZE)
|
||||
|
||||
/* Configuration options */
|
||||
|
||||
/* Accept all incoming packets.
|
||||
* This option defaults to disabled (cleared) */
|
||||
#define XTE_OPTION_PROMISC (1 << 0)
|
||||
/* Jumbo frame support for Tx & Rx.
|
||||
* This option defaults to disabled (cleared) */
|
||||
#define XTE_OPTION_JUMBO (1 << 1)
|
||||
/* VLAN Rx & Tx frame support.
|
||||
* This option defaults to disabled (cleared) */
|
||||
#define XTE_OPTION_VLAN (1 << 2)
|
||||
/* Enable recognition of flow control frames on Rx
|
||||
* This option defaults to enabled (set) */
|
||||
#define XTE_OPTION_FLOW_CONTROL (1 << 4)
|
||||
/* Strip FCS and PAD from incoming frames.
|
||||
* Note: PAD from VLAN frames is not stripped.
|
||||
* This option defaults to disabled (set) */
|
||||
#define XTE_OPTION_FCS_STRIP (1 << 5)
|
||||
/* Generate FCS field and add PAD automatically for outgoing frames.
|
||||
* This option defaults to enabled (set) */
|
||||
#define XTE_OPTION_FCS_INSERT (1 << 6)
|
||||
/* Enable Length/Type error checking for incoming frames. When this option is
|
||||
set, the MAC will filter frames that have a mismatched type/length field
|
||||
and if XTE_OPTION_REPORT_RXERR is set, the user is notified when these
|
||||
types of frames are encountered. When this option is cleared, the MAC will
|
||||
allow these types of frames to be received.
|
||||
This option defaults to enabled (set) */
|
||||
#define XTE_OPTION_LENTYPE_ERR (1 << 7)
|
||||
/* Enable the transmitter.
|
||||
* This option defaults to enabled (set) */
|
||||
#define XTE_OPTION_TXEN (1 << 11)
|
||||
/* Enable the receiver
|
||||
* This option defaults to enabled (set) */
|
||||
#define XTE_OPTION_RXEN (1 << 12)
|
||||
|
||||
/* Default options set when device is initialized or reset */
|
||||
#define XTE_OPTION_DEFAULTS \
|
||||
(XTE_OPTION_TXEN | \
|
||||
XTE_OPTION_FLOW_CONTROL | \
|
||||
XTE_OPTION_RXEN)
|
||||
|
||||
/* XPS_LL_TEMAC SDMA registers definition */
|
||||
|
||||
#define TX_NXTDESC_PTR 0x00 /* r */
|
||||
#define TX_CURBUF_ADDR 0x01 /* r */
|
||||
#define TX_CURBUF_LENGTH 0x02 /* r */
|
||||
#define TX_CURDESC_PTR 0x03 /* rw */
|
||||
#define TX_TAILDESC_PTR 0x04 /* rw */
|
||||
#define TX_CHNL_CTRL 0x05 /* rw */
|
||||
/*
|
||||
0:7 24:31 IRQTimeout
|
||||
8:15 16:23 IRQCount
|
||||
16:20 11:15 Reserved
|
||||
21 10 0
|
||||
22 9 UseIntOnEnd
|
||||
23 8 LdIRQCnt
|
||||
24 7 IRQEn
|
||||
25:28 3:6 Reserved
|
||||
29 2 IrqErrEn
|
||||
30 1 IrqDlyEn
|
||||
31 0 IrqCoalEn
|
||||
*/
|
||||
#define CHNL_CTRL_IRQ_IOE (1 << 9)
|
||||
#define CHNL_CTRL_IRQ_EN (1 << 7)
|
||||
#define CHNL_CTRL_IRQ_ERR_EN (1 << 2)
|
||||
#define CHNL_CTRL_IRQ_DLY_EN (1 << 1)
|
||||
#define CHNL_CTRL_IRQ_COAL_EN (1 << 0)
|
||||
#define TX_IRQ_REG 0x06 /* rw */
|
||||
/*
|
||||
0:7 24:31 DltTmrValue
|
||||
8:15 16:23 ClscCntrValue
|
||||
16:17 14:15 Reserved
|
||||
18:21 10:13 ClscCnt
|
||||
22:23 8:9 DlyCnt
|
||||
24:28 3::7 Reserved
|
||||
29 2 ErrIrq
|
||||
30 1 DlyIrq
|
||||
31 0 CoalIrq
|
||||
*/
|
||||
#define TX_CHNL_STS 0x07 /* r */
|
||||
/*
|
||||
0:9 22:31 Reserved
|
||||
10 21 TailPErr
|
||||
11 20 CmpErr
|
||||
12 19 AddrErr
|
||||
13 18 NxtPErr
|
||||
14 17 CurPErr
|
||||
15 16 BsyWr
|
||||
16:23 8:15 Reserved
|
||||
24 7 Error
|
||||
25 6 IOE
|
||||
26 5 SOE
|
||||
27 4 Cmplt
|
||||
28 3 SOP
|
||||
29 2 EOP
|
||||
30 1 EngBusy
|
||||
31 0 Reserved
|
||||
*/
|
||||
|
||||
#define RX_NXTDESC_PTR 0x08 /* r */
|
||||
#define RX_CURBUF_ADDR 0x09 /* r */
|
||||
#define RX_CURBUF_LENGTH 0x0a /* r */
|
||||
#define RX_CURDESC_PTR 0x0b /* rw */
|
||||
#define RX_TAILDESC_PTR 0x0c /* rw */
|
||||
#define RX_CHNL_CTRL 0x0d /* rw */
|
||||
/*
|
||||
0:7 24:31 IRQTimeout
|
||||
8:15 16:23 IRQCount
|
||||
16:20 11:15 Reserved
|
||||
21 10 0
|
||||
22 9 UseIntOnEnd
|
||||
23 8 LdIRQCnt
|
||||
24 7 IRQEn
|
||||
25:28 3:6 Reserved
|
||||
29 2 IrqErrEn
|
||||
30 1 IrqDlyEn
|
||||
31 0 IrqCoalEn
|
||||
*/
|
||||
#define RX_IRQ_REG 0x0e /* rw */
|
||||
#define IRQ_COAL (1 << 0)
|
||||
#define IRQ_DLY (1 << 1)
|
||||
#define IRQ_ERR (1 << 2)
|
||||
#define IRQ_DMAERR (1 << 7) /* this is not documented ??? */
|
||||
/*
|
||||
0:7 24:31 DltTmrValue
|
||||
8:15 16:23 ClscCntrValue
|
||||
16:17 14:15 Reserved
|
||||
18:21 10:13 ClscCnt
|
||||
22:23 8:9 DlyCnt
|
||||
24:28 3::7 Reserved
|
||||
*/
|
||||
#define RX_CHNL_STS 0x0f /* r */
|
||||
#define CHNL_STS_ENGBUSY (1 << 1)
|
||||
#define CHNL_STS_EOP (1 << 2)
|
||||
#define CHNL_STS_SOP (1 << 3)
|
||||
#define CHNL_STS_CMPLT (1 << 4)
|
||||
#define CHNL_STS_SOE (1 << 5)
|
||||
#define CHNL_STS_IOE (1 << 6)
|
||||
#define CHNL_STS_ERR (1 << 7)
|
||||
|
||||
#define CHNL_STS_BSYWR (1 << 16)
|
||||
#define CHNL_STS_CURPERR (1 << 17)
|
||||
#define CHNL_STS_NXTPERR (1 << 18)
|
||||
#define CHNL_STS_ADDRERR (1 << 19)
|
||||
#define CHNL_STS_CMPERR (1 << 20)
|
||||
#define CHNL_STS_TAILERR (1 << 21)
|
||||
/*
|
||||
0:9 22:31 Reserved
|
||||
10 21 TailPErr
|
||||
11 20 CmpErr
|
||||
12 19 AddrErr
|
||||
13 18 NxtPErr
|
||||
14 17 CurPErr
|
||||
15 16 BsyWr
|
||||
16:23 8:15 Reserved
|
||||
24 7 Error
|
||||
25 6 IOE
|
||||
26 5 SOE
|
||||
27 4 Cmplt
|
||||
28 3 SOP
|
||||
29 2 EOP
|
||||
30 1 EngBusy
|
||||
31 0 Reserved
|
||||
*/
|
||||
|
||||
#define DMA_CONTROL_REG 0x10 /* rw */
|
||||
#define DMA_CONTROL_RST (1 << 0)
|
||||
#define DMA_TAIL_ENABLE (1 << 2)
|
||||
|
||||
/* XPS_LL_TEMAC direct registers definition */
|
||||
|
||||
#define XTE_RAF0_OFFSET 0x00
|
||||
#define RAF0_RST (1 << 0)
|
||||
#define RAF0_MCSTREJ (1 << 1)
|
||||
#define RAF0_BCSTREJ (1 << 2)
|
||||
#define XTE_TPF0_OFFSET 0x04
|
||||
#define XTE_IFGP0_OFFSET 0x08
|
||||
#define XTE_ISR0_OFFSET 0x0c
|
||||
#define ISR0_HARDACSCMPLT (1 << 0)
|
||||
#define ISR0_AUTONEG (1 << 1)
|
||||
#define ISR0_RXCMPLT (1 << 2)
|
||||
#define ISR0_RXREJ (1 << 3)
|
||||
#define ISR0_RXFIFOOVR (1 << 4)
|
||||
#define ISR0_TXCMPLT (1 << 5)
|
||||
#define ISR0_RXDCMLCK (1 << 6)
|
||||
|
||||
#define XTE_IPR0_OFFSET 0x10
|
||||
#define XTE_IER0_OFFSET 0x14
|
||||
|
||||
#define XTE_MSW0_OFFSET 0x20
|
||||
#define XTE_LSW0_OFFSET 0x24
|
||||
#define XTE_CTL0_OFFSET 0x28
|
||||
#define XTE_RDY0_OFFSET 0x2c
|
||||
|
||||
#define XTE_RSE_MIIM_RR_MASK 0x0002
|
||||
#define XTE_RSE_MIIM_WR_MASK 0x0004
|
||||
#define XTE_RSE_CFG_RR_MASK 0x0020
|
||||
#define XTE_RSE_CFG_WR_MASK 0x0040
|
||||
#define XTE_RDY0_HARD_ACS_RDY_MASK (0x10000)
|
||||
|
||||
/* XPS_LL_TEMAC indirect registers offset definition */
|
||||
|
||||
#define XTE_RXC0_OFFSET 0x00000200 /* Rx configuration word 0 */
|
||||
#define XTE_RXC1_OFFSET 0x00000240 /* Rx configuration word 1 */
|
||||
#define XTE_RXC1_RXRST_MASK (1 << 31) /* Receiver reset */
|
||||
#define XTE_RXC1_RXJMBO_MASK (1 << 30) /* Jumbo frame enable */
|
||||
#define XTE_RXC1_RXFCS_MASK (1 << 29) /* FCS not stripped */
|
||||
#define XTE_RXC1_RXEN_MASK (1 << 28) /* Receiver enable */
|
||||
#define XTE_RXC1_RXVLAN_MASK (1 << 27) /* VLAN enable */
|
||||
#define XTE_RXC1_RXHD_MASK (1 << 26) /* Half duplex */
|
||||
#define XTE_RXC1_RXLT_MASK (1 << 25) /* Length/type check disable */
|
||||
|
||||
#define XTE_TXC_OFFSET 0x00000280 /* Tx configuration */
|
||||
#define XTE_TXC_TXRST_MASK (1 << 31) /* Transmitter reset */
|
||||
#define XTE_TXC_TXJMBO_MASK (1 << 30) /* Jumbo frame enable */
|
||||
#define XTE_TXC_TXFCS_MASK (1 << 29) /* Generate FCS */
|
||||
#define XTE_TXC_TXEN_MASK (1 << 28) /* Transmitter enable */
|
||||
#define XTE_TXC_TXVLAN_MASK (1 << 27) /* VLAN enable */
|
||||
#define XTE_TXC_TXHD_MASK (1 << 26) /* Half duplex */
|
||||
|
||||
#define XTE_FCC_OFFSET 0x000002C0 /* Flow control config */
|
||||
#define XTE_FCC_RXFLO_MASK (1 << 29) /* Rx flow control enable */
|
||||
#define XTE_FCC_TXFLO_MASK (1 << 30) /* Tx flow control enable */
|
||||
|
||||
#define XTE_EMCFG_OFFSET 0x00000300 /* EMAC configuration */
|
||||
#define XTE_EMCFG_LINKSPD_MASK 0xC0000000 /* Link speed */
|
||||
#define XTE_EMCFG_HOSTEN_MASK (1 << 26) /* Host interface enable */
|
||||
#define XTE_EMCFG_LINKSPD_10 0x00000000 /* 10 Mbit LINKSPD_MASK */
|
||||
#define XTE_EMCFG_LINKSPD_100 (1 << 30) /* 100 Mbit LINKSPD_MASK */
|
||||
#define XTE_EMCFG_LINKSPD_1000 (1 << 31) /* 1000 Mbit LINKSPD_MASK */
|
||||
|
||||
#define XTE_GMIC_OFFSET 0x00000320 /* RGMII/SGMII config */
|
||||
#define XTE_MC_OFFSET 0x00000340 /* MDIO configuration */
|
||||
#define XTE_UAW0_OFFSET 0x00000380 /* Unicast address word 0 */
|
||||
#define XTE_UAW1_OFFSET 0x00000384 /* Unicast address word 1 */
|
||||
|
||||
#define XTE_MAW0_OFFSET 0x00000388 /* Multicast addr word 0 */
|
||||
#define XTE_MAW1_OFFSET 0x0000038C /* Multicast addr word 1 */
|
||||
#define XTE_AFM_OFFSET 0x00000390 /* Promiscuous mode */
|
||||
#define XTE_AFM_EPPRM_MASK (1 << 31) /* Promiscuous mode enable */
|
||||
|
||||
/* Interrupt Request status */
|
||||
#define XTE_TIS_OFFSET 0x000003A0
|
||||
#define TIS_FRIS (1 << 0)
|
||||
#define TIS_MRIS (1 << 1)
|
||||
#define TIS_MWIS (1 << 2)
|
||||
#define TIS_ARIS (1 << 3)
|
||||
#define TIS_AWIS (1 << 4)
|
||||
#define TIS_CRIS (1 << 5)
|
||||
#define TIS_CWIS (1 << 6)
|
||||
|
||||
#define XTE_TIE_OFFSET 0x000003A4 /* Interrupt enable */
|
||||
|
||||
/** MII Mamagement Control register (MGTCR) */
|
||||
#define XTE_MGTDR_OFFSET 0x000003B0 /* MII data */
|
||||
#define XTE_MIIMAI_OFFSET 0x000003B4 /* MII control */
|
||||
|
||||
#define CNTLREG_WRITE_ENABLE_MASK 0x8000
|
||||
#define CNTLREG_EMAC1SEL_MASK 0x0400
|
||||
#define CNTLREG_ADDRESSCODE_MASK 0x03ff
|
||||
|
||||
/* CDMAC descriptor status bit definitions */
|
||||
|
||||
#define STS_CTRL_APP0_ERR (1 << 31)
|
||||
#define STS_CTRL_APP0_IRQONEND (1 << 30)
|
||||
/* undoccumented */
|
||||
#define STS_CTRL_APP0_STOPONEND (1 << 29)
|
||||
#define STS_CTRL_APP0_CMPLT (1 << 28)
|
||||
#define STS_CTRL_APP0_SOP (1 << 27)
|
||||
#define STS_CTRL_APP0_EOP (1 << 26)
|
||||
#define STS_CTRL_APP0_ENGBUSY (1 << 25)
|
||||
/* undocumented */
|
||||
#define STS_CTRL_APP0_ENGRST (1 << 24)
|
||||
|
||||
#define TX_CONTROL_CALC_CSUM_MASK 1
|
||||
|
||||
#define MULTICAST_CAM_TABLE_NUM 4
|
||||
|
||||
/* TEMAC Synthesis features */
|
||||
#define TEMAC_FEATURE_RX_CSUM (1 << 0)
|
||||
#define TEMAC_FEATURE_TX_CSUM (1 << 1)
|
||||
|
||||
/* TX/RX CURDESC_PTR points to first descriptor */
|
||||
/* TX/RX TAILDESC_PTR points to last descriptor in linked list */
|
||||
|
||||
/**
|
||||
* struct cdmac_bd - LocalLink buffer descriptor format
|
||||
*
|
||||
* app0 bits:
|
||||
* 0 Error
|
||||
* 1 IrqOnEnd generate an interrupt at completion of DMA op
|
||||
* 2 reserved
|
||||
* 3 completed Current descriptor completed
|
||||
* 4 SOP TX - marks first desc/ RX marks first desct
|
||||
* 5 EOP TX marks last desc/RX marks last desc
|
||||
* 6 EngBusy DMA is processing
|
||||
* 7 reserved
|
||||
* 8:31 application specific
|
||||
*/
|
||||
struct cdmac_bd {
|
||||
u32 next; /* Physical address of next buffer descriptor */
|
||||
u32 phys;
|
||||
u32 len;
|
||||
u32 app0;
|
||||
u32 app1; /* TX start << 16 | insert */
|
||||
u32 app2; /* TX csum */
|
||||
u32 app3;
|
||||
u32 app4; /* skb for TX length for RX */
|
||||
};
|
||||
|
||||
struct temac_local {
|
||||
struct net_device *ndev;
|
||||
struct device *dev;
|
||||
|
||||
/* Connection to PHY device */
|
||||
struct phy_device *phy_dev; /* Pointer to PHY device */
|
||||
struct device_node *phy_node;
|
||||
|
||||
/* MDIO bus data */
|
||||
struct mii_bus *mii_bus; /* MII bus reference */
|
||||
int mdio_irqs[PHY_MAX_ADDR]; /* IRQs table for MDIO bus */
|
||||
|
||||
/* IO registers, dma functions and IRQs */
|
||||
void __iomem *regs;
|
||||
void __iomem *sdma_regs;
|
||||
#ifdef CONFIG_PPC_DCR
|
||||
dcr_host_t sdma_dcrs;
|
||||
#endif
|
||||
u32 (*dma_in)(struct temac_local *, int);
|
||||
void (*dma_out)(struct temac_local *, int, u32);
|
||||
|
||||
int tx_irq;
|
||||
int rx_irq;
|
||||
int emac_num;
|
||||
|
||||
struct sk_buff **rx_skb;
|
||||
spinlock_t rx_lock;
|
||||
struct mutex indirect_mutex;
|
||||
u32 options; /* Current options word */
|
||||
int last_link;
|
||||
unsigned int temac_features;
|
||||
|
||||
/* Buffer descriptors */
|
||||
struct cdmac_bd *tx_bd_v;
|
||||
dma_addr_t tx_bd_p;
|
||||
struct cdmac_bd *rx_bd_v;
|
||||
dma_addr_t rx_bd_p;
|
||||
int tx_bd_ci;
|
||||
int tx_bd_next;
|
||||
int tx_bd_tail;
|
||||
int rx_bd_ci;
|
||||
};
|
||||
|
||||
/* xilinx_temac.c */
|
||||
u32 temac_ior(struct temac_local *lp, int offset);
|
||||
void temac_iow(struct temac_local *lp, int offset, u32 value);
|
||||
int temac_indirect_busywait(struct temac_local *lp);
|
||||
u32 temac_indirect_in32(struct temac_local *lp, int reg);
|
||||
void temac_indirect_out32(struct temac_local *lp, int reg, u32 value);
|
||||
|
||||
|
||||
/* xilinx_temac_mdio.c */
|
||||
int temac_mdio_setup(struct temac_local *lp, struct device_node *np);
|
||||
void temac_mdio_teardown(struct temac_local *lp);
|
||||
|
||||
#endif /* XILINX_LL_TEMAC_H */
|
||||
1154
drivers/net/ethernet/xilinx/ll_temac_main.c
Normal file
1154
drivers/net/ethernet/xilinx/ll_temac_main.c
Normal file
File diff suppressed because it is too large
Load Diff
122
drivers/net/ethernet/xilinx/ll_temac_mdio.c
Normal file
122
drivers/net/ethernet/xilinx/ll_temac_mdio.c
Normal file
@@ -0,0 +1,122 @@
|
||||
/*
|
||||
* MDIO bus driver for the Xilinx TEMAC device
|
||||
*
|
||||
* Copyright (c) 2009 Secret Lab Technologies, Ltd.
|
||||
*/
|
||||
|
||||
#include <linux/io.h>
|
||||
#include <linux/netdevice.h>
|
||||
#include <linux/mutex.h>
|
||||
#include <linux/phy.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/of_device.h>
|
||||
#include <linux/of_address.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/of_mdio.h>
|
||||
|
||||
#include "ll_temac.h"
|
||||
|
||||
/* ---------------------------------------------------------------------
|
||||
* MDIO Bus functions
|
||||
*/
|
||||
static int temac_mdio_read(struct mii_bus *bus, int phy_id, int reg)
|
||||
{
|
||||
struct temac_local *lp = bus->priv;
|
||||
u32 rc;
|
||||
|
||||
/* Write the PHY address to the MIIM Access Initiator register.
|
||||
* When the transfer completes, the PHY register value will appear
|
||||
* in the LSW0 register */
|
||||
mutex_lock(&lp->indirect_mutex);
|
||||
temac_iow(lp, XTE_LSW0_OFFSET, (phy_id << 5) | reg);
|
||||
rc = temac_indirect_in32(lp, XTE_MIIMAI_OFFSET);
|
||||
mutex_unlock(&lp->indirect_mutex);
|
||||
|
||||
dev_dbg(lp->dev, "temac_mdio_read(phy_id=%i, reg=%x) == %x\n",
|
||||
phy_id, reg, rc);
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
static int temac_mdio_write(struct mii_bus *bus, int phy_id, int reg, u16 val)
|
||||
{
|
||||
struct temac_local *lp = bus->priv;
|
||||
|
||||
dev_dbg(lp->dev, "temac_mdio_write(phy_id=%i, reg=%x, val=%x)\n",
|
||||
phy_id, reg, val);
|
||||
|
||||
/* First write the desired value into the write data register
|
||||
* and then write the address into the access initiator register
|
||||
*/
|
||||
mutex_lock(&lp->indirect_mutex);
|
||||
temac_indirect_out32(lp, XTE_MGTDR_OFFSET, val);
|
||||
temac_indirect_out32(lp, XTE_MIIMAI_OFFSET, (phy_id << 5) | reg);
|
||||
mutex_unlock(&lp->indirect_mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int temac_mdio_setup(struct temac_local *lp, struct device_node *np)
|
||||
{
|
||||
struct mii_bus *bus;
|
||||
const u32 *bus_hz;
|
||||
int clk_div;
|
||||
int rc, size;
|
||||
struct resource res;
|
||||
|
||||
/* Calculate a reasonable divisor for the clock rate */
|
||||
clk_div = 0x3f; /* worst-case default setting */
|
||||
bus_hz = of_get_property(np, "clock-frequency", &size);
|
||||
if (bus_hz && size >= sizeof(*bus_hz)) {
|
||||
clk_div = (*bus_hz) / (2500 * 1000 * 2) - 1;
|
||||
if (clk_div < 1)
|
||||
clk_div = 1;
|
||||
if (clk_div > 0x3f)
|
||||
clk_div = 0x3f;
|
||||
}
|
||||
|
||||
/* Enable the MDIO bus by asserting the enable bit and writing
|
||||
* in the clock config */
|
||||
mutex_lock(&lp->indirect_mutex);
|
||||
temac_indirect_out32(lp, XTE_MC_OFFSET, 1 << 6 | clk_div);
|
||||
mutex_unlock(&lp->indirect_mutex);
|
||||
|
||||
bus = mdiobus_alloc();
|
||||
if (!bus)
|
||||
return -ENOMEM;
|
||||
|
||||
of_address_to_resource(np, 0, &res);
|
||||
snprintf(bus->id, MII_BUS_ID_SIZE, "%.8llx",
|
||||
(unsigned long long)res.start);
|
||||
bus->priv = lp;
|
||||
bus->name = "Xilinx TEMAC MDIO";
|
||||
bus->read = temac_mdio_read;
|
||||
bus->write = temac_mdio_write;
|
||||
bus->parent = lp->dev;
|
||||
bus->irq = lp->mdio_irqs; /* preallocated IRQ table */
|
||||
|
||||
lp->mii_bus = bus;
|
||||
|
||||
rc = of_mdiobus_register(bus, np);
|
||||
if (rc)
|
||||
goto err_register;
|
||||
|
||||
mutex_lock(&lp->indirect_mutex);
|
||||
dev_dbg(lp->dev, "MDIO bus registered; MC:%x\n",
|
||||
temac_indirect_in32(lp, XTE_MC_OFFSET));
|
||||
mutex_unlock(&lp->indirect_mutex);
|
||||
return 0;
|
||||
|
||||
err_register:
|
||||
mdiobus_free(bus);
|
||||
return rc;
|
||||
}
|
||||
|
||||
void temac_mdio_teardown(struct temac_local *lp)
|
||||
{
|
||||
mdiobus_unregister(lp->mii_bus);
|
||||
kfree(lp->mii_bus->irq);
|
||||
mdiobus_free(lp->mii_bus);
|
||||
lp->mii_bus = NULL;
|
||||
}
|
||||
|
||||
1330
drivers/net/ethernet/xilinx/xilinx_emaclite.c
Normal file
1330
drivers/net/ethernet/xilinx/xilinx_emaclite.c
Normal file
File diff suppressed because it is too large
Load Diff
Reference in New Issue
Block a user