25 #define ESP_SEQ_MAX (4294967295UL) 27 #define foreach_esp_encrypt_next \ 28 _(DROP, "error-drop") \ 29 _(IP4_INPUT, "ip4-input") \ 30 _(IP6_INPUT, "ip6-input") \ 31 _(INTERFACE_OUTPUT, "interface-output") 33 #define _(v, s) ESP_ENCRYPT_NEXT_##v, 41 #define foreach_esp_encrypt_error \ 42 _(RX_PKTS, "ESP pkts received") \ 43 _(NO_BUFFER, "No buffer (packet dropped)") \ 44 _(DECRYPTION_FAILED, "ESP encryption failed") \ 45 _(SEQ_CYCLED, "sequence number cycled") 50 #define _(sym,str) ESP_ENCRYPT_ERROR_##sym, 57 #define _(sym,string) string, 80 s =
format (s,
"esp: spi %u seq %u crypto %U integrity %U",
89 u8 * in,
u8 * out,
size_t in_len,
u8 * key,
u8 * iv)
94 const EVP_CIPHER *cipher =
NULL;
108 EVP_EncryptInit_ex (ctx, cipher,
NULL, key, iv);
110 EVP_EncryptUpdate (ctx, out, &out_len, in, in_len);
111 EVP_EncryptFinal_ex (ctx, out + out_len, &out_len);
142 u32 n_left_from, *from, *to_next = 0, next_index;
156 ESP_ENCRYPT_ERROR_NO_BUFFER, n_left_from);
157 clib_warning (
"no enough empty buffers. discarding frame");
158 goto free_buffers_and_exit;
163 while (n_left_from > 0)
169 while (n_left_from > 0 && n_left_to_next > 0)
171 u32 i_bi0, o_bi0, next0;
175 ip4_and_esp_header_t *ih0, *oh0 = 0;
176 ip6_and_esp_header_t *ih6_0, *oh6_0 = 0;
177 uword last_empty_buffer;
184 u8 transport_mode = 0;
191 next0 = ESP_ENCRYPT_NEXT_DROP;
194 sa_index0 =
vnet_buffer (i_b0)->output_features.ipsec_sad_index;
199 clib_warning (
"sequence number counter has cycled SPI %u",
202 ESP_ENCRYPT_ERROR_SEQ_CYCLED, 1);
209 last_empty_buffer =
vec_len (empty_buffers) - 1;
210 o_bi0 = empty_buffers[last_empty_buffer];
216 empty_buffers[last_empty_buffer -
218 _vec_len (empty_buffers) = last_empty_buffer;
227 ((ih0->ip4.ip_version_and_header_length & 0xF0) == 0x60))
232 next_hdr_type = IP_PROTOCOL_IPV6;
236 oh6_0->ip6.ip_version_traffic_class_and_flow_label =
237 ih6_0->ip6.ip_version_traffic_class_and_flow_label;
238 oh6_0->ip6.protocol = IP_PROTOCOL_IPSEC_ESP;
239 oh6_0->ip6.hop_limit = 254;
240 oh6_0->ip6.src_address.as_u64[0] =
241 ih6_0->ip6.src_address.as_u64[0];
242 oh6_0->ip6.src_address.as_u64[1] =
243 ih6_0->ip6.src_address.as_u64[1];
244 oh6_0->ip6.dst_address.as_u64[0] =
245 ih6_0->ip6.dst_address.as_u64[0];
246 oh6_0->ip6.dst_address.as_u64[1] =
247 ih6_0->ip6.dst_address.as_u64[1];
248 oh6_0->esp.spi = clib_net_to_host_u32 (sa0->
spi);
249 oh6_0->esp.seq = clib_net_to_host_u32 (sa0->
seq);
250 ip_proto = ih6_0->ip6.protocol;
252 next0 = ESP_ENCRYPT_NEXT_IP6_INPUT;
258 next_hdr_type = IP_PROTOCOL_IP_IN_IP;
262 oh0->ip4.ip_version_and_header_length = 0x45;
263 oh0->ip4.tos = ih0->ip4.tos;
264 oh0->ip4.fragment_id = 0;
265 oh0->ip4.flags_and_fragment_offset = 0;
267 oh0->ip4.protocol = IP_PROTOCOL_IPSEC_ESP;
268 oh0->ip4.src_address.as_u32 = ih0->ip4.src_address.as_u32;
269 oh0->ip4.dst_address.as_u32 = ih0->ip4.dst_address.as_u32;
270 oh0->esp.spi = clib_net_to_host_u32 (sa0->
spi);
271 oh0->esp.seq = clib_net_to_host_u32 (sa0->
seq);
272 ip_proto = ih0->ip4.protocol;
274 next0 = ESP_ENCRYPT_NEXT_IP4_INPUT;
287 oh6_0->ip6.src_address.as_u64[0] =
289 oh6_0->ip6.src_address.as_u64[1] =
291 oh6_0->ip6.dst_address.as_u64[0] =
293 oh6_0->ip6.dst_address.as_u64[1] =
301 next_hdr_type = ip_proto;
309 next0 = ESP_ENCRYPT_NEXT_INTERFACE_OUTPUT;
323 const int BLOCK_SIZE = 16;
324 const int IV_SIZE = 16;
333 for (i = 0; i < pad_bytes; ++
i)
342 BLOCK_SIZE * blocks + IV_SIZE;
348 RAND_bytes (iv,
sizeof (iv));
357 IV_SIZE, BLOCK_SIZE * blocks,
373 oh6_0->ip6.payload_length =
404 to_next, n_left_to_next, o_bi0,
410 ESP_ENCRYPT_ERROR_RX_PKTS,
413 free_buffers_and_exit:
424 .name =
"esp-encrypt",
425 .vector_size =
sizeof (
u32),
434 #define _(s,n) [ESP_ENCRYPT_NEXT_##s] = n,
#define foreach_esp_encrypt_next
void vlib_put_next_frame(vlib_main_t *vm, vlib_node_runtime_t *r, u32 next_index, u32 n_vectors_left)
Release pointer to next frame vector data.
sll srl srl sll sra u16x4 i
ip46_address_t tunnel_src_addr
vlib_node_registration_t esp_encrypt_node
(constructor) VLIB_REGISTER_NODE (esp_encrypt_node)
static vlib_cli_command_t trace
(constructor) VLIB_CLI_COMMAND (trace)
bad routing header type(not 4)") sr_error (NO_MORE_SEGMENTS
static uword esp_encrypt_node_fn(vlib_main_t *vm, vlib_node_runtime_t *node, vlib_frame_t *from_frame)
static unsigned int hmac_calc(ipsec_integ_alg_t alg, u8 *key, int key_len, u8 *data, int data_len, u8 *signature, u8 use_esn, u32 seq_hi)
ipsec_integ_alg_t integ_alg
#define vec_add1(V, E)
Add 1 element to end of vector (unspecified alignment).
struct _vlib_node_registration vlib_node_registration_t
ipsec_integ_alg_t integ_alg
ipsec_crypto_alg_t crypto_alg
static void ipsec_alloc_empty_buffers(vlib_main_t *vm, ipsec_main_t *im)
esp_crypto_alg_t * esp_crypto_algs
static uword vlib_buffer_length_in_chain(vlib_main_t *vm, vlib_buffer_t *b)
Get length in bytes of the buffer chain.
i16 current_data
signed offset in data[], pre_data[] that we are currently processing.
#define vlib_prefetch_buffer_with_index(vm, bi, type)
Prefetch buffer metadata by buffer index The first 64 bytes of buffer contains most header informatio...
static void * vlib_buffer_get_current(vlib_buffer_t *b)
Get pointer to current data to process.
#define clib_warning(format, args...)
u8 * format_ipsec_integ_alg(u8 *s, va_list *args)
static void esp_encrypt_aes_cbc(ipsec_crypto_alg_t alg, u8 *in, u8 *out, size_t in_len, u8 *key, u8 *iv)
#define pool_elt_at_index(p, i)
Returns pointer to element at given index.
EVP_CIPHER_CTX encrypt_ctx
u16 current_length
Nbytes between current data and the end of this buffer.
uword os_get_cpu_number(void)
static void vlib_buffer_reset(vlib_buffer_t *b)
Reset current header & length to state they were in when packet was received.
#define vlib_validate_buffer_enqueue_x1(vm, node, next_index, to_next, n_left_to_next, bi0, next0)
Finish enqueueing one buffer forward in the graph.
#define vlib_get_next_frame(vm, node, next_index, vectors, n_vectors_left)
Get pointer to next frame vector data by (vlib_node_runtime_t, next_index).
static void vlib_node_increment_counter(vlib_main_t *vm, u32 node_index, u32 counter_index, u64 increment)
ip46_address_t tunnel_dst_addr
#define vec_free(V)
Free vector's memory (no header).
static u8 * format_esp_encrypt_trace(u8 *s, va_list *args)
#define BUFFER_OUTPUT_FEAT_DONE
#define clib_memcpy(a, b, c)
static void vlib_buffer_advance(vlib_buffer_t *b, word l)
Advance current data pointer by the supplied (signed!) amount.
#define VLIB_BUFFER_TOTAL_LENGTH_VALID
static char * esp_encrypt_error_strings[]
void vlib_buffer_free(vlib_main_t *vm, u32 *buffers, u32 n_buffers)
Free buffers Frees the entire buffer chain for each buffer.
#define VLIB_BUFFER_IS_TRACED
static void * vlib_add_trace(vlib_main_t *vm, vlib_node_runtime_t *r, vlib_buffer_t *b, u32 n_data_bytes)
#define foreach_esp_encrypt_error
ipsec_crypto_alg_t last_encrypt_alg
static int esp_seq_advance(ipsec_sa_t *sa)
#define vec_len(v)
Number of elements in vector (rvalue-only, NULL tolerant)
static void * vlib_frame_vector_args(vlib_frame_t *f)
Get pointer to frame vector data.
#define VLIB_NODE_FUNCTION_MULTIARCH(node, fn)
ipsec_crypto_alg_t crypto_alg
#define VLIB_REGISTER_NODE(x,...)
u32 flags
buffer flags: VLIB_BUFFER_IS_TRACED: trace this buffer.
u8 * format_ipsec_crypto_alg(u8 *s, va_list *args)
esp_main_per_thread_data_t * per_thread_data
static vlib_buffer_t * vlib_get_buffer(vlib_main_t *vm, u32 buffer_index)
Translate buffer index into buffer pointer.
u32 trace_index
Specifies index into trace buffer if VLIB_PACKET_IS_TRACED flag is set.
static u16 ip4_header_checksum(ip4_header_t *i)