vnet/vnet/ip/udp.h

   1 /*
   2  * ip/udp.h: udp protocol
   3  *
   4  * Copyright (c) 2013 Cisco and/or its affiliates.
   5  * Licensed under the Apache License, Version 2.0 (the "License");
   6  * you may not use this file except in compliance with the License.
   7  * You may obtain a copy of the License at:
   8  *
   9  *     http://www.apache.org/licenses/LICENSE-2.0
  10  *
  11  * Unless required by applicable law or agreed to in writing, software
  12  * distributed under the License is distributed on an "AS IS" BASIS,
  13  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  14  * See the License for the specific language governing permissions and
  15  * limitations under the License.
  16  */
  17
  18 #ifndef included_udp_h
  19 #define included_udp_h
  20
  21 #include <vnet/vnet.h>
  22 #include <vnet/ip/udp_packet.h>
  23 #include <vnet/ip/ip.h>
  24 #include <vnet/ip/ip4.h>
  25 #include <vnet/ip/ip4_packet.h>
  26 #include <vnet/pg/pg.h>
  27 #include <vnet/ip/format.h>
  28
  29 typedef enum {
  30 #define udp_error(n,s) UDP_ERROR_##n,
  31 #include <vnet/ip/udp_error.def>
  32 #undef udp_error
  33   UDP_N_ERROR,
  34 } udp_error_t;
  35
  36 #define foreach_udp4_dst_port                   \
  37 _ (67, dhcp_to_server)                          \
  38 _ (68, dhcp_to_client)                          \
  39 _ (500, ikev2)                                  \
  40 _ (4341, lisp_gpe)                              \
  41 _ (4342, lisp_cp)                               \
  42 _ (4739, ipfix)                                 \
  43 _ (4789, vxlan)                                 \
  44 _ (4789, vxlan6)                                \
  45 _ (4790, vxlan_gpe)                             \
  46 _ (6633, vpath_3)
  47
  48
  49 #define foreach_udp6_dst_port                   \
  50 _ (547, dhcpv6_to_server)                       \
  51 _ (546, dhcpv6_to_client)                       \
  52 _ (4341, lisp_gpe6)                             \
  53 _ (4342, lisp_cp6)                              \
  54 _ (4790, vxlan6_gpe)      \
  55 _ (6633, vpath6_3)
  56
  57 typedef enum {
  58 #define _(n,f) UDP_DST_PORT_##f = n,
  59   foreach_udp4_dst_port
  60   foreach_udp6_dst_port
  61 #undef _
  62 } udp_dst_port_t;
  63
  64 typedef enum {
  65 #define _(n,f) UDP6_DST_PORT_##f = n,
  66   foreach_udp6_dst_port
  67 #undef _
  68 } udp6_dst_port_t;
  69
  70 typedef struct {
  71   /* Name (a c string). */
  72   char * name;
  73
  74   /* GRE protocol type in host byte order. */
  75   udp_dst_port_t dst_port;
  76
  77   /* Node which handles this type. */
  78   u32 node_index;
  79
  80   /* Next index for this type. */
  81   u32 next_index;
  82 } udp_dst_port_info_t;
  83
  84 typedef enum {
  85   UDP_IP6 = 0,
  86   UDP_IP4,                      /* the code is full of is_ip4... */
  87   N_UDP_AF,
  88 } udp_af_t;
  89
  90 typedef struct {
  91   udp_dst_port_info_t * dst_port_infos [N_UDP_AF];
  92
  93   /* Hash tables mapping name/protocol to protocol info index. */
  94   uword * dst_port_info_by_name[N_UDP_AF];
  95   uword * dst_port_info_by_dst_port[N_UDP_AF];
  96
  97   /* convenience */
  98   vlib_main_t * vlib_main;
  99 } udp_main_t;
 100
 101 always_inline udp_dst_port_info_t *
 102 udp_get_dst_port_info (udp_main_t * um, udp_dst_port_t dst_port, u8 is_ip4)
 103 {
 104   uword * p = hash_get (um->dst_port_info_by_dst_port[is_ip4], dst_port);
 105   return p ? vec_elt_at_index (um->dst_port_infos[is_ip4], p[0]) : 0;
 106 }
 107
 108 format_function_t format_udp_header;
 109 format_function_t format_udp_rx_trace;
 110
 111 unformat_function_t unformat_udp_header;
 112
 113 void udp_register_dst_port (vlib_main_t * vm,
 114                             udp_dst_port_t dst_port,
 115                             u32 node_index, u8 is_ip4);
 116
 117 always_inline void
 118 ip_udp_encap_one (vlib_main_t * vm, vlib_buffer_t * b0, u8 * ec0, word ec_len,
 119                   u8 is_ip4)
 120 {
 121   u16 new_l0;
 122   udp_header_t * udp0;
 123
 124   vlib_buffer_advance (b0, - ec_len);
 125
 126   if (is_ip4)
 127     {
 128       ip4_header_t * ip0;
 129       ip_csum_t sum0;
 130       u16 old_l0 = 0;
 131
 132       ip0 = vlib_buffer_get_current(b0);
 133
 134       /* Apply the encap string. */
 135       clib_memcpy(ip0, ec0, ec_len);
 136
 137       /* fix the <bleep>ing outer-IP checksum */
 138       sum0 = ip0->checksum;
 139       /* old_l0 always 0, see the rewrite setup */
 140       new_l0 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b0));
 141
 142       sum0 = ip_csum_update(sum0, old_l0, new_l0, ip4_header_t,
 143                             length /* changed member */);
 144       ip0->checksum = ip_csum_fold (sum0);
 145       ip0->length = new_l0;
 146
 147       /* Fix UDP length */
 148       udp0 = (udp_header_t *)(ip0+1);
 149       new_l0 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b0)
 150                                      - sizeof (*ip0));
 151       udp0->length = new_l0;
 152     }
 153   else
 154     {
 155       ip6_header_t * ip0;
 156       int bogus0;
 157
 158       ip0 = vlib_buffer_get_current(b0);
 159
 160       /* Apply the encap string. */
 161       clib_memcpy(ip0, ec0, ec_len);
 162
 163       new_l0 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b0)
 164                                      - sizeof (*ip0));
 165       ip0->payload_length = new_l0;
 166
 167       /* Fix UDP length */
 168       udp0 = (udp_header_t *)(ip0+1);
 169       udp0->length = new_l0;
 170
 171       udp0->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, b0, ip0, &bogus0);
 172       ASSERT(bogus0 == 0);
 173
 174       if (udp0->checksum == 0)
 175           udp0->checksum = 0xffff;
 176     }
 177 }
 178
 179 always_inline void
 180 ip_udp_encap_two (vlib_main_t * vm, vlib_buffer_t * b0, vlib_buffer_t * b1,
 181                   u8 * ec0, u8 * ec1, word ec_len, u8 is_v4)
 182 {
 183   u16 new_l0, new_l1;
 184   udp_header_t * udp0, *udp1;
 185
 186   ASSERT(_vec_len(ec0) == _vec_len(ec1));
 187
 188   vlib_buffer_advance (b0, -ec_len);
 189   vlib_buffer_advance (b1, -ec_len);
 190
 191   if (is_v4)
 192     {
 193       ip4_header_t * ip0, *ip1;
 194       ip_csum_t sum0, sum1;
 195       u16 old_l0 = 0, old_l1 = 0;
 196
 197       ip0 = vlib_buffer_get_current (b0);
 198       ip1 = vlib_buffer_get_current (b1);
 199
 200       /* Apply the encap string */
 201       clib_memcpy (ip0, ec0, ec_len);
 202       clib_memcpy (ip1, ec1, ec_len);
 203
 204       /* fix the <bleep>ing outer-IP checksum */
 205       sum0 = ip0->checksum;
 206       sum1 = ip1->checksum;
 207
 208       /* old_l0 always 0, see the rewrite setup */
 209       new_l0 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b0));
 210       new_l1 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b1));
 211
 212       sum0 = ip_csum_update(sum0, old_l0, new_l0, ip4_header_t,
 213                             length /* changed member */);
 214       sum1 = ip_csum_update(sum1, old_l1, new_l1, ip4_header_t,
 215                             length /* changed member */);
 216
 217       ip0->checksum = ip_csum_fold (sum0);
 218       ip1->checksum = ip_csum_fold (sum1);
 219
 220       ip0->length = new_l0;
 221       ip1->length = new_l1;
 222
 223       /* Fix UDP length */
 224       udp0 = (udp_header_t *) (ip0 + 1);
 225       udp1 = (udp_header_t *) (ip1 + 1);
 226
 227       new_l0 = clib_host_to_net_u16 (
 228           vlib_buffer_length_in_chain (vm, b0) - sizeof(*ip0));
 229       new_l1 = clib_host_to_net_u16 (
 230           vlib_buffer_length_in_chain (vm, b1) - sizeof(*ip1));
 231       udp0->length = new_l0;
 232       udp1->length = new_l1;
 233     }
 234   else
 235     {
 236       ip6_header_t * ip0, * ip1;
 237       int bogus0, bogus1;
 238
 239       ip0 = vlib_buffer_get_current(b0);
 240       ip1 = vlib_buffer_get_current(b1);
 241
 242       /* Apply the encap string. */
 243       clib_memcpy(ip0, ec0, ec_len);
 244       clib_memcpy(ip1, ec1, ec_len);
 245
 246       new_l0 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b0)
 247                                      - sizeof (*ip0));
 248       new_l1 = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b1)
 249                                      - sizeof (*ip1));
 250       ip0->payload_length = new_l0;
 251       ip1->payload_length = new_l1;
 252
 253       /* Fix UDP length */
 254       udp0 = (udp_header_t *)(ip0+1);
 255       udp1 = (udp_header_t *)(ip1+1);
 256
 257       udp0->length = new_l0;
 258       udp1->length = new_l1;
 259
 260       udp0->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, b0, ip0, &bogus0);
 261       udp1->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, b1, ip1, &bogus1);
 262       ASSERT(bogus0 == 0);
 263       ASSERT(bogus1 == 0);
 264
 265       if (udp0->checksum == 0)
 266           udp0->checksum = 0xffff;
 267       if (udp1->checksum == 0)
 268           udp1->checksum = 0xffff;
 269     }
 270 }
 271
 272 #endif /* included_udp_h */