rtl8366_smi: register the switch directly from the probe routine

SVN-Revision: 19202
lede-17.01
Gabor Juhos 2010-01-17 21:37:09 +00:00
parent 088ba7e1db
commit d2229cb1cc
1 changed files with 36 additions and 21 deletions

View File

@ -1718,6 +1718,27 @@ static struct switch_dev rtldev = {
.reset_switch = rtl8366_reset_switch,
};
static int rtl8366_smi_switch_init(struct rtl8366_smi *smi)
{
struct switch_dev *dev = &smi->dev;
int err;
memcpy(dev, &rtldev, sizeof(struct switch_dev));
dev->priv = smi;
dev->devname = dev_name(&smi->pdev->dev);
err = register_switch(dev, NULL);
if (err)
dev_err(&smi->pdev->dev, "switch registration failed\n");
return;
}
static void rtl8366_smi_switch_cleanup(struct rtl8366_smi *smi)
{
unregister_switch(&smi->dev);
}
static int rtl8366_smi_mii_read(struct mii_bus *bus, int addr, int reg)
{
struct rtl8366_smi *smi = bus->priv;
@ -1787,6 +1808,12 @@ static void rtl8366_smi_mii_cleanup(struct rtl8366_smi *smi)
mdiobus_free(smi->mii_bus);
}
static int rtl8366_smi_mii_bus_match(struct mii_bus *bus)
{
return (bus->read == rtl8366_smi_mii_read &&
bus->write == rtl8366_smi_mii_write);
}
static int rtl8366_smi_setup(struct rtl8366_smi *smi)
{
u32 chip_id = 0;
@ -1878,8 +1905,14 @@ static int __init rtl8366_smi_probe(struct platform_device *pdev)
if (err)
goto err_clear_drvdata;
err = rtl8366_smi_switch_init(smi);
if (err)
goto err_mii_cleanup;
return 0;
err_mii_cleanup:
rtl8366_smi_mii_cleanup(smi);
err_clear_drvdata:
platform_set_drvdata(pdev, NULL);
gpio_free(pdata->gpio_sck);
@ -1893,26 +1926,8 @@ static int __init rtl8366_smi_probe(struct platform_device *pdev)
int rtl8366_phy_config_init(struct phy_device *phydev)
{
int err;
struct net_device *netdev = phydev->attached_dev;
struct rtl8366_smi *smi = phydev->bus->priv;
struct switch_dev *dev = &smi->dev;
/* Only init the switch for the primary PHY */
if (phydev->addr != 4) {
printk(KERN_INFO "Discarding address: %d\n", phydev->addr);
return 0;
}
memcpy(&smi->dev, &rtldev, sizeof(struct switch_dev));
dev->priv = smi;
dev->netdev = netdev;
err = register_switch(dev, netdev);
if (err < 0) {
printk(KERN_INFO "Switch registration failed\n");
return err;
}
if (!rtl8366_smi_mii_bus_match(phydev->bus))
return -EINVAL;
return 0;
}
@ -1944,8 +1959,8 @@ static int __devexit rtl8366_smi_remove(struct platform_device *pdev)
pdata = pdev->dev.platform_data;
rtl8366_smi_switch_cleanup(smi);
rtl8366_debugfs_remove(smi);
phy_driver_unregister(&rtl8366_smi_phy_driver);
rtl8366_smi_mii_cleanup(smi);
platform_set_drvdata(pdev, NULL);
gpio_free(pdata->gpio_sck);