27 #define foreach_esp_encrypt_next \ 28 _(DROP, "error-drop") \ 29 _(IP4_LOOKUP, "ip4-lookup") \ 30 _(IP6_LOOKUP, "ip6-lookup") \ 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)
93 #if OPENSSL_VERSION_NUMBER >= 0x10100000L 98 const EVP_CIPHER *cipher =
NULL;
114 EVP_EncryptInit_ex (ctx, cipher,
NULL, key, iv);
116 EVP_EncryptUpdate (ctx, out, &out_len, in, in_len);
117 EVP_EncryptFinal_ex (ctx, out + out_len, &out_len);
124 u32 n_left_from, *from, *to_next = 0, next_index;
139 ESP_ENCRYPT_ERROR_NO_BUFFER, n_left_from);
140 clib_warning (
"no enough empty buffers. discarding frame");
141 goto free_buffers_and_exit;
146 while (n_left_from > 0)
152 while (n_left_from > 0 && n_left_to_next > 0)
154 u32 i_bi0, o_bi0, next0;
158 ip4_and_esp_header_t *ih0, *oh0 = 0;
159 ip6_and_esp_header_t *ih6_0, *oh6_0 = 0;
160 uword last_empty_buffer;
167 u8 transport_mode = 0;
174 next0 = ESP_ENCRYPT_NEXT_DROP;
182 clib_warning (
"sequence number counter has cycled SPI %u",
185 ESP_ENCRYPT_ERROR_SEQ_CYCLED, 1);
196 last_empty_buffer =
vec_len (empty_buffers) - 1;
197 o_bi0 = empty_buffers[last_empty_buffer];
203 empty_buffers[last_empty_buffer -
205 _vec_len (empty_buffers) = last_empty_buffer;
214 ((ih0->ip4.ip_version_and_header_length & 0xF0) == 0x60))
219 next_hdr_type = IP_PROTOCOL_IPV6;
223 oh6_0->ip6.ip_version_traffic_class_and_flow_label =
224 ih6_0->ip6.ip_version_traffic_class_and_flow_label;
225 oh6_0->ip6.protocol = IP_PROTOCOL_IPSEC_ESP;
226 oh6_0->ip6.hop_limit = 254;
227 oh6_0->ip6.src_address.as_u64[0] =
228 ih6_0->ip6.src_address.as_u64[0];
229 oh6_0->ip6.src_address.as_u64[1] =
230 ih6_0->ip6.src_address.as_u64[1];
231 oh6_0->ip6.dst_address.as_u64[0] =
232 ih6_0->ip6.dst_address.as_u64[0];
233 oh6_0->ip6.dst_address.as_u64[1] =
234 ih6_0->ip6.dst_address.as_u64[1];
235 oh6_0->esp.spi = clib_net_to_host_u32 (sa0->
spi);
236 oh6_0->esp.seq = clib_net_to_host_u32 (sa0->
seq);
237 ip_proto = ih6_0->ip6.protocol;
239 next0 = ESP_ENCRYPT_NEXT_IP6_LOOKUP;
245 next_hdr_type = IP_PROTOCOL_IP_IN_IP;
249 oh0->ip4.ip_version_and_header_length = 0x45;
250 oh0->ip4.tos = ih0->ip4.tos;
251 oh0->ip4.fragment_id = 0;
252 oh0->ip4.flags_and_fragment_offset = 0;
254 oh0->ip4.protocol = IP_PROTOCOL_IPSEC_ESP;
255 oh0->ip4.src_address.as_u32 = ih0->ip4.src_address.as_u32;
256 oh0->ip4.dst_address.as_u32 = ih0->ip4.dst_address.as_u32;
257 oh0->esp.spi = clib_net_to_host_u32 (sa0->
spi);
258 oh0->esp.seq = clib_net_to_host_u32 (sa0->
seq);
259 ip_proto = ih0->ip4.protocol;
261 next0 = ESP_ENCRYPT_NEXT_IP4_LOOKUP;
274 oh6_0->ip6.src_address.as_u64[0] =
276 oh6_0->ip6.src_address.as_u64[1] =
278 oh6_0->ip6.dst_address.as_u64[0] =
280 oh6_0->ip6.dst_address.as_u64[1] =
287 next_hdr_type = ip_proto;
298 next0 = ESP_ENCRYPT_NEXT_INTERFACE_OUTPUT;
310 const int BLOCK_SIZE =
322 for (i = 0; i < pad_bytes; ++
i)
331 BLOCK_SIZE * blocks + IV_SIZE;
337 ipsec_proto_main_crypto_algs[sa0->
crypto_alg].iv_size];
338 RAND_bytes (iv,
sizeof (iv));
349 IV_SIZE, BLOCK_SIZE * blocks,
365 oh6_0->ip6.payload_length =
396 to_next, n_left_to_next, o_bi0,
402 ESP_ENCRYPT_ERROR_RX_PKTS,
405 free_buffers_and_exit:
416 .name =
"esp-encrypt",
417 .vector_size =
sizeof (
u32),
426 #define _(s,n) [ESP_ENCRYPT_NEXT_##s] = n,
sll srl srl sll sra u16x4 i
ip46_address_t tunnel_src_addr
static void vlib_buffer_reset(vlib_buffer_t *b)
Reset current header & length to state they were in when packet was received.
static void vlib_buffer_free(vlib_main_t *vm, u32 *buffers, u32 n_buffers)
Free buffers Frees the entire buffer chain for each buffer.
static vlib_cli_command_t trace
(constructor) VLIB_CLI_COMMAND (trace)
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
static u8 * format_esp_encrypt_trace(u8 *s, va_list *args)
ipsec_integ_alg_t integ_alg
ipsec_crypto_alg_t crypto_alg
static uword vlib_buffer_length_in_chain(vlib_main_t *vm, vlib_buffer_t *b)
Get length in bytes of the buffer chain.
ipsec_proto_main_crypto_alg_t * ipsec_proto_main_crypto_algs
ipsec_proto_main_t ipsec_proto_main
static int esp_seq_advance(ipsec_sa_t *sa)
i16 current_data
signed offset in data[], pre_data[] that we are currently processing.
#define foreach_esp_encrypt_next
#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...
vlib_node_registration_t esp_encrypt_node
(constructor) VLIB_REGISTER_NODE (esp_encrypt_node)
#define VLIB_BUFFER_TOTAL_LENGTH_VALID
u8 * format_ipsec_crypto_alg(u8 *s, va_list *args)
ipsec_proto_main_per_thread_data_t * per_thread_data
#define pool_elt_at_index(p, i)
Returns pointer to element at given index.
u16 current_length
Nbytes between current data and the end of this buffer.
static void * vlib_buffer_get_current(vlib_buffer_t *b)
Get pointer to current data to process.
ipsec_crypto_alg_t last_encrypt_alg
#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 char * esp_encrypt_error_strings[]
static void vlib_node_increment_counter(vlib_main_t *vm, u32 node_index, u32 counter_index, u64 increment)
ip46_address_t tunnel_dst_addr
static_always_inline uword vlib_get_thread_index(void)
#define vec_free(V)
Free vector's memory (no header).
#define clib_warning(format, args...)
#define VLIB_BUFFER_IS_TRACED
#define clib_memcpy(a, b, c)
static void ipsec_alloc_empty_buffers(vlib_main_t *vm, ipsec_main_t *im)
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.
static void esp_encrypt_cbc(ipsec_crypto_alg_t alg, u8 *in, u8 *out, size_t in_len, u8 *key, u8 *iv)
u16 cached_next_index
Next frame index that vector arguments were last enqueued to last time this node ran.
static void vlib_buffer_advance(vlib_buffer_t *b, word l)
Advance current data pointer by the supplied (signed!) amount.
EVP_CIPHER_CTX encrypt_ctx
static void * vlib_add_trace(vlib_main_t *vm, vlib_node_runtime_t *r, vlib_buffer_t *b, u32 n_data_bytes)
u8 * format_ipsec_integ_alg(u8 *s, va_list *args)
#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_FREE_LIST_INDEX_MASK: bits used to store free list index, VLIB_BUFFER_IS_TRACED: trace this buffer.
#define foreach_esp_encrypt_error
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)