net: stmmac: selftests: Add a test for TBS feature

Add a new test for TBS feature which is used in ETF scheduler. In this
test, we send a packet with a launch time specified as now + 500ms and
check if the packet was transmitted on that time frame.

Changes from v2:
- Use the TBS bitfield
- Remove debug message

Signed-off-by: Jose Abreu <Jose.Abreu@synopsys.com>
Signed-off-by: Jakub Kicinski <kuba@kernel.org>

diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_selftests.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_selftests.c
index d50ae59fe3d822d782d8f197ab26ad01de8b5f0f..5a3aea628fc2a497e06bcaf2a0201c234c74609b 100644 (file)
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac_selftests.c
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_selftests.c
@@ -14,6 +14,7 @@
 #include <linux/phy.h>
 #include <linux/udp.h>
 #include <net/pkt_cls.h>
+#include <net/pkt_sched.h>
 #include <net/tcp.h>
 #include <net/udp.h>
 #include <net/tc_act/tc_gact.h>
@@ -50,6 +51,7 @@ struct stmmac_packet_attrs {
        u8 id;
        int sarc;
        u16 queue_mapping;
+       u64 timestamp;
 };
 
 static u8 stmmac_test_next_id;
@@ -208,6 +210,9 @@ static struct sk_buff *stmmac_test_get_udp_skb(struct stmmac_priv *priv,
        skb->pkt_type = PACKET_HOST;
        skb->dev = priv->dev;
 
+       if (attr->timestamp)
+               skb->tstamp = ns_to_ktime(attr->timestamp);
+
        return skb;
 }
 
@@ -1723,6 +1728,68 @@ static int stmmac_test_sph(struct stmmac_priv *priv)
        return 0;
 }
 
+static int stmmac_test_tbs(struct stmmac_priv *priv)
+{
+#define STMMAC_TBS_LT_OFFSET           (500 * 1000 * 1000) /* 500 ms*/
+       struct stmmac_packet_attrs attr = { };
+       struct tc_etf_qopt_offload qopt;
+       u64 start_time, curr_time = 0;
+       unsigned long flags;
+       int ret, i;
+
+       if (!priv->hwts_tx_en)
+               return -EOPNOTSUPP;
+
+       /* Find first TBS enabled Queue, if any */
+       for (i = 0; i < priv->plat->tx_queues_to_use; i++)
+               if (priv->tx_queue[i].tbs & STMMAC_TBS_AVAIL)
+                       break;
+
+       if (i >= priv->plat->tx_queues_to_use)
+               return -EOPNOTSUPP;
+
+       qopt.enable = true;
+       qopt.queue = i;
+
+       ret = stmmac_tc_setup_etf(priv, priv, &qopt);
+       if (ret)
+               return ret;
+
+       spin_lock_irqsave(&priv->ptp_lock, flags);
+       stmmac_get_systime(priv, priv->ptpaddr, &curr_time);
+       spin_unlock_irqrestore(&priv->ptp_lock, flags);
+
+       if (!curr_time) {
+               ret = -EOPNOTSUPP;
+               goto fail_disable;
+       }
+
+       start_time = curr_time;
+       curr_time += STMMAC_TBS_LT_OFFSET;
+
+       attr.dst = priv->dev->dev_addr;
+       attr.timestamp = curr_time;
+       attr.timeout = nsecs_to_jiffies(2 * STMMAC_TBS_LT_OFFSET);
+       attr.queue_mapping = i;
+
+       ret = __stmmac_test_loopback(priv, &attr);
+       if (ret)
+               goto fail_disable;
+
+       /* Check if expected time has elapsed */
+       spin_lock_irqsave(&priv->ptp_lock, flags);
+       stmmac_get_systime(priv, priv->ptpaddr, &curr_time);
+       spin_unlock_irqrestore(&priv->ptp_lock, flags);
+
+       if ((curr_time - start_time) < STMMAC_TBS_LT_OFFSET)
+               ret = -EINVAL;
+
+fail_disable:
+       qopt.enable = false;
+       stmmac_tc_setup_etf(priv, priv, &qopt);
+       return ret;
+}
+
 #define STMMAC_LOOPBACK_NONE   0
 #define STMMAC_LOOPBACK_MAC    1
 #define STMMAC_LOOPBACK_PHY    2
@@ -1856,6 +1923,10 @@ static const struct stmmac_test {
                .name = "Split Header               ",
                .lb = STMMAC_LOOPBACK_PHY,
                .fn = stmmac_test_sph,
+       }, {
+               .name = "TBS (ETF Scheduler)        ",
+               .lb = STMMAC_LOOPBACK_PHY,
+               .fn = stmmac_test_tbs,
        },
 };