net: keystone: add ethtool get and set settings

This patch adds support of ethtool set and get settings.

Signed-off-by: WingMan Kwok <w-kwok2@ti.com>

1 files changed, 61 insertions, 0 deletions

diff --git a/drivers/net/ethernet/ti/keystone_ethss.c b/drivers/net/ethernet/ti/keystone_ethss.c
index 8b22272bcec..27c6ce34982 100644
--- a/drivers/net/ethernet/ti/keystone_ethss.c
+++ b/drivers/net/ethernet/ti/keystone_ethss.c
@@ -83,6 +83,7 @@ struct cpsw_slave {
         const char                      *phy_id;
         struct cpsw_ale                 *ale;
         u32                              link_interface;
+        u8                               phy_port_t;
 };
 
 struct cpsw_ss_regs {
@@ -1218,6 +1219,63 @@ static void keystone_get_ethtool_stats(struct net_device *ndev,
         return;
 }
 
+static int keystone_get_settings(struct net_device *ndev,
+                              struct ethtool_cmd *cmd)
+{
+        struct phy_device *phy = ndev->phydev;
+        struct cpsw_slave *slave;
+        int ret;
+
+        if (!phy)
+                return -EINVAL;
+
+        slave = (struct cpsw_slave *)phy->context;
+        if (!slave)
+                return -EINVAL;
+
+        ret = phy_ethtool_gset(phy, cmd);
+        if (!ret)
+                cmd->port = slave->phy_port_t;
+
+        return ret;
+}
+
+static int keystone_set_settings(struct net_device *ndev,
+                                struct ethtool_cmd *cmd)
+{
+        struct phy_device *phy = ndev->phydev;
+        struct cpsw_slave *slave;
+        u32 features = cmd->advertising & cmd->supported;
+
+        if (!phy)
+                return -EINVAL;
+
+        slave = (struct cpsw_slave *)phy->context;
+        if (!slave)
+                return -EINVAL;
+
+        if (cmd->port != slave->phy_port_t) {
+                if ((cmd->port == PORT_TP) && !(features & ADVERTISED_TP))
+                        return -EINVAL;
+
+                if ((cmd->port == PORT_AUI) && !(features & ADVERTISED_AUI))
+                        return -EINVAL;
+
+                if ((cmd->port == PORT_BNC) && !(features & ADVERTISED_BNC))
+                        return -EINVAL;
+
+                if ((cmd->port == PORT_MII) && !(features & ADVERTISED_MII))
+                        return -EINVAL;
+
+                if ((cmd->port == PORT_FIBRE) && !(features & ADVERTISED_FIBRE))
+                        return -EINVAL;
+        }
+
+        slave->phy_port_t = cmd->port;
+
+        return phy_ethtool_sset(phy, cmd);
+}
+
 static const struct ethtool_ops keystone_ethtool_ops = {
         .get_drvinfo            = keystone_get_drvinfo,
         .get_link               = ethtool_op_get_link,
@@ -1226,6 +1284,8 @@ static const struct ethtool_ops keystone_ethtool_ops = {
         .get_strings            = keystone_get_stat_strings,
         .get_sset_count         = keystone_get_sset_count,
         .get_ethtool_stats      = keystone_get_ethtool_stats,
+        .get_settings           = keystone_get_settings,
+        .set_settings           = keystone_set_settings,
 };
 
 #define mac_hi(mac)     (((mac)[0] << 0) | ((mac)[1] << 8) |    \
@@ -1415,6 +1475,7 @@ static void cpsw_slave_open(struct cpsw_slave *slave,
                         dev_info(priv->dev, "phy found: id is: 0x%s\n",
                                  dev_name(&slave->phy->dev));
                         cpsw_intf->ndev->phydev = slave->phy;
+                        slave->phy_port_t = PORT_MII;
                         phy_start(slave->phy);
                 }
         }