Hi Simon,
On Thu, Oct 6, 2016 at 4:25 PM, Jagan Teki jteki@openedev.com wrote:
From: Jagan Teki jagan@amarulasolutions.com
This patch add driver model support for fec_mxc driver.
Cc: Simon Glass sjg@chromium.org Cc: Joe Hershberger joe.hershberger@ni.com Cc: Peng Fan peng.fan@nxp.com Cc: Stefano Babic sbabic@denx.de Cc: Michael Trimarchi michael@amarulasolutions.com Signed-off-by: Jagan Teki jagan@amarulasolutions.com
drivers/net/fec_mxc.c | 314 ++++++++++++++++++++++++++++++++++++++++++-------- drivers/net/fec_mxc.h | 4 + 2 files changed, 271 insertions(+), 47 deletions(-)
diff --git a/drivers/net/fec_mxc.c b/drivers/net/fec_mxc.c index 0838d58..c0ec976 100644 --- a/drivers/net/fec_mxc.c +++ b/drivers/net/fec_mxc.c @@ -9,6 +9,7 @@ */
#include <common.h> +#include <dm.h> #include <malloc.h> #include <memalign.h> #include <net.h> @@ -368,11 +369,8 @@ static int fec_get_hwaddr(int dev_id, unsigned char *mac) return !is_valid_ethaddr(mac); }
-static int fec_set_hwaddr(struct eth_device *dev) +static int _fec_set_hwaddr(struct fec_priv *fec, uchar *mac) {
uchar *mac = dev->enetaddr;struct fec_priv *fec = (struct fec_priv *)dev->priv;writel(0, &fec->eth->iaddr1); writel(0, &fec->eth->iaddr2); writel(0, &fec->eth->gaddr1);@@ -426,9 +424,8 @@ static void fec_reg_setup(struct fec_priv *fec)
- Start the FEC engine
- @param[in] dev Our device to handle
*/ -static int fec_open(struct eth_device *edev) +static int fec_open(struct fec_priv *fec) {
struct fec_priv *fec = (struct fec_priv *)edev->priv; int speed; uint32_t addr, size; int i;@@ -534,14 +531,13 @@ static int fec_open(struct eth_device *edev) return 0; }
-static int fec_init(struct eth_device *dev, bd_t* bd) +static int _fec_init(struct fec_priv *fec, uchar *mac) {
struct fec_priv *fec = (struct fec_priv *)dev->priv; uint32_t mib_ptr = (uint32_t)&fec->eth->rmon_t_drop; int i; /* Initialize MAC address */fec_set_hwaddr(dev);
_fec_set_hwaddr(fec, mac); /* * Setup transmit descriptors, there are two in total.@@ -587,7 +583,7 @@ static int fec_init(struct eth_device *dev, bd_t* bd) if (fec->xcv_type != SEVENWIRE) miiphy_restart_aneg(dev); #endif
fec_open(dev);
fec_open(fec); return 0;}
@@ -595,9 +591,8 @@ static int fec_init(struct eth_device *dev, bd_t* bd)
- Halt the FEC engine
- @param[in] dev Our device to handle
*/ -static void fec_halt(struct eth_device *dev) +static void _fec_halt(struct fec_priv *fec) {
struct fec_priv *fec = (struct fec_priv *)dev->priv; int counter = 0xffff; /*@@ -637,7 +632,7 @@ static void fec_halt(struct eth_device *dev)
- @param[in] length Data count in bytes
- @return 0 on success
*/ -static int fec_send(struct eth_device *dev, void *packet, int length) +static int _fec_send(struct fec_priv *fec, void *packet, int length) { unsigned int status; uint32_t size, end; @@ -649,8 +644,6 @@ static int fec_send(struct eth_device *dev, void *packet, int length) * This routine transmits one frame. This routine only accepts * 6-byte Ethernet addresses. */
struct fec_priv *fec = (struct fec_priv *)dev->priv;/* * Check for valid length of data. */@@ -777,14 +770,14 @@ out: return ret; }
/**
- Pull one frame from the card
- @param[in] dev Our ethernet device to handle
- @return Length of packet read
*/ -static int fec_recv(struct eth_device *dev) +static int _fec_recv(struct fec_priv *fec, uchar *mac) {
struct fec_priv *fec = (struct fec_priv *)dev->priv; struct fec_bd *rbd = &fec->rbd_base[fec->rbd_index]; unsigned long ievent; int frame_length, len = 0;@@ -800,8 +793,8 @@ static int fec_recv(struct eth_device *dev) writel(ievent, &fec->eth->ievent); debug("fec_recv: ievent 0x%lx\n", ievent); if (ievent & FEC_IEVENT_BABR) {
fec_halt(dev);fec_init(dev, fec->bd);
_fec_halt(fec);_fec_init(fec, mac); printf("some error: 0x%08lx\n", ievent); return 0; }@@ -813,10 +806,10 @@ static int fec_recv(struct eth_device *dev) if (ievent & FEC_IEVENT_GRA) { /* Graceful stop complete */ if (readl(&fec->eth->x_cntrl) & 0x00000001) {
fec_halt(dev);
_fec_halt(fec); writel(~0x00000001 & readl(&fec->eth->x_cntrl), &fec->eth->x_cntrl);
fec_init(dev, fec->bd);
_fec_init(fec, mac); } }@@ -970,6 +963,71 @@ static void fec_free_descs(struct fec_priv *fec) free(fec->tbd_base); }
+struct mii_dev *fec_get_miibus(uint32_t base_addr, int dev_id) +{
struct ethernet_regs *eth = (struct ethernet_regs *)base_addr;struct mii_dev *bus;int ret;bus = mdio_alloc();if (!bus) {printf("mdio_alloc failed\n");return NULL;}bus->read = fec_phy_read;bus->write = fec_phy_write;bus->priv = eth;fec_set_dev_name(bus->name, dev_id);ret = mdio_register(bus);if (ret) {printf("mdio_register failed\n");free(bus);return NULL;}fec_mii_setspeed(eth);return bus;+}
+#ifndef CONFIG_DM_ETH +static int fec_recv(struct eth_device *dev) +{
struct fec_priv *fec = (struct fec_priv *)dev->priv;uchar *mac = dev->enetaddr;return _fec_recv(fec, mac);+}
+static int fec_send(struct eth_device *dev, void *packet, int length) +{
struct fec_priv *fec = (struct fec_priv *)dev->priv;return _fec_send(fec, packet, length);+}
+static void fec_halt(struct eth_device *dev) +{
struct fec_priv *fec = (struct fec_priv *)dev->priv;_fec_halt(fec);+}
+static int fec_set_hwaddr(struct eth_device *dev) +{
struct fec_priv *fec = (struct fec_priv *)dev->priv;uchar *mac = dev->enetaddr;return _fec_set_hwaddr(fec, mac);+}
+static int fec_init(struct eth_device *dev, bd_t *bd) +{
struct fec_priv *fec = (struct fec_priv *)dev->priv;uchar *mac = dev->enetaddr;return _fec_init(fec, mac);+}
#ifdef CONFIG_PHYLIB int fec_probe(bd_t *bd, int dev_id, uint32_t base_addr, struct mii_dev *bus, struct phy_device *phydev) @@ -1061,32 +1119,6 @@ err1: return ret; }
-struct mii_dev *fec_get_miibus(uint32_t base_addr, int dev_id) -{
struct ethernet_regs *eth = (struct ethernet_regs *)base_addr;struct mii_dev *bus;int ret;bus = mdio_alloc();if (!bus) {printf("mdio_alloc failed\n");return NULL;}bus->read = fec_phy_read;bus->write = fec_phy_write;bus->priv = eth;fec_set_dev_name(bus->name, dev_id);ret = mdio_register(bus);if (ret) {printf("mdio_register failed\n");free(bus);return NULL;}fec_mii_setspeed(eth);return bus;-}
int fecmxc_initialize_multi(bd_t *bd, int dev_id, int phy_id, uint32_t addr) { uint32_t base_mii; @@ -1146,3 +1178,191 @@ int fecmxc_register_mii_postcall(struct eth_device *dev, int (*cb)(int)) return 0; } #endif
+#else
+static int fec_set_hwaddr(struct udevice *dev) +{
struct fec_priv *fec = dev_get_priv(dev);struct eth_pdata *pdata = dev_get_platdata(dev);uchar *mac = pdata->enetaddr;return _fec_set_hwaddr(fec, mac);+}
+static void fec_halt(struct udevice *dev) +{
struct fec_priv *fec = dev_get_priv(dev);_fec_halt(fec);+}
+static int fec_recv(struct udevice *dev, int flags, uchar **packetp) +{
struct fec_priv *fec = dev_get_priv(dev);struct eth_pdata *pdata = dev_get_platdata(dev);uchar *mac = pdata->enetaddr;return _fec_recv(fec, mac);+}
+static int fec_send(struct udevice *dev, void *packet, int length) +{
struct fec_priv *fec = dev_get_priv(dev);return _fec_send(fec, packet, length);+}
+static int fec_init(struct udevice *dev) +{
struct fec_priv *fec = dev_get_priv(dev);struct eth_pdata *pdata = dev_get_platdata(dev);uchar *mac = pdata->enetaddr;return _fec_init(fec, mac);+}
This look OK now, let me know if you have any inputs.
thanks!