Commit 28c1cf73 authored by Jose Abreu's avatar Jose Abreu Committed by Jakub Kicinski
Browse files

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: default avatarJose Abreu <Jose.Abreu@synopsys.com>
Signed-off-by: default avatarJakub Kicinski <kuba@kernel.org>
parent 05373e31

drivers/net/ethernet/stmicro/stmmac/stmmac_selftests.c

+71 −0
Original line number Diff line number Diff line
@@ -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,

	},

};

CRA Git | Maintained and supported by SUSTech CRA and CCSE