bcal/bcal-ctr.c

   1 /* bcal-ctr.c */
   2 /*
   3     This file is part of the AVR-Crypto-Lib.
   4     Copyright (C) 2010 Daniel Otte (daniel.otte@rub.de)
   5
   6     This program is free software: you can redistribute it and/or modify
   7     it under the terms of the GNU General Public License as published by
   8     the Free Software Foundation, either version 3 of the License, or
   9     (at your option) any later version.
  10
  11     This program is distributed in the hope that it will be useful,
  12     but WITHOUT ANY WARRANTY; without even the implied warranty of
  13     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14     GNU General Public License for more details.
  15
  16     You should have received a copy of the GNU General Public License
  17     along with this program.  If not, see <http://www.gnu.org/licenses/>.
  18 */
  19
  20
  21 #include <stdint.h>
  22 #include <string.h>
  23 #include "bcal-basic.h"
  24 #include "bcal-ctr.h"
  25 #include "memxor.h"
  26
  27 static void increment_be(void* block, uint8_t size_B){
  28         uint16_t c=1;
  29         do{
  30                 --size_B;
  31                 c += ((uint8_t*)block)[size_B];
  32                 ((uint8_t*)block)[size_B] = (uint8_t)c;
  33                 c>>=8;
  34         }while(size_B);
  35 }
  36
  37 uint8_t bcal_ctr_init(const bcdesc_t* desc, const void* key, uint16_t keysize_b, inc_fp_t inc_func, bcal_ctr_ctx_t* ctx){
  38         ctx->desc = (bcdesc_t*)desc;
  39         if(inc_func){
  40                 ctx->inc_func = inc_func;
  41         }else{
  42                 ctx->inc_func = increment_be;
  43         }
  44         ctx->blocksize_B = (bcal_cipher_getBlocksize_b(desc)+7)/8;
  45         ctx->in_block=malloc(ctx->blocksize_B);
  46         if(ctx->in_block==NULL){
  47                         return 0x11;
  48         }
  49         return bcal_cipher_init(desc, key, keysize_b, &(ctx->cctx));
  50 }
  51
  52 void bcal_ctr_free(bcal_ctr_ctx_t* ctx){
  53         free(ctx->in_block);
  54         bcal_cipher_free(&(ctx->cctx));
  55 }
  56
  57 void bcal_ctr_loadIV(const void* iv, bcal_ctr_ctx_t* ctx){
  58         if(iv){
  59                 memcpy(ctx->in_block, iv, ctx->blocksize_B);
  60         }
  61 }
  62
  63 void bcal_ctr_encNext(void* block, bcal_ctr_ctx_t* ctx){
  64         uint8_t tmp[ctx->blocksize_B];
  65         memcpy(tmp, ctx->in_block, ctx->blocksize_B);
  66         bcal_cipher_enc(tmp, &(ctx->cctx));
  67         memxor(block, tmp, ctx->blocksize_B);
  68         ctx->inc_func(ctx->in_block, ctx->blocksize_B);
  69 }
  70
  71 void bcal_ctr_decNext(void* block, bcal_ctr_ctx_t* ctx){
  72         bcal_ctr_encNext(block, ctx);
  73 }
  74
  75 void bcal_ctr_encMsg(const void* iv, void* msg, uint32_t msg_len_b, bcal_ctr_ctx_t* ctx){
  76         bcal_ctr_loadIV(iv, ctx);
  77         uint16_t blocksize_b;
  78         blocksize_b = ctx->blocksize_B*8;
  79         while(msg_len_b>blocksize_b){
  80                 bcal_ctr_encNext(msg, ctx);
  81                 msg_len_b -= blocksize_b;
  82                 msg = (uint8_t*)msg + ctx->blocksize_B;
  83         }
  84         uint8_t tmp[ctx->blocksize_B];
  85         memcpy(tmp, ctx->in_block, ctx->blocksize_B);
  86         bcal_cipher_enc(tmp, &(ctx->cctx));
  87         ctx->inc_func(ctx->in_block, ctx->blocksize_B);
  88         tmp[msg_len_b/8] = 0xff00>>(msg_len_b&7);
  89         memxor(msg, tmp, (msg_len_b+7)/8);
  90 }
  91
  92 void bcal_ctr_decMsg(const void* iv, void* msg, uint32_t msg_len_b, bcal_ctr_ctx_t* ctx){
  93         bcal_ctr_encMsg(iv, msg, msg_len_b, ctx);
  94 }
  95