net: airoha: Introduce ndo_select_queue callback

Airoha EN7581 SoC supports 32 Tx DMA rings used to feed packets to QoS
channels. Each channels supports 8 QoS queues where the user can apply
QoS scheduling policies. In a similar way, the user can configure hw
rate shaping for each QoS channel.
Introduce ndo_select_queue callback in order to select the tx queue
based on QoS channel and QoS queue. In particular, for dsa device select
QoS channel according to the dsa user port index, rely on port id
otherwise. Select QoS queue based on the skb priority.

Signed-off-by: Lorenzo Bianconi <lorenzo@kernel.org>
Signed-off-by: Paolo Abeni <pabeni@redhat.com>

diff --git a/drivers/net/ethernet/mediatek/airoha_eth.c b/drivers/net/ethernet/mediatek/airoha_eth.c
index 59e889cf08e49b89d20fa630f83a1c1322bae6b4..4b361f30829f4f5c40b1d8a97d43fd3a206e4206 100644 (file)
--- a/drivers/net/ethernet/mediatek/airoha_eth.c
+++ b/drivers/net/ethernet/mediatek/airoha_eth.c
@@ -23,6 +23,8 @@
 #define AIROHA_MAX_NUM_XSI_RSTS                5
 #define AIROHA_MAX_MTU                 2000
 #define AIROHA_MAX_PACKET_SIZE         2048
+#define AIROHA_NUM_QOS_CHANNELS                4
+#define AIROHA_NUM_QOS_QUEUES          8
 #define AIROHA_NUM_TX_RING             32
 #define AIROHA_NUM_RX_RING             32
 #define AIROHA_FE_MC_MAX_VLAN_TABLE    64
@@ -2429,21 +2431,44 @@ static void airoha_dev_get_stats64(struct net_device *dev,
        } while (u64_stats_fetch_retry(&port->stats.syncp, start));
 }
 
+static u16 airoha_dev_select_queue(struct net_device *dev, struct sk_buff *skb,
+                                  struct net_device *sb_dev)
+{
+       struct airoha_gdm_port *port = netdev_priv(dev);
+       int queue, channel;
+
+       /* For dsa device select QoS channel according to the dsa user port
+        * index, rely on port id otherwise. Select QoS queue based on the
+        * skb priority.
+        */
+       channel = netdev_uses_dsa(dev) ? skb_get_queue_mapping(skb) : port->id;
+       channel = channel % AIROHA_NUM_QOS_CHANNELS;
+       queue = (skb->priority - 1) % AIROHA_NUM_QOS_QUEUES; /* QoS queue */
+       queue = channel * AIROHA_NUM_QOS_QUEUES + queue;
+
+       return queue < dev->num_tx_queues ? queue : 0;
+}
+
 static netdev_tx_t airoha_dev_xmit(struct sk_buff *skb,
                                   struct net_device *dev)
 {
        struct skb_shared_info *sinfo = skb_shinfo(skb);
        struct airoha_gdm_port *port = netdev_priv(dev);
-       u32 msg0 = 0, msg1, len = skb_headlen(skb);
-       int i, qid = skb_get_queue_mapping(skb);
+       u32 msg0, msg1, len = skb_headlen(skb);
        struct airoha_qdma *qdma = port->qdma;
        u32 nr_frags = 1 + sinfo->nr_frags;
        struct netdev_queue *txq;
        struct airoha_queue *q;
        void *data = skb->data;
+       int i, qid;
        u16 index;
        u8 fport;
 
+       qid = skb_get_queue_mapping(skb) % ARRAY_SIZE(qdma->q_tx);
+       msg0 = FIELD_PREP(QDMA_ETH_TXMSG_CHAN_MASK,
+                         qid / AIROHA_NUM_QOS_QUEUES) |
+              FIELD_PREP(QDMA_ETH_TXMSG_QUEUE_MASK,
+                         qid % AIROHA_NUM_QOS_QUEUES);
        if (skb->ip_summed == CHECKSUM_PARTIAL)
                msg0 |= FIELD_PREP(QDMA_ETH_TXMSG_TCO_MASK, 1) |
                        FIELD_PREP(QDMA_ETH_TXMSG_UCO_MASK, 1) |
@@ -2617,6 +2642,7 @@ static const struct net_device_ops airoha_netdev_ops = {
        .ndo_init               = airoha_dev_init,
        .ndo_open               = airoha_dev_open,
        .ndo_stop               = airoha_dev_stop,
+       .ndo_select_queue       = airoha_dev_select_queue,
        .ndo_start_xmit         = airoha_dev_xmit,
        .ndo_get_stats64        = airoha_dev_get_stats64,
        .ndo_set_mac_address    = airoha_dev_set_macaddr,