FD.io VPP  v21.06-3-gbb25fbf28
Vector Packet Processing
packets.c
Go to the documentation of this file.
1 /*
2  * Copyright (c) 2016 Cisco and/or its affiliates.
3  * Licensed under the Apache License, Version 2.0 (the "License");
4  * you may not use this file except in compliance with the License.
5  * You may obtain a copy of the License at:
6  *
7  * http://www.apache.org/licenses/LICENSE-2.0
8  *
9  * Unless required by applicable law or agreed to in writing, software
10  * distributed under the License is distributed on an "AS IS" BASIS,
11  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12  * See the License for the specific language governing permissions and
13  * limitations under the License.
14  */
15 
16 #include <lisp/lisp-cp/packets.h>
18 #include <vnet/udp/udp_packet.h>
19 #include <vnet/ip/ip4_inlines.h>
20 #include <vnet/ip/ip6_inlines.h>
21 
22 /* Returns IP ID for the packet */
23 /* static u16 ip_id = 0;
24 static inline u16
25 get_IP_ID()
26 {
27  ip_id++;
28  return (ip_id);
29 } */
30 
31 u16
32 udp_ip4_checksum (const void *b, u32 len, u8 * src, u8 * dst)
33 {
34  const u16 *buf = b;
35  u16 *ip_src = (u16 *) src;
36  u16 *ip_dst = (u16 *) dst;
37  u32 length = len;
38  u32 sum = 0;
39 
40  while (len > 1)
41  {
42  sum += *buf++;
43  if (sum & 0x80000000)
44  sum = (sum & 0xFFFF) + (sum >> 16);
45  len -= 2;
46  }
47 
48  /* Add the padding if the packet length is odd */
49  if (len & 1)
50  sum += *((u8 *) buf);
51 
52  /* Add the pseudo-header */
53  sum += *(ip_src++);
54  sum += *ip_src;
55 
56  sum += *(ip_dst++);
57  sum += *ip_dst;
58 
59  sum += clib_host_to_net_u16 (IP_PROTOCOL_UDP);
60  sum += clib_host_to_net_u16 (length);
61 
62  /* Add the carries */
63  while (sum >> 16)
64  sum = (sum & 0xFFFF) + (sum >> 16);
65 
66  /* Return the one's complement of sum */
67  return ((u16) (~sum));
68 }
69 
70 u16
72 {
73  size_t i;
74  register const u16 *sp;
75  u32 sum;
76  union
77  {
78  struct
79  {
80  ip6_address_t ph_src;
81  ip6_address_t ph_dst;
82  u32 ph_len;
83  u8 ph_zero[3];
84  u8 ph_nxt;
85  } ph;
86  u16 pa[20];
87  } phu;
88 
89  /* pseudo-header */
90  clib_memset (&phu, 0, sizeof (phu));
91  phu.ph.ph_src = ip6->src_address;
92  phu.ph.ph_dst = ip6->dst_address;
93  phu.ph.ph_len = clib_host_to_net_u32 (len);
94  phu.ph.ph_nxt = IP_PROTOCOL_UDP;
95 
96  sum = 0;
97  for (i = 0; i < sizeof (phu.pa) / sizeof (phu.pa[0]); i++)
98  sum += phu.pa[i];
99 
100  sp = (const u16 *) up;
101 
102  for (i = 0; i < (len & ~1); i += 2)
103  sum += *sp++;
104 
105  if (len & 1)
106  sum += clib_host_to_net_u16 ((*(const u8 *) sp) << 8);
107 
108  while (sum > 0xffff)
109  sum = (sum & 0xffff) + (sum >> 16);
110  sum = ~sum & 0xffff;
111 
112  return (sum);
113 }
114 
115 u16
116 udp_checksum (udp_header_t * uh, u32 udp_len, void *ih, u8 version)
117 {
118  switch (version)
119  {
120  case AF_IP4:
121  return (udp_ip4_checksum (uh, udp_len,
122  ((ip4_header_t *) ih)->src_address.as_u8,
123  ((ip4_header_t *) ih)->dst_address.as_u8));
124  case AF_IP6:
125  return (udp_ip6_checksum (ih, uh, udp_len));
126  default:
127  return ~0;
128  }
129 }
130 
131 void *
133 {
134  udp_header_t *uh;
135  u16 udp_len = sizeof (udp_header_t) + vlib_buffer_length_in_chain (vm, b);
136 
137  uh = vlib_buffer_push_uninit (b, sizeof (*uh));
138 
139  uh->src_port = clib_host_to_net_u16 (sp);
140  uh->dst_port = clib_host_to_net_u16 (dp);
141  uh->length = clib_host_to_net_u16 (udp_len);
142  uh->checksum = 0;
143  return uh;
144 }
145 
146 void *
148  ip_address_t * dst, u32 proto, u8 csum_offload)
149 {
151  {
152  clib_warning ("src %U and dst %U IP have different AFI! Discarding!",
154  return 0;
155  }
156 
157  switch (ip_addr_version (src))
158  {
159  case AF_IP4:
160  return vlib_buffer_push_ip4 (vm, b, &ip_addr_v4 (src),
161  &ip_addr_v4 (dst), proto, csum_offload);
162  break;
163  case AF_IP6:
164  return vlib_buffer_push_ip6 (vm, b, &ip_addr_v6 (src),
165  &ip_addr_v6 (dst), proto);
166  break;
167  }
168 
169  return 0;
170 }
171 
172 void *
174  ip_address_t * sip, ip_address_t * dip, u8 csum_offload)
175 {
176  u16 udpsum;
177  udp_header_t *uh;
178  void *ih;
179 
180  uh = pkt_push_udp (vm, b, sp, dp);
181 
182  if (csum_offload)
183  {
184  ih = pkt_push_ip (vm, b, sip, dip, IP_PROTOCOL_UDP, 1);
185  vnet_buffer_offload_flags_set (b, VNET_BUFFER_OFFLOAD_F_UDP_CKSUM);
186  vnet_buffer (b)->l3_hdr_offset = (u8 *) ih - b->data;
187  vnet_buffer (b)->l4_hdr_offset = (u8 *) uh - b->data;
188  uh->checksum = 0;
189  }
190  else
191  {
192  ih = pkt_push_ip (vm, b, sip, dip, IP_PROTOCOL_UDP, 0);
193  udpsum = udp_checksum (uh, clib_net_to_host_u16 (uh->length), ih,
194  ip_addr_version (sip));
195  if (udpsum == (u16) ~ 0)
196  {
197  clib_warning ("Failed UDP checksum! Discarding");
198  return 0;
199  }
200  /* clear flags used for csum since we're not offloading */
201  b->flags &= ~(VNET_BUFFER_F_IS_IP4 | VNET_BUFFER_F_IS_IP6);
202  uh->checksum = udpsum;
203  }
204  return ih;
205 }
206 
207 void *
209 {
210  ecm_hdr_t *h;
211  h = vlib_buffer_push_uninit (b, sizeof (h[0]));
212 
213  clib_memset (h, 0, sizeof (h[0]));
214  h->type = LISP_ENCAP_CONTROL_TYPE;
215  clib_memset (h->reserved2, 0, sizeof (h->reserved2));
216 
217  return h;
218 }
219 
220 /* *INDENT-ON* */
221 
222 /*
223  * fd.io coding-style-patch-verification: ON
224  *
225  * Local Variables:
226  * eval: (c-set-style "gnu")
227  * End:
228  */
ip_address
Definition: ip_types.h:79
udp_header_t::src_port
u16 src_port
Definition: udp_packet.h:48
udp_header_t::length
u16 length
Definition: udp_packet.h:51
udp_ip4_checksum
u16 udp_ip4_checksum(const void *b, u32 len, u8 *src, u8 *dst)
Definition: packets.c:32
lisp_cp_messages.h
pkt_push_udp
void * pkt_push_udp(vlib_main_t *vm, vlib_buffer_t *b, u16 sp, u16 dp)
Definition: packets.c:132
ip4_inlines.h
vlib_buffer_push_ip6
static void * vlib_buffer_push_ip6(vlib_main_t *vm, vlib_buffer_t *b, ip6_address_t *src, ip6_address_t *dst, int proto)
Push IPv6 header to buffer.
Definition: ip6_inlines.h:255
vnet_buffer_offload_flags_set
static_always_inline void vnet_buffer_offload_flags_set(vlib_buffer_t *b, vnet_buffer_oflags_t oflags)
Definition: buffer.h:522
vlib_buffer_push_ip4
static void * vlib_buffer_push_ip4(vlib_main_t *vm, vlib_buffer_t *b, ip4_address_t *src, ip4_address_t *dst, int proto, u8 csum_offload)
Push IPv4 header to buffer.
Definition: ip4_inlines.h:150
u16
unsigned short u16
Definition: types.h:57
vm
vlib_main_t * vm
X-connect all packets from the HOST to the PHY.
Definition: nat44_ei.c:3047
udp_ip6_checksum
u16 udp_ip6_checksum(ip6_header_t *ip6, udp_header_t *up, u32 len)
Definition: packets.c:71
AF_IP4
@ AF_IP4
Definition: ip_types.h:23
vlib_buffer_length_in_chain
static uword vlib_buffer_length_in_chain(vlib_main_t *vm, vlib_buffer_t *b)
Get length in bytes of the buffer chain.
Definition: buffer_funcs.h:433
udp_header_t
Definition: udp_packet.h:45
ip4_header_t
Definition: ip4_packet.h:87
h
h
Definition: flowhash_template.h:372
ph
pool_header_t * ph(void *p)
GDB callable function: ph - call pool_header - get pool header.
Definition: gdb_funcs.c:78
pkt_push_ip
void * pkt_push_ip(vlib_main_t *vm, vlib_buffer_t *b, ip_address_t *src, ip_address_t *dst, u32 proto, u8 csum_offload)
Definition: packets.c:147
ip_addr_version
#define ip_addr_version(_a)
Definition: ip_types.h:93
len
u8 len
Definition: ip_types.api:103
vnet_buffer
#define vnet_buffer(b)
Definition: buffer.h:437
ip_addr_v6
#define ip_addr_v6(_a)
Definition: ip_types.h:92
udp_packet.h
format_ip_address
u8 * format_ip_address(u8 *s, va_list *args)
Definition: ip_types.c:21
ip_addr_v4
#define ip_addr_v4(_a)
Definition: ip_types.h:91
ecm_hdr_t
Definition: lisp_cp_messages.h:109
i
sll srl srl sll sra u16x4 i
Definition: vector_sse42.h:261
src
vl_api_address_t src
Definition: gre.api:54
ip6_inlines.h
udp_header_t::checksum
u16 checksum
Definition: udp_packet.h:55
vlib_buffer_push_uninit
static void * vlib_buffer_push_uninit(vlib_buffer_t *b, u8 size)
Prepend uninitialized data to buffer.
Definition: buffer.h:363
version
option version
Definition: sample.api:19
pkt_push_udp_and_ip
void * pkt_push_udp_and_ip(vlib_main_t *vm, vlib_buffer_t *b, u16 sp, u16 dp, ip_address_t *sip, ip_address_t *dip, u8 csum_offload)
Definition: packets.c:173
buf
u64 buf
Definition: application.c:493
u32
unsigned int u32
Definition: types.h:88
packets.h
udp_header_t::dst_port
u16 dst_port
Definition: udp_packet.h:48
ip6
vl_api_ip6_address_t ip6
Definition: one.api:424
dst
vl_api_ip4_address_t dst
Definition: pnat.api:41
LISP_ENCAP_CONTROL_TYPE
@ LISP_ENCAP_CONTROL_TYPE
Definition: lisp_cp_messages.h:65
AF_IP6
@ AF_IP6
Definition: ip_types.h:24
ip6_header_t
Definition: ip6_packet.h:294
length
char const int length
Definition: cJSON.h:163
clib_memset
clib_memset(h->entries, 0, sizeof(h->entries[0]) *entries)
vlib_main_t
Definition: main.h:102
b
vlib_buffer_t ** b
Definition: nat44_ei_out2in.c:717
u8
unsigned char u8
Definition: types.h:56
vlib_buffer_t::data
u8 data[]
Packet data.
Definition: buffer.h:204
clib_warning
#define clib_warning(format, args...)
Definition: error.h:59
pkt_push_ecm_hdr
void * pkt_push_ecm_hdr(vlib_buffer_t *b)
Definition: packets.c:208
proto
vl_api_ip_proto_t proto
Definition: acl_types.api:51
udp_checksum
u16 udp_checksum(udp_header_t *uh, u32 udp_len, void *ih, u8 version)
Definition: packets.c:116
src_address
vl_api_address_union_t src_address
Definition: ip_types.api:122
vlib_buffer_t::flags
u32 flags
buffer flags: VLIB_BUFFER_FREE_LIST_INDEX_MASK: bits used to store free list index,...
Definition: buffer.h:133
vlib_buffer_t
VLIB buffer representation.
Definition: buffer.h:111