*/
/**
* \file shavs.c
- * \author Daniel Otte
+ * \author Daniel Otte
* \date 2006-05-16
* \license GPLv3 or later
- *
+ *
*/
#include <avr/pgmspace.h>
#include <stdint.h>
#include <stdlib.h>
+#include <ctype.h>
#include "hashfunction_descriptor.h"
+#include "hfal-basic.h"
#include "shavs.h"
#include "string-extras.h"
#include "cli.h"
-hfdesc_t* algo=NULL;
-hfdesc_t** algolist=NULL;
+hfdesc_t* shavs_algo=NULL;
+hfdesc_t** shavs_algolist=NULL;
void shavs_listalgos(void){
char option = 'a';
-
- cli_putstr_P(PSTR("\r\nDBG: &algolist: "));
- cli_hexdump(&algolist, 2);
- cli_putstr_P(PSTR("\r\nDBG: algolist[0]: "));
- cli_hexdump(algolist, 8);
-
+
hfdesc_t* t;
uint8_t i=0;
cli_putstr_P(PSTR("\r\nthe following algorithms are available:\r\n"));
- while(option<='z' && (t=(hfdesc_t*)pgm_read_word(&(algolist[i])))){
+ while(option<='z' && (t=(hfdesc_t*)pgm_read_word(&(shavs_algolist[i])))){
cli_putc('\t');
- cli_putc((t==algo)?'*':' ');
+ cli_putc((t==shavs_algo)?'*':' ');
cli_putc(option++);
cli_putstr_P(PSTR(":\t"));
cli_putstr_P((void*)(pgm_read_word(&(t->name))));
param = strstrip(param);
if(param[1]=='\0'){ /* single letter specified */
uint8_t i,option = param[0]-'a';
-
- if(!algolist){
- cli_putstr_P(PSTR("\r\nERROR: algolist not set!"));
+
+ if(!shavs_algolist){
+ cli_putstr_P(PSTR("\r\nERROR: shavs_algolist not set!"));
return;
}
for(i=0; i<=option; ++i){
- if((void*)pgm_read_word(&(algolist[i]))==NULL){
+ if((void*)pgm_read_word(&(shavs_algolist[i]))==NULL){
cli_putstr_P(PSTR("\r\nERROR: invalid selection!"));
return;
}
}
- algo=(hfdesc_t*)pgm_read_word(&(algolist[option]));
- } else { /* name specifyed */
+ shavs_algo=(hfdesc_t*)pgm_read_word(&(shavs_algolist[option]));
+ } else { /* name specifyed */
hfdesc_t* t=NULL;
uint8_t i=0;
- while((t=(hfdesc_t*)pgm_read_word(&(algolist[i]))) &&
+ while((t=(hfdesc_t*)pgm_read_word(&(shavs_algolist[i]))) &&
strcasecmp_P(param, (void*)pgm_read_word(&(t->name))))
++i;
if(t){
- algo=t;
+ shavs_algo=t;
}else{
cli_putstr_P(PSTR("\r\nERROR: could not find \""));
cli_putstr(param);
cli_putstr_P(PSTR("\"!"));
- }
+ }
+ }
+}
+
+static uint16_t buffer_idx=0;
+static uint8_t in_byte=0;
+static uint16_t blocks=0;
+static uint8_t* buffer;
+static uint16_t buffersize_B;
+static hfgen_ctx_t ctx;
+
+static
+uint8_t buffer_add(char c){
+ uint8_t v,t;
+ if(buffer_idx==buffersize_B){
+ hfal_hash_nextBlock(&ctx, buffer);
+ ++blocks;
+ buffer_idx=0;
+ in_byte=0;
+ }
+ if(c>='0' && c<='9'){
+ v=c-'0';
+ }else{
+ if(c>='a' && c<='f'){
+ v=c-'a'+10;
+ }else{
+ if(c>='A' && c<='F'){
+ v=c-'A'+10;
+ }else{
+ return 1;
+ }
+ }
+ }
+
+ t=buffer[buffer_idx];
+ if(in_byte){
+ t = (t&0xF0) | v;
+ buffer[buffer_idx]=t;
+ buffer_idx++;
+ }else{
+ t = (t&0x0F) | (v<<4);
+ buffer[buffer_idx]=t;
+ }
+ in_byte ^= 1;
+ return 0;
+}
+
+void shavs_test1(void){
+ char lenstr[21];
+ char* len2;
+ uint32_t length=0;
+ uint8_t len_set=0;
+ if(!shavs_algo){
+ cli_putstr_P(PSTR("\r\nERROR: select algorithm first!"));
+ return;
+ }
+
+ buffersize_B=pgm_read_word(&(shavs_algo->blocksize_b))/8;
+ cli_putstr_P(PSTR("\r\nbuffer allocated for 0x"));
+ cli_hexdump(&buffersize_B, 2);
+ cli_putstr_P(PSTR(" bytes"));
+ buffer = malloc(buffersize_B);
+ if(buffer==NULL){
+ cli_putstr_P(PSTR("\r\n allocating memory for buffer failed!"));
+ return;
+ }
+ for(;;){
+ blocks = 0;
+ do{
+ cli_putstr_P(PSTR("\r\n"));
+ cli_getsn(lenstr, 20);
+ len2 = strstrip(lenstr);
+ if(!strncasecmp_P(len2, PSTR("LEN"), 3)){
+ while(*len2 && *len2!='=')
+ len2++;
+ if(*len2=='='){
+ len2++;
+ length=strtoul(len2, NULL, 0);
+ len_set=1;
+ }
+ } else {
+ if(!strncasecmp_P(len2, PSTR("EXIT"), 4)){
+ free(buffer);
+ return;
+ }
+ }
+ }while(!len_set);
+ volatile int32_t expect_input;
+ char c;
+
+ if(length==0){
+ expect_input=2;
+ }else{
+ expect_input=((length+7)/8)*2;
+ }
+
+ buffer_idx = 0;
+ in_byte=0;
+ len_set = 0;
+ uint8_t ret;
+// cli_putstr_P(PSTR("\r\n HFAL init"));
+ ret = hfal_hash_init(shavs_algo, &ctx);
+ if(ret){
+ cli_putstr_P(PSTR("\r\n HFAL init returned with: "));
+ cli_hexdump(&ret, 1);
+ free(buffer);
+ return;
+ }
+// cli_putstr_P(PSTR("\r\n"));
+ while((c=cli_getc_cecho())!='M' && c!='m'){
+ if(!isblank(c)){
+ cli_putstr_P(PSTR("\r\nERROR: wrong input (1) [0x"));
+ cli_hexdump(&c, 1);
+ cli_putstr_P(PSTR("]!\r\n"));
+ free(buffer);
+ return;
+ }
+ }
+ if((c=cli_getc_cecho())!='s' && c!='S'){
+ cli_putstr_P(PSTR("\r\nERROR: wrong input (2)!\r\n"));
+ free(buffer);
+ return;
+ }
+ if((c=cli_getc_cecho())!='g' && c!='G'){
+ cli_putstr_P(PSTR("\r\nERROR: wrong input (3)!\r\n"));
+ free(buffer);
+ return;
+ }
+ while((c=cli_getc_cecho())!='='){
+ if(!isblank(c)){
+ cli_putstr_P(PSTR("\r\nERROR: wrong input (4)!\r\n"));
+ free(buffer);
+ return;
+ }
+ }
+
+ buffer_idx=0;
+ while(expect_input>0){
+ c=cli_getc_cecho();
+ cli_putstr_P(PSTR("+("));
+ cli_hexdump_rev((uint8_t*)&expect_input, 4);
+ cli_putstr_P(PSTR(") "));
+ if(buffer_add(c)==0){
+ --expect_input;
+ }else{
+ if(!isblank((uint16_t)c)){
+ cli_putstr_P(PSTR("\r\nERROR: wrong input (5) ("));
+ cli_putc(c);
+ cli_putstr_P(PSTR(")!\r\n"));
+ free(buffer);
+ return;
+ }
+ }
+ }
+// cli_putstr_P(PSTR("\r\n starting finalisation"));
+ uint8_t diggest[pgm_read_word(shavs_algo->hashsize_b)/8];
+// cli_putstr_P(PSTR("\r\n starting last block"));
+ hfal_hash_lastBlock(&ctx, buffer, length-blocks*(buffersize_B*8));
+// cli_putstr_P(PSTR("\r\n starting ctx2hash"));
+ hfal_hash_ctx2hash(diggest, &ctx);
+// cli_putstr_P(PSTR("\r\n starting hash free"));
+ hfal_hash_free(&ctx);
+ cli_putstr_P(PSTR("\r\n MD = "));
+ cli_hexdump(diggest, pgm_read_word(&(shavs_algo->hashsize_b))/8);
+
}
+ free(buffer);
}
projects / avr-crypto-lib.git / blobdiff