|
@ -0,0 +1,164 @@ |
|
|
|
|
|
#include <stdio.h> |
|
|
|
|
|
#include <string.h> |
|
|
|
|
|
#include <openssl/conf.h> |
|
|
|
|
|
#include <openssl/evp.h> |
|
|
|
|
|
#include <openssl/err.h> |
|
|
|
|
|
|
|
|
|
|
|
static const char HDL_LOGIC_CHAR[] = { 'U', 'X', '0', '1', 'Z', 'W', 'L', 'H', '-'}; |
|
|
|
|
|
|
|
|
|
|
|
enum HDL_LOGIC_STATES { |
|
|
|
|
|
HDL_U = 0, |
|
|
|
|
|
HDL_X = 1, |
|
|
|
|
|
HDL_0 = 2, |
|
|
|
|
|
HDL_1 = 3, |
|
|
|
|
|
HDL_Z = 4, |
|
|
|
|
|
HDL_W = 5, |
|
|
|
|
|
HDL_L = 6, |
|
|
|
|
|
HDL_H = 7, |
|
|
|
|
|
HDL_D = 8, |
|
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
|
|
EVP_CIPHER_CTX *ctx; |
|
|
|
|
|
|
|
|
|
|
|
void slv_to_uchar(char* datain, unsigned char* dataout, int bytelen) { |
|
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < bytelen; i++) { |
|
|
|
|
|
for (int y = 0; y < 8; y++) { |
|
|
|
|
|
if (*datain == HDL_1) { |
|
|
|
|
|
*dataout |= 1 << y; |
|
|
|
|
|
} else if (*datain == HDL_0) { |
|
|
|
|
|
*dataout &= ~(1 << y); |
|
|
|
|
|
} |
|
|
|
|
|
datain++; |
|
|
|
|
|
} |
|
|
|
|
|
dataout++; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
return; |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void slv_to_string(char* datain, char* dataout, int bytelen) { |
|
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < bytelen; i++) { |
|
|
|
|
|
*dataout = HDL_LOGIC_CHAR[*datain]; |
|
|
|
|
|
datain++; |
|
|
|
|
|
dataout++; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
return; |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void uchar_to_slv(unsigned char* datain, char* dataout, int bytelen) { |
|
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i < bytelen; i++) { |
|
|
|
|
|
for (int y = 0; y < 8; y++) { |
|
|
|
|
|
if ((*datain >> y) & 1 == 1) { |
|
|
|
|
|
*dataout = HDL_1 ; |
|
|
|
|
|
} else { |
|
|
|
|
|
*dataout = HDL_0; |
|
|
|
|
|
} |
|
|
|
|
|
dataout++; |
|
|
|
|
|
} |
|
|
|
|
|
datain++; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
return; |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void handleErrors(void) { |
|
|
|
|
|
|
|
|
|
|
|
ERR_print_errors_fp(stderr); |
|
|
|
|
|
abort(); |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void init(unsigned char *key, unsigned char *iv) { |
|
|
|
|
|
|
|
|
|
|
|
// Create and initialise the context |
|
|
|
|
|
if(!(ctx = EVP_CIPHER_CTX_new())) |
|
|
|
|
|
handleErrors(); |
|
|
|
|
|
|
|
|
|
|
|
// Initialise the encryption operation, no IV needed in CTR mode |
|
|
|
|
|
if(1 != EVP_EncryptInit_ex(ctx, EVP_aes_128_ctr(), NULL, key, iv)) |
|
|
|
|
|
handleErrors(); |
|
|
|
|
|
|
|
|
|
|
|
// We don't want padding |
|
|
|
|
|
if(1 != EVP_CIPHER_CTX_set_padding(ctx, 0)) |
|
|
|
|
|
handleErrors(); |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int encrypt(unsigned char *plaintext, |
|
|
|
|
|
int plaintext_len, |
|
|
|
|
|
unsigned char *ciphertext) { |
|
|
|
|
|
|
|
|
|
|
|
int len = 0; |
|
|
|
|
|
|
|
|
|
|
|
// Provide the message to be encrypted, and obtain the encrypted output |
|
|
|
|
|
if (1 != EVP_EncryptUpdate(ctx, ciphertext, &len, plaintext, plaintext_len)) |
|
|
|
|
|
handleErrors(); |
|
|
|
|
|
|
|
|
|
|
|
return len; |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int finalize(void) { |
|
|
|
|
|
|
|
|
|
|
|
int len = 0; |
|
|
|
|
|
unsigned char data[16]; |
|
|
|
|
|
|
|
|
|
|
|
// Finalise the encryption. No further bytes are written as padding is switched off |
|
|
|
|
|
if (1 != EVP_EncryptFinal_ex(ctx, data, &len)) |
|
|
|
|
|
handleErrors(); |
|
|
|
|
|
|
|
|
|
|
|
// Clean up |
|
|
|
|
|
EVP_CIPHER_CTX_free(ctx); |
|
|
|
|
|
|
|
|
|
|
|
return len; |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void cryptData(char* datain, char* key, char* iv, char start, char final, char* dataout, int bytelen) { |
|
|
|
|
|
|
|
|
|
|
|
int crypt_len; |
|
|
|
|
|
unsigned char c_din[bytelen]; |
|
|
|
|
|
unsigned char c_key[bytelen]; |
|
|
|
|
|
unsigned char c_iv[bytelen]; |
|
|
|
|
|
unsigned char c_dout[bytelen]; |
|
|
|
|
|
|
|
|
|
|
|
slv_to_uchar(datain, c_din, bytelen); |
|
|
|
|
|
slv_to_uchar(key, c_key, bytelen); |
|
|
|
|
|
slv_to_uchar(iv, c_iv, bytelen); |
|
|
|
|
|
|
|
|
|
|
|
if (start) { |
|
|
|
|
|
init(c_key, c_iv); |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
crypt_len = encrypt(c_din, bytelen, c_dout); |
|
|
|
|
|
|
|
|
|
|
|
if (crypt_len != bytelen) { |
|
|
|
|
|
printf("Warning: encrypt() returned with unexpected length %d\n", crypt_len); |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
if (final) { |
|
|
|
|
|
crypt_len = finalize(); |
|
|
|
|
|
if (crypt_len != 0) { |
|
|
|
|
|
printf("Warning: finalize() returned with unexpected length %d\n", crypt_len); |
|
|
|
|
|
} |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
uchar_to_slv(c_dout, dataout, bytelen); |
|
|
|
|
|
|
|
|
|
|
|
return; |
|
|
|
|
|
|
|
|
|
|
|
} |