net/mpc52xx_phy: Various code cleanups
- don't free bus->irq (obsoleted by ca816d9817
)
- 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: Wolfram Sang <w.sang@pengutronix.de>
Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
f9f3545e1e
commit
e95095540c
1 changed files with 5 additions and 19 deletions
|
@ -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,
|
||||||
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,
|
||||||
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,
|
||||||
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,
|
||||||
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)
|
||||||
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 = {
|
||||||
/* 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");
|
||||||
|
|
Loading…
Reference in a new issue