net: stmmac: mediatek: use stmmac_get_phy_intf_sel()
Use stmmac_get_phy_intf_sel() to decode the PHY interface mode to the phy_intf_sel value, validate the result, and pass that into the implementation specific ->dwmac_set_phy_interface() method. Use this to configure the PHY interface selection field. Signed-off-by: Russell King (Oracle) <rmk+kernel@armlinux.org.uk> Reviewed-by: Maxime Chevallier <maxime.chevallier@bootlin.com> Link: https://patch.msgid.link/E1vIjTz-0000000DqtP-3N9v@rmk-PC.armlinux.org.uk Signed-off-by: Jakub Kicinski <kuba@kernel.org>
This commit is contained in:
committed by
Jakub Kicinski
parent
c3308d380e
commit
d9c7964fd9
@@ -85,7 +85,8 @@ struct mediatek_dwmac_plat_data {
|
||||
};
|
||||
|
||||
struct mediatek_dwmac_variant {
|
||||
int (*dwmac_set_phy_interface)(struct mediatek_dwmac_plat_data *plat);
|
||||
int (*dwmac_set_phy_interface)(struct mediatek_dwmac_plat_data *plat,
|
||||
u8 phy_intf_sel);
|
||||
int (*dwmac_set_delay)(struct mediatek_dwmac_plat_data *plat);
|
||||
|
||||
/* clock ids to be requested */
|
||||
@@ -106,25 +107,25 @@ static const char * const mt8195_dwmac_clk_l[] = {
|
||||
"axi", "apb", "mac_cg", "mac_main", "ptp_ref"
|
||||
};
|
||||
|
||||
static int mt2712_set_interface(struct mediatek_dwmac_plat_data *plat)
|
||||
static int mt2712_set_interface(struct mediatek_dwmac_plat_data *plat,
|
||||
u8 phy_intf_sel)
|
||||
{
|
||||
int rmii_clk_from_mac = plat->rmii_clk_from_mac ? RMII_CLK_SRC_INTERNAL : 0;
|
||||
int rmii_rxc = plat->rmii_rxc ? RMII_CLK_SRC_RXC : 0;
|
||||
u32 intf_val = 0;
|
||||
u32 intf_val;
|
||||
|
||||
intf_val = phy_intf_sel;
|
||||
|
||||
/* select phy interface in top control domain */
|
||||
switch (plat->phy_mode) {
|
||||
case PHY_INTERFACE_MODE_MII:
|
||||
intf_val |= PHY_INTF_SEL_GMII_MII;
|
||||
break;
|
||||
case PHY_INTERFACE_MODE_RMII:
|
||||
intf_val |= PHY_INTF_SEL_RMII | rmii_rxc | rmii_clk_from_mac;
|
||||
intf_val |= rmii_rxc | rmii_clk_from_mac;
|
||||
break;
|
||||
case PHY_INTERFACE_MODE_MII:
|
||||
case PHY_INTERFACE_MODE_RGMII:
|
||||
case PHY_INTERFACE_MODE_RGMII_TXID:
|
||||
case PHY_INTERFACE_MODE_RGMII_RXID:
|
||||
case PHY_INTERFACE_MODE_RGMII_ID:
|
||||
intf_val |= PHY_INTF_SEL_RGMII;
|
||||
break;
|
||||
default:
|
||||
dev_err(plat->dev, "phy interface not supported\n");
|
||||
@@ -285,27 +286,25 @@ static const struct mediatek_dwmac_variant mt2712_gmac_variant = {
|
||||
.tx_delay_max = 17600,
|
||||
};
|
||||
|
||||
static int mt8195_set_interface(struct mediatek_dwmac_plat_data *plat)
|
||||
static int mt8195_set_interface(struct mediatek_dwmac_plat_data *plat,
|
||||
u8 phy_intf_sel)
|
||||
{
|
||||
int rmii_clk_from_mac = plat->rmii_clk_from_mac ? MT8195_RMII_CLK_SRC_INTERNAL : 0;
|
||||
int rmii_rxc = plat->rmii_rxc ? MT8195_RMII_CLK_SRC_RXC : 0;
|
||||
u32 intf_val = 0;
|
||||
u32 intf_val;
|
||||
|
||||
intf_val = FIELD_PREP(MT8195_ETH_INTF_SEL, phy_intf_sel);
|
||||
|
||||
/* select phy interface in top control domain */
|
||||
switch (plat->phy_mode) {
|
||||
case PHY_INTERFACE_MODE_MII:
|
||||
intf_val |= FIELD_PREP(MT8195_ETH_INTF_SEL,
|
||||
PHY_INTF_SEL_GMII_MII);
|
||||
break;
|
||||
case PHY_INTERFACE_MODE_RMII:
|
||||
intf_val |= rmii_rxc | rmii_clk_from_mac;
|
||||
intf_val |= FIELD_PREP(MT8195_ETH_INTF_SEL, PHY_INTF_SEL_RMII);
|
||||
break;
|
||||
case PHY_INTERFACE_MODE_MII:
|
||||
case PHY_INTERFACE_MODE_RGMII:
|
||||
case PHY_INTERFACE_MODE_RGMII_TXID:
|
||||
case PHY_INTERFACE_MODE_RGMII_RXID:
|
||||
case PHY_INTERFACE_MODE_RGMII_ID:
|
||||
intf_val |= FIELD_PREP(MT8195_ETH_INTF_SEL, PHY_INTF_SEL_RGMII);
|
||||
break;
|
||||
default:
|
||||
dev_err(plat->dev, "phy interface not supported\n");
|
||||
@@ -525,10 +524,18 @@ static int mediatek_dwmac_init(struct device *dev, void *priv)
|
||||
{
|
||||
struct mediatek_dwmac_plat_data *plat = priv;
|
||||
const struct mediatek_dwmac_variant *variant = plat->variant;
|
||||
int ret;
|
||||
int phy_intf_sel, ret;
|
||||
|
||||
if (variant->dwmac_set_phy_interface) {
|
||||
ret = variant->dwmac_set_phy_interface(plat);
|
||||
phy_intf_sel = stmmac_get_phy_intf_sel(plat->phy_mode);
|
||||
if (phy_intf_sel != PHY_INTF_SEL_GMII_MII &&
|
||||
phy_intf_sel != PHY_INTF_SEL_RGMII &&
|
||||
phy_intf_sel != PHY_INTF_SEL_RMII) {
|
||||
dev_err(plat->dev, "phy interface not supported\n");
|
||||
return phy_intf_sel < 0 ? phy_intf_sel : -EINVAL;
|
||||
}
|
||||
|
||||
ret = variant->dwmac_set_phy_interface(plat, phy_intf_sel);
|
||||
if (ret) {
|
||||
dev_err(dev, "failed to set phy interface, err = %d\n", ret);
|
||||
return ret;
|
||||
|
||||
Reference in New Issue
Block a user