ar71xx: add a secondary mdio bus

SVN-Revision: 28984
lede-17.01
Gabor Juhos 2011-11-12 12:09:54 +00:00
parent 90a42da270
commit f835106c8c
2 changed files with 57 additions and 15 deletions

View File

@ -132,7 +132,7 @@ static struct ag71xx_mdio_platform_data ar71xx_mdio0_data;
struct platform_device ar71xx_mdio0_device = { struct platform_device ar71xx_mdio0_device = {
.name = "ag71xx-mdio", .name = "ag71xx-mdio",
.id = -1, .id = 0,
.resource = ar71xx_mdio0_resources, .resource = ar71xx_mdio0_resources,
.num_resources = ARRAY_SIZE(ar71xx_mdio0_resources), .num_resources = ARRAY_SIZE(ar71xx_mdio0_resources),
.dev = { .dev = {
@ -140,6 +140,27 @@ struct platform_device ar71xx_mdio0_device = {
}, },
}; };
static struct resource ar71xx_mdio1_resources[] = {
{
.name = "mdio_base",
.flags = IORESOURCE_MEM,
.start = AR71XX_GE1_BASE,
.end = AR71XX_GE1_BASE + 0x200 - 1,
}
};
static struct ag71xx_mdio_platform_data ar71xx_mdio1_data;
struct platform_device ar71xx_mdio1_device = {
.name = "ag71xx-mdio",
.id = 1,
.resource = ar71xx_mdio1_resources,
.num_resources = ARRAY_SIZE(ar71xx_mdio1_resources),
.dev = {
.platform_data = &ar71xx_mdio1_data,
},
};
static void ar71xx_set_pll(u32 cfg_reg, u32 pll_reg, u32 pll_val, u32 shift) static void ar71xx_set_pll(u32 cfg_reg, u32 pll_reg, u32 pll_val, u32 shift)
{ {
void __iomem *base; void __iomem *base;
@ -171,38 +192,47 @@ static void ar71xx_set_pll(u32 cfg_reg, u32 pll_reg, u32 pll_val, u32 shift)
void __init ar71xx_add_device_mdio(unsigned int id, u32 phy_mask) void __init ar71xx_add_device_mdio(unsigned int id, u32 phy_mask)
{ {
struct platform_device *mdio_dev;
struct ag71xx_mdio_platform_data *mdio_data;
if (id > 0) { if (id > 0) {
printk(KERN_ERR "ar71xx: invalid MDIO id %u\n", id); printk(KERN_ERR "ar71xx: invalid MDIO id %u\n", id);
return; return;
} }
switch (ar71xx_soc) { switch (ar71xx_soc) {
case AR71XX_SOC_AR7240:
ar71xx_mdio0_data.is_ar7240 = 1;
break;
case AR71XX_SOC_AR7241: case AR71XX_SOC_AR7241:
ar71xx_mdio0_data.is_ar7240 = 1; case AR71XX_SOC_AR9330:
ar71xx_mdio0_resources[0].start = AR71XX_GE1_BASE; case AR71XX_SOC_AR9331:
ar71xx_mdio0_resources[0].end = AR71XX_GE1_BASE + 0x200 - 1; mdio_dev = &ar71xx_mdio1_device;
mdio_data = &ar71xx_mdio1_data;
break; break;
case AR71XX_SOC_AR7242: case AR71XX_SOC_AR7242:
ar71xx_set_pll(AR71XX_PLL_REG_SEC_CONFIG, ar71xx_set_pll(AR71XX_PLL_REG_SEC_CONFIG,
AR7242_PLL_REG_ETH0_INT_CLOCK, 0x62000000, AR7242_PLL_REG_ETH0_INT_CLOCK, 0x62000000,
AR71XX_ETH0_PLL_SHIFT); AR71XX_ETH0_PLL_SHIFT);
/* fall through */
default:
mdio_dev = &ar71xx_mdio0_device;
mdio_data = &ar71xx_mdio0_data;
break; break;
}
mdio_data->phy_mask = phy_mask;
switch (ar71xx_soc) {
case AR71XX_SOC_AR7240:
case AR71XX_SOC_AR7241:
case AR71XX_SOC_AR9330: case AR71XX_SOC_AR9330:
case AR71XX_SOC_AR9331: case AR71XX_SOC_AR9331:
ar71xx_mdio0_data.is_ar7240 = 1; mdio_data->is_ar7240 = 1;
ar71xx_mdio0_resources[0].start = AR71XX_GE1_BASE;
ar71xx_mdio0_resources[0].end = AR71XX_GE1_BASE + 0x200 - 1;
break; break;
default: default:
break; break;
} }
ar71xx_mdio0_data.phy_mask = phy_mask; platform_device_register(mdio_dev);
platform_device_register(&ar71xx_mdio0_device);
} }
struct ar71xx_eth_pll_data ar71xx_eth0_pll_data; struct ar71xx_eth_pll_data ar71xx_eth0_pll_data;
@ -723,8 +753,19 @@ void __init ar71xx_add_device_eth(unsigned int id)
ar71xx_eth_instance); ar71xx_eth_instance);
} }
if (pdata->mii_bus_dev == NULL) if (pdata->mii_bus_dev == NULL) {
pdata->mii_bus_dev = &ar71xx_mdio0_device.dev; switch (ar71xx_soc) {
case AR71XX_SOC_AR7241:
case AR71XX_SOC_AR9330:
case AR71XX_SOC_AR9331:
pdata->mii_bus_dev = &ar71xx_mdio1_device.dev;
break;
default:
pdata->mii_bus_dev = &ar71xx_mdio0_device.dev;
break;
}
}
/* Reset the device */ /* Reset the device */
ar71xx_device_stop(pdata->reset_bit); ar71xx_device_stop(pdata->reset_bit);

View File

@ -41,6 +41,7 @@ extern struct platform_device ar71xx_eth1_device;
void ar71xx_add_device_eth(unsigned int id) __init; void ar71xx_add_device_eth(unsigned int id) __init;
extern struct platform_device ar71xx_mdio0_device; extern struct platform_device ar71xx_mdio0_device;
extern struct platform_device ar71xx_mdio1_device;
void ar71xx_add_device_mdio(unsigned int id, u32 phy_mask) __init; void ar71xx_add_device_mdio(unsigned int id, u32 phy_mask) __init;
void ar71xx_add_device_uart(void) __init; void ar71xx_add_device_uart(void) __init;