ipsec: Support MPLS over IPSec[46] interface

[vpp.git] / src / vnet / tunnel / tunnel_dp.h

diff --git a/src/vnet/tunnel/tunnel_dp.h b/src/vnet/tunnel/tunnel_dp.h
index f84e764..deef408 100644 (file)
--- a/src/vnet/tunnel/tunnel_dp.h
+++ b/src/vnet/tunnel/tunnel_dp.h
@@ -68,6 +68,26 @@ tunnel_encap_fixup_4o4_w_chksum (tunnel_encap_decap_flags_t flags,
     }
 }
 
+static_always_inline void
+tunnel_encap_fixup_mplso4_w_chksum (tunnel_encap_decap_flags_t flags,
+                                   const mpls_unicast_header_t *inner,
+                                   ip4_header_t *outer)
+{
+  if (flags & TUNNEL_ENCAP_DECAP_FLAG_ENCAP_COPY_DSCP)
+    {
+      ip_csum_t sum = outer->checksum;
+      u8 tos = outer->tos;
+
+      if (flags & TUNNEL_ENCAP_DECAP_FLAG_ENCAP_COPY_DSCP)
+       ip4_header_set_dscp (outer,
+                            vnet_mpls_uc_get_exp (inner->label_exp_s_ttl));
+
+      sum =
+       ip_csum_update (outer->checksum, tos, outer->tos, ip4_header_t, tos);
+      outer->checksum = ip_csum_fold (sum);
+    }
+}
+
 static_always_inline void
 tunnel_encap_fixup_6o4 (tunnel_encap_decap_flags_t flags,
                        const ip6_header_t * inner, ip4_header_t * outer)
@@ -120,6 +140,25 @@ tunnel_encap_fixup_4o6 (tunnel_encap_decap_flags_t flags,
     ip6_set_ecn_network_order (outer, ip4_header_get_ecn (inner));
 }
 
+static_always_inline void
+tunnel_encap_fixup_mplso6 (tunnel_encap_decap_flags_t flags,
+                          const mpls_unicast_header_t *inner,
+                          ip6_header_t *outer)
+{
+  if (flags & TUNNEL_ENCAP_DECAP_FLAG_ENCAP_COPY_DSCP)
+    ip6_set_dscp_network_order (outer,
+                               vnet_mpls_uc_get_exp (inner->label_exp_s_ttl));
+}
+
+static_always_inline void
+tunnel_encap_fixup_mplso4 (tunnel_encap_decap_flags_t flags,
+                          const mpls_unicast_header_t *inner,
+                          ip4_header_t *outer)
+{
+  if (flags & TUNNEL_ENCAP_DECAP_FLAG_ENCAP_COPY_DSCP)
+    ip4_header_set_dscp (outer, vnet_mpls_uc_get_exp (inner->label_exp_s_ttl));
+}
+
 static_always_inline void
 tunnel_decap_fixup_4o6 (tunnel_encap_decap_flags_t flags,
                        ip4_header_t * inner, const ip6_header_t * outer)
@@ -152,6 +191,20 @@ tunnel_decap_fixup_4o4 (tunnel_encap_decap_flags_t flags,
     ip4_header_set_ecn_w_chksum (inner, ip4_header_get_ecn (outer));
 }
 
+static_always_inline void
+tunnel_decap_fixup_mplso6 (tunnel_encap_decap_flags_t flags,
+                          mpls_unicast_header_t *inner,
+                          const ip6_header_t *outer)
+{
+}
+
+static_always_inline void
+tunnel_decap_fixup_mplso4 (tunnel_encap_decap_flags_t flags,
+                          mpls_unicast_header_t *inner,
+                          const ip4_header_t *outer)
+{
+}
+
 #endif
 
 /*