implement raw_*_{encrypt,decrypt} in C

1 files changed, 162 insertions, 0 deletions

diff --git a/src/aes256.c b/src/aes256.c
new file mode 100644
index 0000000..1faa092
--- /dev/null
+++ b/src/aes256.c
@@ -0,0 +1,162 @@
+/**
+ * \file
+ * \author Egor Tensin <Egor.Tensin@gmail.com>
+ * \date 2015
+ * \copyright This file is licensed under the terms of the MIT License.
+ *            See LICENSE.txt for details.
+ */
+
+#include <aesni/all.h>
+
+#include <emmintrin.h>
+#include <wmmintrin.h>
+
+AesBlock128 __fastcall raw_aes256ecb_encrypt(
+    AesBlock128 plain,
+    Aes256KeySchedule* key_schedule)
+{
+    plain = _mm_xor_si128(plain, key_schedule->keys[0]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[1]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[2]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[3]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[4]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[5]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[6]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[7]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[8]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[9]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[10]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[11]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[12]);
+    plain = _mm_aesenc_si128(plain, key_schedule->keys[13]);
+    return _mm_aesenclast_si128(plain, key_schedule->keys[14]);
+}
+
+AesBlock128 __fastcall raw_aes256ecb_decrypt(
+    AesBlock128 cipher,
+    Aes256KeySchedule* inverted_schedule)
+{
+    cipher = _mm_xor_si128(cipher, inverted_schedule->keys[0]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[1]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[2]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[3]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[4]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[5]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[6]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[7]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[8]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[9]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[10]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[11]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[12]);
+    cipher = _mm_aesdec_si128(cipher, inverted_schedule->keys[13]);
+    return _mm_aesdeclast_si128(cipher, inverted_schedule->keys[14]);
+}
+
+static AesBlock128 __fastcall aes256_keygen_assist(
+    AesBlock128* prev_lo,
+    AesBlock128* prev_hi,
+    AesBlock128 hwgen)
+{
+    AesBlock128 tmp = *prev_lo;
+
+    tmp = _mm_slli_si128(tmp, 4);
+    *prev_lo = _mm_xor_si128(*prev_lo, tmp);
+    tmp = _mm_slli_si128(tmp, 4);
+    *prev_lo = _mm_xor_si128(*prev_lo, tmp);
+    tmp = _mm_slli_si128(tmp, 4);
+    *prev_lo = _mm_xor_si128(*prev_lo, tmp);
+
+    *prev_lo = _mm_xor_si128(*prev_lo, hwgen);
+
+    *prev_hi = _mm_xor_si128(*prev_hi, *prev_lo);
+    *prev_lo = _mm_xor_si128(*prev_lo, *prev_hi);
+    *prev_hi = _mm_xor_si128(*prev_hi, *prev_lo);
+
+    return *prev_hi;
+}
+
+void __fastcall raw_aes256_expand_key_schedule(
+    AesBlock128 key_lo,
+    AesBlock128 key_hi,
+    Aes256KeySchedule* key_schedule)
+{
+    AesBlock128 prev_lo, prev_hi;
+    AesBlock128 hwgen;
+
+    prev_lo = key_schedule->keys[0] = key_lo;
+    prev_hi = key_schedule->keys[1] = key_hi;
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0x01);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xff);
+    key_schedule->keys[2] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xaa);
+    key_schedule->keys[3] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0x02);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xff);
+    key_schedule->keys[4] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xaa);
+    key_schedule->keys[5] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0x04);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xff);
+    key_schedule->keys[6] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xaa);
+    key_schedule->keys[7] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0x08);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xff);
+    key_schedule->keys[8] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xaa);
+    key_schedule->keys[9] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0x10);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xff);
+    key_schedule->keys[10] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xaa);
+    key_schedule->keys[11] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0x20);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xff);
+    key_schedule->keys[12] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xaa);
+    key_schedule->keys[13] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+
+    hwgen = _mm_aeskeygenassist_si128(prev_hi, 0x40);
+    hwgen = _mm_shuffle_epi32(hwgen, 0xff);
+    key_schedule->keys[14] = aes256_keygen_assist(&prev_lo, &prev_hi, hwgen);
+}
+
+void __fastcall raw_aes256_invert_key_schedule(
+    Aes256KeySchedule* key_schedule,
+    Aes256KeySchedule* inverted_schedule)
+{
+    inverted_schedule->keys[0] = key_schedule->keys[14];
+    inverted_schedule->keys[1] = _mm_aesimc_si128(key_schedule->keys[13]);
+    inverted_schedule->keys[2] = _mm_aesimc_si128(key_schedule->keys[12]);
+    inverted_schedule->keys[3] = _mm_aesimc_si128(key_schedule->keys[11]);
+    inverted_schedule->keys[4] = _mm_aesimc_si128(key_schedule->keys[10]);
+    inverted_schedule->keys[5] = _mm_aesimc_si128(key_schedule->keys[9]);
+    inverted_schedule->keys[6] = _mm_aesimc_si128(key_schedule->keys[8]);
+    inverted_schedule->keys[7] = _mm_aesimc_si128(key_schedule->keys[7]);
+    inverted_schedule->keys[8] = _mm_aesimc_si128(key_schedule->keys[6]);
+    inverted_schedule->keys[9] = _mm_aesimc_si128(key_schedule->keys[5]);
+    inverted_schedule->keys[10] = _mm_aesimc_si128(key_schedule->keys[4]);
+    inverted_schedule->keys[11] = _mm_aesimc_si128(key_schedule->keys[3]);
+    inverted_schedule->keys[12] = _mm_aesimc_si128(key_schedule->keys[2]);
+    inverted_schedule->keys[13] = _mm_aesimc_si128(key_schedule->keys[1]);
+    inverted_schedule->keys[14] = key_schedule->keys[0];
+}