blob: f9341d62a6824491749395246c94b47ffc4c8acc [file] [log] [blame]
Ed Warnickecb9cada2015-12-08 15:45:58 -07001/*
2 * ipsec_if_in.c : IPSec interface input node
3 *
4 * Copyright (c) 2015 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#include <vnet/vnet.h>
19#include <vnet/api_errno.h>
20#include <vnet/ip/ip.h>
21
22#include <vnet/ipsec/ipsec.h>
23#include <vnet/ipsec/esp.h>
Neale Ranns918c1612019-02-21 23:34:59 -080024#include <vnet/ipsec/ipsec_io.h>
Neale Rannsb71fa752019-04-04 12:43:36 +000025#include <vnet/ipsec/ipsec_punt.h>
Ed Warnickecb9cada2015-12-08 15:45:58 -070026
27/* Statistics (not really errors) */
Matthew Smith831fd642018-05-15 22:03:05 -050028#define foreach_ipsec_if_input_error \
29_(RX, "good packets received") \
Neale Ranns8d7c5022019-02-06 01:41:05 -080030_(DISABLED, "ipsec packets received on disabled interface") \
Neale Rannsb71fa752019-04-04 12:43:36 +000031_(NO_TUNNEL, "no matching tunnel") \
Neale Ranns41afb332019-07-16 06:19:35 -070032_(NAT_KEEPALIVE, "NAT Keepalive") \
33_(TOO_SHORT, "Too Short") \
Neale Rannsb71fa752019-04-04 12:43:36 +000034_(SPI_0, "SPI 0")
Ed Warnickecb9cada2015-12-08 15:45:58 -070035
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -070036static char *ipsec_if_input_error_strings[] = {
Ed Warnickecb9cada2015-12-08 15:45:58 -070037#define _(sym,string) string,
38 foreach_ipsec_if_input_error
39#undef _
40};
41
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -070042typedef enum
43{
Ed Warnickecb9cada2015-12-08 15:45:58 -070044#define _(sym,str) IPSEC_IF_INPUT_ERROR_##sym,
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -070045 foreach_ipsec_if_input_error
Ed Warnickecb9cada2015-12-08 15:45:58 -070046#undef _
47 IPSEC_IF_INPUT_N_ERROR,
48} ipsec_if_input_error_t;
49
Ed Warnickecb9cada2015-12-08 15:45:58 -070050
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -070051typedef struct
52{
Neale Ranns41afb332019-07-16 06:19:35 -070053 union
54 {
55 ipsec4_tunnel_key_t key4;
56 ipsec6_tunnel_key_t key6;
57 };
58 u8 is_ip6;
Ed Warnickecb9cada2015-12-08 15:45:58 -070059 u32 seq;
60} ipsec_if_input_trace_t;
61
Kingwel Xiec69ac312019-02-04 01:49:29 -080062static u8 *
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -070063format_ipsec_if_input_trace (u8 * s, va_list * args)
Ed Warnickecb9cada2015-12-08 15:45:58 -070064{
65 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
66 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -070067 ipsec_if_input_trace_t *t = va_arg (*args, ipsec_if_input_trace_t *);
Ed Warnickecb9cada2015-12-08 15:45:58 -070068
Neale Ranns41afb332019-07-16 06:19:35 -070069 if (t->is_ip6)
70 s = format (s, "IPSec: %U seq %u",
71 format_ipsec6_tunnel_key, &t->key6, t->seq);
72 else
73 s = format (s, "IPSec: %U seq %u",
74 format_ipsec4_tunnel_key, &t->key4, t->seq);
Ed Warnickecb9cada2015-12-08 15:45:58 -070075 return s;
76}
77
Neale Rannsb71fa752019-04-04 12:43:36 +000078always_inline u16
79ipsec_ip4_if_no_tunnel (vlib_node_runtime_t * node,
80 vlib_buffer_t * b,
81 const esp_header_t * esp,
82 const ip4_header_t * ip4, u16 offset)
83{
84 if (PREDICT_FALSE (0 == esp->spi))
85 {
86 b->error = node->errors[IPSEC_IF_INPUT_ERROR_SPI_0];
87 b->punt_reason =
88 ipsec_punt_reason[(ip4->protocol == IP_PROTOCOL_UDP ?
Neale Ranns719beb72019-07-10 07:10:25 +000089 IPSEC_PUNT_IP4_SPI_UDP_0 :
90 IPSEC_PUNT_IP4_NO_SUCH_TUNNEL)];
Neale Rannsb71fa752019-04-04 12:43:36 +000091 }
92 else
93 {
94 b->error = node->errors[IPSEC_IF_INPUT_ERROR_NO_TUNNEL];
95 b->punt_reason = ipsec_punt_reason[IPSEC_PUNT_IP4_NO_SUCH_TUNNEL];
96 }
97 vlib_buffer_advance (b, -offset);
98 return IPSEC_INPUT_NEXT_PUNT;
99}
100
101always_inline u16
102ipsec_ip6_if_no_tunnel (vlib_node_runtime_t * node,
103 vlib_buffer_t * b,
104 const esp_header_t * esp, u16 offset)
105{
Neale Ranns719beb72019-07-10 07:10:25 +0000106 b->error = node->errors[IPSEC_IF_INPUT_ERROR_NO_TUNNEL];
107 b->punt_reason = ipsec_punt_reason[IPSEC_PUNT_IP6_NO_SUCH_TUNNEL];
108
Neale Rannsb71fa752019-04-04 12:43:36 +0000109 vlib_buffer_advance (b, -offset);
110 return (IPSEC_INPUT_NEXT_PUNT);
111}
Kingwel Xie00bff192019-03-07 01:25:32 -0500112
113always_inline uword
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400114ipsec_if_input_inline (vlib_main_t * vm, vlib_node_runtime_t * node,
115 vlib_frame_t * from_frame, int is_ip6)
Ed Warnickecb9cada2015-12-08 15:45:58 -0700116{
117 ipsec_main_t *im = &ipsec_main;
Matthew Smith01034be2017-05-16 11:51:18 -0500118 vnet_main_t *vnm = im->vnet_main;
119 vnet_interface_main_t *vim = &vnm->interface_main;
Kingwel Xie00bff192019-03-07 01:25:32 -0500120
121 int is_trace = node->flags & VLIB_NODE_FLAG_TRACE;
Damjan Marion067cd622018-07-11 12:47:43 +0200122 u32 thread_index = vm->thread_index;
Kingwel Xie00bff192019-03-07 01:25:32 -0500123
124 u32 n_left_from, *from;
125 u16 nexts[VLIB_FRAME_SIZE], *next;
126 vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b;
127
128 from = vlib_frame_vector_args (from_frame);
129 n_left_from = from_frame->n_vectors;
130
131 vlib_get_buffers (vm, from, bufs, n_left_from);
132 b = bufs;
133 next = nexts;
134
135 clib_memset_u16 (nexts, im->esp4_decrypt_next_index, n_left_from);
136
Matthew Smith01034be2017-05-16 11:51:18 -0500137 u64 n_bytes = 0, n_packets = 0;
Kingwel Xie00bff192019-03-07 01:25:32 -0500138 u32 n_disabled = 0, n_no_tunnel = 0;
139
140 u32 last_sw_if_index = ~0;
141 u32 last_tunnel_id = ~0;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400142 ipsec4_tunnel_key_t last_key4;
143 ipsec6_tunnel_key_t last_key6;
Kingwel Xie00bff192019-03-07 01:25:32 -0500144
Matthew Smith831fd642018-05-15 22:03:05 -0500145 vlib_combined_counter_main_t *rx_counter;
146 vlib_combined_counter_main_t *drop_counter;
Matthew Smith831fd642018-05-15 22:03:05 -0500147
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400148 if (is_ip6)
149 clib_memset (&last_key6, 0xff, sizeof (last_key6));
150 else
151 last_key4.as_u64 = ~0;
152
Matthew Smith831fd642018-05-15 22:03:05 -0500153 rx_counter = vim->combined_sw_if_counters + VNET_INTERFACE_COUNTER_RX;
154 drop_counter = vim->combined_sw_if_counters + VNET_INTERFACE_COUNTER_DROP;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700155
Kingwel Xie00bff192019-03-07 01:25:32 -0500156 while (n_left_from >= 2)
Ed Warnickecb9cada2015-12-08 15:45:58 -0700157 {
Kingwel Xie00bff192019-03-07 01:25:32 -0500158 u32 sw_if_index0, sw_if_index1;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400159 ip4_header_t *ip40, *ip41;
160 ip6_header_t *ip60, *ip61;
Kingwel Xie00bff192019-03-07 01:25:32 -0500161 esp_header_t *esp0, *esp1;
162 u32 len0, len1;
163 u16 buf_adv0, buf_adv1;
Neale Ranns4b0b0d42019-07-15 01:04:11 -0700164 u16 buf_rewind0, buf_rewind1;
Kingwel Xie00bff192019-03-07 01:25:32 -0500165 u32 tid0, tid1;
166 ipsec_tunnel_if_t *t0, *t1;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400167 ipsec4_tunnel_key_t key40, key41;
168 ipsec6_tunnel_key_t key60, key61;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700169
Kingwel Xie00bff192019-03-07 01:25:32 -0500170 if (n_left_from >= 4)
Neale Ranns77eb28f2019-03-04 14:13:14 +0000171 {
Kingwel Xie00bff192019-03-07 01:25:32 -0500172 CLIB_PREFETCH (b[2], CLIB_CACHE_LINE_BYTES, STORE);
173 CLIB_PREFETCH (b[2]->data, CLIB_CACHE_LINE_BYTES, LOAD);
174 CLIB_PREFETCH (b[3], CLIB_CACHE_LINE_BYTES, STORE);
175 CLIB_PREFETCH (b[3]->data, CLIB_CACHE_LINE_BYTES, LOAD);
176 }
Neale Ranns77eb28f2019-03-04 14:13:14 +0000177
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400178 ip40 =
179 (ip4_header_t *) (b[0]->data + vnet_buffer (b[0])->l3_hdr_offset);
180 ip41 =
181 (ip4_header_t *) (b[1]->data + vnet_buffer (b[1])->l3_hdr_offset);
Neale Ranns77eb28f2019-03-04 14:13:14 +0000182
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400183 if (is_ip6)
Kingwel Xie00bff192019-03-07 01:25:32 -0500184 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400185 ip60 = (ip6_header_t *) ip40;
186 ip61 = (ip6_header_t *) ip41;
187 esp0 = (esp_header_t *) ((u8 *) ip60 + sizeof (ip6_header_t));
188 esp1 = (esp_header_t *) ((u8 *) ip61 + sizeof (ip6_header_t));
189 buf_adv0 = sizeof (ip6_header_t);
190 buf_adv1 = sizeof (ip6_header_t);
Kingwel Xie00bff192019-03-07 01:25:32 -0500191 }
192 else
193 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400194 /* NAT UDP port 4500 case, don't advance any more */
195 if (ip40->protocol == IP_PROTOCOL_UDP)
196 {
197 esp0 =
198 (esp_header_t *) ((u8 *) ip40 + ip4_header_bytes (ip40) +
199 sizeof (udp_header_t));
200 buf_adv0 = 0;
Neale Ranns4b0b0d42019-07-15 01:04:11 -0700201 buf_rewind0 = ip4_header_bytes (ip40) + sizeof (udp_header_t);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400202 }
203 else
204 {
205 esp0 = (esp_header_t *) ((u8 *) ip40 + ip4_header_bytes (ip40));
Neale Ranns4b0b0d42019-07-15 01:04:11 -0700206 buf_rewind0 = buf_adv0 = ip4_header_bytes (ip40);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400207 }
208 /* NAT UDP port 4500 case, don't advance any more */
209 if (ip41->protocol == IP_PROTOCOL_UDP)
210 {
211 esp1 =
212 (esp_header_t *) ((u8 *) ip41 + ip4_header_bytes (ip41) +
213 sizeof (udp_header_t));
214 buf_adv1 = 0;
Neale Ranns37dab432019-07-16 00:53:22 -0700215 buf_rewind1 = ip4_header_bytes (ip41) + sizeof (udp_header_t);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400216 }
217 else
218 {
219 esp1 = (esp_header_t *) ((u8 *) ip41 + ip4_header_bytes (ip41));
Neale Ranns4b0b0d42019-07-15 01:04:11 -0700220 buf_rewind1 = buf_adv1 = ip4_header_bytes (ip41);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400221 }
Kingwel Xie00bff192019-03-07 01:25:32 -0500222 }
Neale Ranns77eb28f2019-03-04 14:13:14 +0000223
Kingwel Xie00bff192019-03-07 01:25:32 -0500224 vlib_buffer_advance (b[0], buf_adv0);
225 vlib_buffer_advance (b[1], buf_adv1);
Neale Ranns77eb28f2019-03-04 14:13:14 +0000226
Kingwel Xie00bff192019-03-07 01:25:32 -0500227 len0 = vlib_buffer_length_in_chain (vm, b[0]);
228 len1 = vlib_buffer_length_in_chain (vm, b[1]);
Neale Ranns77eb28f2019-03-04 14:13:14 +0000229
Neale Ranns41afb332019-07-16 06:19:35 -0700230 /* If the packet is too short to contain an SPI, then maybe
231 * it's a keep alive */
232 if (len0 < sizeof (esp_header_t))
233 {
234 if (esp0->spi_bytes[0] == 0xff)
235 b[0]->error = node->errors[IPSEC_IF_INPUT_ERROR_NAT_KEEPALIVE];
236 else
237 b[0]->error = node->errors[IPSEC_IF_INPUT_ERROR_TOO_SHORT];
238
239 next[0] = IPSEC_INPUT_NEXT_DROP;
240 goto pkt1;
241 }
242
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400243 if (is_ip6)
244 {
245 key60.remote_ip = ip60->src_address;
246 key60.spi = esp0->spi;
Neale Ranns77eb28f2019-03-04 14:13:14 +0000247
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400248 if (memcmp (&key60, &last_key6, sizeof (last_key6)) == 0)
Neale Ranns77eb28f2019-03-04 14:13:14 +0000249 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400250 tid0 = last_tunnel_id;
Neale Ranns77eb28f2019-03-04 14:13:14 +0000251 }
252 else
253 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400254 uword *p =
255 hash_get_mem (im->ipsec6_if_pool_index_by_key, &key60);
256 if (p)
257 {
258 tid0 = p[0];
259 last_tunnel_id = tid0;
260 clib_memcpy_fast (&last_key6, &key60, sizeof (key60));
261 }
262 else
263 {
Neale Rannsb71fa752019-04-04 12:43:36 +0000264 next[0] =
265 ipsec_ip6_if_no_tunnel (node, b[0], esp0, buf_adv0);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400266 n_no_tunnel++;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400267 goto pkt1;
268 }
269 }
270 }
271 else /* !is_ip6 */
272 {
Neale Ranns41afb332019-07-16 06:19:35 -0700273 key40.remote_ip = ip40->src_address;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400274 key40.spi = esp0->spi;
275
276 if (key40.as_u64 == last_key4.as_u64)
277 {
278 tid0 = last_tunnel_id;
279 }
280 else
281 {
282 uword *p =
283 hash_get (im->ipsec4_if_pool_index_by_key, key40.as_u64);
284 if (p)
285 {
286 tid0 = p[0];
287 last_tunnel_id = tid0;
288 last_key4.as_u64 = key40.as_u64;
289 }
290 else
291 {
Neale Rannsb71fa752019-04-04 12:43:36 +0000292 next[0] =
Neale Ranns4b0b0d42019-07-15 01:04:11 -0700293 ipsec_ip4_if_no_tunnel (node, b[0], esp0, ip40,
294 buf_rewind0);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400295 n_no_tunnel++;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400296 goto pkt1;
297 }
Kingwel Xie00bff192019-03-07 01:25:32 -0500298 }
299 }
300
301 t0 = pool_elt_at_index (im->tunnel_interfaces, tid0);
302 vnet_buffer (b[0])->ipsec.sad_index = t0->input_sa_index;
303
304 if (PREDICT_TRUE (t0->hw_if_index != ~0))
305 {
Kingwel Xie00bff192019-03-07 01:25:32 -0500306 sw_if_index0 = t0->sw_if_index;
307 vnet_buffer (b[0])->sw_if_index[VLIB_RX] = sw_if_index0;
308
309 if (PREDICT_FALSE (!(t0->flags & VNET_HW_INTERFACE_FLAG_LINK_UP)))
310 {
311 vlib_increment_combined_counter
312 (drop_counter, thread_index, sw_if_index0, 1, len0);
313 n_disabled++;
Neale Rannse524d452019-02-19 15:22:46 +0000314 b[0]->error = node->errors[IPSEC_IF_INPUT_ERROR_DISABLED];
Kingwel Xie00bff192019-03-07 01:25:32 -0500315 next[0] = IPSEC_INPUT_NEXT_DROP;
316 goto pkt1;
Neale Ranns77eb28f2019-03-04 14:13:14 +0000317 }
318
Kingwel Xie00bff192019-03-07 01:25:32 -0500319 if (PREDICT_TRUE (sw_if_index0 == last_sw_if_index))
Neale Ranns77eb28f2019-03-04 14:13:14 +0000320 {
Kingwel Xie00bff192019-03-07 01:25:32 -0500321 n_packets++;
322 n_bytes += len0;
Neale Ranns77eb28f2019-03-04 14:13:14 +0000323 }
324 else
325 {
Kingwel Xie00bff192019-03-07 01:25:32 -0500326 if (n_packets)
327 {
328 vlib_increment_combined_counter
329 (rx_counter, thread_index, last_sw_if_index,
330 n_packets, n_bytes);
331 }
332
333 last_sw_if_index = sw_if_index0;
334 n_packets = 1;
335 n_bytes = len0;
336 }
337 }
Kingwel Xie00bff192019-03-07 01:25:32 -0500338
339 pkt1:
Neale Ranns41afb332019-07-16 06:19:35 -0700340
341 if (len1 < sizeof (esp_header_t))
342 {
343 if (esp0->spi_bytes[0] == 0xff)
344 b[1]->error = node->errors[IPSEC_IF_INPUT_ERROR_NAT_KEEPALIVE];
345 else
346 b[1]->error = node->errors[IPSEC_IF_INPUT_ERROR_TOO_SHORT];
347
348 next[1] = IPSEC_INPUT_NEXT_DROP;
349 goto trace1;
350 }
351
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400352 if (is_ip6)
Kingwel Xie00bff192019-03-07 01:25:32 -0500353 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400354 key61.remote_ip = ip61->src_address;
355 key61.spi = esp1->spi;
356
357 if (memcmp (&key61, &last_key6, sizeof (last_key6)) == 0)
Kingwel Xie00bff192019-03-07 01:25:32 -0500358 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400359 tid1 = last_tunnel_id;
Kingwel Xie00bff192019-03-07 01:25:32 -0500360 }
361 else
362 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400363 uword *p =
364 hash_get_mem (im->ipsec6_if_pool_index_by_key, &key61);
365 if (p)
366 {
367 tid1 = p[0];
368 last_tunnel_id = tid1;
369 clib_memcpy_fast (&last_key6, &key61, sizeof (key61));
370 }
371 else
372 {
Neale Rannsb71fa752019-04-04 12:43:36 +0000373 next[1] =
374 ipsec_ip6_if_no_tunnel (node, b[1], esp1, buf_adv1);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400375 n_no_tunnel++;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400376 goto trace1;
377 }
378 }
379 }
380 else /* !is_ip6 */
381 {
Neale Ranns41afb332019-07-16 06:19:35 -0700382 key41.remote_ip = ip41->src_address;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400383 key41.spi = esp1->spi;
384
385 if (key41.as_u64 == last_key4.as_u64)
386 {
387 tid1 = last_tunnel_id;
388 }
389 else
390 {
391 uword *p =
392 hash_get (im->ipsec4_if_pool_index_by_key, key41.as_u64);
393 if (p)
394 {
395 tid1 = p[0];
396 last_tunnel_id = tid1;
397 last_key4.as_u64 = key41.as_u64;
398 }
399 else
400 {
Neale Rannsb71fa752019-04-04 12:43:36 +0000401 next[1] =
Neale Ranns4b0b0d42019-07-15 01:04:11 -0700402 ipsec_ip4_if_no_tunnel (node, b[1], esp1, ip41,
403 buf_rewind1);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400404 n_no_tunnel++;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400405 goto trace1;
406 }
Kingwel Xie00bff192019-03-07 01:25:32 -0500407 }
408 }
409
410 t1 = pool_elt_at_index (im->tunnel_interfaces, tid1);
411 vnet_buffer (b[1])->ipsec.sad_index = t1->input_sa_index;
412
413 if (PREDICT_TRUE (t1->hw_if_index != ~0))
414 {
Kingwel Xie00bff192019-03-07 01:25:32 -0500415 sw_if_index1 = t1->sw_if_index;
416 vnet_buffer (b[1])->sw_if_index[VLIB_RX] = sw_if_index1;
417
418 if (PREDICT_FALSE (!(t1->flags & VNET_HW_INTERFACE_FLAG_LINK_UP)))
419 {
420 vlib_increment_combined_counter
421 (drop_counter, thread_index, sw_if_index1, 1, len1);
422 n_disabled++;
Neale Rannse524d452019-02-19 15:22:46 +0000423 b[1]->error = node->errors[IPSEC_IF_INPUT_ERROR_DISABLED];
Kingwel Xie00bff192019-03-07 01:25:32 -0500424 next[1] = IPSEC_INPUT_NEXT_DROP;
425 goto trace1;
Neale Ranns77eb28f2019-03-04 14:13:14 +0000426 }
427
Kingwel Xie00bff192019-03-07 01:25:32 -0500428 if (PREDICT_TRUE (sw_if_index1 == last_sw_if_index))
429 {
430 n_packets++;
431 n_bytes += len1;
432 }
433 else
434 {
435 if (n_packets)
436 {
437 vlib_increment_combined_counter
438 (rx_counter, thread_index, last_sw_if_index,
439 n_packets, n_bytes);
440 }
441
442 last_sw_if_index = sw_if_index1;
443 n_packets = 1;
444 n_bytes = len1;
445 }
446 }
Kingwel Xie00bff192019-03-07 01:25:32 -0500447
448 trace1:
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400449 if (PREDICT_FALSE (is_trace))
Kingwel Xie00bff192019-03-07 01:25:32 -0500450 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400451 if (b[0]->flags & VLIB_BUFFER_IS_TRACED)
Neale Ranns77eb28f2019-03-04 14:13:14 +0000452 {
453 ipsec_if_input_trace_t *tr =
Kingwel Xie00bff192019-03-07 01:25:32 -0500454 vlib_add_trace (vm, node, b[0], sizeof (*tr));
Neale Ranns41afb332019-07-16 06:19:35 -0700455 if (is_ip6)
456 clib_memcpy (&tr->key6, &key60, sizeof (tr->key6));
457 else
458 clib_memcpy (&tr->key4, &key40, sizeof (tr->key4));
459 tr->is_ip6 = is_ip6;
Neale Ranns77eb28f2019-03-04 14:13:14 +0000460 tr->seq = clib_host_to_net_u32 (esp0->seq);
461 }
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400462 if (b[1]->flags & VLIB_BUFFER_IS_TRACED)
Neale Ranns77eb28f2019-03-04 14:13:14 +0000463 {
464 ipsec_if_input_trace_t *tr =
Kingwel Xie00bff192019-03-07 01:25:32 -0500465 vlib_add_trace (vm, node, b[1], sizeof (*tr));
Neale Ranns41afb332019-07-16 06:19:35 -0700466 if (is_ip6)
467 clib_memcpy (&tr->key6, &key61, sizeof (tr->key6));
468 else
469 clib_memcpy (&tr->key4, &key41, sizeof (tr->key4));
470 tr->is_ip6 = is_ip6;
Neale Ranns77eb28f2019-03-04 14:13:14 +0000471 tr->seq = clib_host_to_net_u32 (esp1->seq);
472 }
Neale Ranns77eb28f2019-03-04 14:13:14 +0000473 }
Kingwel Xie00bff192019-03-07 01:25:32 -0500474
475 /* next */
476 b += 2;
477 next += 2;
478 n_left_from -= 2;
479 }
480 while (n_left_from > 0)
481 {
482 u32 sw_if_index0;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400483 ip4_header_t *ip40;
484 ip6_header_t *ip60;
Kingwel Xie00bff192019-03-07 01:25:32 -0500485 esp_header_t *esp0;
486 u32 len0;
Neale Rannsa6bee0a2019-06-14 01:13:25 -0700487 u16 buf_adv0, buf_rewind0;
Kingwel Xie00bff192019-03-07 01:25:32 -0500488 u32 tid0;
489 ipsec_tunnel_if_t *t0;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400490 ipsec4_tunnel_key_t key40;
491 ipsec6_tunnel_key_t key60;
Kingwel Xie00bff192019-03-07 01:25:32 -0500492
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400493 ip40 =
494 (ip4_header_t *) (b[0]->data + vnet_buffer (b[0])->l3_hdr_offset);
Kingwel Xie00bff192019-03-07 01:25:32 -0500495
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400496 if (is_ip6)
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -0700497 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400498 ip60 = (ip6_header_t *) ip40;
499 esp0 = (esp_header_t *) ((u8 *) ip60 + sizeof (ip6_header_t));
500 buf_adv0 = sizeof (ip6_header_t);
Kingwel Xie00bff192019-03-07 01:25:32 -0500501 }
502 else
503 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400504 /* NAT UDP port 4500 case, don't advance any more */
505 if (ip40->protocol == IP_PROTOCOL_UDP)
506 {
507 esp0 =
508 (esp_header_t *) ((u8 *) ip40 + ip4_header_bytes (ip40) +
509 sizeof (udp_header_t));
510 buf_adv0 = 0;
Neale Rannsa6bee0a2019-06-14 01:13:25 -0700511 buf_rewind0 = ip4_header_bytes (ip40) + sizeof (udp_header_t);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400512 }
513 else
514 {
515 esp0 = (esp_header_t *) ((u8 *) ip40 + ip4_header_bytes (ip40));
Neale Rannsa6bee0a2019-06-14 01:13:25 -0700516 buf_rewind0 = buf_adv0 = ip4_header_bytes (ip40);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400517 }
Kingwel Xie00bff192019-03-07 01:25:32 -0500518 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700519
Kingwel Xie00bff192019-03-07 01:25:32 -0500520 /* stats for the tunnel include all the data after the IP header
521 just like a norml IP-IP tunnel */
522 vlib_buffer_advance (b[0], buf_adv0);
523 len0 = vlib_buffer_length_in_chain (vm, b[0]);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700524
Neale Ranns41afb332019-07-16 06:19:35 -0700525 if (len0 < sizeof (esp_header_t))
526 {
527 if (esp0->spi_bytes[0] == 0xff)
528 b[0]->error = node->errors[IPSEC_IF_INPUT_ERROR_NAT_KEEPALIVE];
529 else
530 b[0]->error = node->errors[IPSEC_IF_INPUT_ERROR_TOO_SHORT];
531
532 next[0] = IPSEC_INPUT_NEXT_DROP;
533 goto trace00;
534 }
535
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400536 if (is_ip6)
Kingwel Xie00bff192019-03-07 01:25:32 -0500537 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400538 key60.remote_ip = ip60->src_address;
539 key60.spi = esp0->spi;
540
541 if (memcmp (&key60, &last_key6, sizeof (last_key6)) == 0)
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -0700542 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400543 tid0 = last_tunnel_id;
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -0700544 }
Neale Ranns8d7c5022019-02-06 01:41:05 -0800545 else
546 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400547 uword *p =
548 hash_get_mem (im->ipsec6_if_pool_index_by_key, &key60);
549 if (p)
550 {
551 tid0 = p[0];
552 last_tunnel_id = tid0;
553 clib_memcpy_fast (&last_key6, &key60, sizeof (key60));
554 }
555 else
556 {
Neale Rannsb71fa752019-04-04 12:43:36 +0000557 next[0] =
558 ipsec_ip6_if_no_tunnel (node, b[0], esp0, buf_adv0);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400559 n_no_tunnel++;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400560 goto trace00;
561 }
562 }
563 }
564 else /* !is_ip6 */
565 {
Neale Ranns41afb332019-07-16 06:19:35 -0700566 key40.remote_ip = ip40->src_address;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400567 key40.spi = esp0->spi;
568
569 if (key40.as_u64 == last_key4.as_u64)
570 {
571 tid0 = last_tunnel_id;
572 }
573 else
574 {
575 uword *p =
576 hash_get (im->ipsec4_if_pool_index_by_key, key40.as_u64);
577 if (p)
578 {
579 tid0 = p[0];
580 last_tunnel_id = tid0;
581 last_key4.as_u64 = key40.as_u64;
582 }
583 else
584 {
Neale Rannsb71fa752019-04-04 12:43:36 +0000585 next[0] =
Neale Rannsa6bee0a2019-06-14 01:13:25 -0700586 ipsec_ip4_if_no_tunnel (node, b[0], esp0, ip40,
587 buf_rewind0);
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400588 n_no_tunnel++;
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400589 goto trace00;
590 }
Kingwel Xie00bff192019-03-07 01:25:32 -0500591 }
592 }
593
594 t0 = pool_elt_at_index (im->tunnel_interfaces, tid0);
595 vnet_buffer (b[0])->ipsec.sad_index = t0->input_sa_index;
596
597 if (PREDICT_TRUE (t0->hw_if_index != ~0))
598 {
Kingwel Xie00bff192019-03-07 01:25:32 -0500599 sw_if_index0 = t0->sw_if_index;
600 vnet_buffer (b[0])->sw_if_index[VLIB_RX] = sw_if_index0;
601
602 if (PREDICT_FALSE (!(t0->flags & VNET_HW_INTERFACE_FLAG_LINK_UP)))
603 {
604 vlib_increment_combined_counter
605 (drop_counter, thread_index, sw_if_index0, 1, len0);
606 n_disabled++;
Neale Rannse524d452019-02-19 15:22:46 +0000607 b[0]->error = node->errors[IPSEC_IF_INPUT_ERROR_DISABLED];
Kingwel Xie00bff192019-03-07 01:25:32 -0500608 next[0] = IPSEC_INPUT_NEXT_DROP;
609 goto trace00;
Neale Ranns8d7c5022019-02-06 01:41:05 -0800610 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700611
Kingwel Xie00bff192019-03-07 01:25:32 -0500612 if (PREDICT_TRUE (sw_if_index0 == last_sw_if_index))
613 {
614 n_packets++;
615 n_bytes += len0;
616 }
617 else
618 {
619 if (n_packets)
620 {
621 vlib_increment_combined_counter
622 (rx_counter, thread_index, last_sw_if_index,
623 n_packets, n_bytes);
624 }
625
626 last_sw_if_index = sw_if_index0;
627 n_packets = 1;
628 n_bytes = len0;
629 }
630 }
Kingwel Xie00bff192019-03-07 01:25:32 -0500631
632 trace00:
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400633 if (PREDICT_FALSE (is_trace))
Kingwel Xie00bff192019-03-07 01:25:32 -0500634 {
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400635 if (b[0]->flags & VLIB_BUFFER_IS_TRACED)
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -0700636 {
637 ipsec_if_input_trace_t *tr =
Kingwel Xie00bff192019-03-07 01:25:32 -0500638 vlib_add_trace (vm, node, b[0], sizeof (*tr));
Neale Ranns41afb332019-07-16 06:19:35 -0700639 if (is_ip6)
640 clib_memcpy (&tr->key6, &key60, sizeof (tr->key6));
641 else
642 clib_memcpy (&tr->key4, &key40, sizeof (tr->key4));
643 tr->is_ip6 = is_ip6;
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -0700644 tr->seq = clib_host_to_net_u32 (esp0->seq);
645 }
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -0700646 }
Kingwel Xie00bff192019-03-07 01:25:32 -0500647
648 /* next */
649 b += 1;
650 next += 1;
651 n_left_from -= 1;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700652 }
653
Kingwel Xie00bff192019-03-07 01:25:32 -0500654 if (n_packets)
Matthew Smith01034be2017-05-16 11:51:18 -0500655 {
Matthew Smith831fd642018-05-15 22:03:05 -0500656 vlib_increment_combined_counter (rx_counter,
Matthew Smith01034be2017-05-16 11:51:18 -0500657 thread_index,
658 last_sw_if_index, n_packets, n_bytes);
659 }
660
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400661 vlib_node_increment_counter (vm, node->node_index,
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -0700662 IPSEC_IF_INPUT_ERROR_RX,
Neale Rannse524d452019-02-19 15:22:46 +0000663 from_frame->n_vectors - (n_disabled +
664 n_no_tunnel));
Kingwel Xie00bff192019-03-07 01:25:32 -0500665
666 vlib_buffer_enqueue_to_next (vm, node, from, nexts, from_frame->n_vectors);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700667
668 return from_frame->n_vectors;
669}
670
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400671VLIB_NODE_FN (ipsec4_if_input_node) (vlib_main_t * vm,
672 vlib_node_runtime_t * node,
673 vlib_frame_t * from_frame)
Kingwel Xie00bff192019-03-07 01:25:32 -0500674{
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400675 return ipsec_if_input_inline (vm, node, from_frame, 0 /* is_ip6 */ );
Kingwel Xie00bff192019-03-07 01:25:32 -0500676}
677
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -0700678/* *INDENT-OFF* */
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400679VLIB_REGISTER_NODE (ipsec4_if_input_node) = {
680 .name = "ipsec4-if-input",
Ed Warnickecb9cada2015-12-08 15:45:58 -0700681 .vector_size = sizeof (u32),
682 .format_trace = format_ipsec_if_input_trace,
683 .type = VLIB_NODE_TYPE_INTERNAL,
Ed Warnickecb9cada2015-12-08 15:45:58 -0700684 .n_errors = ARRAY_LEN(ipsec_if_input_error_strings),
685 .error_strings = ipsec_if_input_error_strings,
Pierre Pfister057b3562018-12-10 17:01:01 +0100686 .sibling_of = "ipsec4-input-feature",
Damjan Marion1c80e832016-05-11 23:07:18 +0200687};
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -0700688/* *INDENT-ON* */
Damjan Marion1c80e832016-05-11 23:07:18 +0200689
Kingwel Xie1ba5bc82019-03-20 07:21:58 -0400690VLIB_NODE_FN (ipsec6_if_input_node) (vlib_main_t * vm,
691 vlib_node_runtime_t * node,
692 vlib_frame_t * from_frame)
693{
694 return ipsec_if_input_inline (vm, node, from_frame, 1 /* is_ip6 */ );
695}
696
697/* *INDENT-OFF* */
698VLIB_REGISTER_NODE (ipsec6_if_input_node) = {
699 .name = "ipsec6-if-input",
700 .vector_size = sizeof (u32),
701 .format_trace = format_ipsec_if_input_trace,
702 .type = VLIB_NODE_TYPE_INTERNAL,
703 .n_errors = ARRAY_LEN(ipsec_if_input_error_strings),
704 .error_strings = ipsec_if_input_error_strings,
705 .sibling_of = "ipsec6-input-feature",
706};
707/* *INDENT-ON* */
708
Keith Burns (alagalah)166a9d42016-08-06 11:00:56 -0700709/*
710 * fd.io coding-style-patch-verification: ON
711 *
712 * Local Variables:
713 * eval: (c-set-style "gnu")
714 * End:
715 */