return regmap_update_bits(mac->regmap, 0, mac->soc_info->mask, val);
}
-static int ingenic_mac_init(struct platform_device *pdev, void *bsp_priv)
+static int ingenic_set_phy_intf_sel(void *bsp_priv, u8 phy_intf_sel)
{
struct ingenic_mac *mac = bsp_priv;
- phy_interface_t interface;
- int phy_intf_sel, ret;
-
- if (mac->soc_info->set_mode) {
- interface = mac->plat_dat->phy_interface;
-
- phy_intf_sel = stmmac_get_phy_intf_sel(interface);
- if (phy_intf_sel < 0 || phy_intf_sel >= BITS_PER_BYTE ||
- ~mac->soc_info->valid_phy_intf_sel & BIT(phy_intf_sel)) {
- dev_err(mac->dev, "unsupported interface %s\n",
- phy_modes(interface));
- return phy_intf_sel < 0 ? phy_intf_sel : -EINVAL;
- }
- dev_dbg(mac->dev, "MAC PHY control register: interface %s\n",
- phy_modes(interface));
+ if (!mac->soc_info->set_mode)
+ return 0;
- ret = mac->soc_info->set_mode(mac, phy_intf_sel);
- if (ret)
- return ret;
- }
+ if (phy_intf_sel >= BITS_PER_BYTE ||
+ ~mac->soc_info->valid_phy_intf_sel & BIT(phy_intf_sel))
+ return -EINVAL;
+
+ dev_dbg(mac->dev, "MAC PHY control register: interface %s\n",
+ phy_modes(mac->plat_dat->phy_interface));
- return 0;
+ return mac->soc_info->set_mode(mac, phy_intf_sel);
}
static int ingenic_mac_probe(struct platform_device *pdev)
mac->plat_dat = plat_dat;
plat_dat->bsp_priv = mac;
- plat_dat->init = ingenic_mac_init;
+ plat_dat->set_phy_intf_sel = ingenic_set_phy_intf_sel;
return devm_stmmac_pltfr_probe(pdev, plat_dat, &stmmac_res);
}