/* *------------------------------------------------------------------ * Copyright (c) 2019 Cisco and/or its affiliates. * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at: * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. *------------------------------------------------------------------ */ #include #include #include #include #include #include #if __GNUC__ > 4 && !__clang__ && CLIB_DEBUG == 0 #pragma GCC optimize ("O3") #endif typedef struct { /* pre-calculated hash key values */ const u8x16 Hi[8]; /* extracted AES key */ const u8x16 Ke[15]; } aes_gcm_key_data_t; static_always_inline void aesni_gcm_load (u8x16 * d, u8x16u * inv, int n, int n_bytes) { for (int i = 0; i < n - 1; i++) d[i] = inv[i]; d[n - 1] = n_bytes ? aes_load_partial (inv + n - 1, n_bytes) : inv[n - 1]; } static_always_inline void aesni_gcm_store (u8x16 * d, u8x16u * outv, int n, int n_bytes) { for (int i = 0; i < n - 1; i++) outv[i] = d[i]; if (n_bytes & 0xf) aes_store_partial (outv + n - 1, d[n - 1], n_bytes); else outv[n - 1] = d[n - 1]; } static_always_inline void aesni_gcm_enc_first_round (u8x16 * r, u32x4 * Y, u32 * ctr, u8x16 k, int n_blocks) { static const u32x4 last_byte_one = { 0, 0, 0, 1 << 24 }; if (PREDICT_TRUE ((u8) ctr[0] < (256 - n_blocks))) { for (int i = 0; i < n_blocks; i++) { Y[0] += last_byte_one; r[i] = k ^ (u8x16) Y[0]; } ctr[0] += n_blocks; } else { for (int i = 0; i < n_blocks; i++) { Y[0][3] = clib_host_to_net_u32 (++ctr[0]); r[i] = k ^ (u8x16) Y[0]; } } } static_always_inline void aesni_gcm_enc_round (u8x16 * r, u8x16 k, int n_blocks) { for (int i = 0; i < n_blocks; i++) r[i] = aes_enc_round (r[i], k); } static_always_inline void aesni_gcm_enc_last_round (u8x16 * r, u8x16 * d, u8x16 const *k, int rounds, int n_blocks) { /* additional ronuds for AES-192 and AES-256 */ for (int i = 10; i < rounds; i++) aesni_gcm_enc_round (r, k[i], n_blocks); for (int i = 0; i < n_blocks; i++) d[i] ^= aes_enc_last_round (r[i], k[rounds]); } static_always_inline u8x16 aesni_gcm_ghash_blocks (u8x16 T, aes_gcm_key_data_t * kd, u8x16u * in, int n_blocks) { ghash_data_t _gd, *gd = &_gd; const u8x16 *Hi = kd->Hi + n_blocks - 1; ghash_mul_first (gd, u8x16_reflect (in[0]) ^ T, Hi[0]); for (int i = 1; i < n_blocks; i++) ghash_mul_next (gd, u8x16_reflect ((in[i])), Hi[-i]); ghash_reduce (gd); ghash_reduce2 (gd); return ghash_final (gd); } static_always_inline u8x16 aesni_gcm_ghash (u8x16 T, aes_gcm_key_data_t * kd, u8x16u * in, u32 n_left) { while (n_left >= 128) { T = aesni_gcm_ghash_blocks (T, kd, in, 8); n_left -= 128; in += 8; } if (n_left >= 64) { T = aesni_gcm_ghash_blocks (T, kd, in, 4); n_left -= 64; in += 4; } if (n_left >= 32) { T = aesni_gcm_ghash_blocks (T, kd, in, 2); n_left -= 32; in += 2; } if (n_left >= 16) { T = aesni_gcm_ghash_blocks (T, kd, in, 1); n_left -= 16; in += 1; } if (n_left) { u8x16 r = aes_load_partial (in, n_left); T = ghash_mul (u8x16_reflect (r) ^ T, kd->Hi[0]); } return T; } static_always_inline u8x16 aesni_gcm_calc (u8x16 T, aes_gcm_key_data_t * kd, u8x16 * d, u32x4 * Y, u32 * ctr, u8x16u * inv, u8x16u * outv, int rounds, int n, int last_block_bytes, int with_ghash, int is_encrypt) { u8x16 r[n]; ghash_data_t _gd = { }, *gd = &_gd; const u8x16 *rk = (u8x16 *) kd->Ke; int hidx = is_encrypt ? 4 : n, didx = 0; clib_prefetch_load (inv + 4); /* AES rounds 0 and 1 */ aesni_gcm_enc_first_round (r, Y, ctr, rk[0], n); aesni_gcm_enc_round (r, rk[1], n); /* load data - decrypt round */ if (is_encrypt == 0) aesni_gcm_load (d, inv, n, last_block_bytes); /* GHASH multiply block 1 */ if (with_ghash) ghash_mul_first (gd, u8x16_reflect (d[didx++]) ^ T, kd->Hi[--hidx]); /* AES rounds 2 and 3 */ aesni_gcm_enc_round (r, rk[2], n); aesni_gcm_enc_round (r, rk[3], n); /* GHASH multiply block 2 */ if (with_ghash && hidx) ghash_mul_next (gd, u8x16_reflect (d[didx++]), kd->Hi[--hidx]); /* AES rounds 4 and 5 */ aesni_gcm_enc_round (r, rk[4], n); aesni_gcm_enc_round (r, rk[5], n); /* GHASH multiply block 3 */ if (with_ghash && hidx) ghash_mul_next (gd, u8x16_reflect (d[didx++]), kd->Hi[--hidx]); /* AES rounds 6 and 7 */ aesni_gcm_enc_round (r, rk[6], n); aesni_gcm_enc_round (r, rk[7], n); /* GHASH multiply block 4 */ if (with_ghash && hidx) ghash_mul_next (gd, u8x16_reflect (d[didx++]), kd->Hi[--hidx]); /* AES rounds 8 and 9 */ aesni_gcm_enc_round (r, rk[8], n); aesni_gcm_enc_round (r, rk[9], n); /* GHASH reduce 1st step */ if (with_ghash) ghash_reduce (gd); /* load data - encrypt round */ if (is_encrypt) aesni_gcm_load (d, inv, n, last_block_bytes); /* GHASH reduce 2nd step */ if (with_ghash) ghash_reduce2 (gd); /* AES last round(s) */ aesni_gcm_enc_last_round (r, d, rk, rounds, n); /* store data */ aesni_gcm_store (d, outv, n, last_block_bytes); /* GHASH final step */ if (with_ghash) T = ghash_final (gd); return T; } static_always_inline u8x16 aesni_gcm_calc_double (u8x16 T, aes_gcm_key_data_t * kd, u8x16 * d, u32x4 * Y, u32 * ctr, u8x16u * inv, u8x16u * outv, int rounds, int is_encrypt) { u8x16 r[4]; ghash_data_t _gd, *gd = &_gd; const u8x16 *rk = (u8x16 *) kd->Ke; /* AES rounds 0 and 1 */ aesni_gcm_enc_first_round (r, Y, ctr, rk[0], 4); aesni_gcm_enc_round (r, rk[1], 4); /* load 4 blocks of data - decrypt round */ if (is_encrypt == 0) aesni_gcm_load (d, inv, 4, 0); /* GHASH multiply block 0 */ ghash_mul_first (gd, u8x16_reflect (d[0]) ^ T, kd->Hi[7]); /* AES rounds 2 and 3 */ aesni_gcm_enc_round (r, rk[2], 4); aesni_gcm_enc_round (r, rk[3], 4); /* GHASH multiply block 1 */ ghash_mul_next (gd, u8x16_reflect (d[1]), kd->Hi[6]); /* AES rounds 4 and 5 */ aesni_gcm_enc_round (r, rk[4], 4); aesni_gcm_enc_round (r, rk[5], 4); /* GHASH multiply block 2 */ ghash_mul_next (gd, u8x16_reflect (d[2]), kd->Hi[5]); /* AES rounds 6 and 7 */ aesni_gcm_enc_round (r, rk[6], 4); aesni_gcm_enc_round (r, rk[7], 4); /* GHASH multiply block 3 */ ghash_mul_next (gd, u8x16_reflect (d[3]), kd->Hi[4]); /* AES rounds 8 and 9 */ aesni_gcm_enc_round (r, rk[8], 4); aesni_gcm_enc_round (r, rk[9], 4); /* load 4 blocks of data - encrypt round */ if (is_encrypt) aesni_gcm_load (d, inv, 4, 0); /* AES last round(s) */ aesni_gcm_enc_last_round (r, d, rk, rounds, 4); /* store 4 blocks of data */ aesni_gcm_store (d, outv, 4, 0); /* load next 4 blocks of data data - decrypt round */ if (is_encrypt == 0) aesni_gcm_load (d, inv + 4, 4, 0); /* GHASH multiply block 4 */ ghash_mul_next (gd, u8x16_reflect (d[0]), kd->Hi[3]); /* AES rounds 0, 1 and 2 */ aesni_gcm_enc_first_round (r, Y, ctr, rk[0], 4); aesni_gcm_enc_round (r, rk[1], 4); aesni_gcm_enc_round (r, rk[2], 4); /* GHASH multiply block 5 */ ghash_mul_next (gd, u8x16_reflect (d[1]), kd->Hi[2]); /* AES rounds 3 and 4 */ aesni_gcm_enc_round (r, rk[3], 4); aesni_gcm_enc_round (r, rk[4], 4); /* GHASH multiply block 6 */ ghash_mul_next (gd, u8x16_reflect (d[2]), kd->Hi[1]); /* AES rounds 5 and 6 */ aesni_gcm_enc_round (r, rk[5], 4); aesni_gcm_enc_round (r, rk[6], 4); /* GHASH multiply block 7 */ ghash_mul_next (gd, u8x16_reflect (d[3]), kd->Hi[0]); /* AES rounds 7 and 8 */ aesni_gcm_enc_round (r, rk[7], 4); aesni_gcm_enc_round (r, rk[8], 4); /* GHASH reduce 1st step */ ghash_reduce (gd); /* AES round 9 */ aesni_gcm_enc_round (r, rk[9], 4); /* load data - encrypt round */ if (is_encrypt) aesni_gcm_load (d, inv + 4, 4, 0); /* GHASH reduce 2nd step */ ghash_reduce2 (gd); /* AES last round(s) */ aesni_gcm_enc_last_round (r, d, rk, rounds, 4); /* store data */ aesni_gcm_store (d, outv + 4, 4, 0); /* GHASH final step */ return ghash_final (gd); } static_always_inline u8x16 aesni_gcm_ghash_last (u8x16 T, aes_gcm_key_data_t * kd, u8x16 * d, int n_blocks, int n_bytes) { ghash_data_t _gd, *gd = &_gd; if (n_bytes) d[n_blocks - 1] = aes_byte_mask (d[n_blocks - 1], n_bytes); ghash_mul_first (gd, u8x16_reflect (d[0]) ^ T, kd->Hi[n_blocks - 1]); if (n_blocks > 1) ghash_mul_next (gd, u8x16_reflect (d[1]), kd->Hi[n_blocks - 2]); if (n_blocks > 2) ghash_mul_next (gd, u8x16_reflect (d[2]), kd->Hi[n_blocks - 3]); if (n_blocks > 3) ghash_mul_next (gd, u8x16_reflect (d[3]), kd->Hi[n_blocks - 4]); ghash_reduce (gd); ghash_reduce2 (gd); return ghash_final (gd); } static_always_inline u8x16 aesni_gcm_enc (u8x16 T, aes_gcm_key_data_t * kd, u32x4 Y, u8x16u * inv, u8x16u * outv, u32 n_left, int rounds) { u8x16 d[4]; u32 ctr = 1; if (n_left == 0) return T; if (n_left < 64) { if (n_left > 48) { n_left &= 0x0f; aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 4, n_left, /* with_ghash */ 0, /* is_encrypt */ 1); return aesni_gcm_ghash_last (T, kd, d, 4, n_left); } else if (n_left > 32) { n_left &= 0x0f; aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 3, n_left, /* with_ghash */ 0, /* is_encrypt */ 1); return aesni_gcm_ghash_last (T, kd, d, 3, n_left); } else if (n_left > 16) { n_left &= 0x0f; aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 2, n_left, /* with_ghash */ 0, /* is_encrypt */ 1); return aesni_gcm_ghash_last (T, kd, d, 2, n_left); } else { n_left &= 0x0f; aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 1, n_left, /* with_ghash */ 0, /* is_encrypt */ 1); return aesni_gcm_ghash_last (T, kd, d, 1, n_left); } } aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 4, 0, /* with_ghash */ 0, /* is_encrypt */ 1); /* next */ n_left -= 64; outv += 4; inv += 4; while (n_left >= 128) { T = aesni_gcm_calc_double (T, kd, d, &Y, &ctr, inv, outv, rounds, /* is_encrypt */ 1); /* next */ n_left -= 128; outv += 8; inv += 8; } if (n_left >= 64) { T = aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 4, 0, /* with_ghash */ 1, /* is_encrypt */ 1); /* next */ n_left -= 64; outv += 4; inv += 4; } if (n_left == 0) return aesni_gcm_ghash_last (T, kd, d, 4, 0); if (n_left > 48) { n_left &= 0x0f; T = aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 4, n_left, /* with_ghash */ 1, /* is_encrypt */ 1); return aesni_gcm_ghash_last (T, kd, d, 4, n_left); } if (n_left > 32) { n_left &= 0x0f; T = aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 3, n_left, /* with_ghash */ 1, /* is_encrypt */ 1); return aesni_gcm_ghash_last (T, kd, d, 3, n_left); } if (n_left > 16) { n_left &= 0x0f; T = aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 2, n_left, /* with_ghash */ 1, /* is_encrypt */ 1); return aesni_gcm_ghash_last (T, kd, d, 2, n_left); } n_left &= 0x0f; T = aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 1, n_left, /* with_ghash */ 1, /* is_encrypt */ 1); return aesni_gcm_ghash_last (T, kd, d, 1, n_left); } static_always_inline u8x16 aesni_gcm_dec (u8x16 T, aes_gcm_key_data_t * kd, u32x4 Y, u8x16u * inv, u8x16u * outv, u32 n_left, int rounds) { u8x16 d[8]; u32 ctr = 1; while (n_left >= 128) { T = aesni_gcm_calc_double (T, kd, d, &Y, &ctr, inv, outv, rounds, /* is_encrypt */ 0); /* next */ n_left -= 128; outv += 8; inv += 8; } if (n_left >= 64) { T = aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 4, 0, 1, 0); /* next */ n_left -= 64; outv += 4; inv += 4; } if (n_left == 0) return T; if (n_left > 48) return aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 4, n_left - 48, /* with_ghash */ 1, /* is_encrypt */ 0); if (n_left > 32) return aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 3, n_left - 32, /* with_ghash */ 1, /* is_encrypt */ 0); if (n_left > 16) return aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 2, n_left - 16, /* with_ghash */ 1, /* is_encrypt */ 0); return aesni_gcm_calc (T, kd, d, &Y, &ctr, inv, outv, rounds, 1, n_left, /* with_ghash */ 1, /* is_encrypt */ 0); } static_always_inline int aes_gcm (u8x16u * in, u8x16u * out, u8x16u * addt, u8x16u * iv, u8x16u * tag, u32 data_bytes, u32 aad_bytes, u8 tag_len, aes_gcm_key_data_t * kd, int aes_rounds, int is_encrypt) { int i; u8x16 r, T = { }; u32x4 Y0; ghash_data_t _gd, *gd = &_gd; clib_prefetch_load (iv); clib_prefetch_load (in); clib_prefetch_load (in + 4); /* calculate ghash for AAD - optimized for ipsec common cases */ if (aad_bytes == 8) T = aesni_gcm_ghash (T, kd, addt, 8); else if (aad_bytes == 12) T = aesni_gcm_ghash (T, kd, addt, 12); else T = aesni_gcm_ghash (T, kd, addt, aad_bytes); /* initalize counter */ Y0 = (u32x4) aes_load_partial (iv, 12); Y0[3] = clib_host_to_net_u32 (1); /* ghash and encrypt/edcrypt */ if (is_encrypt) T = aesni_gcm_enc (T, kd, Y0, in, out, data_bytes, aes_rounds); else T = aesni_gcm_dec (T, kd, Y0, in, out, data_bytes, aes_rounds); clib_prefetch_load (tag); /* Finalize ghash - data bytes and aad bytes converted to bits */ /* *INDENT-OFF* */ r = (u8x16) ((u64x2) {data_bytes, aad_bytes} << 3); /* *INDENT-ON* */ /* interleaved computation of final ghash and E(Y0, k) */ ghash_mul_first (gd, r ^ T, kd->Hi[0]); r = kd->Ke[0] ^ (u8x16) Y0; for (i = 1; i < 5; i += 1) r = aes_enc_round (r, kd->Ke[i]); ghash_reduce (gd); ghash_reduce2 (gd); for (; i < 9; i += 1) r = aes_enc_round (r, kd->Ke[i]); T = ghash_final (gd); for (; i < aes_rounds; i += 1) r = aes_enc_round (r, kd->Ke[i]); r = aes_enc_last_round (r, kd->Ke[aes_rounds]); T = u8x16_reflect (T) ^ r; /* tag_len 16 -> 0 */ tag_len &= 0xf; if (is_encrypt) { /* store tag */ if (tag_len) aes_store_partial (tag, T, tag_len); else tag[0] = T; } else { /* check tag */ u16 tag_mask = tag_len ? (1 << tag_len) - 1 : 0xffff; if ((u8x16_msb_mask (tag[0] == T) & tag_mask) != tag_mask) return 0; } return 1; } static_always_inline u32 aesni_ops_enc_aes_gcm (vlib_main_t * vm, vnet_crypto_op_t * ops[], u32 n_ops, aes_key_size_t ks) { crypto_native_main_t *cm = &crypto_native_main; vnet_crypto_op_t *op = ops[0]; aes_gcm_key_data_t *kd; u32 n_left = n_ops; next: kd = (aes_gcm_key_data_t *) cm->key_data[op->key_index]; aes_gcm ((u8x16u *) op->src, (u8x16u *) op->dst, (u8x16u *) op->aad, (u8x16u *) op->iv, (u8x16u *) op->tag, op->len, op->aad_len, op->tag_len, kd, AES_KEY_ROUNDS (ks), /* is_encrypt */ 1); op->status = VNET_CRYPTO_OP_STATUS_COMPLETED; if (--n_left) { op += 1; goto next; } return n_ops; } static_always_inline u32 aesni_ops_dec_aes_gcm (vlib_main_t * vm, vnet_crypto_op_t * ops[], u32 n_ops, aes_key_size_t ks) { crypto_native_main_t *cm = &crypto_native_main; vnet_crypto_op_t *op = ops[0]; aes_gcm_key_data_t *kd; u32 n_left = n_ops; int rv; next: kd = (aes_gcm_key_data_t *) cm->key_data[op->key_index]; rv = aes_gcm ((u8x16u *) op->src, (u8x16u *) op->dst, (u8x16u *) op->aad, (u8x16u *) op->iv, (u8x16u *) op->tag, op->len, op->aad_len, op->tag_len, kd, AES_KEY_ROUNDS (ks), /* is_encrypt */ 0); if (rv) { op->status = VNET_CRYPTO_OP_STATUS_COMPLETED; } else { op->status = VNET_CRYPTO_OP_STATUS_FAIL_BAD_HMAC; n_ops--; } if (--n_left) { op += 1; goto next; } return n_ops; } static_always_inline void * aesni_gcm_key_exp (vnet_crypto_key_t * key, aes_key_size_t ks) { aes_gcm_key_data_t *kd; u8x16 H; kd = clib_mem_alloc_aligned (sizeof (*kd), CLIB_CACHE_LINE_BYTES); /* expand AES key */ aes_key_expand ((u8x16 *) kd->Ke, key->data, ks); /* pre-calculate H */ H = aes_encrypt_block (u8x16_splat (0), kd->Ke, ks); H = u8x16_reflect (H); ghash_precompute (H, (u8x16 *) kd->Hi, 8); return kd; } #define foreach_aesni_gcm_handler_type _(128) _(192) _(256) #define _(x) \ static u32 aesni_ops_dec_aes_gcm_##x \ (vlib_main_t * vm, vnet_crypto_op_t * ops[], u32 n_ops) \ { return aesni_ops_dec_aes_gcm (vm, ops, n_ops, AES_KEY_##x); } \ static u32 aesni_ops_enc_aes_gcm_##x \ (vlib_main_t * vm, vnet_crypto_op_t * ops[], u32 n_ops) \ { return aesni_ops_enc_aes_gcm (vm, ops, n_ops, AES_KEY_##x); } \ static void * aesni_gcm_key_exp_##x (vnet_crypto_key_t *key) \ { return aesni_gcm_key_exp (key, AES_KEY_##x); } foreach_aesni_gcm_handler_type; #undef _ clib_error_t * #ifdef __VAES__ crypto_native_aes_gcm_init_vaes (vlib_main_t * vm) #elif __AVX512F__ crypto_native_aes_gcm_init_avx512 (vlib_main_t * vm) #elif __AVX2__ crypto_native_aes_gcm_init_avx2 (vlib_main_t * vm) #elif __aarch64__ crypto_native_aes_gcm_init_neon (vlib_main_t * vm) #else crypto_native_aes_gcm_init_sse42 (vlib_main_t * vm) #endif { crypto_native_main_t *cm = &crypto_native_main; #define _(x) \ vnet_crypto_register_ops_handler (vm, cm->crypto_engine_index, \ VNET_CRYPTO_OP_AES_##x##_GCM_ENC, \ aesni_ops_enc_aes_gcm_##x); \ vnet_crypto_register_ops_handler (vm, cm->crypto_engine_index, \ VNET_CRYPTO_OP_AES_##x##_GCM_DEC, \ aesni_ops_dec_aes_gcm_##x); \ cm->key_fn[VNET_CRYPTO_ALG_AES_##x##_GCM] = aesni_gcm_key_exp_##x; foreach_aesni_gcm_handler_type; #undef _ return 0; } /* * fd.io coding-style-patch-verification: ON * * Local Variables: * eval: (c-set-style "gnu") * End: */