net: lan743x: implement ndo_hwtstamp_get()

Permit programs such as "hwtstamp_ctl -i eth0" to retrieve the current
timestamping configuration of the NIC, rather than returning "Device
driver does not have support for non-destructive SIOCGHWTSTAMP."

The driver configures all channels with the same timestamping settings.
On TX, retrieve the settings of the first channel, those should be
representative for the entire NIC. On RX, save the filter settings in a
new adapter field.

Signed-off-by: Vladimir Oltean <vladimir.oltean@nxp.com>
Reviewed-by: Gerhard Engleder <gerhard@engleder-embedded.com>
Reviewed-by: Vadim Fedorenko <vadim.fedorenko@linux.dev>
Link: https://patch.msgid.link/20250514151931.1988047-2-vladimir.oltean@nxp.com
Signed-off-by: Jakub Kicinski <kuba@kernel.org>

diff --git a/drivers/net/ethernet/microchip/lan743x_main.c b/drivers/net/ethernet/microchip/lan743x_main.c
index b01695bf4f55251425839403141a005133cd6a31..880681085df21c71b840597f9b54ee1ecb6d9f85 100644 (file)
--- a/drivers/net/ethernet/microchip/lan743x_main.c
+++ b/drivers/net/ethernet/microchip/lan743x_main.c
@@ -1729,6 +1729,7 @@ int lan743x_rx_set_tstamp_mode(struct lan743x_adapter *adapter,
        default:
                        return -ERANGE;
        }
+       adapter->rx_tstamp_filter = rx_filter;
        return 0;
 }
 
@@ -3445,6 +3446,7 @@ static const struct net_device_ops lan743x_netdev_ops = {
        .ndo_change_mtu         = lan743x_netdev_change_mtu,
        .ndo_get_stats64        = lan743x_netdev_get_stats64,
        .ndo_set_mac_address    = lan743x_netdev_set_mac_address,
+       .ndo_hwtstamp_get       = lan743x_ptp_hwtstamp_get,
        .ndo_hwtstamp_set       = lan743x_ptp_hwtstamp_set,
 };
 

diff --git a/drivers/net/ethernet/microchip/lan743x_main.h b/drivers/net/ethernet/microchip/lan743x_main.h
index db5fc73e41cca5ab5eaa207a2acde750d0addf73..02a28b7091630d21b78e1494254593253f63f057 100644 (file)
--- a/drivers/net/ethernet/microchip/lan743x_main.h
+++ b/drivers/net/ethernet/microchip/lan743x_main.h
@@ -1087,6 +1087,7 @@ struct lan743x_adapter {
        phy_interface_t         phy_interface;
        struct phylink          *phylink;
        struct phylink_config   phylink_config;
+       int                     rx_tstamp_filter;
 };
 
 #define LAN743X_COMPONENT_FLAG_RX(channel)  BIT(20 + (channel))

diff --git a/drivers/net/ethernet/microchip/lan743x_ptp.c b/drivers/net/ethernet/microchip/lan743x_ptp.c
index 026d1660fd745d395b0c271f84a3668c44bf5446..a3b48388b3fde77020c1747e2b40ea08f29d4c64 100644 (file)
--- a/drivers/net/ethernet/microchip/lan743x_ptp.c
+++ b/drivers/net/ethernet/microchip/lan743x_ptp.c
@@ -1736,6 +1736,24 @@ void lan743x_ptp_tx_timestamp_skb(struct lan743x_adapter *adapter,
        lan743x_ptp_tx_ts_complete(adapter);
 }
 
+int lan743x_ptp_hwtstamp_get(struct net_device *netdev,
+                            struct kernel_hwtstamp_config *config)
+{
+       struct lan743x_adapter *adapter = netdev_priv(netdev);
+       struct lan743x_tx *tx = &adapter->tx[0];
+
+       if (tx->ts_flags & TX_TS_FLAG_ONE_STEP_SYNC)
+               config->tx_type = HWTSTAMP_TX_ONESTEP_SYNC;
+       else if (tx->ts_flags & TX_TS_FLAG_TIMESTAMPING_ENABLED)
+               config->tx_type = HWTSTAMP_TX_ON;
+       else
+               config->tx_type = HWTSTAMP_TX_OFF;
+
+       config->rx_filter = adapter->rx_tstamp_filter;
+
+       return 0;
+}
+
 int lan743x_ptp_hwtstamp_set(struct net_device *netdev,
                             struct kernel_hwtstamp_config *config,
                             struct netlink_ext_ack *extack)

diff --git a/drivers/net/ethernet/microchip/lan743x_ptp.h b/drivers/net/ethernet/microchip/lan743x_ptp.h
index 9581a7992ff6fa3dd0b84b36cf77a98da24fe990..e8d073bfa2cac582308ff59f929adb4ccf8ed9c4 100644 (file)
--- a/drivers/net/ethernet/microchip/lan743x_ptp.h
+++ b/drivers/net/ethernet/microchip/lan743x_ptp.h
@@ -51,7 +51,8 @@ int lan743x_ptp_open(struct lan743x_adapter *adapter);
 void lan743x_ptp_close(struct lan743x_adapter *adapter);
 void lan743x_ptp_update_latency(struct lan743x_adapter *adapter,
                                u32 link_speed);
-
+int lan743x_ptp_hwtstamp_get(struct net_device *netdev,
+                            struct kernel_hwtstamp_config *config);
 int lan743x_ptp_hwtstamp_set(struct net_device *netdev,
                             struct kernel_hwtstamp_config *config,
                             struct netlink_ext_ack *extack);