Parse VLAN encapsulated TECMP packets. (#6)

Technica-Engineering · Sep 19, 2022 · aa62ac8 · aa62ac8
1 parent 79646eb
commit aa62ac8
Show file tree

Hide file tree

Showing 2 changed files with 6 additions and 1 deletion.
diff --git a/CMakeLists.txt b/CMakeLists.txt
@@ -2,7 +2,7 @@ cmake_minimum_required(VERSION 3.17)
 
 # Project name and a few useful settings. Other commands can pick up the results
 project(LIBTECMP
-    VERSION 0.1
+    VERSION 0.2
     DESCRIPTION "TECMP Library"
 )
 

diff --git a/src/tecmp.c b/src/tecmp.c
@@ -52,6 +52,11 @@ int tecmp_next(
 
 	uint16_t ether = ntoh16(*((uint16_t*)(raw_frame + 12)));
 
+	// VLAN ethertypes
+	if ((ether == 0x8100) || (ether == 0x88A8) || (ether == 0x9100)) {
+		uint32_t skip = 4;
+		return tecmp_next(raw_frame + skip, raw_frame_size - skip, iterator, header, data);
+	}
 	// Ethertype mismatch
 	if (!(ether == 0x2090 || ether == 0x99FE)) {
 		return EINVAL;