net: stmmac: rk: remove need for ->set_speed() method

As we can detect whether the SoC provides the parameters necessary for
rk_set_reg_speed(), we don't need to have explicit calls to this.
Instead, we can move the contents of this function to
rk_set_clk_tx_rate().

This remsoves all the .set_speed() implementations that merely go on to
invoke rk_set_reg_speed().

Signed-off-by: Russell King (Oracle) <rmk+kernel@armlinux.org.uk>
Link: https://patch.msgid.link/E1vmqnM-00000007VD8-1xWo@rmk-PC.armlinux.org.uk
Signed-off-by: Jakub Kicinski <kuba@kernel.org>

diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c b/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c
index 9c845562c79fe80f436523b98f2fa0364164a91d..d74c32365a334f8e6f8ace7fbcf9247807d3b03e 100644 (file)
--- a/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c
+++ b/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c
@@ -167,37 +167,6 @@ static int rk_write_clock_grf_reg(struct rk_priv_data *bsp_priv, u32 val)
        return regmap_write(regmap, bsp_priv->clock_grf_reg, val);
 }
 
-static int rk_set_reg_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       unsigned int val;
-       int ret;
-
-       if (phy_interface_mode_is_rgmii(interface)) {
-               ret = rk_gmac_rgmii_clk_div(speed);
-               if (ret < 0)
-                       return ret;
-
-               val = rk_encode_wm16(ret, bsp_priv->clock.gmii_clk_sel_mask);
-       } else if (interface == PHY_INTERFACE_MODE_RMII) {
-               val = rk_encode_wm16(speed == SPEED_100,
-                                    bsp_priv->clock.mac_speed_mask) |
-                     rk_encode_wm16(speed == SPEED_100,
-                                    bsp_priv->clock.rmii_clk_sel_mask);
-       } else {
-               /* This should never happen, as .get_interfaces() limits
-                * the interface modes that are supported to RGMII and/or
-                * RMII.
-                */
-               return -EINVAL;
-       }
-
-       rk_write_clock_grf_reg(bsp_priv, val);
-
-       return 0;
-
-}
-
 static int rk_set_clk_mac_speed(struct rk_priv_data *bsp_priv,
                                phy_interface_t interface, int speed)
 {
@@ -368,16 +337,9 @@ static void rk3128_set_to_rmii(struct rk_priv_data *bsp_priv)
 {
 }
 
-static int rk3128_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static const struct rk_gmac_ops rk3128_ops = {
        .set_to_rgmii = rk3128_set_to_rgmii,
        .set_to_rmii = rk3128_set_to_rmii,
-       .set_speed = rk3128_set_speed,
 
        .gmac_grf_reg = RK3128_GRF_MAC_CON1,
        .gmac_phy_intf_sel_mask = GENMASK_U16(8, 6),
@@ -426,12 +388,6 @@ static void rk3228_set_to_rmii(struct rk_priv_data *bsp_priv)
        regmap_write(bsp_priv->grf, RK3228_GRF_MAC_CON1, GRF_BIT(11));
 }
 
-static int rk3228_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static void rk3228_integrated_phy_powerup(struct rk_priv_data *priv)
 {
        regmap_write(priv->grf, RK3228_GRF_CON_MUX,
@@ -443,7 +399,6 @@ static void rk3228_integrated_phy_powerup(struct rk_priv_data *priv)
 static const struct rk_gmac_ops rk3228_ops = {
        .set_to_rgmii = rk3228_set_to_rgmii,
        .set_to_rmii = rk3228_set_to_rmii,
-       .set_speed = rk3228_set_speed,
        .integrated_phy_powerup = rk3228_integrated_phy_powerup,
        .integrated_phy_powerdown = rk_gmac_integrated_ephy_powerdown,
 
@@ -485,16 +440,9 @@ static void rk3288_set_to_rmii(struct rk_priv_data *bsp_priv)
 {
 }
 
-static int rk3288_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static const struct rk_gmac_ops rk3288_ops = {
        .set_to_rgmii = rk3288_set_to_rgmii,
        .set_to_rmii = rk3288_set_to_rmii,
-       .set_speed = rk3288_set_speed,
 
        .gmac_grf_reg = RK3288_GRF_SOC_CON1,
        .gmac_phy_intf_sel_mask = GENMASK_U16(8, 6),
@@ -516,15 +464,8 @@ static void rk3308_set_to_rmii(struct rk_priv_data *bsp_priv)
 {
 }
 
-static int rk3308_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static const struct rk_gmac_ops rk3308_ops = {
        .set_to_rmii = rk3308_set_to_rmii,
-       .set_speed = rk3308_set_speed,
 
        .gmac_grf_reg = RK3308_GRF_MAC_CON0,
        .gmac_phy_intf_sel_mask = GENMASK_U16(4, 2),
@@ -586,12 +527,6 @@ static void rk3328_set_to_rmii(struct rk_priv_data *bsp_priv)
 {
 }
 
-static int rk3328_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static void rk3328_integrated_phy_powerup(struct rk_priv_data *priv)
 {
        regmap_write(priv->grf, RK3328_GRF_MACPHY_CON1,
@@ -604,7 +539,6 @@ static const struct rk_gmac_ops rk3328_ops = {
        .init = rk3328_init,
        .set_to_rgmii = rk3328_set_to_rgmii,
        .set_to_rmii = rk3328_set_to_rmii,
-       .set_speed = rk3328_set_speed,
        .integrated_phy_powerup = rk3328_integrated_phy_powerup,
        .integrated_phy_powerdown = rk_gmac_integrated_ephy_powerdown,
 
@@ -650,16 +584,9 @@ static void rk3366_set_to_rmii(struct rk_priv_data *bsp_priv)
 {
 }
 
-static int rk3366_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static const struct rk_gmac_ops rk3366_ops = {
        .set_to_rgmii = rk3366_set_to_rgmii,
        .set_to_rmii = rk3366_set_to_rmii,
-       .set_speed = rk3366_set_speed,
 
        .gmac_grf_reg = RK3366_GRF_SOC_CON6,
        .gmac_phy_intf_sel_mask = GENMASK_U16(11, 9),
@@ -699,16 +626,9 @@ static void rk3368_set_to_rmii(struct rk_priv_data *bsp_priv)
 {
 }
 
-static int rk3368_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static const struct rk_gmac_ops rk3368_ops = {
        .set_to_rgmii = rk3368_set_to_rgmii,
        .set_to_rmii = rk3368_set_to_rmii,
-       .set_speed = rk3368_set_speed,
 
        .gmac_grf_reg = RK3368_GRF_SOC_CON15,
        .gmac_phy_intf_sel_mask = GENMASK_U16(11, 9),
@@ -748,16 +668,9 @@ static void rk3399_set_to_rmii(struct rk_priv_data *bsp_priv)
 {
 }
 
-static int rk3399_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static const struct rk_gmac_ops rk3399_ops = {
        .set_to_rgmii = rk3399_set_to_rgmii,
        .set_to_rmii = rk3399_set_to_rmii,
-       .set_speed = rk3399_set_speed,
 
        .gmac_grf_reg = RK3399_GRF_SOC_CON5,
        .gmac_phy_intf_sel_mask = GENMASK_U16(11, 9),
@@ -804,12 +717,6 @@ static void rk3506_set_to_rmii(struct rk_priv_data *bsp_priv)
        regmap_write(bsp_priv->grf, offset, RK3506_GMAC_RMII_MODE);
 }
 
-static int rk3506_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static void rk3506_set_clock_selection(struct rk_priv_data *bsp_priv,
                                       bool input, bool enable)
 {
@@ -827,7 +734,6 @@ static void rk3506_set_clock_selection(struct rk_priv_data *bsp_priv,
 static const struct rk_gmac_ops rk3506_ops = {
        .init = rk3506_init,
        .set_to_rmii = rk3506_set_to_rmii,
-       .set_speed = rk3506_set_speed,
        .set_clock_selection = rk3506_set_clock_selection,
 
        .clock.rmii_clk_sel_mask = BIT_U16(3),
@@ -909,12 +815,6 @@ static void rk3528_set_to_rmii(struct rk_priv_data *bsp_priv)
                             RK3528_GMAC0_PHY_INTF_SEL_RMII);
 }
 
-static int rk3528_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static void rk3528_set_clock_selection(struct rk_priv_data *bsp_priv,
                                       bool input, bool enable)
 {
@@ -947,7 +847,6 @@ static const struct rk_gmac_ops rk3528_ops = {
        .init = rk3528_init,
        .set_to_rgmii = rk3528_set_to_rgmii,
        .set_to_rmii = rk3528_set_to_rmii,
-       .set_speed = rk3528_set_speed,
        .set_clock_selection = rk3528_set_clock_selection,
        .integrated_phy_powerup = rk3528_integrated_phy_powerup,
        .integrated_phy_powerdown = rk3528_integrated_phy_powerdown,
@@ -1100,12 +999,6 @@ static void rk3576_set_to_rmii(struct rk_priv_data *bsp_priv)
 {
 }
 
-static int rk3576_set_gmac_speed(struct rk_priv_data *bsp_priv,
-                                phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static void rk3576_set_clock_selection(struct rk_priv_data *bsp_priv, bool input,
                                       bool enable)
 {
@@ -1126,7 +1019,6 @@ static const struct rk_gmac_ops rk3576_ops = {
        .init = rk3576_init,
        .set_to_rgmii = rk3576_set_to_rgmii,
        .set_to_rmii = rk3576_set_to_rmii,
-       .set_speed = rk3576_set_gmac_speed,
        .set_clock_selection = rk3576_set_clock_selection,
 
        .gmac_rmii_mode_mask = BIT_U16(3),
@@ -1215,12 +1107,6 @@ static void rk3588_set_to_rmii(struct rk_priv_data *bsp_priv)
                     RK3588_GMAC_CLK_RMII_MODE(bsp_priv->id));
 }
 
-static int rk3588_set_gmac_speed(struct rk_priv_data *bsp_priv,
-                                phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static void rk3588_set_clock_selection(struct rk_priv_data *bsp_priv, bool input,
                                       bool enable)
 {
@@ -1237,7 +1123,6 @@ static const struct rk_gmac_ops rk3588_ops = {
        .init = rk3588_init,
        .set_to_rgmii = rk3588_set_to_rgmii,
        .set_to_rmii = rk3588_set_to_rmii,
-       .set_speed = rk3588_set_gmac_speed,
        .set_clock_selection = rk3588_set_clock_selection,
 
        .gmac_grf_reg_in_php = true,
@@ -1265,15 +1150,8 @@ static void rv1108_set_to_rmii(struct rk_priv_data *bsp_priv)
 {
 }
 
-static int rv1108_set_speed(struct rk_priv_data *bsp_priv,
-                           phy_interface_t interface, int speed)
-{
-       return rk_set_reg_speed(bsp_priv, interface, speed);
-}
-
 static const struct rk_gmac_ops rv1108_ops = {
        .set_to_rmii = rv1108_set_to_rmii,
-       .set_speed = rv1108_set_speed,
 
        .gmac_grf_reg = RV1108_GRF_GMAC_CON0,
        .gmac_phy_intf_sel_mask = GENMASK_U16(6, 4),
@@ -1705,11 +1583,37 @@ static int rk_set_clk_tx_rate(void *bsp_priv_, struct clk *clk_tx_i,
                              phy_interface_t interface, int speed)
 {
        struct rk_priv_data *bsp_priv = bsp_priv_;
+       int ret = -EINVAL;
+       bool is_100m;
+       u32 val;
 
-       if (bsp_priv->ops->set_speed)
-               return bsp_priv->ops->set_speed(bsp_priv, interface, speed);
+       if (bsp_priv->ops->set_speed) {
+               ret = bsp_priv->ops->set_speed(bsp_priv, interface, speed);
+               if (ret < 0)
+                       return ret;
+       }
 
-       return -EINVAL;
+       if (phy_interface_mode_is_rgmii(interface) &&
+           bsp_priv->clock.gmii_clk_sel_mask) {
+               ret = rk_gmac_rgmii_clk_div(speed);
+               if (ret < 0)
+                       return ret;
+
+               val = rk_encode_wm16(ret, bsp_priv->clock.gmii_clk_sel_mask);
+
+               ret = rk_write_clock_grf_reg(bsp_priv, val);
+       } else if (interface == PHY_INTERFACE_MODE_RMII &&
+                  (bsp_priv->clock.rmii_clk_sel_mask ||
+                   bsp_priv->clock.mac_speed_mask)) {
+               is_100m = speed == SPEED_100;
+               val = rk_encode_wm16(is_100m, bsp_priv->clock.mac_speed_mask) |
+                     rk_encode_wm16(is_100m,
+                                    bsp_priv->clock.rmii_clk_sel_mask);
+
+               ret = rk_write_clock_grf_reg(bsp_priv, val);
+       }
+
+       return ret;
 }
 
 static int rk_gmac_suspend(struct device *dev, void *bsp_priv_)