|
@@ -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");
|