stmmac: dwmac-sti: refactor the init glue callbacks

Remove the two platform specific init callbacks and make
them use a common one by creating a function member in
the internal data structure. This allow us to remove the
layer of indirection and simplify the code a bit.

Signed-off-by: Joachim Eastwood <manabian@gmail.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
Joachim Eastwood 2015-07-29 00:09:04 +02:00 committed by David S. Miller
parent 75fee59550
commit 16b1adbb16
1 changed files with 14 additions and 33 deletions

View File

@ -129,11 +129,11 @@ struct sti_dwmac {
struct device *dev; struct device *dev;
struct regmap *regmap; struct regmap *regmap;
u32 speed; u32 speed;
void (*fix_retime_src)(void *priv, unsigned int speed);
}; };
struct sti_dwmac_of_data { struct sti_dwmac_of_data {
void (*fix_mac_speed)(void *priv, unsigned int speed); void (*fix_retime_src)(void *priv, unsigned int speed);
int (*init)(struct platform_device *pdev, void *priv);
}; };
static u32 phy_intf_sels[] = { static u32 phy_intf_sels[] = {
@ -228,8 +228,9 @@ static void stid127_fix_retime_src(void *priv, u32 spd)
regmap_update_bits(dwmac->regmap, reg, STID127_RETIME_SRC_MASK, val); regmap_update_bits(dwmac->regmap, reg, STID127_RETIME_SRC_MASK, val);
} }
static void sti_dwmac_ctrl_init(struct sti_dwmac *dwmac) static int sti_dwmac_init(struct platform_device *pdev, void *priv)
{ {
struct sti_dwmac *dwmac = priv;
struct regmap *regmap = dwmac->regmap; struct regmap *regmap = dwmac->regmap;
int iface = dwmac->interface; int iface = dwmac->interface;
struct device *dev = dwmac->dev; struct device *dev = dwmac->dev;
@ -247,28 +248,8 @@ static void sti_dwmac_ctrl_init(struct sti_dwmac *dwmac)
val = (iface == PHY_INTERFACE_MODE_REVMII) ? 0 : ENMII; val = (iface == PHY_INTERFACE_MODE_REVMII) ? 0 : ENMII;
regmap_update_bits(regmap, reg, ENMII_MASK, val); regmap_update_bits(regmap, reg, ENMII_MASK, val);
}
static int stix4xx_init(struct platform_device *pdev, void *priv) dwmac->fix_retime_src(priv, dwmac->speed);
{
struct sti_dwmac *dwmac = priv;
u32 spd = dwmac->speed;
sti_dwmac_ctrl_init(dwmac);
stih4xx_fix_retime_src(priv, spd);
return 0;
}
static int stid127_init(struct platform_device *pdev, void *priv)
{
struct sti_dwmac *dwmac = priv;
u32 spd = dwmac->speed;
sti_dwmac_ctrl_init(dwmac);
stid127_fix_retime_src(priv, spd);
return 0; return 0;
} }
@ -372,12 +353,14 @@ static int sti_dwmac_probe(struct platform_device *pdev)
return ret; return ret;
} }
plat_dat->bsp_priv = dwmac; dwmac->fix_retime_src = data->fix_retime_src;
plat_dat->init = data->init;
plat_dat->exit = sti_dwmac_exit;
plat_dat->fix_mac_speed = data->fix_mac_speed;
ret = plat_dat->init(pdev, plat_dat->bsp_priv); plat_dat->bsp_priv = dwmac;
plat_dat->init = sti_dwmac_init;
plat_dat->exit = sti_dwmac_exit;
plat_dat->fix_mac_speed = data->fix_retime_src;
ret = sti_dwmac_init(pdev, plat_dat->bsp_priv);
if (ret) if (ret)
return ret; return ret;
@ -385,13 +368,11 @@ static int sti_dwmac_probe(struct platform_device *pdev)
} }
static const struct sti_dwmac_of_data stih4xx_dwmac_data = { static const struct sti_dwmac_of_data stih4xx_dwmac_data = {
.fix_mac_speed = stih4xx_fix_retime_src, .fix_retime_src = stih4xx_fix_retime_src,
.init = stix4xx_init,
}; };
static const struct sti_dwmac_of_data stid127_dwmac_data = { static const struct sti_dwmac_of_data stid127_dwmac_data = {
.fix_mac_speed = stid127_fix_retime_src, .fix_retime_src = stid127_fix_retime_src,
.init = stid127_init,
}; };
static const struct of_device_id sti_dwmac_match[] = { static const struct of_device_id sti_dwmac_match[] = {