sfc: only advertise TX timestamping if we have the license for it

We check the license for TX hardware timestamping capability.
The PTP probe will have enabled PTP sync events from the adapter.  If
 later, at TX queue init, it turns out we do not have the license, we
 don't need the sync events either.

Signed-off-by: Martin Habets <mhabets@solarflare.com>
Signed-off-by: Edward Cree <ecree@solarflare.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

2 files changed, 16 insertions, 1 deletions

diff --git a/drivers/net/ethernet/sfc/ef10.c b/drivers/net/ethernet/sfc/ef10.c
index b460e06880e6..75fbf58e421c 100644
--- a/drivers/net/ethernet/sfc/ef10.c
+++ b/drivers/net/ethernet/sfc/ef10.c
@@ -2433,8 +2433,12 @@ static void efx_ef10_tx_init(struct efx_tx_queue *tx_queue)
          * otherwise TXQ init will fail
          */
         if (!(nic_data->licensed_features &
-              (1 << LICENSED_V3_FEATURES_TX_TIMESTAMPS_LBN)))
+              (1 << LICENSED_V3_FEATURES_TX_TIMESTAMPS_LBN))) {
                 tx_queue->timestamping = false;
+                /* Disable sync events on this channel. */
+                if (efx->type->ptp_set_ts_sync_events)
+                        efx->type->ptp_set_ts_sync_events(efx, false, false);
+        }
 
         /* TSOv2 is a limited resource that can only be configured on a limited
          * number of queues. TSO without checksum offload is not really a thing,
diff --git a/drivers/net/ethernet/sfc/ptp.c b/drivers/net/ethernet/sfc/ptp.c
index 87a72f37141b..cbfc171d90ee 100644
--- a/drivers/net/ethernet/sfc/ptp.c
+++ b/drivers/net/ethernet/sfc/ptp.c
@@ -1657,6 +1657,17 @@ void efx_ptp_get_ts_info(struct efx_nic *efx, struct ethtool_ts_info *ts_info)
         ts_info->so_timestamping |= (SOF_TIMESTAMPING_TX_HARDWARE |
                                      SOF_TIMESTAMPING_RX_HARDWARE |
                                      SOF_TIMESTAMPING_RAW_HARDWARE);
+        /* Check licensed features.  If we don't have the license for TX
+         * timestamps, the NIC will not support them.
+         */
+        if (efx_ptp_use_mac_tx_timestamps(efx)) {
+                struct efx_ef10_nic_data *nic_data = efx->nic_data;
+
+                if (!(nic_data->licensed_features &
+                      (1 << LICENSED_V3_FEATURES_TX_TIMESTAMPS_LBN)))
+                        ts_info->so_timestamping &=
+                                ~SOF_TIMESTAMPING_TX_HARDWARE;
+        }
         if (primary && primary->ptp_data && primary->ptp_data->phc_clock)
                 ts_info->phc_index =
                         ptp_clock_index(primary->ptp_data->phc_clock);