2 * ipsec_output.c : IPSec output node
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:
9 * http://www.apache.org/licenses/LICENSE-2.0
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.
18 #include <vnet/vnet.h>
19 #include <vnet/api_errno.h>
20 #include <vnet/ip/ip.h>
22 #include <vnet/ipsec/ipsec.h>
25 #define foreach_ipsec_output_next \
26 _(DROP, "error-drop") \
27 _(ESP_ENCRYPT, "esp-encrypt")
29 #define _(v, s) IPSEC_OUTPUT_NEXT_##v,
31 foreach_intf_output_feat
32 foreach_ipsec_output_next
35 } ipsec_output_next_t;
38 #define foreach_ipsec_output_error \
39 _(RX_PKTS, "IPSec pkts received") \
40 _(POLICY_DISCARD, "IPSec policy discard") \
41 _(POLICY_NO_MATCH, "IPSec policy (no match)") \
42 _(POLICY_PROTECT, "IPSec policy protect") \
43 _(POLICY_BYPASS, "IPSec policy bypass") \
44 _(ENCAPS_FAILED, "IPSec encapsulation failed")
48 #define _(sym,str) IPSEC_OUTPUT_ERROR_##sym,
49 foreach_ipsec_output_error
52 } ipsec_output_error_t;
54 static char * ipsec_output_error_strings[] = {
55 #define _(sym,string) string,
56 foreach_ipsec_output_error
60 vlib_node_registration_t ipsec_output_node;
64 } ipsec_output_trace_t;
66 /* packet trace format function */
67 static u8 * format_ipsec_output_trace (u8 * s, va_list * args)
69 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
70 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
71 ipsec_output_trace_t * t = va_arg (*args, ipsec_output_trace_t *);
75 s = format (s, "spd %u ", t->spd_id);
79 s = format (s, "no spd");
84 always_inline intf_output_feat_t
85 get_next_intf_output_feature_and_reset_bit(vlib_buffer_t *b)
88 count_trailing_zeros(next_feature, vnet_buffer(b)->output_features.bitmap);
89 if (next_feature != INTF_OUTPUT_FEAT_DONE)
90 vnet_buffer(b)->output_features.bitmap &= ~(1 << next_feature);
94 always_inline ipsec_policy_t *
95 ipsec_output_policy_match(ipsec_spd_t * spd, u8 pr, u32 la, u32 ra, u16 lp, u16 rp)
100 vec_foreach(i, spd->ipv4_outbound_policies)
102 p = pool_elt_at_index(spd->policies, *i);
103 if (PREDICT_FALSE(p->protocol && (p->protocol != pr)))
106 if (la < clib_net_to_host_u32(p->laddr.start.ip4.as_u32))
109 if (la > clib_net_to_host_u32(p->laddr.stop.ip4.as_u32))
112 if (ra < clib_net_to_host_u32(p->raddr.start.ip4.as_u32))
115 if (ra > clib_net_to_host_u32(p->raddr.stop.ip4.as_u32))
118 if (PREDICT_FALSE((pr != IP_PROTOCOL_TCP) && (pr != IP_PROTOCOL_UDP)))
121 if (lp < p->lport.start)
124 if (lp > p->lport.stop)
127 if (rp < p->rport.start)
130 if (rp > p->rport.stop)
139 ip6_addr_match_range (ip6_address_t * a, ip6_address_t * la, ip6_address_t * ua)
141 if ((memcmp(a->as_u64, la->as_u64, 2 * sizeof(u64)) >= 0) &&
142 (memcmp(a->as_u64, ua->as_u64, 2 * sizeof(u64)) <= 0))
147 always_inline ipsec_policy_t *
148 ipsec_output_ip6_policy_match (ipsec_spd_t * spd,
158 vec_foreach(i, spd->ipv6_outbound_policies)
160 p = pool_elt_at_index(spd->policies, *i);
161 if (PREDICT_FALSE(p->protocol && (p->protocol != pr)))
164 if (!ip6_addr_match_range(sa, &p->raddr.start.ip6, &p->raddr.stop.ip6))
167 if (!ip6_addr_match_range(da, &p->laddr.start.ip6, &p->laddr.stop.ip6))
170 if (PREDICT_FALSE((pr != IP_PROTOCOL_TCP) && (pr != IP_PROTOCOL_UDP)))
173 if (lp < p->lport.start)
176 if (lp > p->lport.stop)
179 if (rp < p->rport.start)
182 if (rp > p->rport.stop)
191 ipsec_output_node_fn (vlib_main_t * vm,
192 vlib_node_runtime_t * node,
193 vlib_frame_t * from_frame)
195 ipsec_main_t *im = &ipsec_main;
196 vnet_main_t * vnm = im->vnet_main;
198 u32 * from, * to_next = 0;
199 u32 n_left_from, sw_if_index0, last_sw_if_index = (u32) ~0;
200 u32 next_node_index = (u32)~0, last_next_node_index = (u32) ~0;
203 ipsec_spd_t * spd0 = 0;
204 u64 nc_protect = 0, nc_bypass = 0, nc_discard = 0, nc_nomatch = 0;
206 from = vlib_frame_vector_args (from_frame);
207 n_left_from = from_frame->n_vectors;
209 while (n_left_from > 0)
215 ip6_header_t * ip6_0 = 0;
220 b0 = vlib_get_buffer (vm, bi0);
221 sw_if_index0 = vnet_buffer(b0)->sw_if_index[VLIB_TX];
224 ip0 = (ip4_header_t *) ((u8 *) vlib_buffer_get_current (b0) +
225 sizeof(ethernet_header_t));
227 /* just forward non ipv4 packets */
228 if (PREDICT_FALSE((ip0->ip_version_and_header_length & 0xF0 ) != 0x40))
231 if (PREDICT_TRUE((ip0->ip_version_and_header_length & 0xF0 ) == 0x60))
234 ip6_0 = (ip6_header_t *) ((u8 *) vlib_buffer_get_current (b0) +
235 sizeof(ethernet_header_t));
239 next_node_index = get_next_output_feature_node_index(vnm, b0);
244 /* lookup for SPD only if sw_if_index is changed */
245 if (PREDICT_FALSE(last_sw_if_index != sw_if_index0))
247 uword * p = hash_get (im->spd_index_by_sw_if_index, sw_if_index0);
250 spd0 = pool_elt_at_index(im->spds, spd_index0);
251 last_sw_if_index = sw_if_index0;
256 udp0 = ip6_next_header(ip6_0);
258 clib_warning("packet received from %U port %u to %U port %u spd_id %u",
259 format_ip6_address, &ip6_0->src_address,
260 clib_net_to_host_u16(udp0->src_port),
261 format_ip6_address, &ip6_0->dst_address,
262 clib_net_to_host_u16(udp0->dst_port),
266 p0 = ipsec_output_ip6_policy_match(spd0,
269 clib_net_to_host_u16(udp0->src_port),
270 clib_net_to_host_u16(udp0->dst_port),
275 udp0 = (udp_header_t *) ((u8 *) ip0 + ip4_header_bytes (ip0));
278 clib_warning("packet received from %U to %U port %u",
279 format_ip4_address, ip0->src_address.as_u8,
280 format_ip4_address, ip0->dst_address.as_u8,
281 clib_net_to_host_u16(udp0->dst_port));
282 clib_warning("sw_if_index0 %u spd_index0 %u spd_id %u",
283 sw_if_index0, spd_index0, spd0->id);
286 p0 = ipsec_output_policy_match(spd0, ip0->protocol,
287 clib_net_to_host_u32(ip0->src_address.as_u32),
288 clib_net_to_host_u32(ip0->dst_address.as_u32),
289 clib_net_to_host_u16(udp0->src_port),
290 clib_net_to_host_u16(udp0->dst_port));
293 if (PREDICT_TRUE(p0 != NULL))
295 if (p0->policy == IPSEC_POLICY_ACTION_PROTECT)
298 next_node_index = im->esp_encrypt_node_index;
299 vnet_buffer(b0)->output_features.ipsec_sad_index = p0->sa_index;
300 vlib_buffer_advance(b0, sizeof(ethernet_header_t));
301 p0->counter.packets++;
304 p0->counter.bytes += clib_net_to_host_u16(ip6_0->payload_length);
305 p0->counter.bytes += sizeof(ip6_header_t);
309 p0->counter.bytes += clib_net_to_host_u16(ip0->length);
312 else if (p0->policy == IPSEC_POLICY_ACTION_BYPASS)
315 next_node_index = get_next_output_feature_node_index(vnm, b0);
316 p0->counter.packets++;
319 p0->counter.bytes += clib_net_to_host_u16(ip6_0->payload_length);
320 p0->counter.bytes += sizeof(ip6_header_t);
324 p0->counter.bytes += clib_net_to_host_u16(ip0->length);
330 p0->counter.packets++;
333 p0->counter.bytes += clib_net_to_host_u16(ip6_0->payload_length);
334 p0->counter.bytes += sizeof(ip6_header_t);
338 p0->counter.bytes += clib_net_to_host_u16(ip0->length);
340 next_node_index = im->error_drop_node_index;
346 next_node_index = im->error_drop_node_index;
353 if (PREDICT_FALSE((last_next_node_index != next_node_index)))
355 /* if this is not 1st frame */
357 vlib_put_frame_to_node (vm, last_next_node_index, f);
359 last_next_node_index = next_node_index;
361 f = vlib_get_frame_to_node(vm, next_node_index);
362 to_next = vlib_frame_vector_args (f);
369 if (PREDICT_FALSE(b0->flags & VLIB_BUFFER_IS_TRACED)) {
370 ipsec_output_trace_t *tr = vlib_add_trace (vm, node, b0, sizeof (*tr));
372 tr->spd_id = spd0->id;
376 vlib_put_frame_to_node (vm, next_node_index, f);
377 vlib_node_increment_counter (vm, ipsec_output_node.index,
378 IPSEC_OUTPUT_ERROR_POLICY_PROTECT, nc_protect);
379 vlib_node_increment_counter (vm, ipsec_output_node.index,
380 IPSEC_OUTPUT_ERROR_POLICY_BYPASS, nc_bypass);
381 vlib_node_increment_counter (vm, ipsec_output_node.index,
382 IPSEC_OUTPUT_ERROR_POLICY_DISCARD, nc_discard);
383 vlib_node_increment_counter (vm, ipsec_output_node.index,
384 IPSEC_OUTPUT_ERROR_POLICY_NO_MATCH, nc_nomatch);
385 return from_frame->n_vectors;
388 VLIB_REGISTER_NODE (ipsec_output_node) = {
389 .function = ipsec_output_node_fn,
390 .name = "ipsec-output",
391 .vector_size = sizeof (u32),
392 .format_trace = format_ipsec_output_trace,
393 .type = VLIB_NODE_TYPE_INTERNAL,
395 .n_errors = ARRAY_LEN(ipsec_output_error_strings),
396 .error_strings = ipsec_output_error_strings,
398 .n_next_nodes = IPSEC_OUTPUT_N_NEXT,
400 #define _(s,n) [IPSEC_OUTPUT_NEXT_##s] = n,
401 foreach_intf_output_feat
402 foreach_ipsec_output_next