* [PATCH net-next v2 1/2] net: stmmac: add tc-ets qdisc offload
2026-08-07 8:41 [PATCH net-next v2 0/2] Implement mqprio and ets qdisc offload in stmmac driver Lorenzo Bianconi
@ 2026-08-07 8:41 ` Lorenzo Bianconi
2026-08-07 8:41 ` [PATCH net-next v2 2/2] net: stmmac: add tc-mqprio " Lorenzo Bianconi
2026-08-07 9:34 ` [PATCH net-next v2 0/2] Implement mqprio and ets qdisc offload in stmmac driver Davide Caratti
2 siblings, 0 replies; 4+ messages in thread
From: Lorenzo Bianconi @ 2026-08-07 8:41 UTC (permalink / raw)
To: Maxime Chevallier, Andrew Lunn, David S. Miller, Eric Dumazet,
Jakub Kicinski, Paolo Abeni, Maxime Coquelin, Alexandre Torgue
Cc: Daniel Thompson, Alex Elder, Davide Caratti, netdev, linux-stm32,
linux-arm-kernel, Lorenzo Bianconi
Implement offload of the tc-ets qdisc in the stmmac driver. The number
of ETS bands cannot exceed the number of TX queues, and strict priority
bands (zero quanta) are rejected, since sched prio is not implemented in
the ETS offload but will be implemented in the mqprio qdisc offload.
Weighted bands whose weight is zero are rejected as well, since MTL DWRR
would never schedule traffic on them.
The requested weights are applied to the TX queues and the MTL scheduler
is switched to DWRR. The TC_ETS_GRAFT command is not offloaded and falls
back to the software implementation, and TC_ETS_STATS is accepted while
the ETS qdisc is offloaded but no hardware statistics are provided.
Export stmmac_set_tx_queue_weight() so the ETS path can reprogram queue
weights, and wire TC_SETUP_QDISC_ETS into stmmac_setup_tc(). Destroying
the ETS qdisc restores the devicetree configured scheduling algorithm
and TX queue weights.
Reviewed-by: Maxime Chevallier <maxime.chevallier@bootlin.com>
Signed-off-by: Lorenzo Bianconi <lorenzo.bianconi@oss.qualcomm.com>
---
drivers/net/ethernet/stmicro/stmmac/hwif.h | 4 ++
drivers/net/ethernet/stmicro/stmmac/stmmac.h | 6 ++
drivers/net/ethernet/stmicro/stmmac/stmmac_main.c | 22 +++++--
drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c | 78 +++++++++++++++++++++++
4 files changed, 105 insertions(+), 5 deletions(-)
diff --git a/drivers/net/ethernet/stmicro/stmmac/hwif.h b/drivers/net/ethernet/stmicro/stmmac/hwif.h
index 04dafec021b4..b70883a53b09 100644
--- a/drivers/net/ethernet/stmicro/stmmac/hwif.h
+++ b/drivers/net/ethernet/stmicro/stmmac/hwif.h
@@ -580,6 +580,8 @@ struct stmmac_tc_ops {
struct tc_taprio_qopt_offload *qopt);
int (*setup_etf)(struct stmmac_priv *priv,
struct tc_etf_qopt_offload *qopt);
+ int (*setup_ets)(struct stmmac_priv *priv,
+ struct tc_ets_qopt_offload *qopt);
int (*query_caps)(struct stmmac_priv *priv,
struct tc_query_caps_base *base);
int (*setup_mqprio)(struct stmmac_priv *priv,
@@ -598,6 +600,8 @@ struct stmmac_tc_ops {
stmmac_do_callback(__priv, tc, setup_taprio, __args)
#define stmmac_tc_setup_etf(__priv, __args...) \
stmmac_do_callback(__priv, tc, setup_etf, __args)
+#define stmmac_tc_setup_ets(__priv, __args...) \
+ stmmac_do_callback(__priv, tc, setup_ets, __args)
#define stmmac_tc_query_caps(__priv, __args...) \
stmmac_do_callback(__priv, tc, query_caps, __args)
#define stmmac_tc_setup_mqprio(__priv, __args...) \
diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac.h b/drivers/net/ethernet/stmicro/stmmac/stmmac.h
index 8ba8f03e1ce0..823b40212233 100644
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac.h
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac.h
@@ -301,6 +301,11 @@ struct stmmac_priv {
/* Protect est parameters */
struct mutex est_lock;
struct stmmac_est *est;
+ struct {
+ bool enable;
+ u8 algo;
+ u32 quanta[MTL_MAX_TX_QUEUES];
+ } qdisc;
struct dma_features dma_cap;
struct stmmac_counters mmc;
int hw_cap_support;
@@ -394,6 +399,7 @@ enum stmmac_state {
extern const struct dev_pm_ops stmmac_simple_pm_ops;
+void stmmac_set_tx_queue_weight(struct stmmac_priv *priv);
int stmmac_mdio_unregister(struct net_device *ndev);
int stmmac_mdio_register(struct net_device *ndev);
int stmmac_mdio_reset(struct mii_bus *mii);
diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
index c729ab127afd..7d1473fbde54 100644
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
@@ -3419,14 +3419,18 @@ static void stmmac_set_rings_length(struct stmmac_priv *priv)
* @priv: driver private structure
* Description: It is used for setting TX queues weight
*/
-static void stmmac_set_tx_queue_weight(struct stmmac_priv *priv)
+void stmmac_set_tx_queue_weight(struct stmmac_priv *priv)
{
u8 tx_queues_count = priv->plat->tx_queues_to_use;
u32 weight;
u8 queue;
for (queue = 0; queue < tx_queues_count; queue++) {
- weight = priv->plat->tx_queues_cfg[queue].weight;
+ if (priv->qdisc.enable &&
+ priv->qdisc.algo == MTL_TX_ALGORITHM_DWRR)
+ weight = priv->qdisc.quanta[queue];
+ else
+ weight = priv->plat->tx_queues_cfg[queue].weight;
stmmac_set_mtl_tx_queue_weight(priv, priv->hw, weight, queue);
}
}
@@ -3570,9 +3574,15 @@ static void stmmac_mtl_configuration(struct stmmac_priv *priv)
priv->plat->rx_sched_algorithm);
/* Configure MTL TX algorithms */
- if (tx_queues_count > 1)
- stmmac_prog_mtl_tx_algorithms(priv, priv->hw,
- priv->plat->tx_sched_algorithm);
+ if (tx_queues_count > 1) {
+ u8 tx_sched_algo;
+
+ if (priv->qdisc.enable)
+ tx_sched_algo = priv->qdisc.algo;
+ else
+ tx_sched_algo = priv->plat->tx_sched_algorithm;
+ stmmac_prog_mtl_tx_algorithms(priv, priv->hw, tx_sched_algo);
+ }
/* Configure CBS in AVB TX queues */
if (tx_queues_count > 1)
@@ -6428,6 +6438,8 @@ static int stmmac_setup_tc(struct net_device *ndev, enum tc_setup_type type,
return stmmac_tc_setup_taprio(priv, priv, type_data);
case TC_SETUP_QDISC_ETF:
return stmmac_tc_setup_etf(priv, priv, type_data);
+ case TC_SETUP_QDISC_ETS:
+ return stmmac_tc_setup_ets(priv, priv, type_data);
default:
return -EOPNOTSUPP;
}
diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c
index 14cabe76e53e..5dcd18b5808e 100644
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c
@@ -1210,6 +1210,82 @@ static int tc_setup_etf(struct stmmac_priv *priv,
return 0;
}
+/* Max quantum value supported by the MTL DWRR scheduler */
+#define MTL_TXQ_WEIGHT_QUANTUM_MAX 0x1312d0
+
+static void stmmac_qdisc_restore_dt_config(struct stmmac_priv *priv)
+{
+ /* reset to the dt configured algorithm. */
+ priv->qdisc.enable = false;
+ stmmac_set_tx_queue_weight(priv);
+ stmmac_prog_mtl_tx_algorithms(priv, priv->hw,
+ priv->plat->tx_sched_algorithm);
+}
+
+static int tc_setup_ets_sched(struct stmmac_priv *priv,
+ struct tc_ets_qopt_offload *qopt)
+{
+ struct tc_ets_qopt_offload_replace_params *p = &qopt->replace_params;
+ struct plat_stmmacenet_data *pdata = priv->plat;
+ int i;
+
+ if (qopt->parent != TC_H_ROOT)
+ goto error;
+
+ if (p->bands > pdata->tx_queues_to_use)
+ goto error;
+
+ for (i = 0; i < pdata->tx_queues_to_use; i++) {
+ u32 quantum = 0;
+
+ if (pdata->tx_queues_cfg[i].mode_to_use == MTL_QUEUE_AVB)
+ goto error;
+
+ if (i < p->bands) {
+ if (!p->quanta[i])
+ goto error;
+
+ if (p->quanta[i] > MTL_TXQ_WEIGHT_QUANTUM_MAX)
+ goto error;
+
+ quantum = p->quanta[i];
+ }
+
+ priv->qdisc.quanta[i] = quantum;
+ stmmac_set_mtl_tx_queue_weight(priv, priv->hw, quantum, i);
+ }
+
+ stmmac_prog_mtl_tx_algorithms(priv, priv->hw, MTL_TX_ALGORITHM_DWRR);
+ priv->qdisc.algo = MTL_TX_ALGORITHM_DWRR;
+ priv->qdisc.enable = true;
+
+ return 0;
+error:
+ stmmac_qdisc_restore_dt_config(priv);
+ return -EOPNOTSUPP;
+}
+
+static int tc_setup_ets(struct stmmac_priv *priv,
+ struct tc_ets_qopt_offload *qopt)
+{
+ switch (qopt->command) {
+ case TC_ETS_REPLACE:
+ return tc_setup_ets_sched(priv, qopt);
+ case TC_ETS_DESTROY:
+ stmmac_qdisc_restore_dt_config(priv);
+ break;
+ case TC_ETS_STATS:
+ if (priv->qdisc.enable &&
+ priv->qdisc.algo == MTL_TX_ALGORITHM_DWRR)
+ break;
+ fallthrough;
+ default:
+ return -EOPNOTSUPP;
+ }
+
+ return 0;
+}
+
static int tc_query_caps(struct stmmac_priv *priv,
struct tc_query_caps_base *base)
{
@@ -1308,6 +1384,7 @@ const struct stmmac_tc_ops dwmac4_tc_ops = {
.setup_cls = tc_setup_cls,
.setup_taprio = tc_setup_taprio_without_fpe,
.setup_etf = tc_setup_etf,
+ .setup_ets = tc_setup_ets,
.query_caps = tc_query_caps,
.setup_mqprio = tc_setup_mqprio_unimplemented,
};
@@ -1319,6 +1396,7 @@ const struct stmmac_tc_ops dwmac510_tc_ops = {
.setup_cls = tc_setup_cls,
.setup_taprio = tc_setup_taprio,
.setup_etf = tc_setup_etf,
+ .setup_ets = tc_setup_ets,
.query_caps = tc_query_caps,
.setup_mqprio = tc_setup_dwmac510_mqprio,
};
--
2.55.0
^ permalink raw reply related [flat|nested] 4+ messages in thread* [PATCH net-next v2 2/2] net: stmmac: add tc-mqprio qdisc offload
2026-08-07 8:41 [PATCH net-next v2 0/2] Implement mqprio and ets qdisc offload in stmmac driver Lorenzo Bianconi
2026-08-07 8:41 ` [PATCH net-next v2 1/2] net: stmmac: add tc-ets qdisc offload Lorenzo Bianconi
@ 2026-08-07 8:41 ` Lorenzo Bianconi
2026-08-07 9:34 ` [PATCH net-next v2 0/2] Implement mqprio and ets qdisc offload in stmmac driver Davide Caratti
2 siblings, 0 replies; 4+ messages in thread
From: Lorenzo Bianconi @ 2026-08-07 8:41 UTC (permalink / raw)
To: Maxime Chevallier, Andrew Lunn, David S. Miller, Eric Dumazet,
Jakub Kicinski, Paolo Abeni, Maxime Coquelin, Alexandre Torgue
Cc: Daniel Thompson, Alex Elder, Davide Caratti, netdev, linux-stm32,
linux-arm-kernel, Lorenzo Bianconi
Implement offload of the tc-mqprio qdisc in the stmmac driver. The MTL
TX scheduler is switched to strict priority, and the priority (PSTQX)
of each TX queue is programmed according to the requested traffic class
mapping: queues assigned to a higher tc are given a higher priority and
are served first, while queues not mapped to any tc keep the lowest
priority.
The per-queue priorities are stored in the unified qdisc state
(priv->qdisc.prio) so they can be reprogrammed on device reopen, and
are applied through the MTL TX queue priority map registers. Export
stmmac_mac_config_tx_queues_prio() so the mqprio path can reprogram the
queue priorities. Destroying the mqprio qdisc, or failing its setup,
restores the devicetree configured scheduling algorithm, TX queue
priorities and TX queue weights.
Signed-off-by: Lorenzo Bianconi <lorenzo.bianconi@oss.qualcomm.com>
---
drivers/net/ethernet/stmicro/stmmac/stmmac.h | 2 ++
drivers/net/ethernet/stmicro/stmmac/stmmac_main.c | 13 ++++++++-----
drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c | 22 +++++++++++++++++++++-
3 files changed, 31 insertions(+), 6 deletions(-)
diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac.h b/drivers/net/ethernet/stmicro/stmmac/stmmac.h
index 823b40212233..1bb261fdcb0e 100644
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac.h
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac.h
@@ -305,6 +305,7 @@ struct stmmac_priv {
bool enable;
u8 algo;
u32 quanta[MTL_MAX_TX_QUEUES];
+ u32 prio[MTL_MAX_TX_QUEUES];
} qdisc;
struct dma_features dma_cap;
struct stmmac_counters mmc;
@@ -400,6 +401,7 @@ enum stmmac_state {
extern const struct dev_pm_ops stmmac_simple_pm_ops;
void stmmac_set_tx_queue_weight(struct stmmac_priv *priv);
+void stmmac_mac_config_tx_queues_prio(struct stmmac_priv *priv);
int stmmac_mdio_unregister(struct net_device *ndev);
int stmmac_mdio_register(struct net_device *ndev);
int stmmac_mdio_reset(struct mii_bus *mii);
diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
index 7d1473fbde54..c2786ecca530 100644
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
@@ -3503,17 +3503,20 @@ static void stmmac_mac_config_rx_queues_prio(struct stmmac_priv *priv)
* @priv: driver private structure
* Description: It is used for configuring the TX Queue Priority
*/
-static void stmmac_mac_config_tx_queues_prio(struct stmmac_priv *priv)
+void stmmac_mac_config_tx_queues_prio(struct stmmac_priv *priv)
{
u8 tx_queues_count = priv->plat->tx_queues_to_use;
u8 queue;
- u32 prio;
for (queue = 0; queue < tx_queues_count; queue++) {
- if (!priv->plat->tx_queues_cfg[queue].use_prio)
- continue;
+ u32 prio = 0;
+
+ if (priv->qdisc.enable &&
+ priv->qdisc.algo == MTL_TX_ALGORITHM_SP)
+ prio = priv->qdisc.prio[queue];
+ else if (priv->plat->tx_queues_cfg[queue].use_prio)
+ prio = priv->plat->tx_queues_cfg[queue].prio;
- prio = priv->plat->tx_queues_cfg[queue].prio;
stmmac_tx_queue_prio(priv, priv->hw, prio, queue);
}
}
diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c
index 5dcd18b5808e..3ba71be24c64 100644
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c
@@ -1218,6 +1218,7 @@ static void stmmac_qdisc_restore_dt_config(struct stmmac_priv *priv)
/* reset to the dt configured algorithm. */
priv->qdisc.enable = false;
stmmac_set_tx_queue_weight(priv);
+ stmmac_mac_config_tx_queues_prio(priv);
stmmac_prog_mtl_tx_algorithms(priv, priv->hw,
priv->plat->tx_sched_algorithm);
}
@@ -1321,17 +1322,19 @@ static void stmmac_reset_tc_mqprio(struct net_device *ndev,
netdev_reset_tc(ndev);
netif_set_real_num_tx_queues(ndev, priv->plat->tx_queues_to_use);
stmmac_fpe_map_preemption_class(priv, ndev, extack, 0);
+ stmmac_qdisc_restore_dt_config(priv);
}
static int tc_setup_dwmac510_mqprio(struct stmmac_priv *priv,
struct tc_mqprio_qopt_offload *mqprio)
{
struct netlink_ext_ack *extack = mqprio->extack;
+ struct plat_stmmacenet_data *pdata = priv->plat;
struct tc_mqprio_qopt *qopt = &mqprio->qopt;
u32 offset, count, num_stack_tx_queues = 0;
struct net_device *ndev = priv->dev;
u32 num_tc = qopt->num_tc;
- int err;
+ int i, tc, err;
if (!num_tc) {
stmmac_reset_tc_mqprio(ndev, extack);
@@ -1361,6 +1364,23 @@ static int tc_setup_dwmac510_mqprio(struct stmmac_priv *priv,
if (err)
goto err_reset_tc;
+ /* Queues not mapped to any TC default to the lowest priority */
+ for (i = 0; i < pdata->tx_queues_to_use; i++) {
+ priv->qdisc.prio[i] = 0;
+ stmmac_tx_queue_prio(priv, priv->hw, 0, i);
+ }
+
+ for (tc = 0; tc < num_tc; tc++) {
+ for (i = qopt->offset[tc];
+ i < qopt->offset[tc] + qopt->count[tc]; i++) {
+ priv->qdisc.prio[i] = tc;
+ stmmac_tx_queue_prio(priv, priv->hw, tc, i);
+ }
+ }
+ stmmac_prog_mtl_tx_algorithms(priv, priv->hw, MTL_TX_ALGORITHM_SP);
+ priv->qdisc.algo = MTL_TX_ALGORITHM_SP;
+ priv->qdisc.enable = true;
+
return 0;
err_reset_tc:
--
2.55.0
^ permalink raw reply related [flat|nested] 4+ messages in thread