Commit e9509554 authored by Wolfram Sang's avatar Wolfram Sang Committed by David S. Miller

net/mpc52xx_phy: Various code cleanups

- don't free bus->irq (obsoleted by ca816d98)
- don't dispose irqs (should be done in of_mdiobus_register())
- use fec-pointer consistently in transfer()
- use resource_size()
- cosmetic fixes
Signed-off-by: default avatarWolfram Sang <w.sang@pengutronix.de>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent f9f3545e
...@@ -29,15 +29,14 @@ static int mpc52xx_fec_mdio_transfer(struct mii_bus *bus, int phy_id, ...@@ -29,15 +29,14 @@ static int mpc52xx_fec_mdio_transfer(struct mii_bus *bus, int phy_id,
int reg, u32 value) int reg, u32 value)
{ {
struct mpc52xx_fec_mdio_priv *priv = bus->priv; struct mpc52xx_fec_mdio_priv *priv = bus->priv;
struct mpc52xx_fec __iomem *fec; struct mpc52xx_fec __iomem *fec = priv->regs;
int tries = 3; int tries = 3;
value |= (phy_id << FEC_MII_DATA_PA_SHIFT) & FEC_MII_DATA_PA_MSK; value |= (phy_id << FEC_MII_DATA_PA_SHIFT) & FEC_MII_DATA_PA_MSK;
value |= (reg << FEC_MII_DATA_RA_SHIFT) & FEC_MII_DATA_RA_MSK; value |= (reg << FEC_MII_DATA_RA_SHIFT) & FEC_MII_DATA_RA_MSK;
fec = priv->regs;
out_be32(&fec->ievent, FEC_IEVENT_MII); out_be32(&fec->ievent, FEC_IEVENT_MII);
out_be32(&priv->regs->mii_data, value); out_be32(&fec->mii_data, value);
/* wait for it to finish, this takes about 23 us on lite5200b */ /* wait for it to finish, this takes about 23 us on lite5200b */
while (!(in_be32(&fec->ievent) & FEC_IEVENT_MII) && --tries) while (!(in_be32(&fec->ievent) & FEC_IEVENT_MII) && --tries)
...@@ -47,7 +46,7 @@ static int mpc52xx_fec_mdio_transfer(struct mii_bus *bus, int phy_id, ...@@ -47,7 +46,7 @@ static int mpc52xx_fec_mdio_transfer(struct mii_bus *bus, int phy_id,
return -ETIMEDOUT; return -ETIMEDOUT;
return value & FEC_MII_DATA_OP_RD ? return value & FEC_MII_DATA_OP_RD ?
in_be32(&priv->regs->mii_data) & FEC_MII_DATA_DATAMSK : 0; in_be32(&fec->mii_data) & FEC_MII_DATA_DATAMSK : 0;
} }
static int mpc52xx_fec_mdio_read(struct mii_bus *bus, int phy_id, int reg) static int mpc52xx_fec_mdio_read(struct mii_bus *bus, int phy_id, int reg)
...@@ -69,9 +68,8 @@ static int mpc52xx_fec_mdio_probe(struct of_device *of, ...@@ -69,9 +68,8 @@ static int mpc52xx_fec_mdio_probe(struct of_device *of,
struct device_node *np = of->dev.of_node; struct device_node *np = of->dev.of_node;
struct mii_bus *bus; struct mii_bus *bus;
struct mpc52xx_fec_mdio_priv *priv; struct mpc52xx_fec_mdio_priv *priv;
struct resource res = {}; struct resource res;
int err; int err;
int i;
bus = mdiobus_alloc(); bus = mdiobus_alloc();
if (bus == NULL) if (bus == NULL)
...@@ -93,7 +91,7 @@ static int mpc52xx_fec_mdio_probe(struct of_device *of, ...@@ -93,7 +91,7 @@ static int mpc52xx_fec_mdio_probe(struct of_device *of,
err = of_address_to_resource(np, 0, &res); err = of_address_to_resource(np, 0, &res);
if (err) if (err)
goto out_free; goto out_free;
priv->regs = ioremap(res.start, res.end - res.start + 1); priv->regs = ioremap(res.start, resource_size(&res));
if (priv->regs == NULL) { if (priv->regs == NULL) {
err = -ENOMEM; err = -ENOMEM;
goto out_free; goto out_free;
...@@ -118,10 +116,6 @@ static int mpc52xx_fec_mdio_probe(struct of_device *of, ...@@ -118,10 +116,6 @@ static int mpc52xx_fec_mdio_probe(struct of_device *of,
out_unmap: out_unmap:
iounmap(priv->regs); iounmap(priv->regs);
out_free: out_free:
for (i=0; i<PHY_MAX_ADDR; i++)
if (bus->irq[i] != PHY_POLL)
irq_dispose_mapping(bus->irq[i]);
kfree(bus->irq);
kfree(priv); kfree(priv);
mdiobus_free(bus); mdiobus_free(bus);
...@@ -133,23 +127,16 @@ static int mpc52xx_fec_mdio_remove(struct of_device *of) ...@@ -133,23 +127,16 @@ static int mpc52xx_fec_mdio_remove(struct of_device *of)
struct device *dev = &of->dev; struct device *dev = &of->dev;
struct mii_bus *bus = dev_get_drvdata(dev); struct mii_bus *bus = dev_get_drvdata(dev);
struct mpc52xx_fec_mdio_priv *priv = bus->priv; struct mpc52xx_fec_mdio_priv *priv = bus->priv;
int i;
mdiobus_unregister(bus); mdiobus_unregister(bus);
dev_set_drvdata(dev, NULL); dev_set_drvdata(dev, NULL);
iounmap(priv->regs); iounmap(priv->regs);
for (i=0; i<PHY_MAX_ADDR; i++)
if (bus->irq[i] != PHY_POLL)
irq_dispose_mapping(bus->irq[i]);
kfree(priv); kfree(priv);
kfree(bus->irq);
mdiobus_free(bus); mdiobus_free(bus);
return 0; return 0;
} }
static struct of_device_id mpc52xx_fec_mdio_match[] = { static struct of_device_id mpc52xx_fec_mdio_match[] = {
{ .compatible = "fsl,mpc5200b-mdio", }, { .compatible = "fsl,mpc5200b-mdio", },
{ .compatible = "fsl,mpc5200-mdio", }, { .compatible = "fsl,mpc5200-mdio", },
...@@ -171,5 +158,4 @@ struct of_platform_driver mpc52xx_fec_mdio_driver = { ...@@ -171,5 +158,4 @@ struct of_platform_driver mpc52xx_fec_mdio_driver = {
/* let fec driver call it, since this has to be registered before it */ /* let fec driver call it, since this has to be registered before it */
EXPORT_SYMBOL_GPL(mpc52xx_fec_mdio_driver); EXPORT_SYMBOL_GPL(mpc52xx_fec_mdio_driver);
MODULE_LICENSE("Dual BSD/GPL"); MODULE_LICENSE("Dual BSD/GPL");
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment