From 0097737ac987e4cfa4de161202da6f4f93c7a5d0 Mon Sep 17 00:00:00 2001 From: Dmitry Belyavskiy Date: Tue, 11 Sep 2018 12:28:40 +0300 Subject: [PATCH] Formatting --- gost_grasshopper_cipher.c | 1470 ++++++++++++++++++------------------- 1 file changed, 735 insertions(+), 735 deletions(-) diff --git a/gost_grasshopper_cipher.c b/gost_grasshopper_cipher.c index d641bcb..2818e86 100644 --- a/gost_grasshopper_cipher.c +++ b/gost_grasshopper_cipher.c @@ -20,849 +20,849 @@ extern "C" { #include "gost_lcl.h" #include "e_gost_err.h" - enum GRASSHOPPER_CIPHER_TYPE { - GRASSHOPPER_CIPHER_ECB = 0, - GRASSHOPPER_CIPHER_CBC, - GRASSHOPPER_CIPHER_OFB, - GRASSHOPPER_CIPHER_CFB, - GRASSHOPPER_CIPHER_CTR, - GRASSHOPPER_CIPHER_CTRACPKM, - }; - - static EVP_CIPHER *gost_grasshopper_ciphers[6] = { - [GRASSHOPPER_CIPHER_ECB] = NULL, - [GRASSHOPPER_CIPHER_CBC] = NULL, - [GRASSHOPPER_CIPHER_OFB] = NULL, - [GRASSHOPPER_CIPHER_CFB] = NULL, - [GRASSHOPPER_CIPHER_CTR] = NULL, - [GRASSHOPPER_CIPHER_CTRACPKM] = NULL, - }; - - static GRASSHOPPER_INLINE void - gost_grasshopper_cipher_destroy_ofb(gost_grasshopper_cipher_ctx * c); - static GRASSHOPPER_INLINE void - gost_grasshopper_cipher_destroy_ctr(gost_grasshopper_cipher_ctx * c); - - struct GRASSHOPPER_CIPHER_PARAMS { - int nid; - grasshopper_init_cipher_func init_cipher; - grasshopper_do_cipher_func do_cipher; - grasshopper_destroy_cipher_func destroy_cipher; - int block_size; - int ctx_size; - int iv_size; - bool padding; - }; - - static struct GRASSHOPPER_CIPHER_PARAMS gost_cipher_params[6] = { - [GRASSHOPPER_CIPHER_ECB] = { - NID_grasshopper_ecb, - gost_grasshopper_cipher_init_ecb, - gost_grasshopper_cipher_do_ecb, - NULL, - 16, - sizeof(gost_grasshopper_cipher_ctx), - 0, - true} - , - [GRASSHOPPER_CIPHER_CBC] = { - NID_grasshopper_cbc, - gost_grasshopper_cipher_init_cbc, - gost_grasshopper_cipher_do_cbc, - NULL, - 16, - sizeof(gost_grasshopper_cipher_ctx), - 16, - true} - , - [GRASSHOPPER_CIPHER_OFB] = { - NID_grasshopper_ofb, - gost_grasshopper_cipher_init_ofb, - gost_grasshopper_cipher_do_ofb, - gost_grasshopper_cipher_destroy_ofb, - 1, - sizeof(gost_grasshopper_cipher_ctx_ofb), - 16, - false} - , - [GRASSHOPPER_CIPHER_CFB] = { - NID_grasshopper_cfb, - gost_grasshopper_cipher_init_cfb, - gost_grasshopper_cipher_do_cfb, - NULL, - 1, - sizeof(gost_grasshopper_cipher_ctx), - 16, - false} - , - [GRASSHOPPER_CIPHER_CTR] = { - NID_grasshopper_ctr, - gost_grasshopper_cipher_init_ctr, - gost_grasshopper_cipher_do_ctr, - gost_grasshopper_cipher_destroy_ctr, - 1, - sizeof(gost_grasshopper_cipher_ctx_ctr), - /* IV size is set to match full block, to make it responsibility of - * user to assign correct values (IV || 0), and to make naive context - * copy possible (for software such as openssh) */ - 16, - false} - , - [GRASSHOPPER_CIPHER_CTRACPKM] = { - NID_id_tc26_cipher_gostr3412_2015_kuznyechik_ctracpkm, - gost_grasshopper_cipher_init_ctracpkm, - gost_grasshopper_cipher_do_ctracpkm, - gost_grasshopper_cipher_destroy_ctr, - 1, - sizeof - (gost_grasshopper_cipher_ctx_ctr), - 16, - false} - , - }; +enum GRASSHOPPER_CIPHER_TYPE { + GRASSHOPPER_CIPHER_ECB = 0, + GRASSHOPPER_CIPHER_CBC, + GRASSHOPPER_CIPHER_OFB, + GRASSHOPPER_CIPHER_CFB, + GRASSHOPPER_CIPHER_CTR, + GRASSHOPPER_CIPHER_CTRACPKM, +}; + +static EVP_CIPHER *gost_grasshopper_ciphers[6] = { + [GRASSHOPPER_CIPHER_ECB] = NULL, + [GRASSHOPPER_CIPHER_CBC] = NULL, + [GRASSHOPPER_CIPHER_OFB] = NULL, + [GRASSHOPPER_CIPHER_CFB] = NULL, + [GRASSHOPPER_CIPHER_CTR] = NULL, + [GRASSHOPPER_CIPHER_CTRACPKM] = NULL, +}; + +static GRASSHOPPER_INLINE void + gost_grasshopper_cipher_destroy_ofb(gost_grasshopper_cipher_ctx * c); +static GRASSHOPPER_INLINE void + gost_grasshopper_cipher_destroy_ctr(gost_grasshopper_cipher_ctx * c); + +struct GRASSHOPPER_CIPHER_PARAMS { + int nid; + grasshopper_init_cipher_func init_cipher; + grasshopper_do_cipher_func do_cipher; + grasshopper_destroy_cipher_func destroy_cipher; + int block_size; + int ctx_size; + int iv_size; + bool padding; +}; + +static struct GRASSHOPPER_CIPHER_PARAMS gost_cipher_params[6] = { + [GRASSHOPPER_CIPHER_ECB] = { + NID_grasshopper_ecb, + gost_grasshopper_cipher_init_ecb, + gost_grasshopper_cipher_do_ecb, + NULL, + 16, + sizeof(gost_grasshopper_cipher_ctx), + 0, + true} + , + [GRASSHOPPER_CIPHER_CBC] = { + NID_grasshopper_cbc, + gost_grasshopper_cipher_init_cbc, + gost_grasshopper_cipher_do_cbc, + NULL, + 16, + sizeof(gost_grasshopper_cipher_ctx), + 16, + true} + , + [GRASSHOPPER_CIPHER_OFB] = { + NID_grasshopper_ofb, + gost_grasshopper_cipher_init_ofb, + gost_grasshopper_cipher_do_ofb, + gost_grasshopper_cipher_destroy_ofb, + 1, + sizeof(gost_grasshopper_cipher_ctx_ofb), + 16, + false} + , + [GRASSHOPPER_CIPHER_CFB] = { + NID_grasshopper_cfb, + gost_grasshopper_cipher_init_cfb, + gost_grasshopper_cipher_do_cfb, + NULL, + 1, + sizeof(gost_grasshopper_cipher_ctx), + 16, + false} + , + [GRASSHOPPER_CIPHER_CTR] = { + NID_grasshopper_ctr, + gost_grasshopper_cipher_init_ctr, + gost_grasshopper_cipher_do_ctr, + gost_grasshopper_cipher_destroy_ctr, + 1, + sizeof(gost_grasshopper_cipher_ctx_ctr), + /* IV size is set to match full block, to make it responsibility of + * user to assign correct values (IV || 0), and to make naive context + * copy possible (for software such as openssh) */ + 16, + false} + , + [GRASSHOPPER_CIPHER_CTRACPKM] = { + NID_id_tc26_cipher_gostr3412_2015_kuznyechik_ctracpkm, + gost_grasshopper_cipher_init_ctracpkm, + gost_grasshopper_cipher_do_ctracpkm, + gost_grasshopper_cipher_destroy_ctr, + 1, + sizeof + (gost_grasshopper_cipher_ctx_ctr), + 16, + false} + , +}; /* first 256 bit of D from draft-irtf-cfrg-re-keying-12 */ - static const unsigned char ACPKM_D_2018[] = { - 0x80, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, /* 64 bit */ - 0x88, 0x89, 0x8a, 0x8b, 0x8c, 0x8d, 0x8e, 0x8f, /* 128 bit */ - 0x90, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, - 0x98, 0x99, 0x9a, 0x9b, 0x9c, 0x9d, 0x9e, 0x9f, /* 256 bit */ - }; - - static void acpkm_next(gost_grasshopper_cipher_ctx * c) { - unsigned char newkey[GRASSHOPPER_KEY_SIZE]; - const int J = GRASSHOPPER_KEY_SIZE / GRASSHOPPER_BLOCK_SIZE; - int n; - - for (n = 0; n < J; n++) { - const unsigned char *D_n = - &ACPKM_D_2018[n * GRASSHOPPER_BLOCK_SIZE]; - - grasshopper_encrypt_block(&c->encrypt_round_keys, - (grasshopper_w128_t *) D_n, - (grasshopper_w128_t *) & newkey[n * - GRASSHOPPER_BLOCK_SIZE], - &c->buffer); - } - gost_grasshopper_cipher_key(c, newkey); - } +static const unsigned char ACPKM_D_2018[] = { + 0x80, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, /* 64 bit */ + 0x88, 0x89, 0x8a, 0x8b, 0x8c, 0x8d, 0x8e, 0x8f, /* 128 bit */ + 0x90, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, + 0x98, 0x99, 0x9a, 0x9b, 0x9c, 0x9d, 0x9e, 0x9f, /* 256 bit */ +}; + +static void acpkm_next(gost_grasshopper_cipher_ctx * c) { + unsigned char newkey[GRASSHOPPER_KEY_SIZE]; + const int J = GRASSHOPPER_KEY_SIZE / GRASSHOPPER_BLOCK_SIZE; + int n; + + for (n = 0; n < J; n++) { + const unsigned char *D_n = + &ACPKM_D_2018[n * GRASSHOPPER_BLOCK_SIZE]; + + grasshopper_encrypt_block(&c->encrypt_round_keys, + (grasshopper_w128_t *) D_n, + (grasshopper_w128_t *) & newkey[n * + GRASSHOPPER_BLOCK_SIZE], + &c->buffer); + } + gost_grasshopper_cipher_key(c, newkey); +} /* Set 256 bit key into context */ - GRASSHOPPER_INLINE void - gost_grasshopper_cipher_key(gost_grasshopper_cipher_ctx * c, - const uint8_t *k) { - int i; - for (i = 0; i < 2; i++) { - grasshopper_copy128(&c->key.k.k[i], - (const grasshopper_w128_t *)(k + i * 16)); - } - grasshopper_set_encrypt_key(&c->encrypt_round_keys, &c->key); - grasshopper_set_decrypt_key(&c->decrypt_round_keys, &c->key); - } +GRASSHOPPER_INLINE void + gost_grasshopper_cipher_key(gost_grasshopper_cipher_ctx * c, + const uint8_t *k) { + int i; + for (i = 0; i < 2; i++) { + grasshopper_copy128(&c->key.k.k[i], + (const grasshopper_w128_t *)(k + i * 16)); + } + grasshopper_set_encrypt_key(&c->encrypt_round_keys, &c->key); + grasshopper_set_decrypt_key(&c->decrypt_round_keys, &c->key); +} /* Cleans up key from context */ - GRASSHOPPER_INLINE void - gost_grasshopper_cipher_destroy(gost_grasshopper_cipher_ctx * c) { - int i; - for (i = 0; i < 2; i++) { - grasshopper_zero128(&c->key.k.k[i]); - } - for (i = 0; i < GRASSHOPPER_ROUND_KEYS_COUNT; i++) { - grasshopper_zero128(&c->encrypt_round_keys.k[i]); - } - for (i = 0; i < GRASSHOPPER_ROUND_KEYS_COUNT; i++) { - grasshopper_zero128(&c->decrypt_round_keys.k[i]); - } - grasshopper_zero128(&c->buffer); +GRASSHOPPER_INLINE void + gost_grasshopper_cipher_destroy(gost_grasshopper_cipher_ctx * c) { + int i; + for (i = 0; i < 2; i++) { + grasshopper_zero128(&c->key.k.k[i]); } - - static GRASSHOPPER_INLINE void - gost_grasshopper_cipher_destroy_ofb(gost_grasshopper_cipher_ctx * c) { - gost_grasshopper_cipher_ctx_ofb *ctx = - (gost_grasshopper_cipher_ctx_ofb *) c; - - grasshopper_zero128(&ctx->buffer1); + for (i = 0; i < GRASSHOPPER_ROUND_KEYS_COUNT; i++) { + grasshopper_zero128(&c->encrypt_round_keys.k[i]); } - - static GRASSHOPPER_INLINE void - gost_grasshopper_cipher_destroy_ctr(gost_grasshopper_cipher_ctx * c) { - gost_grasshopper_cipher_ctx_ctr *ctx = - (gost_grasshopper_cipher_ctx_ctr *) c; - - grasshopper_zero128(&ctx->partial_buffer); + for (i = 0; i < GRASSHOPPER_ROUND_KEYS_COUNT; i++) { + grasshopper_zero128(&c->decrypt_round_keys.k[i]); } + grasshopper_zero128(&c->buffer); +} - int gost_grasshopper_cipher_init(EVP_CIPHER_CTX *ctx, - const unsigned char *key, - const unsigned char *iv, int enc) { - gost_grasshopper_cipher_ctx *c = EVP_CIPHER_CTX_get_cipher_data(ctx); +static GRASSHOPPER_INLINE void + gost_grasshopper_cipher_destroy_ofb(gost_grasshopper_cipher_ctx * c) { + gost_grasshopper_cipher_ctx_ofb *ctx = + (gost_grasshopper_cipher_ctx_ofb *) c; - if (EVP_CIPHER_CTX_get_app_data(ctx) == NULL) { - EVP_CIPHER_CTX_set_app_data(ctx, - EVP_CIPHER_CTX_get_cipher_data(ctx)); - } + grasshopper_zero128(&ctx->buffer1); +} - if (key != NULL) { - gost_grasshopper_cipher_key(c, key); - } +static GRASSHOPPER_INLINE void + gost_grasshopper_cipher_destroy_ctr(gost_grasshopper_cipher_ctx * c) { + gost_grasshopper_cipher_ctx_ctr *ctx = + (gost_grasshopper_cipher_ctx_ctr *) c; - if (iv != NULL) { - memcpy((unsigned char *)EVP_CIPHER_CTX_original_iv(ctx), iv, - EVP_CIPHER_CTX_iv_length(ctx)); - } - - memcpy(EVP_CIPHER_CTX_iv_noconst(ctx), - EVP_CIPHER_CTX_original_iv(ctx), EVP_CIPHER_CTX_iv_length(ctx)); + grasshopper_zero128(&ctx->partial_buffer); +} - grasshopper_zero128(&c->buffer); +int gost_grasshopper_cipher_init(EVP_CIPHER_CTX *ctx, + const unsigned char *key, + const unsigned char *iv, int enc) { + gost_grasshopper_cipher_ctx *c = EVP_CIPHER_CTX_get_cipher_data(ctx); - return 1; + if (EVP_CIPHER_CTX_get_app_data(ctx) == NULL) { + EVP_CIPHER_CTX_set_app_data(ctx, + EVP_CIPHER_CTX_get_cipher_data(ctx)); } - GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_ecb(EVP_CIPHER_CTX *ctx, - const unsigned char - *key, - const unsigned char - *iv, int enc) { - gost_grasshopper_cipher_ctx *c = EVP_CIPHER_CTX_get_cipher_data(ctx); - c->type = GRASSHOPPER_CIPHER_ECB; - return gost_grasshopper_cipher_init(ctx, key, iv, enc); + if (key != NULL) { + gost_grasshopper_cipher_key(c, key); } - GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_cbc(EVP_CIPHER_CTX *ctx, - const unsigned char - *key, - const unsigned char - *iv, int enc) { - gost_grasshopper_cipher_ctx *c = EVP_CIPHER_CTX_get_cipher_data(ctx); - c->type = GRASSHOPPER_CIPHER_CBC; - return gost_grasshopper_cipher_init(ctx, key, iv, enc); + if (iv != NULL) { + memcpy((unsigned char *)EVP_CIPHER_CTX_original_iv(ctx), iv, + EVP_CIPHER_CTX_iv_length(ctx)); } - GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_ofb(EVP_CIPHER_CTX *ctx, - const unsigned char - *key, - const unsigned char - *iv, int enc) { - gost_grasshopper_cipher_ctx_ofb *c = - EVP_CIPHER_CTX_get_cipher_data(ctx); + memcpy(EVP_CIPHER_CTX_iv_noconst(ctx), + EVP_CIPHER_CTX_original_iv(ctx), EVP_CIPHER_CTX_iv_length(ctx)); - c->c.type = GRASSHOPPER_CIPHER_OFB; + grasshopper_zero128(&c->buffer); - grasshopper_zero128(&c->buffer1); + return 1; +} - return gost_grasshopper_cipher_init(ctx, key, iv, enc); - } +GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_ecb(EVP_CIPHER_CTX *ctx, + const unsigned char + *key, + const unsigned char + *iv, int enc) { + gost_grasshopper_cipher_ctx *c = EVP_CIPHER_CTX_get_cipher_data(ctx); + c->type = GRASSHOPPER_CIPHER_ECB; + return gost_grasshopper_cipher_init(ctx, key, iv, enc); +} - GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_cfb(EVP_CIPHER_CTX *ctx, - const unsigned char - *key, - const unsigned char - *iv, int enc) { - gost_grasshopper_cipher_ctx *c = EVP_CIPHER_CTX_get_cipher_data(ctx); - c->type = GRASSHOPPER_CIPHER_CFB; - return gost_grasshopper_cipher_init(ctx, key, iv, enc); - } +GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_cbc(EVP_CIPHER_CTX *ctx, + const unsigned char + *key, + const unsigned char + *iv, int enc) { + gost_grasshopper_cipher_ctx *c = EVP_CIPHER_CTX_get_cipher_data(ctx); + c->type = GRASSHOPPER_CIPHER_CBC; + return gost_grasshopper_cipher_init(ctx, key, iv, enc); +} - GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_ctr(EVP_CIPHER_CTX *ctx, - const unsigned char - *key, - const unsigned char - *iv, int enc) { - gost_grasshopper_cipher_ctx_ctr *c = - EVP_CIPHER_CTX_get_cipher_data(ctx); +GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_ofb(EVP_CIPHER_CTX *ctx, + const unsigned char + *key, + const unsigned char + *iv, int enc) { + gost_grasshopper_cipher_ctx_ofb *c = + EVP_CIPHER_CTX_get_cipher_data(ctx); - c->c.type = GRASSHOPPER_CIPHER_CTR; - EVP_CIPHER_CTX_set_num(ctx, 0); + c->c.type = GRASSHOPPER_CIPHER_OFB; - grasshopper_zero128(&c->partial_buffer); + grasshopper_zero128(&c->buffer1); - return gost_grasshopper_cipher_init(ctx, key, iv, enc); - } + return gost_grasshopper_cipher_init(ctx, key, iv, enc); +} - GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_ctracpkm(EVP_CIPHER_CTX - *ctx, - const unsigned - char *key, - const unsigned - char *iv, - int enc) { - gost_grasshopper_cipher_ctx_ctr *c = - EVP_CIPHER_CTX_get_cipher_data(ctx); - - /* NB: setting type makes EVP do_cipher callback useless */ - c->c.type = GRASSHOPPER_CIPHER_CTRACPKM; - EVP_CIPHER_CTX_set_num(ctx, 0); - c->section_size = 4096; +GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_cfb(EVP_CIPHER_CTX *ctx, + const unsigned char + *key, + const unsigned char + *iv, int enc) { + gost_grasshopper_cipher_ctx *c = EVP_CIPHER_CTX_get_cipher_data(ctx); + c->type = GRASSHOPPER_CIPHER_CFB; + return gost_grasshopper_cipher_init(ctx, key, iv, enc); +} - return gost_grasshopper_cipher_init(ctx, key, iv, enc); - } +GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_ctr(EVP_CIPHER_CTX *ctx, + const unsigned char + *key, + const unsigned char + *iv, int enc) { + gost_grasshopper_cipher_ctx_ctr *c = + EVP_CIPHER_CTX_get_cipher_data(ctx); - GRASSHOPPER_INLINE int gost_grasshopper_cipher_do(EVP_CIPHER_CTX *ctx, - unsigned char *out, - const unsigned char *in, - size_t inl) { - gost_grasshopper_cipher_ctx *c = - (gost_grasshopper_cipher_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx); - struct GRASSHOPPER_CIPHER_PARAMS *params = &gost_cipher_params[c->type]; + c->c.type = GRASSHOPPER_CIPHER_CTR; + EVP_CIPHER_CTX_set_num(ctx, 0); - return params->do_cipher(ctx, out, in, inl); - } + grasshopper_zero128(&c->partial_buffer); - int gost_grasshopper_cipher_do_ecb(EVP_CIPHER_CTX *ctx, unsigned char *out, - const unsigned char *in, size_t inl) { - gost_grasshopper_cipher_ctx *c = - (gost_grasshopper_cipher_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx); - bool encrypting = (bool) EVP_CIPHER_CTX_encrypting(ctx); - const unsigned char *current_in = in; - unsigned char *current_out = out; - size_t blocks = inl / GRASSHOPPER_BLOCK_SIZE; - size_t i; - - for (i = 0; i < blocks; - i++, current_in += GRASSHOPPER_BLOCK_SIZE, current_out += - GRASSHOPPER_BLOCK_SIZE) { - if (encrypting) { - grasshopper_encrypt_block(&c->encrypt_round_keys, - (grasshopper_w128_t *) current_in, - (grasshopper_w128_t *) current_out, - &c->buffer); - } else { - grasshopper_decrypt_block(&c->decrypt_round_keys, - (grasshopper_w128_t *) current_in, - (grasshopper_w128_t *) current_out, - &c->buffer); - } - } + return gost_grasshopper_cipher_init(ctx, key, iv, enc); +} - return 1; - } +GRASSHOPPER_INLINE int gost_grasshopper_cipher_init_ctracpkm(EVP_CIPHER_CTX + *ctx, + const unsigned + char *key, + const unsigned + char *iv, + int enc) { + gost_grasshopper_cipher_ctx_ctr *c = + EVP_CIPHER_CTX_get_cipher_data(ctx); + + /* NB: setting type makes EVP do_cipher callback useless */ + c->c.type = GRASSHOPPER_CIPHER_CTRACPKM; + EVP_CIPHER_CTX_set_num(ctx, 0); + c->section_size = 4096; + + return gost_grasshopper_cipher_init(ctx, key, iv, enc); +} - int gost_grasshopper_cipher_do_cbc(EVP_CIPHER_CTX *ctx, unsigned char *out, - const unsigned char *in, size_t inl) { - gost_grasshopper_cipher_ctx *c = - (gost_grasshopper_cipher_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx); - unsigned char *iv = EVP_CIPHER_CTX_iv_noconst(ctx); - bool encrypting = (bool) EVP_CIPHER_CTX_encrypting(ctx); - const unsigned char *current_in = in; - unsigned char *current_out = out; - grasshopper_w128_t *currentInputBlock; - grasshopper_w128_t *currentOutputBlock; - size_t blocks = inl / GRASSHOPPER_BLOCK_SIZE; - size_t i; - grasshopper_w128_t *currentBlock; - - currentBlock = (grasshopper_w128_t *) iv; - - for (i = 0; i < blocks; - i++, current_in += GRASSHOPPER_BLOCK_SIZE, current_out += - GRASSHOPPER_BLOCK_SIZE) { - currentInputBlock = (grasshopper_w128_t *) current_in; - currentOutputBlock = (grasshopper_w128_t *) current_out; - if (encrypting) { - grasshopper_append128(currentBlock, currentInputBlock); - grasshopper_encrypt_block(&c->encrypt_round_keys, currentBlock, - currentOutputBlock, &c->buffer); - grasshopper_copy128(currentBlock, currentOutputBlock); - } else { - grasshopper_decrypt_block(&c->decrypt_round_keys, - currentInputBlock, currentOutputBlock, - &c->buffer); - grasshopper_append128(currentOutputBlock, currentBlock); - grasshopper_copy128(currentBlock, currentInputBlock); - } - } +GRASSHOPPER_INLINE int gost_grasshopper_cipher_do(EVP_CIPHER_CTX *ctx, + unsigned char *out, + const unsigned char *in, + size_t inl) { + gost_grasshopper_cipher_ctx *c = + (gost_grasshopper_cipher_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx); + struct GRASSHOPPER_CIPHER_PARAMS *params = &gost_cipher_params[c->type]; - return 1; - } + return params->do_cipher(ctx, out, in, inl); +} - void inc_counter(unsigned char *counter, size_t counter_bytes) { - unsigned char c; - unsigned int n = counter_bytes; - - do { - --n; - c = counter[n]; - ++c; - counter[n] = c; - if (c) - return; - } while (n); +int gost_grasshopper_cipher_do_ecb(EVP_CIPHER_CTX *ctx, unsigned char *out, + const unsigned char *in, size_t inl) { + gost_grasshopper_cipher_ctx *c = + (gost_grasshopper_cipher_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx); + bool encrypting = (bool) EVP_CIPHER_CTX_encrypting(ctx); + const unsigned char *current_in = in; + unsigned char *current_out = out; + size_t blocks = inl / GRASSHOPPER_BLOCK_SIZE; + size_t i; + + for (i = 0; i < blocks; + i++, current_in += GRASSHOPPER_BLOCK_SIZE, current_out += + GRASSHOPPER_BLOCK_SIZE) { + if (encrypting) { + grasshopper_encrypt_block(&c->encrypt_round_keys, + (grasshopper_w128_t *) current_in, + (grasshopper_w128_t *) current_out, + &c->buffer); + } else { + grasshopper_decrypt_block(&c->decrypt_round_keys, + (grasshopper_w128_t *) current_in, + (grasshopper_w128_t *) current_out, + &c->buffer); + } } -/* increment counter (128-bit int) by 1 */ - static void ctr128_inc(unsigned char *counter) { - inc_counter(counter, 16); - } + return 1; +} - int gost_grasshopper_cipher_do_ctr(EVP_CIPHER_CTX *ctx, unsigned char *out, - const unsigned char *in, size_t inl) { - gost_grasshopper_cipher_ctx_ctr *c = - (gost_grasshopper_cipher_ctx_ctr *) - EVP_CIPHER_CTX_get_cipher_data(ctx); - unsigned char *iv = EVP_CIPHER_CTX_iv_noconst(ctx); - const unsigned char *current_in = in; - unsigned char *current_out = out; - grasshopper_w128_t *currentInputBlock; - grasshopper_w128_t *currentOutputBlock; - unsigned int n = EVP_CIPHER_CTX_num(ctx); - size_t lasted; - size_t i; - - while (n && inl) { - *(current_out++) = *(current_in++) ^ c->partial_buffer.b[n]; - --inl; - n = (n + 1) % GRASSHOPPER_BLOCK_SIZE; - } - EVP_CIPHER_CTX_set_num(ctx, n); - size_t blocks = inl / GRASSHOPPER_BLOCK_SIZE; - - grasshopper_w128_t *iv_buffer = (grasshopper_w128_t *) iv; - - // full parts - for (i = 0; i < blocks; i++) { - currentInputBlock = (grasshopper_w128_t *) current_in; - currentOutputBlock = (grasshopper_w128_t *) current_out; - grasshopper_encrypt_block(&c->c.encrypt_round_keys, iv_buffer, - currentOutputBlock, &c->c.buffer); - grasshopper_append128(currentOutputBlock, currentInputBlock); - ctr128_inc(iv_buffer->b); - current_in += GRASSHOPPER_BLOCK_SIZE; - current_out += GRASSHOPPER_BLOCK_SIZE; +int gost_grasshopper_cipher_do_cbc(EVP_CIPHER_CTX *ctx, unsigned char *out, + const unsigned char *in, size_t inl) { + gost_grasshopper_cipher_ctx *c = + (gost_grasshopper_cipher_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx); + unsigned char *iv = EVP_CIPHER_CTX_iv_noconst(ctx); + bool encrypting = (bool) EVP_CIPHER_CTX_encrypting(ctx); + const unsigned char *current_in = in; + unsigned char *current_out = out; + grasshopper_w128_t *currentInputBlock; + grasshopper_w128_t *currentOutputBlock; + size_t blocks = inl / GRASSHOPPER_BLOCK_SIZE; + size_t i; + grasshopper_w128_t *currentBlock; + + currentBlock = (grasshopper_w128_t *) iv; + + for (i = 0; i < blocks; + i++, current_in += GRASSHOPPER_BLOCK_SIZE, current_out += + GRASSHOPPER_BLOCK_SIZE) { + currentInputBlock = (grasshopper_w128_t *) current_in; + currentOutputBlock = (grasshopper_w128_t *) current_out; + if (encrypting) { + grasshopper_append128(currentBlock, currentInputBlock); + grasshopper_encrypt_block(&c->encrypt_round_keys, currentBlock, + currentOutputBlock, &c->buffer); + grasshopper_copy128(currentBlock, currentOutputBlock); + } else { + grasshopper_decrypt_block(&c->decrypt_round_keys, + currentInputBlock, currentOutputBlock, + &c->buffer); + grasshopper_append128(currentOutputBlock, currentBlock); + grasshopper_copy128(currentBlock, currentInputBlock); } + } - // last part - lasted = inl - blocks * GRASSHOPPER_BLOCK_SIZE; - if (lasted > 0) { - currentInputBlock = (grasshopper_w128_t *) current_in; - currentOutputBlock = (grasshopper_w128_t *) current_out; - grasshopper_encrypt_block(&c->c.encrypt_round_keys, iv_buffer, - &c->partial_buffer, &c->c.buffer); - for (i = 0; i < lasted; i++) { - currentOutputBlock->b[i] = - c->partial_buffer.b[i] ^ currentInputBlock->b[i]; - } - EVP_CIPHER_CTX_set_num(ctx, i); - ctr128_inc(iv_buffer->b); - } + return 1; +} - return 1; - } +void inc_counter(unsigned char *counter, size_t counter_bytes) { + unsigned char c; + unsigned int n = counter_bytes; -#define GRASSHOPPER_BLOCK_MASK (GRASSHOPPER_BLOCK_SIZE - 1) - static inline void apply_acpkm_grasshopper(gost_grasshopper_cipher_ctx_ctr * - ctx, unsigned int *num) { - if (!ctx->section_size || (*num < ctx->section_size)) + do { + --n; + c = counter[n]; + ++c; + counter[n] = c; + if (c) return; - acpkm_next(&ctx->c); - *num &= GRASSHOPPER_BLOCK_MASK; - } + } while (n); +} -/* If meshing is not configured via ctrl (setting section_size) - * this function works exactly like plain ctr */ - int gost_grasshopper_cipher_do_ctracpkm(EVP_CIPHER_CTX *ctx, - unsigned char *out, - const unsigned char *in, - size_t inl) { - gost_grasshopper_cipher_ctx_ctr *c = - EVP_CIPHER_CTX_get_cipher_data(ctx); - unsigned char *iv = EVP_CIPHER_CTX_iv_noconst(ctx); - unsigned int num = EVP_CIPHER_CTX_num(ctx); - - while ((num & GRASSHOPPER_BLOCK_MASK) && inl) { - *out++ = *in++ ^ c->partial_buffer.b[num & GRASSHOPPER_BLOCK_MASK]; - --inl; - num++; - } - size_t blocks = inl / GRASSHOPPER_BLOCK_SIZE; - size_t i; - - // full parts - for (i = 0; i < blocks; i++) { - apply_acpkm_grasshopper(c, &num); - grasshopper_encrypt_block(&c->c.encrypt_round_keys, - (grasshopper_w128_t *) iv, - (grasshopper_w128_t *) out, &c->c.buffer); - grasshopper_append128((grasshopper_w128_t *) out, - (grasshopper_w128_t *) in); - ctr128_inc(iv); - in += GRASSHOPPER_BLOCK_SIZE; - out += GRASSHOPPER_BLOCK_SIZE; - num += GRASSHOPPER_BLOCK_SIZE; - } +/* increment counter (128-bit int) by 1 */ +static void ctr128_inc(unsigned char *counter) { + inc_counter(counter, 16); +} - // last part - size_t lasted = inl - blocks * GRASSHOPPER_BLOCK_SIZE; - if (lasted > 0) { - apply_acpkm_grasshopper(c, &num); - grasshopper_encrypt_block(&c->c.encrypt_round_keys, - (grasshopper_w128_t *) iv, - &c->partial_buffer, &c->c.buffer); - for (i = 0; i < lasted; i++) - out[i] = c->partial_buffer.b[i] ^ in[i]; - ctr128_inc(iv); - num += lasted; +int gost_grasshopper_cipher_do_ctr(EVP_CIPHER_CTX *ctx, unsigned char *out, + const unsigned char *in, size_t inl) { + gost_grasshopper_cipher_ctx_ctr *c = + (gost_grasshopper_cipher_ctx_ctr *) + EVP_CIPHER_CTX_get_cipher_data(ctx); + unsigned char *iv = EVP_CIPHER_CTX_iv_noconst(ctx); + const unsigned char *current_in = in; + unsigned char *current_out = out; + grasshopper_w128_t *currentInputBlock; + grasshopper_w128_t *currentOutputBlock; + unsigned int n = EVP_CIPHER_CTX_num(ctx); + size_t lasted; + size_t i; + + while (n && inl) { + *(current_out++) = *(current_in++) ^ c->partial_buffer.b[n]; + --inl; + n = (n + 1) % GRASSHOPPER_BLOCK_SIZE; + } + EVP_CIPHER_CTX_set_num(ctx, n); + size_t blocks = inl / GRASSHOPPER_BLOCK_SIZE; + + grasshopper_w128_t *iv_buffer = (grasshopper_w128_t *) iv; + + // full parts + for (i = 0; i < blocks; i++) { + currentInputBlock = (grasshopper_w128_t *) current_in; + currentOutputBlock = (grasshopper_w128_t *) current_out; + grasshopper_encrypt_block(&c->c.encrypt_round_keys, iv_buffer, + currentOutputBlock, &c->c.buffer); + grasshopper_append128(currentOutputBlock, currentInputBlock); + ctr128_inc(iv_buffer->b); + current_in += GRASSHOPPER_BLOCK_SIZE; + current_out += GRASSHOPPER_BLOCK_SIZE; + } + + // last part + lasted = inl - blocks * GRASSHOPPER_BLOCK_SIZE; + if (lasted > 0) { + currentInputBlock = (grasshopper_w128_t *) current_in; + currentOutputBlock = (grasshopper_w128_t *) current_out; + grasshopper_encrypt_block(&c->c.encrypt_round_keys, iv_buffer, + &c->partial_buffer, &c->c.buffer); + for (i = 0; i < lasted; i++) { + currentOutputBlock->b[i] = + c->partial_buffer.b[i] ^ currentInputBlock->b[i]; } - EVP_CIPHER_CTX_set_num(ctx, num); - - return 1; + EVP_CIPHER_CTX_set_num(ctx, i); + ctr128_inc(iv_buffer->b); } + return 1; +} + +#define GRASSHOPPER_BLOCK_MASK (GRASSHOPPER_BLOCK_SIZE - 1) +static inline void apply_acpkm_grasshopper(gost_grasshopper_cipher_ctx_ctr * + ctx, unsigned int *num) { + if (!ctx->section_size || (*num < ctx->section_size)) + return; + acpkm_next(&ctx->c); + *num &= GRASSHOPPER_BLOCK_MASK; +} + +/* If meshing is not configured via ctrl (setting section_size) + * this function works exactly like plain ctr */ +int gost_grasshopper_cipher_do_ctracpkm(EVP_CIPHER_CTX *ctx, + unsigned char *out, + const unsigned char *in, + size_t inl) { + gost_grasshopper_cipher_ctx_ctr *c = + EVP_CIPHER_CTX_get_cipher_data(ctx); + unsigned char *iv = EVP_CIPHER_CTX_iv_noconst(ctx); + unsigned int num = EVP_CIPHER_CTX_num(ctx); + + while ((num & GRASSHOPPER_BLOCK_MASK) && inl) { + *out++ = *in++ ^ c->partial_buffer.b[num & GRASSHOPPER_BLOCK_MASK]; + --inl; + num++; + } + size_t blocks = inl / GRASSHOPPER_BLOCK_SIZE; + size_t i; + + // full parts + for (i = 0; i < blocks; i++) { + apply_acpkm_grasshopper(c, &num); + grasshopper_encrypt_block(&c->c.encrypt_round_keys, + (grasshopper_w128_t *) iv, + (grasshopper_w128_t *) out, &c->c.buffer); + grasshopper_append128((grasshopper_w128_t *) out, + (grasshopper_w128_t *) in); + ctr128_inc(iv); + in += GRASSHOPPER_BLOCK_SIZE; + out += GRASSHOPPER_BLOCK_SIZE; + num += GRASSHOPPER_BLOCK_SIZE; + } + + // last part + size_t lasted = inl - blocks * GRASSHOPPER_BLOCK_SIZE; + if (lasted > 0) { + apply_acpkm_grasshopper(c, &num); + grasshopper_encrypt_block(&c->c.encrypt_round_keys, + (grasshopper_w128_t *) iv, + &c->partial_buffer, &c->c.buffer); + for (i = 0; i < lasted; i++) + out[i] = c->partial_buffer.b[i] ^ in[i]; + ctr128_inc(iv); + num += lasted; + } + EVP_CIPHER_CTX_set_num(ctx, num); + + return 1; +} + /* * Fixed 128-bit IV implementation make shift regiser redundant. */ - static void gost_grasshopper_cnt_next(gost_grasshopper_cipher_ctx_ofb * ctx, - grasshopper_w128_t * iv, - grasshopper_w128_t * buf) { - memcpy(&ctx->buffer1, iv, 16); - grasshopper_encrypt_block(&ctx->c.encrypt_round_keys, &ctx->buffer1, - buf, &ctx->c.buffer); - memcpy(iv, buf, 16); - } - - int gost_grasshopper_cipher_do_ofb(EVP_CIPHER_CTX *ctx, unsigned char *out, - const unsigned char *in, size_t inl) { - gost_grasshopper_cipher_ctx_ofb *c = - (gost_grasshopper_cipher_ctx_ofb *) - EVP_CIPHER_CTX_get_cipher_data(ctx); - const unsigned char *in_ptr = in; - unsigned char *out_ptr = out; - unsigned char *buf = EVP_CIPHER_CTX_buf_noconst(ctx); - unsigned char *iv = EVP_CIPHER_CTX_iv_noconst(ctx); - int num = EVP_CIPHER_CTX_num(ctx); - size_t i = 0; - size_t j; - - /* process partial block if any */ - if (num > 0) { - for (j = (size_t)num, i = 0; j < GRASSHOPPER_BLOCK_SIZE && i < inl; - j++, i++, in_ptr++, out_ptr++) { - *out_ptr = buf[j] ^ (*in_ptr); - } - if (j == GRASSHOPPER_BLOCK_SIZE) { - EVP_CIPHER_CTX_set_num(ctx, 0); - } else { - EVP_CIPHER_CTX_set_num(ctx, (int)j); - return 1; - } - } +static void gost_grasshopper_cnt_next(gost_grasshopper_cipher_ctx_ofb * ctx, + grasshopper_w128_t * iv, + grasshopper_w128_t * buf) { + memcpy(&ctx->buffer1, iv, 16); + grasshopper_encrypt_block(&ctx->c.encrypt_round_keys, &ctx->buffer1, + buf, &ctx->c.buffer); + memcpy(iv, buf, 16); +} - for (; i + GRASSHOPPER_BLOCK_SIZE < - inl; - i += GRASSHOPPER_BLOCK_SIZE, in_ptr += - GRASSHOPPER_BLOCK_SIZE, out_ptr += GRASSHOPPER_BLOCK_SIZE) { - /* - * block cipher current iv - */ - /* Encrypt */ - gost_grasshopper_cnt_next(c, (grasshopper_w128_t *) iv, - (grasshopper_w128_t *) buf); - - /* - * xor next block of input text with it and output it - */ - /* - * output this block - */ - for (j = 0; j < GRASSHOPPER_BLOCK_SIZE; j++) { - out_ptr[j] = buf[j] ^ in_ptr[j]; - } +int gost_grasshopper_cipher_do_ofb(EVP_CIPHER_CTX *ctx, unsigned char *out, + const unsigned char *in, size_t inl) { + gost_grasshopper_cipher_ctx_ofb *c = + (gost_grasshopper_cipher_ctx_ofb *) + EVP_CIPHER_CTX_get_cipher_data(ctx); + const unsigned char *in_ptr = in; + unsigned char *out_ptr = out; + unsigned char *buf = EVP_CIPHER_CTX_buf_noconst(ctx); + unsigned char *iv = EVP_CIPHER_CTX_iv_noconst(ctx); + int num = EVP_CIPHER_CTX_num(ctx); + size_t i = 0; + size_t j; + + /* process partial block if any */ + if (num > 0) { + for (j = (size_t)num, i = 0; j < GRASSHOPPER_BLOCK_SIZE && i < inl; + j++, i++, in_ptr++, out_ptr++) { + *out_ptr = buf[j] ^ (*in_ptr); } - - /* Process rest of buffer */ - if (i < inl) { - gost_grasshopper_cnt_next(c, (grasshopper_w128_t *) iv, - (grasshopper_w128_t *) buf); - for (j = 0; i < inl; j++, i++) { - out_ptr[j] = buf[j] ^ in_ptr[j]; - } - EVP_CIPHER_CTX_set_num(ctx, (int)j); - } else { + if (j == GRASSHOPPER_BLOCK_SIZE) { EVP_CIPHER_CTX_set_num(ctx, 0); + } else { + EVP_CIPHER_CTX_set_num(ctx, (int)j); + return 1; } - - return 1; } - int gost_grasshopper_cipher_do_cfb(EVP_CIPHER_CTX *ctx, unsigned char *out, - const unsigned char *in, size_t inl) { - gost_grasshopper_cipher_ctx *c = - (gost_grasshopper_cipher_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx); - const unsigned char *in_ptr = in; - unsigned char *out_ptr = out; - unsigned char *buf = EVP_CIPHER_CTX_buf_noconst(ctx); - unsigned char *iv = EVP_CIPHER_CTX_iv_noconst(ctx); - bool encrypting = (bool) EVP_CIPHER_CTX_encrypting(ctx); - int num = EVP_CIPHER_CTX_num(ctx); - size_t i = 0; - size_t j = 0; - - /* process partial block if any */ - if (num > 0) { - for (j = (size_t)num, i = 0; j < GRASSHOPPER_BLOCK_SIZE && i < inl; - j++, i++, in_ptr++, out_ptr++) { - if (!encrypting) { - buf[j + GRASSHOPPER_BLOCK_SIZE] = *in_ptr; - } - *out_ptr = buf[j] ^ (*in_ptr); - if (encrypting) { - buf[j + GRASSHOPPER_BLOCK_SIZE] = *out_ptr; - } - } - if (j == GRASSHOPPER_BLOCK_SIZE) { - memcpy(iv, buf + GRASSHOPPER_BLOCK_SIZE, - GRASSHOPPER_BLOCK_SIZE); - EVP_CIPHER_CTX_set_num(ctx, 0); - } else { - EVP_CIPHER_CTX_set_num(ctx, (int)j); - return 1; - } + for (; i + GRASSHOPPER_BLOCK_SIZE < + inl; + i += GRASSHOPPER_BLOCK_SIZE, in_ptr += + GRASSHOPPER_BLOCK_SIZE, out_ptr += GRASSHOPPER_BLOCK_SIZE) { + /* + * block cipher current iv + */ + /* Encrypt */ + gost_grasshopper_cnt_next(c, (grasshopper_w128_t *) iv, + (grasshopper_w128_t *) buf); + + /* + * xor next block of input text with it and output it + */ + /* + * output this block + */ + for (j = 0; j < GRASSHOPPER_BLOCK_SIZE; j++) { + out_ptr[j] = buf[j] ^ in_ptr[j]; } + } - for (; i + GRASSHOPPER_BLOCK_SIZE < - inl; - i += GRASSHOPPER_BLOCK_SIZE, in_ptr += - GRASSHOPPER_BLOCK_SIZE, out_ptr += GRASSHOPPER_BLOCK_SIZE) { - /* - * block cipher current iv - */ - grasshopper_encrypt_block(&c->encrypt_round_keys, - (grasshopper_w128_t *) iv, - (grasshopper_w128_t *) buf, &c->buffer); - /* - * xor next block of input text with it and output it - */ - /* - * output this block - */ - if (!encrypting) { - memcpy(iv, in_ptr, GRASSHOPPER_BLOCK_SIZE); - } - for (j = 0; j < GRASSHOPPER_BLOCK_SIZE; j++) { - out_ptr[j] = buf[j] ^ in_ptr[j]; - } - /* Encrypt */ - /* Next iv is next block of cipher text */ - if (encrypting) { - memcpy(iv, out_ptr, GRASSHOPPER_BLOCK_SIZE); - } + /* Process rest of buffer */ + if (i < inl) { + gost_grasshopper_cnt_next(c, (grasshopper_w128_t *) iv, + (grasshopper_w128_t *) buf); + for (j = 0; i < inl; j++, i++) { + out_ptr[j] = buf[j] ^ in_ptr[j]; } + EVP_CIPHER_CTX_set_num(ctx, (int)j); + } else { + EVP_CIPHER_CTX_set_num(ctx, 0); + } - /* Process rest of buffer */ - if (i < inl) { - grasshopper_encrypt_block(&c->encrypt_round_keys, - (grasshopper_w128_t *) iv, - (grasshopper_w128_t *) buf, &c->buffer); + return 1; +} + +int gost_grasshopper_cipher_do_cfb(EVP_CIPHER_CTX *ctx, unsigned char *out, + const unsigned char *in, size_t inl) { + gost_grasshopper_cipher_ctx *c = + (gost_grasshopper_cipher_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx); + const unsigned char *in_ptr = in; + unsigned char *out_ptr = out; + unsigned char *buf = EVP_CIPHER_CTX_buf_noconst(ctx); + unsigned char *iv = EVP_CIPHER_CTX_iv_noconst(ctx); + bool encrypting = (bool) EVP_CIPHER_CTX_encrypting(ctx); + int num = EVP_CIPHER_CTX_num(ctx); + size_t i = 0; + size_t j = 0; + + /* process partial block if any */ + if (num > 0) { + for (j = (size_t)num, i = 0; j < GRASSHOPPER_BLOCK_SIZE && i < inl; + j++, i++, in_ptr++, out_ptr++) { if (!encrypting) { - memcpy(buf + GRASSHOPPER_BLOCK_SIZE, in_ptr, inl - i); + buf[j + GRASSHOPPER_BLOCK_SIZE] = *in_ptr; } - for (j = 0; i < inl; j++, i++) { - out_ptr[j] = buf[j] ^ in_ptr[j]; - } - EVP_CIPHER_CTX_set_num(ctx, (int)j); + *out_ptr = buf[j] ^ (*in_ptr); if (encrypting) { - memcpy(buf + GRASSHOPPER_BLOCK_SIZE, out_ptr, j); + buf[j + GRASSHOPPER_BLOCK_SIZE] = *out_ptr; } - } else { + } + if (j == GRASSHOPPER_BLOCK_SIZE) { + memcpy(iv, buf + GRASSHOPPER_BLOCK_SIZE, + GRASSHOPPER_BLOCK_SIZE); EVP_CIPHER_CTX_set_num(ctx, 0); + } else { + EVP_CIPHER_CTX_set_num(ctx, (int)j); + return 1; } + } - return 1; + for (; i + GRASSHOPPER_BLOCK_SIZE < + inl; + i += GRASSHOPPER_BLOCK_SIZE, in_ptr += + GRASSHOPPER_BLOCK_SIZE, out_ptr += GRASSHOPPER_BLOCK_SIZE) { + /* + * block cipher current iv + */ + grasshopper_encrypt_block(&c->encrypt_round_keys, + (grasshopper_w128_t *) iv, + (grasshopper_w128_t *) buf, &c->buffer); + /* + * xor next block of input text with it and output it + */ + /* + * output this block + */ + if (!encrypting) { + memcpy(iv, in_ptr, GRASSHOPPER_BLOCK_SIZE); + } + for (j = 0; j < GRASSHOPPER_BLOCK_SIZE; j++) { + out_ptr[j] = buf[j] ^ in_ptr[j]; + } + /* Encrypt */ + /* Next iv is next block of cipher text */ + if (encrypting) { + memcpy(iv, out_ptr, GRASSHOPPER_BLOCK_SIZE); + } } - int gost_grasshopper_cipher_cleanup(EVP_CIPHER_CTX *ctx) { - gost_grasshopper_cipher_ctx *c = - (gost_grasshopper_cipher_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx); + /* Process rest of buffer */ + if (i < inl) { + grasshopper_encrypt_block(&c->encrypt_round_keys, + (grasshopper_w128_t *) iv, + (grasshopper_w128_t *) buf, &c->buffer); + if (!encrypting) { + memcpy(buf + GRASSHOPPER_BLOCK_SIZE, in_ptr, inl - i); + } + for (j = 0; i < inl; j++, i++) { + out_ptr[j] = buf[j] ^ in_ptr[j]; + } + EVP_CIPHER_CTX_set_num(ctx, (int)j); + if (encrypting) { + memcpy(buf + GRASSHOPPER_BLOCK_SIZE, out_ptr, j); + } + } else { + EVP_CIPHER_CTX_set_num(ctx, 0); + } - if (!c) - return 1; + return 1; +} - struct GRASSHOPPER_CIPHER_PARAMS *params = &gost_cipher_params[c->type]; +int gost_grasshopper_cipher_cleanup(EVP_CIPHER_CTX *ctx) { + gost_grasshopper_cipher_ctx *c = + (gost_grasshopper_cipher_ctx *) EVP_CIPHER_CTX_get_cipher_data(ctx); - gost_grasshopper_cipher_destroy(c); - if (params->destroy_cipher != NULL) { - params->destroy_cipher(c); - } + if (!c) + return 1; - EVP_CIPHER_CTX_set_app_data(ctx, NULL); + struct GRASSHOPPER_CIPHER_PARAMS *params = &gost_cipher_params[c->type]; - return 1; + gost_grasshopper_cipher_destroy(c); + if (params->destroy_cipher != NULL) { + params->destroy_cipher(c); } - int gost_grasshopper_set_asn1_parameters(EVP_CIPHER_CTX *ctx, - ASN1_TYPE *params) { - int len = 0; - unsigned char *buf = NULL; - ASN1_OCTET_STRING *os = NULL; + EVP_CIPHER_CTX_set_app_data(ctx, NULL); - os = ASN1_OCTET_STRING_new(); + return 1; +} - if (!os || !ASN1_OCTET_STRING_set(os, buf, len)) { - OPENSSL_free(buf); - GOSTerr(GOST_F_GOST_GRASSHOPPER_SET_ASN1_PARAMETERS, - ERR_R_MALLOC_FAILURE); - return 0; - } - OPENSSL_free(buf); +int gost_grasshopper_set_asn1_parameters(EVP_CIPHER_CTX *ctx, + ASN1_TYPE *params) { + int len = 0; + unsigned char *buf = NULL; + ASN1_OCTET_STRING *os = NULL; - ASN1_TYPE_set(params, V_ASN1_SEQUENCE, os); - return 1; + os = ASN1_OCTET_STRING_new(); + + if (!os || !ASN1_OCTET_STRING_set(os, buf, len)) { + OPENSSL_free(buf); + GOSTerr(GOST_F_GOST_GRASSHOPPER_SET_ASN1_PARAMETERS, + ERR_R_MALLOC_FAILURE); + return 0; } + OPENSSL_free(buf); - GRASSHOPPER_INLINE int gost_grasshopper_get_asn1_parameters(EVP_CIPHER_CTX - *ctx, - ASN1_TYPE - *params) { - int ret = -1; + ASN1_TYPE_set(params, V_ASN1_SEQUENCE, os); + return 1; +} - if (ASN1_TYPE_get(params) != V_ASN1_SEQUENCE) { - return ret; - } +GRASSHOPPER_INLINE int gost_grasshopper_get_asn1_parameters(EVP_CIPHER_CTX + *ctx, + ASN1_TYPE + *params) { + int ret = -1; - return 1; + if (ASN1_TYPE_get(params) != V_ASN1_SEQUENCE) { + return ret; } - int gost_grasshopper_cipher_ctl(EVP_CIPHER_CTX *ctx, int type, int arg, - void *ptr) { - switch (type) { - case EVP_CTRL_RAND_KEY:{ - if (RAND_bytes - ((unsigned char *)ptr, - EVP_CIPHER_CTX_key_length(ctx)) <= 0) { - GOSTerr(GOST_F_GOST_GRASSHOPPER_CIPHER_CTL, - GOST_R_RNG_ERROR); - return -1; - } - break; - } - case EVP_CTRL_KEY_MESH:{ - gost_grasshopper_cipher_ctx_ctr *c = - EVP_CIPHER_CTX_get_cipher_data(ctx); - if (c->c.type != GRASSHOPPER_CIPHER_CTRACPKM || !arg - || (arg % GRASSHOPPER_BLOCK_SIZE)) - return -1; - c->section_size = arg; - break; + return 1; +} + +int gost_grasshopper_cipher_ctl(EVP_CIPHER_CTX *ctx, int type, int arg, + void *ptr) { + switch (type) { + case EVP_CTRL_RAND_KEY:{ + if (RAND_bytes + ((unsigned char *)ptr, + EVP_CIPHER_CTX_key_length(ctx)) <= 0) { + GOSTerr(GOST_F_GOST_GRASSHOPPER_CIPHER_CTL, + GOST_R_RNG_ERROR); + return -1; } - default: - GOSTerr(GOST_F_GOST_GRASSHOPPER_CIPHER_CTL, - GOST_R_UNSUPPORTED_CIPHER_CTL_COMMAND); - return -1; + break; } - return 1; + case EVP_CTRL_KEY_MESH:{ + gost_grasshopper_cipher_ctx_ctr *c = + EVP_CIPHER_CTX_get_cipher_data(ctx); + if (c->c.type != GRASSHOPPER_CIPHER_CTRACPKM || !arg + || (arg % GRASSHOPPER_BLOCK_SIZE)) + return -1; + c->section_size = arg; + break; + } + default: + GOSTerr(GOST_F_GOST_GRASSHOPPER_CIPHER_CTL, + GOST_R_UNSUPPORTED_CIPHER_CTL_COMMAND); + return -1; } + return 1; +} - GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_create(int - cipher_type, - int - block_size) { - return EVP_CIPHER_meth_new(cipher_type, block_size /* block_size */ , - GRASSHOPPER_KEY_SIZE /* key_size */ ); - } +GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_create(int + cipher_type, + int + block_size) { + return EVP_CIPHER_meth_new(cipher_type, block_size /* block_size */ , + GRASSHOPPER_KEY_SIZE /* key_size */ ); +} - const int cipher_gost_grasshopper_setup(EVP_CIPHER *cipher, uint8_t mode, - int iv_size, bool padding) { - return EVP_CIPHER_meth_set_iv_length(cipher, iv_size) - && EVP_CIPHER_meth_set_flags(cipher, - (unsigned long)(mode | - ((!padding) ? - EVP_CIPH_NO_PADDING : - 0) | ((iv_size > - 0) ? - EVP_CIPH_CUSTOM_IV - : 0) | - EVP_CIPH_RAND_KEY | - EVP_CIPH_ALWAYS_CALL_INIT) - ) - && EVP_CIPHER_meth_set_cleanup(cipher, - gost_grasshopper_cipher_cleanup) - && EVP_CIPHER_meth_set_set_asn1_params(cipher, - gost_grasshopper_set_asn1_parameters) - && EVP_CIPHER_meth_set_get_asn1_params(cipher, - gost_grasshopper_get_asn1_parameters) - && EVP_CIPHER_meth_set_ctrl(cipher, gost_grasshopper_cipher_ctl) - && EVP_CIPHER_meth_set_do_cipher(cipher, - gost_grasshopper_cipher_do); - } +const int cipher_gost_grasshopper_setup(EVP_CIPHER *cipher, uint8_t mode, + int iv_size, bool padding) { + return EVP_CIPHER_meth_set_iv_length(cipher, iv_size) + && EVP_CIPHER_meth_set_flags(cipher, + (unsigned long)(mode | + ((!padding) ? + EVP_CIPH_NO_PADDING : + 0) | ((iv_size > + 0) ? + EVP_CIPH_CUSTOM_IV + : 0) | + EVP_CIPH_RAND_KEY | + EVP_CIPH_ALWAYS_CALL_INIT) + ) + && EVP_CIPHER_meth_set_cleanup(cipher, + gost_grasshopper_cipher_cleanup) + && EVP_CIPHER_meth_set_set_asn1_params(cipher, + gost_grasshopper_set_asn1_parameters) + && EVP_CIPHER_meth_set_get_asn1_params(cipher, + gost_grasshopper_get_asn1_parameters) + && EVP_CIPHER_meth_set_ctrl(cipher, gost_grasshopper_cipher_ctl) + && EVP_CIPHER_meth_set_do_cipher(cipher, + gost_grasshopper_cipher_do); +} - const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper(uint8_t mode, - uint8_t num) { - EVP_CIPHER **cipher; - struct GRASSHOPPER_CIPHER_PARAMS *params; +const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper(uint8_t mode, + uint8_t num) { + EVP_CIPHER **cipher; + struct GRASSHOPPER_CIPHER_PARAMS *params; - cipher = &gost_grasshopper_ciphers[num]; + cipher = &gost_grasshopper_ciphers[num]; - if (*cipher == NULL) { - params = &gost_cipher_params[num]; - - int nid = params->nid; - grasshopper_init_cipher_func init_cipher = params->init_cipher; - int block_size = params->block_size; - int ctx_size = params->ctx_size; - int iv_size = params->iv_size; - bool padding = params->padding; - - *cipher = cipher_gost_grasshopper_create(nid, block_size); - if (*cipher == NULL) { - return NULL; - } + if (*cipher == NULL) { + params = &gost_cipher_params[num]; - if (!cipher_gost_grasshopper_setup(*cipher, mode, iv_size, padding) - || !EVP_CIPHER_meth_set_init(*cipher, init_cipher) - || !EVP_CIPHER_meth_set_impl_ctx_size(*cipher, ctx_size)) { - EVP_CIPHER_meth_free(*cipher); - *cipher = NULL; - } + int nid = params->nid; + grasshopper_init_cipher_func init_cipher = params->init_cipher; + int block_size = params->block_size; + int ctx_size = params->ctx_size; + int iv_size = params->iv_size; + bool padding = params->padding; + + *cipher = cipher_gost_grasshopper_create(nid, block_size); + if (*cipher == NULL) { + return NULL; } - return *cipher; + if (!cipher_gost_grasshopper_setup(*cipher, mode, iv_size, padding) + || !EVP_CIPHER_meth_set_init(*cipher, init_cipher) + || !EVP_CIPHER_meth_set_impl_ctx_size(*cipher, ctx_size)) { + EVP_CIPHER_meth_free(*cipher); + *cipher = NULL; + } } - const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_ecb() { - return cipher_gost_grasshopper(EVP_CIPH_ECB_MODE, - GRASSHOPPER_CIPHER_ECB); - } + return *cipher; +} - const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_cbc() { - return cipher_gost_grasshopper(EVP_CIPH_CBC_MODE, - GRASSHOPPER_CIPHER_CBC); - } +const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_ecb() { + return cipher_gost_grasshopper(EVP_CIPH_ECB_MODE, + GRASSHOPPER_CIPHER_ECB); +} - const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_ofb() { - return cipher_gost_grasshopper(EVP_CIPH_OFB_MODE, - GRASSHOPPER_CIPHER_OFB); - } +const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_cbc() { + return cipher_gost_grasshopper(EVP_CIPH_CBC_MODE, + GRASSHOPPER_CIPHER_CBC); +} - const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_cfb() { - return cipher_gost_grasshopper(EVP_CIPH_CFB_MODE, - GRASSHOPPER_CIPHER_CFB); - } +const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_ofb() { + return cipher_gost_grasshopper(EVP_CIPH_OFB_MODE, + GRASSHOPPER_CIPHER_OFB); +} - const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_ctr() { - return cipher_gost_grasshopper(EVP_CIPH_CTR_MODE, - GRASSHOPPER_CIPHER_CTR); - } +const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_cfb() { + return cipher_gost_grasshopper(EVP_CIPH_CFB_MODE, + GRASSHOPPER_CIPHER_CFB); +} - const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_ctracpkm() { - return cipher_gost_grasshopper(EVP_CIPH_CTR_MODE, - GRASSHOPPER_CIPHER_CTRACPKM); - } +const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_ctr() { + return cipher_gost_grasshopper(EVP_CIPH_CTR_MODE, + GRASSHOPPER_CIPHER_CTR); +} - void cipher_gost_grasshopper_destroy(void) { - EVP_CIPHER_meth_free(gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_ECB]); - gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_ECB] = NULL; - EVP_CIPHER_meth_free(gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CBC]); - gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CBC] = NULL; - EVP_CIPHER_meth_free(gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_OFB]); - gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_OFB] = NULL; - EVP_CIPHER_meth_free(gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CFB]); - gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CFB] = NULL; - EVP_CIPHER_meth_free(gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CTR]); - gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CTR] = NULL; - EVP_CIPHER_meth_free(gost_grasshopper_ciphers - [GRASSHOPPER_CIPHER_CTRACPKM]); - gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CTRACPKM] = NULL; - } +const GRASSHOPPER_INLINE EVP_CIPHER *cipher_gost_grasshopper_ctracpkm() { + return cipher_gost_grasshopper(EVP_CIPH_CTR_MODE, + GRASSHOPPER_CIPHER_CTRACPKM); +} + +void cipher_gost_grasshopper_destroy(void) { + EVP_CIPHER_meth_free(gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_ECB]); + gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_ECB] = NULL; + EVP_CIPHER_meth_free(gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CBC]); + gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CBC] = NULL; + EVP_CIPHER_meth_free(gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_OFB]); + gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_OFB] = NULL; + EVP_CIPHER_meth_free(gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CFB]); + gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CFB] = NULL; + EVP_CIPHER_meth_free(gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CTR]); + gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CTR] = NULL; + EVP_CIPHER_meth_free(gost_grasshopper_ciphers + [GRASSHOPPER_CIPHER_CTRACPKM]); + gost_grasshopper_ciphers[GRASSHOPPER_CIPHER_CTRACPKM] = NULL; +} #if defined(__cplusplus) } -- 2.39.5