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:
7 * http://www.apache.org/licenses/LICENSE-2.0
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.
16 #include <vnet/lisp-cp/packets.h>
17 #include <vnet/lisp-cp/lisp_cp_messages.h>
18 #include <vnet/ip/udp_packet.h>
20 /* Returns IP ID for the packet */
21 /* static u16 ip_id = 0;
30 udp_ip4_checksum (const void *b, u32 len, u8 * src, u8 * dst)
33 u16 *ip_src = (u16 *) src;
34 u16 *ip_dst = (u16 *) dst;
42 sum = (sum & 0xFFFF) + (sum >> 16);
46 /* Add the padding if the packet length is odd */
50 /* Add the pseudo-header */
57 sum += clib_host_to_net_u16 (IP_PROTOCOL_UDP);
58 sum += clib_host_to_net_u16 (length);
62 sum = (sum & 0xFFFF) + (sum >> 16);
64 /* Return the one's complement of sum */
65 return ((u16) (~sum));
69 udp_ip6_checksum (ip6_header_t * ip6, udp_header_t * up, u32 len)
72 register const u16 *sp;
88 memset (&phu, 0, sizeof (phu));
89 phu.ph.ph_src = ip6->src_address;
90 phu.ph.ph_dst = ip6->dst_address;
91 phu.ph.ph_len = clib_host_to_net_u32 (len);
92 phu.ph.ph_nxt = IP_PROTOCOL_UDP;
95 for (i = 0; i < sizeof (phu.pa) / sizeof (phu.pa[0]); i++)
98 sp = (const u16 *) up;
100 for (i = 0; i < (len & ~1); i += 2)
104 sum += clib_host_to_net_u16 ((*(const u8 *) sp) << 8);
107 sum = (sum & 0xffff) + (sum >> 16);
114 udp_checksum (udp_header_t * uh, u32 udp_len, void *ih, u8 version)
119 return (udp_ip4_checksum (uh, udp_len,
120 ((ip4_header_t *) ih)->src_address.as_u8,
121 ((ip4_header_t *) ih)->dst_address.as_u8));
123 return (udp_ip6_checksum (ih, uh, udp_len));
130 pkt_push_udp (vlib_main_t * vm, vlib_buffer_t * b, u16 sp, u16 dp)
133 u16 udp_len = sizeof (udp_header_t) + vlib_buffer_length_in_chain (vm, b);
135 uh = vlib_buffer_push_uninit (b, sizeof (*uh));
137 uh->src_port = clib_host_to_net_u16 (sp);
138 uh->dst_port = clib_host_to_net_u16 (dp);
139 uh->length = clib_host_to_net_u16 (udp_len);
145 pkt_push_ipv4 (vlib_main_t * vm, vlib_buffer_t * b, ip4_address_t * src,
146 ip4_address_t * dst, int proto)
151 ih = vlib_buffer_push_uninit (b, sizeof (ip4_header_t));
153 ih->ip_version_and_header_length = 0x45;
155 ih->length = clib_host_to_net_u16 (vlib_buffer_length_in_chain (vm, b));
157 /* iph->fragment_id = clib_host_to_net_u16(get_IP_ID ()); */
159 /* TODO: decide if we allow fragments in case of control */
160 ih->flags_and_fragment_offset = clib_host_to_net_u16 (IP_DF);
162 ih->protocol = proto;
163 ih->src_address.as_u32 = src->as_u32;
164 ih->dst_address.as_u32 = dst->as_u32;
166 ih->checksum = ip4_header_checksum (ih);
171 pkt_push_ipv6 (vlib_main_t * vm, vlib_buffer_t * b, ip6_address_t * src,
172 ip6_address_t * dst, int proto)
178 ip6h = vlib_buffer_push_uninit (b, sizeof (ip6_header_t));
180 ip6h->ip_version_traffic_class_and_flow_label =
181 clib_host_to_net_u32 (0x6 << 28);
183 /* calculate ip6 payload length */
184 payload_length = vlib_buffer_length_in_chain (vm, b);
185 payload_length -= sizeof (*ip6h);
187 ip6h->payload_length = clib_host_to_net_u16 (payload_length);
189 ip6h->hop_limit = 0xff;
190 ip6h->protocol = proto;
191 clib_memcpy (ip6h->src_address.as_u8, src->as_u8,
192 sizeof (ip6h->src_address));
193 clib_memcpy (ip6h->dst_address.as_u8, dst->as_u8,
194 sizeof (ip6h->src_address));
200 pkt_push_ip (vlib_main_t * vm, vlib_buffer_t * b, ip_address_t * src,
201 ip_address_t * dst, u32 proto)
203 if (ip_addr_version (src) != ip_addr_version (dst))
205 clib_warning ("src %U and dst %U IP have different AFI! Discarding!",
206 format_ip_address, src, format_ip_address, dst);
210 switch (ip_addr_version (src))
213 return pkt_push_ipv4 (vm, b, &ip_addr_v4 (src), &ip_addr_v4 (dst),
217 return pkt_push_ipv6 (vm, b, &ip_addr_v6 (src), &ip_addr_v6 (dst),
226 pkt_push_udp_and_ip (vlib_main_t * vm, vlib_buffer_t * b, u16 sp, u16 dp,
227 ip_address_t * sip, ip_address_t * dip)
233 uh = pkt_push_udp (vm, b, sp, dp);
235 ih = pkt_push_ip (vm, b, sip, dip, IP_PROTOCOL_UDP);
237 udpsum = udp_checksum (uh, clib_net_to_host_u16 (uh->length), ih,
238 ip_addr_version (sip));
239 if (udpsum == (u16) ~ 0)
241 clib_warning ("Failed UDP checksum! Discarding");
244 uh->checksum = udpsum;
249 pkt_push_ecm_hdr (vlib_buffer_t * b)
252 h = vlib_buffer_push_uninit (b, sizeof (h[0]));
254 memset (h, 0, sizeof (h[0]));
255 h->type = LISP_ENCAP_CONTROL_TYPE;
256 memset (h->reserved2, 0, sizeof (h->reserved2));
264 * fd.io coding-style-patch-verification: ON
267 * eval: (c-set-style "gnu")