net: core: Dynamic priority and deferred processing

To enable quality-of-service (QoS) applications, allow to reschedule/defer
the processing of a network packet based on its properties. This means,
that processing can be offloaded to tc-queue-threads with different
priorities.

Signed-off-by: Cla Mattia Galliard <[email protected]>

Author: ClaCodes

subsys/net/ip/net_core.c

@@ -64,6 +64,27 @@ LOG_MODULE_REGISTER(net_core, CONFIG_NET_CORE_LOG_LEVEL);
 #include "net_stats.h"
 
 #if defined(CONFIG_NET_NATIVE)
+static void net_queue_rx(struct net_if *iface, struct net_pkt *pkt);
+
+static void update_priority_l2(struct net_pkt *pkt)
+{
+	/* This is just an example.
+	 * Similar infrastructure with custom application rules like
+	 * net_pkt_filter could be established
+	 */
+	if (net_pkt_ll_proto_type(pkt) ==  NET_ETH_PTYPE_PTP) {
+		net_pkt_set_priority(pkt, NET_PRIORITY_IC);
+	}
+}
+
+static bool being_processed_by_correct_thread(struct net_pkt *pkt)
+{
+	uint8_t prio = net_pkt_priority(pkt);
+	uint8_t tc = net_rx_priority2tc(prio);
+
+	return net_tc_rx_is_current_thread(tc);
+}
+
 static inline enum net_verdict process_data(struct net_pkt *pkt)
 {
 	int ret;
@@ -77,27 +98,30 @@ static inline enum net_verdict process_data(struct net_pkt *pkt)
 	if (!pkt->frags) {
 		NET_DBG("Corrupted packet (frags %p)", pkt->frags);
 		net_stats_update_processing_error(net_pkt_iface(pkt));
-
 		return NET_DROP;
 	}
 
 	if (!net_pkt_is_l2_processed(pkt)) {
-		ret = net_if_recv_data(net_pkt_iface(pkt), pkt);
 		net_pkt_set_l2_processed(pkt, true);
+		ret = net_if_recv_data(net_pkt_iface(pkt), pkt);
 		if (ret != NET_CONTINUE) {
 			if (ret == NET_DROP) {
 				NET_DBG("Packet %p discarded by L2", pkt);
 				net_stats_update_processing_error(
 							net_pkt_iface(pkt));
 			}
-
 			return ret;
 		}
-
 		/* L2 has modified the buffer starting point, it is easier
 		 * to re-initialize the cursor rather than updating it.
 		 */
 		net_pkt_cursor_init(pkt);
+
+		update_priority_l2(pkt);
+		if (!being_processed_by_correct_thread(pkt)) {
+			net_queue_rx(net_pkt_iface(pkt), pkt);
+			return NET_OK;
+		}
 	}
 
 	if (IS_ENABLED(CONFIG_NET_SOCKETS_PACKET_DGRAM) &&
@@ -128,7 +152,6 @@ static inline enum net_verdict process_data(struct net_pkt *pkt)
 		} else if (IS_ENABLED(CONFIG_NET_SOCKETS_CAN) && family == AF_CAN) {
 			return net_canbus_socket_input(pkt);
 		}
-
 		NET_DBG("Unknown protocol family packet (0x%x)", family);
 		return NET_DROP;
 	}
@@ -137,6 +160,7 @@ static inline enum net_verdict process_data(struct net_pkt *pkt)
 
 }
 
+
 static void processing_data(struct net_pkt *pkt)
 {
 again:

subsys/net/ip/net_private.h

@@ -207,6 +207,7 @@ static inline void net_tc_rx_init(void) { }
 #endif
 enum net_verdict net_tc_try_submit_to_tx_queue(uint8_t tc, struct net_pkt *pkt,
 					       k_timeout_t timeout);
+bool net_tc_rx_is_current_thread(uint8_t tc);
 extern enum net_verdict net_tc_submit_to_rx_queue(uint8_t tc, struct net_pkt *pkt);
 extern enum net_verdict net_promisc_mode_input(struct net_pkt *pkt);
 

subsys/net/ip/net_tc.c

@@ -235,6 +235,21 @@ static uint8_t rx_tc2thread(uint8_t tc)
 }
 #endif
 
+bool net_tc_rx_is_current_thread(uint8_t tc)
+{
+	uint8_t thread_priority;
+	int priority;
+	int desired_priority;
+
+	thread_priority = rx_tc2thread(tc);
+	desired_priority = IS_ENABLED(CONFIG_NET_TC_THREAD_COOPERATIVE) ?
+		K_PRIO_COOP(thread_priority) :
+		K_PRIO_PREEMPT(thread_priority);
+	priority = k_thread_priority_get(k_current_get());
+
+	return priority == desired_priority;
+}
+
 #if defined(CONFIG_NET_STATISTICS)
 /* Fixup the traffic class statistics so that "net stats" shell command will
  * print output correctly.