Fixed packet I/O in p4-14 programs

Tested on BMv2 and working

Change-Id: I834d7b5a8627181c6888500545e1bdbfe9af8dc1
diff --git a/tools/test/p4src/p4-14/include/actions.p4 b/tools/test/p4src/p4-14/include/actions.p4
index 961890d..1e6d425 100644
--- a/tools/test/p4src/p4-14/include/actions.p4
+++ b/tools/test/p4src/p4-14/include/actions.p4
@@ -15,10 +15,8 @@
 }
 
 action send_to_cpu() {
-    #ifdef __TOFINO_BUILD__
-    modify_field(ig_intr_md_for_tm.copy_to_cpu, 1);
-    #else
-    modify_field(standard_metadata.egress_spec, CPU_PORT);
-    #endif
+    modify_field(EGR_PORT_FIELD, CPU_PORT);
+    add_header(packet_in_hdr);
+    modify_field(packet_in_hdr.ingress_port, IGR_PORT_FIELD);
 }
 #endif
\ No newline at end of file