diff options
Diffstat (limited to 'vnet/vnet/ip/udp.h')
-rw-r--r-- | vnet/vnet/ip/udp.h | 99 |
1 files changed, 98 insertions, 1 deletions
diff --git a/vnet/vnet/ip/udp.h b/vnet/vnet/ip/udp.h index 65eef29cb10..e9ee1e32faa 100644 --- a/vnet/vnet/ip/udp.h +++ b/vnet/vnet/ip/udp.h @@ -38,6 +38,7 @@ _ (67, dhcp_to_server) \ _ (68, dhcp_to_client) \ _ (500, ikev2) \ _ (4341, lisp_gpe) \ +_ (4342, lisp_cp) \ _ (4739, ipfix) \ _ (4789, vxlan) \ _ (4790, vxlan_gpe) \ @@ -47,6 +48,7 @@ _ (6633, vpath_3) #define foreach_udp6_dst_port \ _ (547, dhcpv6_to_server) \ _ (546, dhcpv6_to_client) \ +_ (4342, lisp_cp6) \ _ (6633, vpath6_3) typedef enum { @@ -109,5 +111,100 @@ void udp_register_dst_port (vlib_main_t * vm, udp_dst_port_t dst_port, u32 node_index, u8 is_ip4); -#endif /* included_udp_h */ +always_inline void +ip4_udp_encap_one (vlib_main_t * vm, vlib_buffer_t * b0, u8 * ec0, u32 ec_len) +{ + ip4_header_t * ip0; + ip_csum_t sum0; + u16 old_l0 = 0; + u16 new_l0; + udp_header_t * udp0; + + vlib_buffer_advance (b0, - ec_len); + ip0 = vlib_buffer_get_current(b0); + + /* Apply the encap string. */ +#if DPDK + rte_memcpy(ip0, ec0, ec_len); +#else + memcpy(ip0, ec0, ec_len); +#endif + + /* fix the <bleep>ing outer-IP checksum */ + sum0 = ip0->checksum; + /* old_l0 always 0, see the rewrite setup */ + new_l0 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b0)); + + sum0 = ip_csum_update(sum0, old_l0, new_l0, ip4_header_t, + length /* changed member */); + ip0->checksum = ip_csum_fold (sum0); + ip0->length = new_l0; + + /* Fix UDP length */ + udp0 = (udp_header_t *)(ip0+1); + new_l0 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b0) + - sizeof (*ip0)); + + udp0->length = new_l0; +} +always_inline void +ip4_udp_encap_two (vlib_main_t * vm, vlib_buffer_t * b0, vlib_buffer_t * b1, + u8 * ec0, u8 * ec1, u32 ec_len) +{ + ip4_header_t * ip0, *ip1; + ip_csum_t sum0, sum1; + u16 old_l0 = 0, old_l1 = 0; + u16 new_l0, new_l1; + udp_header_t * udp0, *udp1; + + ASSERT(_vec_len(ec0) == _vec_len(ec1)); + + vlib_buffer_advance (b0, -ec_len); + vlib_buffer_advance (b1, -ec_len); + + ip0 = vlib_buffer_get_current (b0); + ip1 = vlib_buffer_get_current (b1); + + /* Apply the encap string */ +#ifdef DPDK + rte_memcpy (ip0, ec0, ec_len); + rte_memcpy (ip1, ec1, ec_len); +#else + memcpy (ip0, ec0, ec_len); + memcpy (ip1, ec1, ec_len); +#endif + + /* fix the <bleep>ing outer-IP checksum */ + sum0 = ip0->checksum; + sum1 = ip1->checksum; + + /* old_l0 always 0, see the rewrite setup */ + new_l0 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b0)); + new_l1 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b1)); + + sum0 = ip_csum_update(sum0, old_l0, new_l0, ip4_header_t, + length /* changed member */); + sum1 = ip_csum_update(sum1, old_l1, new_l1, ip4_header_t, + length /* changed member */); + + ip0->checksum = ip_csum_fold (sum0); + ip1->checksum = ip_csum_fold (sum1); + + ip0->length = new_l0; + ip1->length = new_l1; + + /* Fix UDP length */ + udp0 = (udp_header_t *) (ip0 + 1); + udp1 = (udp_header_t *) (ip1 + 1); + + new_l0 = clib_host_to_net_u16 ( + vlib_buffer_length_in_chain (vm, b0) - sizeof(*ip0)); + new_l1 = clib_host_to_net_u16 ( + vlib_buffer_length_in_chain (vm, b1) - sizeof(*ip1)); + udp0->length = new_l0; + udp1->length = new_l1; + return; +} + +#endif /* included_udp_h */ |