net: dsa: support tag protocol setup

Supported tag protocol setup.

Signed-off-by: Yangbo Lu <[email protected]>

Author: yangbolu1991

subsys/net/l2/ethernet/dsa/dsa_port.c

@@ -10,6 +10,7 @@ LOG_MODULE_REGISTER(net_dsa_port, CONFIG_NET_DSA_LOG_LEVEL);
 #include <zephyr/net/ethernet.h>
 #include <zephyr/net/phy.h>
 #include <zephyr/net/dsa_core.h>
+#include "dsa_tag.h"
 
 #if defined(CONFIG_NET_INTERFACE_NAME_LEN)
 #define INTERFACE_NAME_LEN CONFIG_NET_INTERFACE_NAME_LEN
@@ -28,19 +29,18 @@ int dsa_port_initialize(const struct device *dev)
 
 	dsa_switch_ctx->init_ports++;
 
-	/* Find conduit port */
+	/* Find the connection of conduit port and cpu port */
 	if (dsa_switch_ctx->iface_conduit == NULL && cfg->ethernet_connection != NULL) {
 		dsa_switch_ctx->iface_conduit = net_if_lookup_by_dev(cfg->ethernet_connection);
 		if (dsa_switch_ctx->iface_conduit == NULL) {
 			LOG_ERR("DSA: Conduit iface NOT found!");
 		}
 
+		/* Set up tag protocol on the cpu port */
 		eth_ctx->dsa_port = DSA_CPU_PORT;
+		dsa_tag_setup(dev);
 
-		/*
-		 * Provide pointer to DSA switch context to conduit's eth interface
-		 * struct ethernet_context
-		 */
+		/* Provide DSA information to the conduit port */
 		eth_ctx_conduit = net_if_l2_data(dsa_switch_ctx->iface_conduit);
 		eth_ctx_conduit->dsa_switch_ctx = dsa_switch_ctx;
 		eth_ctx_conduit->dsa_port = DSA_CONDUIT_PORT;

subsys/net/l2/ethernet/dsa/dsa_tag.c

@@ -6,6 +6,7 @@
 
 #include <zephyr/net/ethernet.h>
 #include <zephyr/net/dsa_core.h>
+#include "dsa_tag.h"
 
 struct net_if *dsa_tag_recv(struct net_if *iface, struct net_pkt *pkt)
 {
@@ -36,3 +37,20 @@ struct net_pkt *dsa_tag_xmit(struct net_if *iface, struct net_pkt *pkt)
 
 	return dsa_switch_ctx->dapi->xmit(iface, pkt);
 }
+
+void dsa_tag_setup(const struct device *dev_cpu)
+{
+	const struct dsa_port_config *cfg = dev_cpu->config;
+	struct dsa_switch_context *dsa_switch_ctx = dev_cpu->data;
+
+	switch (cfg->tag_proto) {
+	case DSA_TAG_PROTO_NETC:
+		dsa_switch_ctx->dapi->recv = dsa_tag_netc_recv;
+		dsa_switch_ctx->dapi->xmit = dsa_tag_netc_xmit;
+		break;
+	default:
+		dsa_switch_ctx->dapi->recv = NULL;
+		dsa_switch_ctx->dapi->xmit = NULL;
+		break;
+	}
+}

subsys/net/l2/ethernet/dsa/dsa_tag.h

@@ -10,5 +10,6 @@
 
 struct net_if *dsa_tag_recv(struct net_if *iface, struct net_pkt *pkt);
 struct net_pkt *dsa_tag_xmit(struct net_if *iface, struct net_pkt *pkt);
+void dsa_tag_setup(const struct device *dev_cpu);
 
 #endif