From a77e8e32be06ad9c46a1c542a91f22249ef3f9a0 Mon Sep 17 00:00:00 2001 From: Sean Cross Date: Wed, 2 Jun 2021 11:08:40 +0800 Subject: [PATCH] aes-test: get initial tests passing Signed-off-by: Sean Cross --- services/aes-test/src/aes.rs | 434 ++++++++++++++++++++++++++-------- services/aes-test/src/main.rs | 115 +++++---- 2 files changed, 401 insertions(+), 148 deletions(-) diff --git a/services/aes-test/src/aes.rs b/services/aes-test/src/aes.rs index be8d2b59d..02873bc88 100644 --- a/services/aes-test/src/aes.rs +++ b/services/aes-test/src/aes.rs @@ -1,4 +1,4 @@ -const Te0: [u32; 256] = [ +const TE0: [u32; 256] = [ 0xc66363a5, 0xf87c7c84, 0xee777799, 0xf67b7b8d, 0xfff2f20d, 0xd66b6bbd, 0xde6f6fb1, 0x91c5c554, 0x60303050, 0x02010103, 0xce6767a9, 0x562b2b7d, 0xe7fefe19, 0xb5d7d762, 0x4dababe6, 0xec76769a, 0x8fcaca45, 0x1f82829d, 0x89c9c940, 0xfa7d7d87, 0xeffafa15, 0xb25959eb, 0x8e4747c9, 0xfbf0f00b, @@ -33,7 +33,7 @@ const Te0: [u32; 256] = [ 0x824141c3, 0x299999b0, 0x5a2d2d77, 0x1e0f0f11, 0x7bb0b0cb, 0xa85454fc, 0x6dbbbbd6, 0x2c16163a, ]; -const Te1: [u32; 256] = [ +const TE1: [u32; 256] = [ 0xa5c66363, 0x84f87c7c, 0x99ee7777, 0x8df67b7b, 0x0dfff2f2, 0xbdd66b6b, 0xb1de6f6f, 0x5491c5c5, 0x50603030, 0x03020101, 0xa9ce6767, 0x7d562b2b, 0x19e7fefe, 0x62b5d7d7, 0xe64dabab, 0x9aec7676, 0x458fcaca, 0x9d1f8282, 0x4089c9c9, 0x87fa7d7d, 0x15effafa, 0xebb25959, 0xc98e4747, 0x0bfbf0f0, @@ -67,7 +67,8 @@ const Te1: [u32; 256] = [ 0x8f038c8c, 0xf859a1a1, 0x80098989, 0x171a0d0d, 0xda65bfbf, 0x31d7e6e6, 0xc6844242, 0xb8d06868, 0xc3824141, 0xb0299999, 0x775a2d2d, 0x111e0f0f, 0xcb7bb0b0, 0xfca85454, 0xd66dbbbb, 0x3a2c1616, ]; -const Te2: [u32; 256] = [ + +const TE2: [u32; 256] = [ 0x63a5c663, 0x7c84f87c, 0x7799ee77, 0x7b8df67b, 0xf20dfff2, 0x6bbdd66b, 0x6fb1de6f, 0xc55491c5, 0x30506030, 0x01030201, 0x67a9ce67, 0x2b7d562b, 0xfe19e7fe, 0xd762b5d7, 0xabe64dab, 0x769aec76, 0xca458fca, 0x829d1f82, 0xc94089c9, 0x7d87fa7d, 0xfa15effa, 0x59ebb259, 0x47c98e47, 0xf00bfbf0, @@ -101,7 +102,8 @@ const Te2: [u32; 256] = [ 0x8c8f038c, 0xa1f859a1, 0x89800989, 0x0d171a0d, 0xbfda65bf, 0xe631d7e6, 0x42c68442, 0x68b8d068, 0x41c38241, 0x99b02999, 0x2d775a2d, 0x0f111e0f, 0xb0cb7bb0, 0x54fca854, 0xbbd66dbb, 0x163a2c16, ]; -const Te3: [u32; 256] = [ + +const TE3: [u32; 256] = [ 0x6363a5c6, 0x7c7c84f8, 0x777799ee, 0x7b7b8df6, 0xf2f20dff, 0x6b6bbdd6, 0x6f6fb1de, 0xc5c55491, 0x30305060, 0x01010302, 0x6767a9ce, 0x2b2b7d56, 0xfefe19e7, 0xd7d762b5, 0xababe64d, 0x76769aec, 0xcaca458f, 0x82829d1f, 0xc9c94089, 0x7d7d87fa, 0xfafa15ef, 0x5959ebb2, 0x4747c98e, 0xf0f00bfb, @@ -136,7 +138,7 @@ const Te3: [u32; 256] = [ 0x4141c382, 0x9999b029, 0x2d2d775a, 0x0f0f111e, 0xb0b0cb7b, 0x5454fca8, 0xbbbbd66d, 0x16163a2c, ]; -const Td0: [u32; 256] = [ +const TD0: [u32; 256] = [ 0x51f4a750, 0x7e416553, 0x1a17a4c3, 0x3a275e96, 0x3bab6bcb, 0x1f9d45f1, 0xacfa58ab, 0x4be30393, 0x2030fa55, 0xad766df6, 0x88cc7691, 0xf5024c25, 0x4fe5d7fc, 0xc52acbd7, 0x26354480, 0xb562a38f, 0xdeb15a49, 0x25ba1b67, 0x45ea0e98, 0x5dfec0e1, 0xc32f7502, 0x814cf012, 0x8d4697a3, 0x6bd3f9c6, @@ -170,7 +172,8 @@ const Td0: [u32; 256] = [ 0xcaaff381, 0xb968c43e, 0x3824342c, 0xc2a3405f, 0x161dc372, 0xbce2250c, 0x283c498b, 0xff0d9541, 0x39a80171, 0x080cb3de, 0xd8b4e49c, 0x6456c190, 0x7bcb8461, 0xd532b670, 0x486c5c74, 0xd0b85742, ]; -const Td1: [u32; 256] = [ + +const TD1: [u32; 256] = [ 0x5051f4a7, 0x537e4165, 0xc31a17a4, 0x963a275e, 0xcb3bab6b, 0xf11f9d45, 0xabacfa58, 0x934be303, 0x552030fa, 0xf6ad766d, 0x9188cc76, 0x25f5024c, 0xfc4fe5d7, 0xd7c52acb, 0x80263544, 0x8fb562a3, 0x49deb15a, 0x6725ba1b, 0x9845ea0e, 0xe15dfec0, 0x02c32f75, 0x12814cf0, 0xa38d4697, 0xc66bd3f9, @@ -204,7 +207,8 @@ const Td1: [u32; 256] = [ 0x81caaff3, 0x3eb968c4, 0x2c382434, 0x5fc2a340, 0x72161dc3, 0x0cbce225, 0x8b283c49, 0x41ff0d95, 0x7139a801, 0xde080cb3, 0x9cd8b4e4, 0x906456c1, 0x617bcb84, 0x70d532b6, 0x74486c5c, 0x42d0b857, ]; -const Td2: [u32; 256] = [ + +const TD2: [u32; 256] = [ 0xa75051f4, 0x65537e41, 0xa4c31a17, 0x5e963a27, 0x6bcb3bab, 0x45f11f9d, 0x58abacfa, 0x03934be3, 0xfa552030, 0x6df6ad76, 0x769188cc, 0x4c25f502, 0xd7fc4fe5, 0xcbd7c52a, 0x44802635, 0xa38fb562, 0x5a49deb1, 0x1b6725ba, 0x0e9845ea, 0xc0e15dfe, 0x7502c32f, 0xf012814c, 0x97a38d46, 0xf9c66bd3, @@ -238,7 +242,7 @@ const Td2: [u32; 256] = [ 0xf381caaf, 0xc43eb968, 0x342c3824, 0x405fc2a3, 0xc372161d, 0x250cbce2, 0x498b283c, 0x9541ff0d, 0x017139a8, 0xb3de080c, 0xe49cd8b4, 0xc1906456, 0x84617bcb, 0xb670d532, 0x5c74486c, 0x5742d0b8, ]; -const Td3: [u32; 256] = [ +const TD3: [u32; 256] = [ 0xf4a75051, 0x4165537e, 0x17a4c31a, 0x275e963a, 0xab6bcb3b, 0x9d45f11f, 0xfa58abac, 0xe303934b, 0x30fa5520, 0x766df6ad, 0xcc769188, 0x024c25f5, 0xe5d7fc4f, 0x2acbd7c5, 0x35448026, 0x62a38fb5, 0xb15a49de, 0xba1b6725, 0xea0e9845, 0xfec0e15d, 0x2f7502c3, 0x4cf01281, 0x4697a38d, 0xd3f9c66b, @@ -273,7 +277,7 @@ const Td3: [u32; 256] = [ 0xa8017139, 0x0cb3de08, 0xb4e49cd8, 0x56c19064, 0xcb84617b, 0x32b670d5, 0x6c5c7448, 0xb85742d0, ]; -const Td4: [u8; 256] = [ +const TD4: [u8; 256] = [ 0x52, 0x09, 0x6a, 0xd5, 0x30, 0x36, 0xa5, 0x38, 0xbf, 0x40, 0xa3, 0x9e, 0x81, 0xf3, 0xd7, 0xfb, 0x7c, 0xe3, 0x39, 0x82, 0x9b, 0x2f, 0xff, 0x87, 0x34, 0x8e, 0x43, 0x44, 0xc4, 0xde, 0xe9, 0xcb, 0x54, 0x7b, 0x94, 0x32, 0xa6, 0xc2, 0x23, 0x3d, 0xee, 0x4c, 0x95, 0x0b, 0x42, 0xfa, 0xc3, 0x4e, @@ -292,111 +296,335 @@ const Td4: [u8; 256] = [ 0x17, 0x2b, 0x04, 0x7e, 0xba, 0x77, 0xd6, 0x26, 0xe1, 0x69, 0x14, 0x63, 0x55, 0x21, 0x0c, 0x7d, ]; -const Rcon: [u32; 10] = [ +const RCON: [u32; 10] = [ 0x01000000, 0x02000000, 0x04000000, 0x08000000, 0x10000000, 0x20000000, 0x40000000, 0x80000000, 0x1B000000, 0x36000000, /* for 128-bit blocks, Rijndael never uses more than 10 rcon values */ ]; -const MAXNR: usize = 14; -pub struct Key { - key: [u32; 4 * (MAXNR + 1)], +#[derive(Clone, Copy, Debug)] +enum AesId { + AesId0 = 0, + AesId1 = 1, + AesId2 = 2, + AesId3 = 3, +} + +#[derive(Debug)] +pub struct Aes { + // Why does this need to be so large? + key: [u32; 60], rounds: usize, } -pub fn -set_encrypt_key(user_key: [u8; 32], bits: usize, key: &mut Key) -> usize -{ - u32 *rk; - int i = 0; - u32 temp; +impl Default for Aes { + fn default() -> Self { + Aes { + key: [0u32; 60], + rounds: 0, + } + } +} - let rk = &mut key.key; +fn aes_enc_round(arg1: u32, arg2: u32, id: AesId) -> u32 { + extern "C" { + fn vex_aes_enc_id_0(arg1: u32, arg2: u32) -> u32; + fn vex_aes_enc_id_1(arg1: u32, arg2: u32) -> u32; + fn vex_aes_enc_id_2(arg1: u32, arg2: u32) -> u32; + fn vex_aes_enc_id_3(arg1: u32, arg2: u32) -> u32; + } + match id { + AesId::AesId0 => unsafe { vex_aes_enc_id_0(arg1, arg2) }, + AesId::AesId1 => unsafe { vex_aes_enc_id_1(arg1, arg2) }, + AesId::AesId2 => unsafe { vex_aes_enc_id_2(arg1, arg2) }, + AesId::AesId3 => unsafe { vex_aes_enc_id_3(arg1, arg2) }, + } +} - key.rounds = match bits { - 128 => 10, - 192 => 12, - 256 => 14, - _ => return -2, +fn aes_enc_round_last(arg1: u32, arg2: u32, id: AesId) -> u32 { + extern "C" { + fn vex_aes_enc_id_last_0(arg1: u32, arg2: u32) -> u32; + fn vex_aes_enc_id_last_1(arg1: u32, arg2: u32) -> u32; + fn vex_aes_enc_id_last_2(arg1: u32, arg2: u32) -> u32; + fn vex_aes_enc_id_last_3(arg1: u32, arg2: u32) -> u32; + } + match id { + AesId::AesId0 => unsafe { vex_aes_enc_id_last_0(arg1, arg2) }, + AesId::AesId1 => unsafe { vex_aes_enc_id_last_1(arg1, arg2) }, + AesId::AesId2 => unsafe { vex_aes_enc_id_last_2(arg1, arg2) }, + AesId::AesId3 => unsafe { vex_aes_enc_id_last_3(arg1, arg2) }, + } +} + +fn aes_dec_round(arg1: u32, arg2: u32, id: AesId) -> u32 { + extern "C" { + fn vex_aes_dec_id_0(arg1: u32, arg2: u32) -> u32; + fn vex_aes_dec_id_1(arg1: u32, arg2: u32) -> u32; + fn vex_aes_dec_id_2(arg1: u32, arg2: u32) -> u32; + fn vex_aes_dec_id_3(arg1: u32, arg2: u32) -> u32; + } + match id { + AesId::AesId0 => unsafe { vex_aes_dec_id_0(arg1, arg2) }, + AesId::AesId1 => unsafe { vex_aes_dec_id_1(arg1, arg2) }, + AesId::AesId2 => unsafe { vex_aes_dec_id_2(arg1, arg2) }, + AesId::AesId3 => unsafe { vex_aes_dec_id_3(arg1, arg2) }, + } +} + +fn aes_dec_round_last(arg1: u32, arg2: u32, id: AesId) -> u32 { + extern "C" { + fn vex_aes_dec_id_last_0(arg1: u32, arg2: u32) -> u32; + fn vex_aes_dec_id_last_1(arg1: u32, arg2: u32) -> u32; + fn vex_aes_dec_id_last_2(arg1: u32, arg2: u32) -> u32; + fn vex_aes_dec_id_last_3(arg1: u32, arg2: u32) -> u32; + } + match id { + AesId::AesId0 => unsafe { vex_aes_dec_id_last_0(arg1, arg2) }, + AesId::AesId1 => unsafe { vex_aes_dec_id_last_1(arg1, arg2) }, + AesId::AesId2 => unsafe { vex_aes_dec_id_last_2(arg1, arg2) }, + AesId::AesId3 => unsafe { vex_aes_dec_id_last_3(arg1, arg2) }, + } +} + +// use core::convert::TryInto; + +fn get_u32(input: &[u8], offset: usize) -> u32 { + // let tmp = [ + // input[offset + 0], + // input[offset + 1], + // input[offset + 2], + // input[offset + 3], + // ]; + let tmp = [ + input[offset + 3], + input[offset + 2], + input[offset + 1], + input[offset + 0], + ]; + u32::from_le_bytes(tmp) +} + +fn get_u32_swapped(input: &[u8], offset: usize) -> u32 { + let tmp = [ + input[offset + 0], + input[offset + 1], + input[offset + 2], + input[offset + 3], + ]; + u32::from_le_bytes(tmp) +} + +fn set_u32(output: &mut [u8], offset: usize, value: u32) { + let tmp = value.to_le_bytes(); + output[offset + 0] = tmp[0]; + output[offset + 1] = tmp[1]; + output[offset + 2] = tmp[2]; + output[offset + 3] = tmp[3]; +} + +pub fn set_encrypt_key(user_key: &[u8], key: &mut Aes) -> Result<(), &'static str> { + let rk = &mut key.key; + + key.rounds = match user_key.len() { + 16 => 10, + 24 => 12, + 32 => 14, + _ => Err("unrecognized keylength")?, }; - rk[0] = GETU32(user_key); - rk[1] = GETU32(user_key + 4); - rk[2] = GETU32(user_key + 8); - rk[3] = GETU32(user_key + 12); - if (bits == 128) { - while (1) { - temp = rk[3]; - rk[4] = rk[0] ^ - (Te2[(temp >> 16) & 0xff] & 0xff000000) ^ - (Te3[(temp >> 8) & 0xff] & 0x00ff0000) ^ - (Te0[(temp) & 0xff] & 0x0000ff00) ^ - (Te1[(temp >> 24)] & 0x000000ff) ^ - rcon[i]; - rk[5] = rk[1] ^ rk[4]; - rk[6] = rk[2] ^ rk[5]; - rk[7] = rk[3] ^ rk[6]; - if (++i == 10) { - vexriscv_aes_swap_key(key->rd_key); - return 0; - } - rk += 4; - } - } - panic!("Unsupported number of bits"); - // rk[4] = GETU32(userKey + 16); - // rk[5] = GETU32(userKey + 20); - // if (bits == 192) { - // while (1) { - // temp = rk[5]; - // rk[6] = rk[ 0] ^ - // (Te2[(temp >> 16) & 0xff] & 0xff000000) ^ - // (Te3[(temp >> 8) & 0xff] & 0x00ff0000) ^ - // (Te0[(temp) & 0xff] & 0x0000ff00) ^ - // (Te1[(temp >> 24)] & 0x000000ff) ^ - // rcon[i]; - // rk[7] = rk[1] ^ rk[6]; - // rk[8] = rk[2] ^ rk[7]; - // rk[9] = rk[3] ^ rk[8]; - // if (++i == 8) { - // vexriscv_aes_swap_key(key->rd_key); - // return 0; - // } - // rk[10] = rk[4] ^ rk[9]; - // rk[11] = rk[5] ^ rk[10]; - // rk += 6; - // } - // } - // rk[6] = GETU32(userKey + 24); - // rk[7] = GETU32(userKey + 28); - // if (bits == 256) { - // while (1) { - // temp = rk[7]; - // rk[8] = rk[0] ^ - // (Te2[(temp >> 16) & 0xff] & 0xff000000) ^ - // (Te3[(temp >> 8) & 0xff] & 0x00ff0000) ^ - // (Te0[(temp) & 0xff] & 0x0000ff00) ^ - // (Te1[(temp >> 24)] & 0x000000ff) ^ - // rcon[i]; - // rk[9] = rk[1] ^ rk[8]; - // rk[10] = rk[2] ^ rk[9]; - // rk[11] = rk[3] ^ rk[10]; - // if (++i == 7) { - // vexriscv_aes_swap_key(key->rd_key); - // return 0; - // } - // temp = rk[11]; - // rk[12] = rk[4] ^ - // (Te2[(temp >> 24)] & 0xff000000) ^ - // (Te3[(temp >> 16) & 0xff] & 0x00ff0000) ^ - // (Te0[(temp >> 8) & 0xff] & 0x0000ff00) ^ - // (Te1[(temp) & 0xff] & 0x000000ff); - // rk[13] = rk[5] ^ rk[12]; - // rk[14] = rk[6] ^ rk[13]; - // rk[15] = rk[7] ^ rk[14]; + rk[0] = get_u32(user_key, 0); + rk[1] = get_u32(user_key, 4); + rk[2] = get_u32(user_key, 8); + rk[3] = get_u32(user_key, 12); + let mut rk_offset = 0; + if user_key.len() == 16 { + for i in 0..10 { + let temp = rk[3 + rk_offset] as usize; + rk[4 + rk_offset] = rk[0 + rk_offset] + ^ (TE2[(temp >> 16) & 0xff] & 0xff000000) + ^ (TE3[(temp >> 8) & 0xff] & 0x00ff0000) + ^ (TE0[(temp) & 0xff] & 0x0000ff00) + ^ (TE1[(temp >> 24)] & 0x000000ff) + ^ RCON[i]; + rk[5 + rk_offset] = rk[1 + rk_offset] ^ rk[4 + rk_offset]; + rk[6 + rk_offset] = rk[2 + rk_offset] ^ rk[5 + rk_offset]; + rk[7 + rk_offset] = rk[3 + rk_offset] ^ rk[6 + rk_offset]; + rk_offset += 4; + } + for value in &mut key.key { + *value = value.swap_bytes(); + } + return Ok(()); + } + rk[4] = get_u32(user_key, 16); + rk[5] = get_u32(user_key, 20); + // if (bits == 192) { + // while (1) { + // temp = rk[5]; + // rk[6] = rk[ 0] ^ + // (Te2[(temp >> 16) & 0xff] & 0xff000000) ^ + // (Te3[(temp >> 8) & 0xff] & 0x00ff0000) ^ + // (Te0[(temp) & 0xff] & 0x0000ff00) ^ + // (Te1[(temp >> 24)] & 0x000000ff) ^ + // rcon[i]; + // rk[7] = rk[1] ^ rk[6]; + // rk[8] = rk[2] ^ rk[7]; + // rk[9] = rk[3] ^ rk[8]; + // if (++i == 8) { + // vexriscv_aes_swap_key(key->rd_key); + // return 0; + // } + // rk[10] = rk[4] ^ rk[9]; + // rk[11] = rk[5] ^ rk[10]; + // rk += 6; + // } + // } + rk[6] = get_u32(user_key, 24); + rk[7] = get_u32(user_key, 28); + if user_key.len() == 32 { + let mut rk_offset = 0; + for i in 0.. { + let temp = rk[7 + rk_offset] as usize; + rk[8 + rk_offset] = rk[0 + rk_offset] ^ + (TE2[(temp >> 16) & 0xff] & 0xff000000) ^ + (TE3[(temp >> 8) & 0xff] & 0x00ff0000) ^ + (TE0[(temp) & 0xff] & 0x0000ff00) ^ + (TE1[(temp >> 24)] & 0x000000ff) ^ + RCON[i]; + rk[9 + rk_offset] = rk[1 + rk_offset] ^ rk[8 + rk_offset]; + rk[10 + rk_offset] = rk[2 + rk_offset] ^ rk[9 + rk_offset]; + rk[11 + rk_offset] = rk[3 + rk_offset] ^ rk[10 + rk_offset]; - // rk += 8; - // } - // } - return 0; + if i == 6 { + break; + } + let temp = rk[11 + rk_offset] as usize; + rk[12 + rk_offset] = rk[4 + rk_offset] ^ + (TE2[(temp >> 24)] & 0xff000000) ^ + (TE3[(temp >> 16) & 0xff] & 0x00ff0000) ^ + (TE0[(temp >> 8) & 0xff] & 0x0000ff00) ^ + (TE1[(temp) & 0xff] & 0x000000ff); + rk[13 + rk_offset] = rk[5 + rk_offset] ^ rk[12 + rk_offset]; + rk[14 + rk_offset] = rk[6 + rk_offset] ^ rk[13 + rk_offset]; + rk[15 + rk_offset] = rk[7 + rk_offset] ^ rk[14 + rk_offset]; + + rk_offset += 8; + } + for value in &mut key.key { + *value = value.swap_bytes(); + } + return Ok(()); + } + unreachable!(); +} + +pub fn vexriscv_aes_encrypt(input: &[u8], output: &mut [u8], key: &Aes) { + let rk = key.key; + + // We do two rounds per loop + let mut round_count = key.rounds / 2; + + let mut s0 = get_u32_swapped(input, 0); + let mut s1 = get_u32_swapped(input, 4); + let mut s2 = get_u32_swapped(input, 8); + let mut s3 = get_u32_swapped(input, 12); + + let mut t0 = rk[0]; + let mut t1 = rk[1]; + let mut t2 = rk[2]; + let mut t3 = rk[3]; + + s0 ^= t0; + s1 ^= t1; + s2 ^= t2; + s3 ^= t3; + + let mut rk_offset = 0; + loop { + t0 = rk[rk_offset + 4]; + t1 = rk[rk_offset + 5]; + t2 = rk[rk_offset + 6]; + t3 = rk[rk_offset + 7]; + + t0 = aes_enc_round(t0, s0, AesId::AesId0); + t1 = aes_enc_round(t1, s1, AesId::AesId0); + t2 = aes_enc_round(t2, s2, AesId::AesId0); + t3 = aes_enc_round(t3, s3, AesId::AesId0); + + t0 = aes_enc_round(t0, s1, AesId::AesId1); + t1 = aes_enc_round(t1, s2, AesId::AesId1); + t2 = aes_enc_round(t2, s3, AesId::AesId1); + t3 = aes_enc_round(t3, s0, AesId::AesId1); + + t0 = aes_enc_round(t0, s2, AesId::AesId2); + t1 = aes_enc_round(t1, s3, AesId::AesId2); + t2 = aes_enc_round(t2, s0, AesId::AesId2); + t3 = aes_enc_round(t3, s1, AesId::AesId2); + + t0 = aes_enc_round(t0, s3, AesId::AesId3); + t1 = aes_enc_round(t1, s0, AesId::AesId3); + t2 = aes_enc_round(t2, s1, AesId::AesId3); + t3 = aes_enc_round(t3, s2, AesId::AesId3); + + rk_offset += 8; + round_count -= 1; + if round_count == 0 { + break; + } + + s0 = rk[rk_offset + 0]; + s1 = rk[rk_offset + 1]; + s2 = rk[rk_offset + 2]; + s3 = rk[rk_offset + 3]; + + s0 = aes_enc_round(s0, t0, AesId::AesId0); + s1 = aes_enc_round(s1, t1, AesId::AesId0); + s2 = aes_enc_round(s2, t2, AesId::AesId0); + s3 = aes_enc_round(s3, t3, AesId::AesId0); + + s0 = aes_enc_round(s0, t1, AesId::AesId1); + s1 = aes_enc_round(s1, t2, AesId::AesId1); + s2 = aes_enc_round(s2, t3, AesId::AesId1); + s3 = aes_enc_round(s3, t0, AesId::AesId1); + + s0 = aes_enc_round(s0, t2, AesId::AesId2); + s1 = aes_enc_round(s1, t3, AesId::AesId2); + s2 = aes_enc_round(s2, t0, AesId::AesId2); + s3 = aes_enc_round(s3, t1, AesId::AesId2); + + s0 = aes_enc_round(s0, t3, AesId::AesId3); + s1 = aes_enc_round(s1, t0, AesId::AesId3); + s2 = aes_enc_round(s2, t1, AesId::AesId3); + s3 = aes_enc_round(s3, t2, AesId::AesId3); + } + + s0 = rk[rk_offset + 0]; + s1 = rk[rk_offset + 1]; + s2 = rk[rk_offset + 2]; + s3 = rk[rk_offset + 3]; + + s0 = aes_enc_round_last(s0, t0, AesId::AesId0); + s1 = aes_enc_round_last(s1, t1, AesId::AesId0); + s2 = aes_enc_round_last(s2, t2, AesId::AesId0); + s3 = aes_enc_round_last(s3, t3, AesId::AesId0); + + s0 = aes_enc_round_last(s0, t1, AesId::AesId1); + s1 = aes_enc_round_last(s1, t2, AesId::AesId1); + s2 = aes_enc_round_last(s2, t3, AesId::AesId1); + s3 = aes_enc_round_last(s3, t0, AesId::AesId1); + + s0 = aes_enc_round_last(s0, t2, AesId::AesId2); + s1 = aes_enc_round_last(s1, t3, AesId::AesId2); + s2 = aes_enc_round_last(s2, t0, AesId::AesId2); + s3 = aes_enc_round_last(s3, t1, AesId::AesId2); + + s0 = aes_enc_round_last(s0, t3, AesId::AesId3); + s1 = aes_enc_round_last(s1, t0, AesId::AesId3); + s2 = aes_enc_round_last(s2, t1, AesId::AesId3); + s3 = aes_enc_round_last(s3, t2, AesId::AesId3); + + set_u32(output, 0, s0); + set_u32(output, 4, s1); + set_u32(output, 8, s2); + set_u32(output, 12, s3); } diff --git a/services/aes-test/src/main.rs b/services/aes-test/src/main.rs index 57dbf1b31..f29cdd95f 100644 --- a/services/aes-test/src/main.rs +++ b/services/aes-test/src/main.rs @@ -1,18 +1,18 @@ #![cfg_attr(target_os = "none", no_std)] #![cfg_attr(target_os = "none", no_main)] +mod aes; mod reference; -// mod aes; #[derive(Clone, Copy, Debug)] -pub enum AesId { +enum AesId { AesId0 = 0, AesId1 = 1, AesId2 = 2, AesId3 = 3, } -pub fn aes_enc_round(arg1: u32, arg2: u32, id: AesId) -> u32 { +fn aes_enc_round(arg1: u32, arg2: u32, id: AesId) -> u32 { extern "C" { fn vex_aes_enc_id_0(arg1: u32, arg2: u32) -> u32; fn vex_aes_enc_id_1(arg1: u32, arg2: u32) -> u32; @@ -27,22 +27,22 @@ pub fn aes_enc_round(arg1: u32, arg2: u32, id: AesId) -> u32 { } } -pub fn aes_enc_round_last(arg1: u32, arg2: u32, id: AesId) -> u32 { +fn aes_enc_round_last(arg1: u32, arg2: u32, id: AesId) -> u32 { extern "C" { - fn vex_aes_dec_id_last_0(arg1: u32, arg2: u32) -> u32; + fn vex_aes_enc_id_last_0(arg1: u32, arg2: u32) -> u32; fn vex_aes_enc_id_last_1(arg1: u32, arg2: u32) -> u32; fn vex_aes_enc_id_last_2(arg1: u32, arg2: u32) -> u32; fn vex_aes_enc_id_last_3(arg1: u32, arg2: u32) -> u32; } match id { - AesId::AesId0 => unsafe { vex_aes_dec_id_last_0(arg1, arg2) }, + AesId::AesId0 => unsafe { vex_aes_enc_id_last_0(arg1, arg2) }, AesId::AesId1 => unsafe { vex_aes_enc_id_last_1(arg1, arg2) }, AesId::AesId2 => unsafe { vex_aes_enc_id_last_2(arg1, arg2) }, AesId::AesId3 => unsafe { vex_aes_enc_id_last_3(arg1, arg2) }, } } -pub fn aes_dec_round(arg1: u32, arg2: u32, id: AesId) -> u32 { +fn aes_dec_round(arg1: u32, arg2: u32, id: AesId) -> u32 { extern "C" { fn vex_aes_dec_id_0(arg1: u32, arg2: u32) -> u32; fn vex_aes_dec_id_1(arg1: u32, arg2: u32) -> u32; @@ -57,7 +57,7 @@ pub fn aes_dec_round(arg1: u32, arg2: u32, id: AesId) -> u32 { } } -pub fn aes_dec_round_last(arg1: u32, arg2: u32, id: AesId) -> u32 { +fn aes_dec_round_last(arg1: u32, arg2: u32, id: AesId) -> u32 { extern "C" { fn vex_aes_dec_id_last_0(arg1: u32, arg2: u32) -> u32; fn vex_aes_dec_id_last_1(arg1: u32, arg2: u32) -> u32; @@ -110,7 +110,7 @@ fn encrypt_test_last(id: AesId) { dut, reference ); - return; + // return; } } log::info!("Pass"); @@ -168,42 +168,6 @@ fn aes_test_main() -> ! { xous::current_pid().unwrap().get() ); - log::info!("Testing Encrypt AesId 0"); - encrypt_test(AesId::AesId0); - log::info!("Testing Encrypt AesId 1"); - encrypt_test(AesId::AesId1); - log::info!("Testing Encrypt AesId 2"); - encrypt_test(AesId::AesId2); - log::info!("Testing Encrypt AesId 3"); - encrypt_test(AesId::AesId3); - - log::info!("Testing Encrypt Last AesId 0"); - encrypt_test_last(AesId::AesId0); - log::info!("Testing Encrypt Last AesId 1"); - encrypt_test_last(AesId::AesId1); - log::info!("Testing Encrypt Last AesId 2"); - encrypt_test_last(AesId::AesId2); - log::info!("Testing Encrypt Last AesId 3"); - encrypt_test_last(AesId::AesId3); - - log::info!("Testing Decrypt AesId 0"); - decrypt_test(AesId::AesId0); - log::info!("Testing Decrypt AesId 1"); - decrypt_test(AesId::AesId1); - log::info!("Testing Decrypt AesId 2"); - decrypt_test(AesId::AesId2); - log::info!("Testing Decrypt AesId 3"); - decrypt_test(AesId::AesId3); - - log::info!("Testing Decrypt Last AesId 0"); - decrypt_test_last(AesId::AesId0); - log::info!("Testing Decrypt Last AesId 1"); - decrypt_test_last(AesId::AesId1); - log::info!("Testing Decrypt Last AesId 2"); - decrypt_test_last(AesId::AesId2); - log::info!("Testing Decrypt Last AesId 3"); - decrypt_test_last(AesId::AesId3); - let key: [u8; 32] = [ 0x70, 0x69, 0x19, 0xa0, 0x40, 0x61, 0x05, 0x17, 0xf7, 0xff, 0xf5, 0x27, 0x2b, 0x64, 0x04, 0x67, 0xc5, 0x06, 0x7a, 0x4b, 0xba, 0x57, 0x78, 0xad, 0x6c, 0xdd, 0xcb, 0xf4, 0x73, 0x03, @@ -218,6 +182,67 @@ fn aes_test_main() -> ! { 0x94, ]; + let key = [ + 0x2B, 0x7E, 0x15, 0x16, 0x28, 0xAE, 0xD2, 0xA6, 0xAB, 0xF7, 0x15, 0x88, 0x09, 0xCF, 0x4F, + 0x3C, + ]; + let plaintext = [ + 0x6B, 0xC1, 0xBE, 0xE2, 0x2E, 0x40, 0x9F, 0x96, 0xE9, 0x3D, 0x7E, 0x11, 0x73, 0x93, 0x17, + 0x2A, + ]; + let reference = [ + 0x3A, 0xD7, 0x7B, 0xB4, 0x0D, 0x7A, 0x36, 0x60, 0xA8, 0x9E, 0xCA, 0xF3, 0x24, 0x66, 0xEF, + 0x97, + ]; + + let mut output = [0u8; 16]; + let mut aes_key = Default::default(); + log::info!("Setting key"); + aes::set_encrypt_key(&key, &mut aes_key).unwrap(); + log::info!("Running encryption"); + aes::vexriscv_aes_encrypt(&plaintext, &mut output, &aes_key); + log::info!("Plaintext: {:?}", plaintext); + log::info!("Key: {:?}", key); + log::info!("Reference: {:?}", reference); + log::info!("Result: {:?}", output); + + // log::info!("Running additional tests"); + + // log::info!("Testing Encrypt AesId 0"); + // encrypt_test(AesId::AesId0); + // log::info!("Testing Encrypt AesId 1"); + // encrypt_test(AesId::AesId1); + // log::info!("Testing Encrypt AesId 2"); + // encrypt_test(AesId::AesId2); + // log::info!("Testing Encrypt AesId 3"); + // encrypt_test(AesId::AesId3); + + // log::info!("Testing Encrypt Last AesId 0"); + // encrypt_test_last(AesId::AesId0); + // log::info!("Testing Encrypt Last AesId 1"); + // encrypt_test_last(AesId::AesId1); + // log::info!("Testing Encrypt Last AesId 2"); + // encrypt_test_last(AesId::AesId2); + // log::info!("Testing Encrypt Last AesId 3"); + // encrypt_test_last(AesId::AesId3); + + // log::info!("Testing Decrypt AesId 0"); + // decrypt_test(AesId::AesId0); + // log::info!("Testing Decrypt AesId 1"); + // decrypt_test(AesId::AesId1); + // log::info!("Testing Decrypt AesId 2"); + // decrypt_test(AesId::AesId2); + // log::info!("Testing Decrypt AesId 3"); + // decrypt_test(AesId::AesId3); + + // log::info!("Testing Decrypt Last AesId 0"); + // decrypt_test_last(AesId::AesId0); + // log::info!("Testing Decrypt Last AesId 1"); + // decrypt_test_last(AesId::AesId1); + // log::info!("Testing Decrypt Last AesId 2"); + // decrypt_test_last(AesId::AesId2); + // log::info!("Testing Decrypt Last AesId 3"); + // decrypt_test_last(AesId::AesId3); loop { xous::wait_event(); }