net: ravb: Add Renesas Ethernet RAVB driver
Add driver for the Renesas Ethernet AVB block found in RCar H3/M3. Signed-off-by: Marek Vasut <marek.vasut+renesas@gmail.com> Cc: Hiroyuki Yokoyama <hiroyuki.yokoyama.vx@renesas.com> Cc: Nobuhiro Iwamatsu <iwamatsu@nigauri.org> Cc: Tom Rini <trini@konsulko.com> Cc: Joe Hershberger <joe.hershberger@ni.com> Based on work of: Hiroyuki Yokoyama <hiroyuki.yokoyama.vx@renesas.com> Takeshi Kihara <takeshi.kihara.df@renesas.com> Kazuya Mizuguchi <kazuya.mizuguchi.ks@renesas.com>
This commit is contained in:
parent
1815c29738
commit
8ae51b6f32
@ -225,4 +225,12 @@ config GMAC_ROCKCHIP
|
||||
This driver provides Rockchip SoCs network support based on the
|
||||
Synopsys Designware driver.
|
||||
|
||||
config RENESAS_RAVB
|
||||
bool "Renesas Ethernet AVB MAC"
|
||||
depends on DM_ETH && RCAR_GEN3
|
||||
select PHYLIB
|
||||
help
|
||||
This driver implements support for the Ethernet AVB block in
|
||||
Renesas M3 and H3 SoCs.
|
||||
|
||||
endif # NETDEVICES
|
||||
|
@ -56,6 +56,7 @@ obj-$(CONFIG_RTL8169) += rtl8169.o
|
||||
obj-$(CONFIG_ETH_SANDBOX) += sandbox.o
|
||||
obj-$(CONFIG_ETH_SANDBOX_RAW) += sandbox-raw.o
|
||||
obj-$(CONFIG_SH_ETHER) += sh_eth.o
|
||||
obj-$(CONFIG_RENESAS_RAVB) += ravb.o
|
||||
obj-$(CONFIG_SMC91111) += smc91111.o
|
||||
obj-$(CONFIG_SMC911X) += smc911x.o
|
||||
obj-$(CONFIG_DRIVER_TI_EMAC) += davinci_emac.o
|
||||
|
601
drivers/net/ravb.c
Normal file
601
drivers/net/ravb.c
Normal file
@ -0,0 +1,601 @@
|
||||
/*
|
||||
* drivers/net/ravb.c
|
||||
* This file is driver for Renesas Ethernet AVB.
|
||||
*
|
||||
* Copyright (C) 2015-2017 Renesas Electronics Corporation
|
||||
*
|
||||
* Based on the SuperH Ethernet driver.
|
||||
*
|
||||
* SPDX-License-Identifier: GPL-2.0+
|
||||
*/
|
||||
|
||||
#include <common.h>
|
||||
#include <dm.h>
|
||||
#include <errno.h>
|
||||
#include <miiphy.h>
|
||||
#include <malloc.h>
|
||||
#include <linux/mii.h>
|
||||
#include <wait_bit.h>
|
||||
#include <asm/io.h>
|
||||
|
||||
/* Registers */
|
||||
#define RAVB_REG_CCC 0x000
|
||||
#define RAVB_REG_DBAT 0x004
|
||||
#define RAVB_REG_CSR 0x00C
|
||||
#define RAVB_REG_APSR 0x08C
|
||||
#define RAVB_REG_RCR 0x090
|
||||
#define RAVB_REG_TGC 0x300
|
||||
#define RAVB_REG_TCCR 0x304
|
||||
#define RAVB_REG_RIC0 0x360
|
||||
#define RAVB_REG_RIC1 0x368
|
||||
#define RAVB_REG_RIC2 0x370
|
||||
#define RAVB_REG_TIC 0x378
|
||||
#define RAVB_REG_ECMR 0x500
|
||||
#define RAVB_REG_RFLR 0x508
|
||||
#define RAVB_REG_ECSIPR 0x518
|
||||
#define RAVB_REG_PIR 0x520
|
||||
#define RAVB_REG_GECMR 0x5b0
|
||||
#define RAVB_REG_MAHR 0x5c0
|
||||
#define RAVB_REG_MALR 0x5c8
|
||||
|
||||
#define CCC_OPC_CONFIG BIT(0)
|
||||
#define CCC_OPC_OPERATION BIT(1)
|
||||
#define CCC_BOC BIT(20)
|
||||
|
||||
#define CSR_OPS 0x0000000F
|
||||
#define CSR_OPS_CONFIG BIT(1)
|
||||
|
||||
#define TCCR_TSRQ0 BIT(0)
|
||||
|
||||
#define RFLR_RFL_MIN 0x05EE
|
||||
|
||||
#define PIR_MDI BIT(3)
|
||||
#define PIR_MDO BIT(2)
|
||||
#define PIR_MMD BIT(1)
|
||||
#define PIR_MDC BIT(0)
|
||||
|
||||
#define ECMR_TRCCM BIT(26)
|
||||
#define ECMR_RZPF BIT(20)
|
||||
#define ECMR_PFR BIT(18)
|
||||
#define ECMR_RXF BIT(17)
|
||||
#define ECMR_RE BIT(6)
|
||||
#define ECMR_TE BIT(5)
|
||||
#define ECMR_DM BIT(1)
|
||||
#define ECMR_CHG_DM (ECMR_TRCCM | ECMR_RZPF | ECMR_PFR | ECMR_RXF)
|
||||
|
||||
/* DMA Descriptors */
|
||||
#define RAVB_NUM_BASE_DESC 16
|
||||
#define RAVB_NUM_TX_DESC 8
|
||||
#define RAVB_NUM_RX_DESC 8
|
||||
|
||||
#define RAVB_TX_QUEUE_OFFSET 0
|
||||
#define RAVB_RX_QUEUE_OFFSET 4
|
||||
|
||||
#define RAVB_DESC_DT(n) ((n) << 28)
|
||||
#define RAVB_DESC_DT_FSINGLE RAVB_DESC_DT(0x7)
|
||||
#define RAVB_DESC_DT_LINKFIX RAVB_DESC_DT(0x9)
|
||||
#define RAVB_DESC_DT_EOS RAVB_DESC_DT(0xa)
|
||||
#define RAVB_DESC_DT_FEMPTY RAVB_DESC_DT(0xc)
|
||||
#define RAVB_DESC_DT_EEMPTY RAVB_DESC_DT(0x3)
|
||||
#define RAVB_DESC_DT_MASK RAVB_DESC_DT(0xf)
|
||||
|
||||
#define RAVB_DESC_DS(n) (((n) & 0xfff) << 0)
|
||||
#define RAVB_DESC_DS_MASK 0xfff
|
||||
|
||||
#define RAVB_RX_DESC_MSC_MC BIT(23)
|
||||
#define RAVB_RX_DESC_MSC_CEEF BIT(22)
|
||||
#define RAVB_RX_DESC_MSC_CRL BIT(21)
|
||||
#define RAVB_RX_DESC_MSC_FRE BIT(20)
|
||||
#define RAVB_RX_DESC_MSC_RTLF BIT(19)
|
||||
#define RAVB_RX_DESC_MSC_RTSF BIT(18)
|
||||
#define RAVB_RX_DESC_MSC_RFE BIT(17)
|
||||
#define RAVB_RX_DESC_MSC_CRC BIT(16)
|
||||
#define RAVB_RX_DESC_MSC_MASK (0xff << 16)
|
||||
|
||||
#define RAVB_RX_DESC_MSC_RX_ERR_MASK \
|
||||
(RAVB_RX_DESC_MSC_CRC | RAVB_RX_DESC_MSC_RFE | RAVB_RX_DESC_MSC_RTLF | \
|
||||
RAVB_RX_DESC_MSC_RTSF | RAVB_RX_DESC_MSC_CEEF)
|
||||
|
||||
#define RAVB_TX_TIMEOUT_MS 1000
|
||||
|
||||
struct ravb_desc {
|
||||
u32 ctrl;
|
||||
u32 dptr;
|
||||
};
|
||||
|
||||
struct ravb_rxdesc {
|
||||
struct ravb_desc data;
|
||||
struct ravb_desc link;
|
||||
u8 __pad[48];
|
||||
u8 packet[PKTSIZE_ALIGN];
|
||||
};
|
||||
|
||||
struct ravb_priv {
|
||||
struct ravb_desc base_desc[RAVB_NUM_BASE_DESC];
|
||||
struct ravb_desc tx_desc[RAVB_NUM_TX_DESC];
|
||||
struct ravb_rxdesc rx_desc[RAVB_NUM_RX_DESC];
|
||||
u32 rx_desc_idx;
|
||||
u32 tx_desc_idx;
|
||||
|
||||
struct phy_device *phydev;
|
||||
struct mii_dev *bus;
|
||||
void __iomem *iobase;
|
||||
};
|
||||
|
||||
static inline void ravb_flush_dcache(u32 addr, u32 len)
|
||||
{
|
||||
flush_dcache_range(addr, addr + len);
|
||||
}
|
||||
|
||||
static inline void ravb_invalidate_dcache(u32 addr, u32 len)
|
||||
{
|
||||
u32 start = addr & ~((uintptr_t)ARCH_DMA_MINALIGN - 1);
|
||||
u32 end = roundup(addr + len, ARCH_DMA_MINALIGN);
|
||||
invalidate_dcache_range(start, end);
|
||||
}
|
||||
|
||||
static int ravb_send(struct udevice *dev, void *packet, int len)
|
||||
{
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
struct ravb_desc *desc = ð->tx_desc[eth->tx_desc_idx];
|
||||
unsigned int start;
|
||||
|
||||
/* Update TX descriptor */
|
||||
ravb_flush_dcache((uintptr_t)packet, len);
|
||||
memset(desc, 0x0, sizeof(*desc));
|
||||
desc->ctrl = RAVB_DESC_DT_FSINGLE | RAVB_DESC_DS(len);
|
||||
desc->dptr = (uintptr_t)packet;
|
||||
ravb_flush_dcache((uintptr_t)desc, sizeof(*desc));
|
||||
|
||||
/* Restart the transmitter if disabled */
|
||||
if (!(readl(eth->iobase + RAVB_REG_TCCR) & TCCR_TSRQ0))
|
||||
setbits_le32(eth->iobase + RAVB_REG_TCCR, TCCR_TSRQ0);
|
||||
|
||||
/* Wait until packet is transmitted */
|
||||
start = get_timer(0);
|
||||
while (get_timer(start) < RAVB_TX_TIMEOUT_MS) {
|
||||
ravb_invalidate_dcache((uintptr_t)desc, sizeof(*desc));
|
||||
if ((desc->ctrl & RAVB_DESC_DT_MASK) != RAVB_DESC_DT_FSINGLE)
|
||||
break;
|
||||
udelay(10);
|
||||
};
|
||||
|
||||
if (get_timer(start) >= RAVB_TX_TIMEOUT_MS)
|
||||
return -ETIMEDOUT;
|
||||
|
||||
eth->tx_desc_idx = (eth->tx_desc_idx + 1) % (RAVB_NUM_TX_DESC - 1);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ravb_recv(struct udevice *dev, int flags, uchar **packetp)
|
||||
{
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
struct ravb_rxdesc *desc = ð->rx_desc[eth->rx_desc_idx];
|
||||
int len;
|
||||
u8 *packet;
|
||||
|
||||
/* Check if the rx descriptor is ready */
|
||||
ravb_invalidate_dcache((uintptr_t)desc, sizeof(*desc));
|
||||
if ((desc->data.ctrl & RAVB_DESC_DT_MASK) == RAVB_DESC_DT_FEMPTY)
|
||||
return -EAGAIN;
|
||||
|
||||
/* Check for errors */
|
||||
if (desc->data.ctrl & RAVB_RX_DESC_MSC_RX_ERR_MASK) {
|
||||
desc->data.ctrl &= ~RAVB_RX_DESC_MSC_MASK;
|
||||
return -EAGAIN;
|
||||
}
|
||||
|
||||
len = desc->data.ctrl & RAVB_DESC_DS_MASK;
|
||||
packet = (u8 *)(uintptr_t)desc->data.dptr;
|
||||
ravb_invalidate_dcache((uintptr_t)packet, len);
|
||||
|
||||
*packetp = packet;
|
||||
return len;
|
||||
}
|
||||
|
||||
static int ravb_free_pkt(struct udevice *dev, uchar *packet, int length)
|
||||
{
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
struct ravb_rxdesc *desc = ð->rx_desc[eth->rx_desc_idx];
|
||||
|
||||
/* Make current descriptor available again */
|
||||
desc->data.ctrl = RAVB_DESC_DT_FEMPTY | RAVB_DESC_DS(PKTSIZE_ALIGN);
|
||||
ravb_flush_dcache((uintptr_t)desc, sizeof(*desc));
|
||||
|
||||
/* Point to the next descriptor */
|
||||
eth->rx_desc_idx = (eth->rx_desc_idx + 1) % RAVB_NUM_RX_DESC;
|
||||
desc = ð->rx_desc[eth->rx_desc_idx];
|
||||
ravb_invalidate_dcache((uintptr_t)desc, sizeof(*desc));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ravb_reset(struct udevice *dev)
|
||||
{
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
|
||||
/* Set config mode */
|
||||
writel(CCC_OPC_CONFIG, eth->iobase + RAVB_REG_CCC);
|
||||
|
||||
/* Check the operating mode is changed to the config mode. */
|
||||
return wait_for_bit(dev->name, (void *)eth->iobase + RAVB_REG_CSR,
|
||||
CSR_OPS_CONFIG, true, 100, true);
|
||||
}
|
||||
|
||||
static void ravb_base_desc_init(struct ravb_priv *eth)
|
||||
{
|
||||
const u32 desc_size = RAVB_NUM_BASE_DESC * sizeof(struct ravb_desc);
|
||||
int i;
|
||||
|
||||
/* Initialize all descriptors */
|
||||
memset(eth->base_desc, 0x0, desc_size);
|
||||
|
||||
for (i = 0; i < RAVB_NUM_BASE_DESC; i++)
|
||||
eth->base_desc[i].ctrl = RAVB_DESC_DT_EOS;
|
||||
|
||||
ravb_flush_dcache((uintptr_t)eth->base_desc, desc_size);
|
||||
|
||||
/* Register the descriptor base address table */
|
||||
writel((uintptr_t)eth->base_desc, eth->iobase + RAVB_REG_DBAT);
|
||||
}
|
||||
|
||||
static void ravb_tx_desc_init(struct ravb_priv *eth)
|
||||
{
|
||||
const u32 desc_size = RAVB_NUM_TX_DESC * sizeof(struct ravb_desc);
|
||||
int i;
|
||||
|
||||
/* Initialize all descriptors */
|
||||
memset(eth->tx_desc, 0x0, desc_size);
|
||||
eth->tx_desc_idx = 0;
|
||||
|
||||
for (i = 0; i < RAVB_NUM_TX_DESC; i++)
|
||||
eth->tx_desc[i].ctrl = RAVB_DESC_DT_EEMPTY;
|
||||
|
||||
/* Mark the end of the descriptors */
|
||||
eth->tx_desc[RAVB_NUM_TX_DESC - 1].ctrl = RAVB_DESC_DT_LINKFIX;
|
||||
eth->tx_desc[RAVB_NUM_TX_DESC - 1].dptr = (uintptr_t)eth->tx_desc;
|
||||
ravb_flush_dcache((uintptr_t)eth->tx_desc, desc_size);
|
||||
|
||||
/* Point the controller to the TX descriptor list. */
|
||||
eth->base_desc[RAVB_TX_QUEUE_OFFSET].ctrl = RAVB_DESC_DT_LINKFIX;
|
||||
eth->base_desc[RAVB_TX_QUEUE_OFFSET].dptr = (uintptr_t)eth->tx_desc;
|
||||
ravb_flush_dcache((uintptr_t)ð->base_desc[RAVB_TX_QUEUE_OFFSET],
|
||||
sizeof(struct ravb_desc));
|
||||
}
|
||||
|
||||
static void ravb_rx_desc_init(struct ravb_priv *eth)
|
||||
{
|
||||
const u32 desc_size = RAVB_NUM_RX_DESC * sizeof(struct ravb_rxdesc);
|
||||
int i;
|
||||
|
||||
/* Initialize all descriptors */
|
||||
memset(eth->rx_desc, 0x0, desc_size);
|
||||
eth->rx_desc_idx = 0;
|
||||
|
||||
for (i = 0; i < RAVB_NUM_RX_DESC; i++) {
|
||||
eth->rx_desc[i].data.ctrl = RAVB_DESC_DT_EEMPTY |
|
||||
RAVB_DESC_DS(PKTSIZE_ALIGN);
|
||||
eth->rx_desc[i].data.dptr = (uintptr_t)eth->rx_desc[i].packet;
|
||||
|
||||
eth->rx_desc[i].link.ctrl = RAVB_DESC_DT_LINKFIX;
|
||||
eth->rx_desc[i].link.dptr = (uintptr_t)ð->rx_desc[i + 1];
|
||||
}
|
||||
|
||||
/* Mark the end of the descriptors */
|
||||
eth->rx_desc[RAVB_NUM_RX_DESC - 1].link.ctrl = RAVB_DESC_DT_LINKFIX;
|
||||
eth->rx_desc[RAVB_NUM_RX_DESC - 1].link.dptr = (uintptr_t)eth->rx_desc;
|
||||
ravb_flush_dcache((uintptr_t)eth->rx_desc, desc_size);
|
||||
|
||||
/* Point the controller to the rx descriptor list */
|
||||
eth->base_desc[RAVB_RX_QUEUE_OFFSET].ctrl = RAVB_DESC_DT_LINKFIX;
|
||||
eth->base_desc[RAVB_RX_QUEUE_OFFSET].dptr = (uintptr_t)eth->rx_desc;
|
||||
ravb_flush_dcache((uintptr_t)ð->base_desc[RAVB_RX_QUEUE_OFFSET],
|
||||
sizeof(struct ravb_desc));
|
||||
}
|
||||
|
||||
static int ravb_phy_config(struct udevice *dev)
|
||||
{
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
struct eth_pdata *pdata = dev_get_platdata(dev);
|
||||
struct phy_device *phydev;
|
||||
int reg;
|
||||
|
||||
phydev = phy_connect(eth->bus, pdata->phy_interface,
|
||||
dev, PHY_INTERFACE_MODE_RGMII_ID);
|
||||
if (!phydev)
|
||||
return -ENODEV;
|
||||
|
||||
eth->phydev = phydev;
|
||||
|
||||
/* 10BASE is not supported for Ethernet AVB MAC */
|
||||
phydev->supported &= ~(SUPPORTED_10baseT_Full
|
||||
| SUPPORTED_10baseT_Half);
|
||||
if (pdata->max_speed != 1000) {
|
||||
phydev->supported &= ~(SUPPORTED_1000baseT_Half
|
||||
| SUPPORTED_1000baseT_Full);
|
||||
reg = phy_read(phydev, -1, MII_CTRL1000);
|
||||
reg &= ~(BIT(9) | BIT(8));
|
||||
phy_write(phydev, -1, MII_CTRL1000, reg);
|
||||
}
|
||||
|
||||
phy_config(phydev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Set Mac address */
|
||||
static int ravb_write_hwaddr(struct udevice *dev)
|
||||
{
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
struct eth_pdata *pdata = dev_get_platdata(dev);
|
||||
unsigned char *mac = pdata->enetaddr;
|
||||
|
||||
writel((mac[0] << 24) | (mac[1] << 16) | (mac[2] << 8) | mac[3],
|
||||
eth->iobase + RAVB_REG_MAHR);
|
||||
|
||||
writel((mac[4] << 8) | mac[5], eth->iobase + RAVB_REG_MALR);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* E-MAC init function */
|
||||
static int ravb_mac_init(struct ravb_priv *eth)
|
||||
{
|
||||
/* Disable MAC Interrupt */
|
||||
writel(0, eth->iobase + RAVB_REG_ECSIPR);
|
||||
|
||||
/* Recv frame limit set register */
|
||||
writel(RFLR_RFL_MIN, eth->iobase + RAVB_REG_RFLR);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* AVB-DMAC init function */
|
||||
static int ravb_dmac_init(struct udevice *dev)
|
||||
{
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
struct eth_pdata *pdata = dev_get_platdata(dev);
|
||||
int ret = 0;
|
||||
|
||||
/* Set CONFIG mode */
|
||||
ret = ravb_reset(dev);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* Disable all interrupts */
|
||||
writel(0, eth->iobase + RAVB_REG_RIC0);
|
||||
writel(0, eth->iobase + RAVB_REG_RIC1);
|
||||
writel(0, eth->iobase + RAVB_REG_RIC2);
|
||||
writel(0, eth->iobase + RAVB_REG_TIC);
|
||||
|
||||
/* Set little endian */
|
||||
clrbits_le32(eth->iobase + RAVB_REG_CCC, CCC_BOC);
|
||||
|
||||
/* AVB rx set */
|
||||
writel(0x18000001, eth->iobase + RAVB_REG_RCR);
|
||||
|
||||
/* FIFO size set */
|
||||
writel(0x00222210, eth->iobase + RAVB_REG_TGC);
|
||||
|
||||
/* Delay CLK: 2ns */
|
||||
if (pdata->max_speed == 1000)
|
||||
writel(BIT(14), eth->iobase + RAVB_REG_APSR);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ravb_config(struct udevice *dev)
|
||||
{
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
struct phy_device *phy;
|
||||
u32 mask = ECMR_CHG_DM | ECMR_RE | ECMR_TE;
|
||||
int ret;
|
||||
|
||||
/* Configure AVB-DMAC register */
|
||||
ravb_dmac_init(dev);
|
||||
|
||||
/* Configure E-MAC registers */
|
||||
ravb_mac_init(eth);
|
||||
ravb_write_hwaddr(dev);
|
||||
|
||||
/* Configure phy */
|
||||
ret = ravb_phy_config(dev);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
phy = eth->phydev;
|
||||
|
||||
ret = phy_startup(phy);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* Set the transfer speed */
|
||||
if (phy->speed == 100)
|
||||
writel(0, eth->iobase + RAVB_REG_GECMR);
|
||||
else if (phy->speed == 1000)
|
||||
writel(1, eth->iobase + RAVB_REG_GECMR);
|
||||
|
||||
/* Check if full duplex mode is supported by the phy */
|
||||
if (phy->duplex)
|
||||
mask |= ECMR_DM;
|
||||
|
||||
writel(mask, eth->iobase + RAVB_REG_ECMR);
|
||||
|
||||
phy->drv->writeext(phy, -1, 0x02, 0x08, (0x0f << 5) | 0x19);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ravb_start(struct udevice *dev)
|
||||
{
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
int ret;
|
||||
|
||||
ret = ravb_reset(dev);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ravb_base_desc_init(eth);
|
||||
ravb_tx_desc_init(eth);
|
||||
ravb_rx_desc_init(eth);
|
||||
|
||||
ret = ravb_config(dev);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/* Setting the control will start the AVB-DMAC process. */
|
||||
writel(CCC_OPC_OPERATION, eth->iobase + RAVB_REG_CCC);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void ravb_stop(struct udevice *dev)
|
||||
{
|
||||
ravb_reset(dev);
|
||||
}
|
||||
|
||||
static int ravb_probe(struct udevice *dev)
|
||||
{
|
||||
struct eth_pdata *pdata = dev_get_platdata(dev);
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
struct mii_dev *mdiodev;
|
||||
void __iomem *iobase;
|
||||
int ret;
|
||||
|
||||
iobase = map_physmem(pdata->iobase, 0x1000, MAP_NOCACHE);
|
||||
eth->iobase = iobase;
|
||||
|
||||
mdiodev = mdio_alloc();
|
||||
if (!mdiodev) {
|
||||
ret = -ENOMEM;
|
||||
goto err_mdio_alloc;
|
||||
}
|
||||
|
||||
mdiodev->read = bb_miiphy_read;
|
||||
mdiodev->write = bb_miiphy_write;
|
||||
bb_miiphy_buses[0].priv = eth;
|
||||
snprintf(mdiodev->name, sizeof(mdiodev->name), dev->name);
|
||||
|
||||
ret = mdio_register(mdiodev);
|
||||
if (ret < 0)
|
||||
goto err_mdio_register;
|
||||
|
||||
eth->bus = miiphy_get_dev_by_name(dev->name);
|
||||
|
||||
return 0;
|
||||
|
||||
err_mdio_register:
|
||||
mdio_free(mdiodev);
|
||||
err_mdio_alloc:
|
||||
unmap_physmem(eth->iobase, MAP_NOCACHE);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int ravb_remove(struct udevice *dev)
|
||||
{
|
||||
struct ravb_priv *eth = dev_get_priv(dev);
|
||||
|
||||
free(eth->phydev);
|
||||
mdio_unregister(eth->bus);
|
||||
mdio_free(eth->bus);
|
||||
unmap_physmem(eth->iobase, MAP_NOCACHE);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ravb_bb_init(struct bb_miiphy_bus *bus)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ravb_bb_mdio_active(struct bb_miiphy_bus *bus)
|
||||
{
|
||||
struct ravb_priv *eth = bus->priv;
|
||||
|
||||
setbits_le32(eth->iobase + RAVB_REG_PIR, PIR_MMD);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ravb_bb_mdio_tristate(struct bb_miiphy_bus *bus)
|
||||
{
|
||||
struct ravb_priv *eth = bus->priv;
|
||||
|
||||
clrbits_le32(eth->iobase + RAVB_REG_PIR, PIR_MMD);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ravb_bb_set_mdio(struct bb_miiphy_bus *bus, int v)
|
||||
{
|
||||
struct ravb_priv *eth = bus->priv;
|
||||
|
||||
if (v)
|
||||
setbits_le32(eth->iobase + RAVB_REG_PIR, PIR_MDO);
|
||||
else
|
||||
clrbits_le32(eth->iobase + RAVB_REG_PIR, PIR_MDO);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ravb_bb_get_mdio(struct bb_miiphy_bus *bus, int *v)
|
||||
{
|
||||
struct ravb_priv *eth = bus->priv;
|
||||
|
||||
*v = (readl(eth->iobase + RAVB_REG_PIR) & PIR_MDI) >> 3;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ravb_bb_set_mdc(struct bb_miiphy_bus *bus, int v)
|
||||
{
|
||||
struct ravb_priv *eth = bus->priv;
|
||||
|
||||
if (v)
|
||||
setbits_le32(eth->iobase + RAVB_REG_PIR, PIR_MDC);
|
||||
else
|
||||
clrbits_le32(eth->iobase + RAVB_REG_PIR, PIR_MDC);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ravb_bb_delay(struct bb_miiphy_bus *bus)
|
||||
{
|
||||
udelay(10);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
struct bb_miiphy_bus bb_miiphy_buses[] = {
|
||||
{
|
||||
.name = "ravb",
|
||||
.init = ravb_bb_init,
|
||||
.mdio_active = ravb_bb_mdio_active,
|
||||
.mdio_tristate = ravb_bb_mdio_tristate,
|
||||
.set_mdio = ravb_bb_set_mdio,
|
||||
.get_mdio = ravb_bb_get_mdio,
|
||||
.set_mdc = ravb_bb_set_mdc,
|
||||
.delay = ravb_bb_delay,
|
||||
},
|
||||
};
|
||||
int bb_miiphy_buses_num = ARRAY_SIZE(bb_miiphy_buses);
|
||||
|
||||
static const struct eth_ops ravb_ops = {
|
||||
.start = ravb_start,
|
||||
.send = ravb_send,
|
||||
.recv = ravb_recv,
|
||||
.free_pkt = ravb_free_pkt,
|
||||
.stop = ravb_stop,
|
||||
.write_hwaddr = ravb_write_hwaddr,
|
||||
};
|
||||
|
||||
U_BOOT_DRIVER(eth_ravb) = {
|
||||
.name = "ravb",
|
||||
.id = UCLASS_ETH,
|
||||
.probe = ravb_probe,
|
||||
.remove = ravb_remove,
|
||||
.ops = &ravb_ops,
|
||||
.priv_auto_alloc_size = sizeof(struct ravb_priv),
|
||||
.platdata_auto_alloc_size = sizeof(struct eth_pdata),
|
||||
.flags = DM_FLAG_ALLOC_PRIV_DMA,
|
||||
};
|
Loading…
Reference in New Issue
Block a user