|
@@ -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,
|
|
|
+};
|