10a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang/* $NetBSD: rijndael-api-fst.c,v 1.4 2006/09/09 16:22:36 manu Exp $ */ 20a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 30a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang/* $KAME: rijndael-api-fst.c,v 1.8 2002/11/18 23:32:54 itojun Exp $ */ 40a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 50a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang/* 60a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * rijndael-api-fst.c v2.3 April '2000 70a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * 80a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * Optimised ANSI C code 90a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * 100a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * authors: v1.0: Antoon Bosselaers 110a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * v2.0: Vincent Rijmen 120a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * v2.1: Vincent Rijmen 130a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * v2.2: Vincent Rijmen 140a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * v2.3: Paulo Barreto 150a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * v2.4: Vincent Rijmen 160a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * 170a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * This code is placed in the public domain. 180a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang */ 190a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 200a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#include "config.h" 210a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 220a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#include <sys/param.h> 230a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#include <sys/types.h> 240a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#ifdef _KERNEL 250a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#include <sys/time.h> 260a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#include <sys/systm.h> 270a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#else 280a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#include <string.h> 290a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#endif 300a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#include <crypto/rijndael/rijndael-alg-fst.h> 310a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#include <crypto/rijndael/rijndael-api-fst.h> 320a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#include <crypto/rijndael/rijndael_local.h> 330a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 340a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#include <err.h> 350a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#define bcopy(a, b, c) memcpy(b, a, c) 360a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#define bzero(a, b) memset(a, 0, b) 370a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#define panic(a) err(1, (a)) 380a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 390a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wangint rijndael_makeKey(keyInstance *key, BYTE direction, int keyLen, char *keyMaterial) { 400a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang word8 k[MAXKC][4]; 410a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang int i; 420a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang char *keyMat; 430a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 440a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (key == NULL) { 450a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_KEY_INSTANCE; 460a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 470a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 480a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if ((direction == DIR_ENCRYPT) || (direction == DIR_DECRYPT)) { 490a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang key->direction = direction; 500a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } else { 510a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_KEY_DIR; 520a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 530a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 540a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if ((keyLen == 128) || (keyLen == 192) || (keyLen == 256)) { 550a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang key->keyLen = keyLen; 560a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } else { 570a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_KEY_MAT; 580a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 590a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 600a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (keyMaterial != NULL) { 610a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(keyMaterial, key->keyMaterial, keyLen/8); 620a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 630a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 640a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang key->ROUNDS = keyLen/32 + 6; 650a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 660a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang /* initialize key schedule: */ 670a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang keyMat = key->keyMaterial; 680a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = 0; i < key->keyLen/8; i++) { 690a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang k[i >> 2][i & 3] = (word8)keyMat[i]; 700a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 710a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelKeySched(k, key->keySched, key->ROUNDS); 720a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (direction == DIR_DECRYPT) { 730a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelKeyEncToDec(key->keySched, key->ROUNDS); 740a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 750a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 760a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return TRUE; 770a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang} 780a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 790a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wangint rijndael_cipherInit(cipherInstance *cipher, BYTE mode, char *IV) { 800a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if ((mode == MODE_ECB) || (mode == MODE_CBC) || (mode == MODE_CFB1)) { 810a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang cipher->mode = mode; 820a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } else { 830a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_CIPHER_MODE; 840a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 850a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (IV != NULL) { 860a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(IV, cipher->IV, MAX_IV_SIZE); 870a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } else { 880a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bzero(cipher->IV, MAX_IV_SIZE); 890a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 900a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return TRUE; 910a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang} 920a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 930a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wangint rijndael_blockEncrypt(cipherInstance *cipher, keyInstance *key, 940a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang BYTE *input, int inputLen, BYTE *outBuffer) { 950a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang int i, k, numBlocks; 960a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang word8 block[16], iv[4][4]; 970a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 980a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (cipher == NULL || 990a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang key == NULL || 1000a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang key->direction == DIR_DECRYPT) { 1010a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_CIPHER_STATE; 1020a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 1030a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (input == NULL || inputLen <= 0) { 1040a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return 0; /* nothing to do */ 1050a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 1060a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 1070a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang numBlocks = inputLen/128; 1080a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 1090a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang switch (cipher->mode) { 1100a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case MODE_ECB: 1110a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = numBlocks; i > 0; i--) { 1120a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelEncrypt(input, outBuffer, key->keySched, key->ROUNDS); 1130a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang input += 16; 1140a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang outBuffer += 16; 1150a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 1160a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 1170a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 1180a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case MODE_CBC: 1190a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#if 1 /*STRICT_ALIGN*/ 1200a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(cipher->IV, block, 16); 1210a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(input, iv, 16); 1220a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[0] ^= ((word32*)iv)[0]; 1230a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[1] ^= ((word32*)iv)[1]; 1240a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[2] ^= ((word32*)iv)[2]; 1250a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[3] ^= ((word32*)iv)[3]; 1260a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#else 1270a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[0] = ((word32*)cipher->IV)[0] ^ ((word32*)input)[0]; 1280a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[1] = ((word32*)cipher->IV)[1] ^ ((word32*)input)[1]; 1290a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[2] = ((word32*)cipher->IV)[2] ^ ((word32*)input)[2]; 1300a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[3] = ((word32*)cipher->IV)[3] ^ ((word32*)input)[3]; 1310a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#endif 1320a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelEncrypt(block, outBuffer, key->keySched, key->ROUNDS); 1330a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang input += 16; 1340a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = numBlocks - 1; i > 0; i--) { 1350a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#if 1 /*STRICT_ALIGN*/ 1360a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(outBuffer, block, 16); 1370a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(input, iv, 16); 1380a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[0] ^= ((word32*)iv)[0]; 1390a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[1] ^= ((word32*)iv)[1]; 1400a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[2] ^= ((word32*)iv)[2]; 1410a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[3] ^= ((word32*)iv)[3]; 1420a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#else 1430a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[0] = ((word32*)outBuffer)[0] ^ ((word32*)input)[0]; 1440a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[1] = ((word32*)outBuffer)[1] ^ ((word32*)input)[1]; 1450a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[2] = ((word32*)outBuffer)[2] ^ ((word32*)input)[2]; 1460a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[3] = ((word32*)outBuffer)[3] ^ ((word32*)input)[3]; 1470a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#endif 1480a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang outBuffer += 16; 1490a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelEncrypt(block, outBuffer, key->keySched, key->ROUNDS); 1500a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang input += 16; 1510a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 1520a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 1530a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 1540a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case MODE_CFB1: 1550a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#if 1 /*STRICT_ALIGN*/ 1560a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(cipher->IV, iv, 16); 1570a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#else /* !STRICT_ALIGN */ 1580a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[0]) = *((word32*)(cipher->IV )); 1590a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[1]) = *((word32*)(cipher->IV+ 4)); 1600a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[2]) = *((word32*)(cipher->IV+ 8)); 1610a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[3]) = *((word32*)(cipher->IV+12)); 1620a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#endif /* ?STRICT_ALIGN */ 1630a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = numBlocks; i > 0; i--) { 1640a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (k = 0; k < 128; k++) { 1650a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*) block ) = *((word32*)iv[0]); 1660a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)(block+ 4)) = *((word32*)iv[1]); 1670a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)(block+ 8)) = *((word32*)iv[2]); 1680a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)(block+12)) = *((word32*)iv[3]); 1690a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelEncrypt(block, block, key->keySched, key->ROUNDS); 1700a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang outBuffer[k/8] ^= (block[0] & 0x80) >> (k & 7); 1710a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[0][0] = (iv[0][0] << 1) | (iv[0][1] >> 7); 1720a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[0][1] = (iv[0][1] << 1) | (iv[0][2] >> 7); 1730a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[0][2] = (iv[0][2] << 1) | (iv[0][3] >> 7); 1740a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[0][3] = (iv[0][3] << 1) | (iv[1][0] >> 7); 1750a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[1][0] = (iv[1][0] << 1) | (iv[1][1] >> 7); 1760a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[1][1] = (iv[1][1] << 1) | (iv[1][2] >> 7); 1770a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[1][2] = (iv[1][2] << 1) | (iv[1][3] >> 7); 1780a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[1][3] = (iv[1][3] << 1) | (iv[2][0] >> 7); 1790a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[2][0] = (iv[2][0] << 1) | (iv[2][1] >> 7); 1800a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[2][1] = (iv[2][1] << 1) | (iv[2][2] >> 7); 1810a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[2][2] = (iv[2][2] << 1) | (iv[2][3] >> 7); 1820a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[2][3] = (iv[2][3] << 1) | (iv[3][0] >> 7); 1830a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[3][0] = (iv[3][0] << 1) | (iv[3][1] >> 7); 1840a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[3][1] = (iv[3][1] << 1) | (iv[3][2] >> 7); 1850a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[3][2] = (iv[3][2] << 1) | (iv[3][3] >> 7); 1860a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[3][3] = (iv[3][3] << 1) | ((outBuffer[k/8] >> (7-(k&7))) & 1); 1870a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 1880a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 1890a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 1900a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 1910a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang default: 1920a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_CIPHER_STATE; 1930a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 1940a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 1950a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return 128*numBlocks; 1960a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang} 1970a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 1980a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang/** 1990a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * Encrypt data partitioned in octets, using RFC 2040-like padding. 2000a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * 2010a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * @param input data to be encrypted (octet sequence) 2020a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * @param inputOctets input length in octets (not bits) 2030a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * @param outBuffer encrypted output data 2040a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * 2050a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * @return length in octets (not bits) of the encrypted output buffer. 2060a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang */ 2070a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wangint rijndael_padEncrypt(cipherInstance *cipher, keyInstance *key, 2080a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang BYTE *input, int inputOctets, BYTE *outBuffer) { 2090a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang int i, numBlocks, padLen; 2100a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang word8 block[16], *iv, *cp; 2110a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2120a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (cipher == NULL || 2130a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang key == NULL || 2140a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang key->direction == DIR_DECRYPT) { 2150a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_CIPHER_STATE; 2160a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 2170a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (input == NULL || inputOctets <= 0) { 2180a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return 0; /* nothing to do */ 2190a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 2200a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2210a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang numBlocks = inputOctets/16; 2220a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2230a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang switch (cipher->mode) { 2240a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case MODE_ECB: 2250a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = numBlocks; i > 0; i--) { 2260a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelEncrypt(input, outBuffer, key->keySched, key->ROUNDS); 2270a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang input += 16; 2280a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang outBuffer += 16; 2290a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 2300a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang padLen = 16 - (inputOctets - 16*numBlocks); 2310a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (padLen <= 0 || padLen > 16) 2320a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang panic("rijndael_padEncrypt(ECB)"); 2330a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(input, block, 16 - padLen); 2340a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (cp = block + 16 - padLen; cp < block + 16; cp++) 2350a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *cp = padLen; 2360a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelEncrypt(block, outBuffer, key->keySched, key->ROUNDS); 2370a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 2380a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2390a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case MODE_CBC: 2400a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv = cipher->IV; 2410a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = numBlocks; i > 0; i--) { 2420a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[0] = ((word32*)input)[0] ^ ((word32*)iv)[0]; 2430a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[1] = ((word32*)input)[1] ^ ((word32*)iv)[1]; 2440a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[2] = ((word32*)input)[2] ^ ((word32*)iv)[2]; 2450a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[3] = ((word32*)input)[3] ^ ((word32*)iv)[3]; 2460a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelEncrypt(block, outBuffer, key->keySched, key->ROUNDS); 2470a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv = outBuffer; 2480a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang input += 16; 2490a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang outBuffer += 16; 2500a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 2510a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang padLen = 16 - (inputOctets - 16*numBlocks); 2520a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (padLen <= 0 || padLen > 16) 2530a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang panic("rijndael_padEncrypt(CBC)"); 2540a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = 0; i < 16 - padLen; i++) { 2550a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang block[i] = input[i] ^ iv[i]; 2560a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 2570a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = 16 - padLen; i < 16; i++) { 2580a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang block[i] = (BYTE)padLen ^ iv[i]; 2590a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 2600a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelEncrypt(block, outBuffer, key->keySched, key->ROUNDS); 2610a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 2620a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2630a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang default: 2640a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_CIPHER_STATE; 2650a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 2660a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2670a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return 16*(numBlocks + 1); 2680a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang} 2690a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2700a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wangint rijndael_blockDecrypt(cipherInstance *cipher, keyInstance *key, 2710a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang BYTE *input, int inputLen, BYTE *outBuffer) { 2720a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang int i, k, numBlocks; 2730a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang word8 block[16], iv[4][4]; 2740a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2750a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (cipher == NULL || 2760a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang key == NULL || 2770a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang (cipher->mode != MODE_CFB1 && key->direction == DIR_ENCRYPT)) { 2780a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_CIPHER_STATE; 2790a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 2800a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (input == NULL || inputLen <= 0) { 2810a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return 0; /* nothing to do */ 2820a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 2830a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2840a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang numBlocks = inputLen/128; 2850a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2860a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang switch (cipher->mode) { 2870a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case MODE_ECB: 2880a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = numBlocks; i > 0; i--) { 2890a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelDecrypt(input, outBuffer, key->keySched, key->ROUNDS); 2900a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang input += 16; 2910a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang outBuffer += 16; 2920a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 2930a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 2940a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 2950a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case MODE_CBC: 2960a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#if 1 /*STRICT_ALIGN */ 2970a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(cipher->IV, iv, 16); 2980a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#else 2990a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[0]) = *((word32*)(cipher->IV )); 3000a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[1]) = *((word32*)(cipher->IV+ 4)); 3010a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[2]) = *((word32*)(cipher->IV+ 8)); 3020a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[3]) = *((word32*)(cipher->IV+12)); 3030a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#endif 3040a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = numBlocks; i > 0; i--) { 3050a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelDecrypt(input, block, key->keySched, key->ROUNDS); 3060a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[0] ^= *((word32*)iv[0]); 3070a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[1] ^= *((word32*)iv[1]); 3080a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[2] ^= *((word32*)iv[2]); 3090a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[3] ^= *((word32*)iv[3]); 3100a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#if 1 /*STRICT_ALIGN*/ 3110a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(input, iv, 16); 3120a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(block, outBuffer, 16); 3130a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#else 3140a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[0]) = ((word32*)input)[0]; ((word32*)outBuffer)[0] = ((word32*)block)[0]; 3150a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[1]) = ((word32*)input)[1]; ((word32*)outBuffer)[1] = ((word32*)block)[1]; 3160a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[2]) = ((word32*)input)[2]; ((word32*)outBuffer)[2] = ((word32*)block)[2]; 3170a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[3]) = ((word32*)input)[3]; ((word32*)outBuffer)[3] = ((word32*)block)[3]; 3180a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#endif 3190a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang input += 16; 3200a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang outBuffer += 16; 3210a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 3220a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 3230a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 3240a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case MODE_CFB1: 3250a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#if 1 /*STRICT_ALIGN */ 3260a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(cipher->IV, iv, 16); 3270a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#else 3280a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[0]) = *((word32*)(cipher->IV)); 3290a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[1]) = *((word32*)(cipher->IV+ 4)); 3300a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[2]) = *((word32*)(cipher->IV+ 8)); 3310a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)iv[3]) = *((word32*)(cipher->IV+12)); 3320a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#endif 3330a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = numBlocks; i > 0; i--) { 3340a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (k = 0; k < 128; k++) { 3350a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*) block ) = *((word32*)iv[0]); 3360a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)(block+ 4)) = *((word32*)iv[1]); 3370a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)(block+ 8)) = *((word32*)iv[2]); 3380a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)(block+12)) = *((word32*)iv[3]); 3390a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelEncrypt(block, block, key->keySched, key->ROUNDS); 3400a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[0][0] = (iv[0][0] << 1) | (iv[0][1] >> 7); 3410a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[0][1] = (iv[0][1] << 1) | (iv[0][2] >> 7); 3420a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[0][2] = (iv[0][2] << 1) | (iv[0][3] >> 7); 3430a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[0][3] = (iv[0][3] << 1) | (iv[1][0] >> 7); 3440a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[1][0] = (iv[1][0] << 1) | (iv[1][1] >> 7); 3450a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[1][1] = (iv[1][1] << 1) | (iv[1][2] >> 7); 3460a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[1][2] = (iv[1][2] << 1) | (iv[1][3] >> 7); 3470a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[1][3] = (iv[1][3] << 1) | (iv[2][0] >> 7); 3480a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[2][0] = (iv[2][0] << 1) | (iv[2][1] >> 7); 3490a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[2][1] = (iv[2][1] << 1) | (iv[2][2] >> 7); 3500a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[2][2] = (iv[2][2] << 1) | (iv[2][3] >> 7); 3510a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[2][3] = (iv[2][3] << 1) | (iv[3][0] >> 7); 3520a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[3][0] = (iv[3][0] << 1) | (iv[3][1] >> 7); 3530a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[3][1] = (iv[3][1] << 1) | (iv[3][2] >> 7); 3540a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[3][2] = (iv[3][2] << 1) | (iv[3][3] >> 7); 3550a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang iv[3][3] = (iv[3][3] << 1) | ((input[k/8] >> (7-(k&7))) & 1); 3560a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang outBuffer[k/8] ^= (block[0] & 0x80) >> (k & 7); 3570a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 3580a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 3590a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 3600a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 3610a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang default: 3620a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_CIPHER_STATE; 3630a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 3640a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 3650a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return 128*numBlocks; 3660a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang} 3670a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 3680a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wangint rijndael_padDecrypt(cipherInstance *cipher, keyInstance *key, 3690a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang BYTE *input, int inputOctets, BYTE *outBuffer) { 3700a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang int i, numBlocks, padLen; 3710a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang word8 block[16]; 3720a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang word32 iv[4]; 3730a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 3740a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (cipher == NULL || 3750a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang key == NULL || 3760a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang key->direction == DIR_ENCRYPT) { 3770a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_CIPHER_STATE; 3780a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 3790a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (input == NULL || inputOctets <= 0) { 3800a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return 0; /* nothing to do */ 3810a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 3820a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (inputOctets % 16 != 0) { 3830a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_DATA; 3840a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 3850a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 3860a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang numBlocks = inputOctets/16; 3870a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 3880a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang switch (cipher->mode) { 3890a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case MODE_ECB: 3900a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang /* all blocks but last */ 3910a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = numBlocks - 1; i > 0; i--) { 3920a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelDecrypt(input, outBuffer, key->keySched, key->ROUNDS); 3930a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang input += 16; 3940a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang outBuffer += 16; 3950a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 3960a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang /* last block */ 3970a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelDecrypt(input, block, key->keySched, key->ROUNDS); 3980a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang padLen = block[15]; 3990a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (padLen >= 16) { 4000a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_DATA; 4010a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4020a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = 16 - padLen; i < 16; i++) { 4030a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (block[i] != padLen) { 4040a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_DATA; 4050a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4060a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4070a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(block, outBuffer, 16 - padLen); 4080a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 4090a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4100a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case MODE_CBC: 4110a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(cipher->IV, iv, 16); 4120a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang /* all blocks but last */ 4130a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = numBlocks - 1; i > 0; i--) { 4140a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelDecrypt(input, block, key->keySched, key->ROUNDS); 4150a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[0] ^= iv[0]; 4160a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[1] ^= iv[1]; 4170a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[2] ^= iv[2]; 4180a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[3] ^= iv[3]; 4190a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(input, iv, 16); 4200a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(block, outBuffer, 16); 4210a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang input += 16; 4220a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang outBuffer += 16; 4230a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4240a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang /* last block */ 4250a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelDecrypt(input, block, key->keySched, key->ROUNDS); 4260a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[0] ^= iv[0]; 4270a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[1] ^= iv[1]; 4280a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[2] ^= iv[2]; 4290a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang ((word32*)block)[3] ^= iv[3]; 4300a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang padLen = block[15]; 4310a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (padLen <= 0 || padLen > 16) { 4320a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_DATA; 4330a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4340a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (i = 16 - padLen; i < 16; i++) { 4350a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (block[i] != padLen) { 4360a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_DATA; 4370a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4380a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4390a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang bcopy(block, outBuffer, 16 - padLen); 4400a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 4410a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4420a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang default: 4430a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_CIPHER_STATE; 4440a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4450a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4460a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return 16*numBlocks - padLen; 4470a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang} 4480a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4490a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#ifdef INTERMEDIATE_VALUE_KAT 4500a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang/** 4510a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * cipherUpdateRounds: 4520a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * 4530a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * Encrypts/Decrypts exactly one full block a specified number of rounds. 4540a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * Only used in the Intermediate Value Known Answer Test. 4550a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * 4560a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * Returns: 4570a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * TRUE - on success 4580a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang * BAD_CIPHER_STATE - cipher in bad state (e.g., not initialized) 4590a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang */ 4600a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wangint rijndael_cipherUpdateRounds(cipherInstance *cipher, keyInstance *key, 4610a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang BYTE *input, int inputLen, BYTE *outBuffer, int rounds) { 4620a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang int j; 4630a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang word8 block[4][4]; 4640a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4650a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang if (cipher == NULL || key == NULL) { 4660a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_CIPHER_STATE; 4670a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4680a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4690a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (j = 3; j >= 0; j--) { 4700a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang /* parse input stream into rectangular array */ 4710a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)block[j]) = *((word32*)(input+4*j)); 4720a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4730a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4740a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang switch (key->direction) { 4750a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case DIR_ENCRYPT: 4760a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelEncryptRound(block, key->keySched, key->ROUNDS, rounds); 4770a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 4780a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4790a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang case DIR_DECRYPT: 4800a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang rijndaelDecryptRound(block, key->keySched, key->ROUNDS, rounds); 4810a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang break; 4820a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4830a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang default: 4840a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return BAD_KEY_DIR; 4850a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4860a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4870a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang for (j = 3; j >= 0; j--) { 4880a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang /* parse rectangular array into output ciphertext bytes */ 4890a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang *((word32*)(outBuffer+4*j)) = *((word32*)block[j]); 4900a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang } 4910a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang 4920a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang return TRUE; 4930a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang} 4940a1907d434839af6a9cb6329bbde60b237bf53dcChung-yih Wang#endif /* INTERMEDIATE_VALUE_KAT */ 495