Write md2_compute function.
[bertos.git] / algos / md2.c
1 /**
2  * \file
3  * <!--
4  * Copyright 2007 Develer S.r.l. (http://www.develer.com/)
5  * This file is part of DevLib - See README.devlib for information.
6  * -->
7  *
8  * \brief MD2 Message-Digest algorithm.
9  *
10  * \version $Id$
11  * \author Daniele Basile <asterix@develer.com>
12  */
13
14 /*#*
15  *#* $Log$
16  *#* Revision 1.4  2007/01/31 13:51:57  asterix
17  *#* Write md2_compute function.
18  *#*
19  *#* Revision 1.2  2007/01/30 17:31:44  asterix
20  *#* Add function prototypes.
21  *#*
22  *#* Revision 1.1  2007/01/30 15:53:26  batt
23  *#* Add first md2 skel.
24  *#*
25  *#*/
26
27 #include "md2.h"
28
29 #include <string.h> //memset();
30 #include <cfg/compiler.h>
31
32 /*
33  * Official array of 256 byte pemutation contructed from digits of pi, defined
34  * in the RFC 1319.
35  */
36 static uint8_t md2_perm[256] =
37 {
38   41, 46, 67, 201, 162, 216, 124, 1, 61, 54, 84, 161, 236, 240, 6,
39   19, 98, 167, 5, 243, 192, 199, 115, 140, 152, 147, 43, 217, 188,
40   76, 130, 202, 30, 155, 87, 60, 253, 212, 224, 22, 103, 66, 111, 24,
41   138, 23, 229, 18, 190, 78, 196, 214, 218, 158, 222, 73, 160, 251,
42   245, 142, 187, 47, 238, 122, 169, 104, 121, 145, 21, 178, 7, 63,
43   148, 194, 16, 137, 11, 34, 95, 33, 128, 127, 93, 154, 90, 144, 50,
44   39, 53, 62, 204, 231, 191, 247, 151, 3, 255, 25, 48, 179, 72, 165,
45   181, 209, 215, 94, 146, 42, 172, 86, 170, 198, 79, 184, 56, 210,
46   150, 164, 125, 182, 118, 252, 107, 226, 156, 116, 4, 241, 69, 157,
47   112, 89, 100, 113, 135, 32, 134, 91, 207, 101, 230, 45, 168, 2, 27,
48   96, 37, 173, 174, 176, 185, 246, 28, 70, 97, 105, 52, 64, 126, 15,
49   85, 71, 163, 35, 221, 81, 175, 58, 195, 92, 249, 206, 186, 197,
50   234, 38, 44, 83, 13, 110, 133, 40, 132, 9, 211, 223, 205, 244, 65,
51   129, 77, 82, 106, 220, 55, 200, 108, 193, 171, 250, 36, 225, 123,
52   8, 12, 189, 177, 74, 120, 136, 149, 139, 227, 99, 232, 109, 233,
53   203, 213, 254, 59, 0, 29, 57, 242, 239, 183, 14, 102, 88, 208, 228,
54   166, 119, 114, 248, 235, 117, 75, 10, 49, 68, 80, 180, 143, 237,
55   31, 26, 219, 153, 141, 51, 159, 17, 131, 20
56 };
57 /**
58  * Pad function. Fill input array with unsigned char until 
59  * lenght of block is equal to CONFIG_MD2_BLOCK_LEN.
60  *
61  */
62 static void md2_pad(void *block, size_t len_pad)
63 {
64         if (len_pad <= CONFIG_MD2_BLOCK_LEN)
65         {
66                 for(int i=(CONFIG_MD2_BLOCK_LEN-len_pad);i<len_pad; i++)
67                 {
68                         block[i]=(uint8_t)len_pad;
69                 }       
70         }
71 }
72
73 static void md2_compute(void *state, void *checksum, void *block)
74 {
75         int t=0;        
76         uint8_t compute_array[CONFIG_MD2_BLOCK_LEN * 3];
77         
78         /*
79          * Copy state and checksum context in compute array. 
80          */
81         memcpy(compute_array, state, CONFIG_MD2_BLOCK_LEN);
82         memcpy(compute_array + CONFIG_MD2_BLOCK_LEN, state, CONFIG_MD2_BLOCK_LEN);
83         
84         /*
85          * Fill compute array with state XOR block
86          */
87         for(int i=0; i< CONFIG_MD2_BLOCK_LEN; i++)
88                 compute_array[i + (CONFIG_MD2_BLOCK_LEN * 2)] = state[i] ^ block[i];
89         
90         /*
91          * Encryt block.
92          */
93         for(i=0; i<NUM_COMPUTE_ROUNDS; i++)
94         {
95                 for(int j=0; j<COMPUTE_ARRAY_LEN; j++)
96                 {
97                         compute_array[j] ^= md2_perm [t];
98                         t = compute_array[j];
99                 }
100                 
101                 t = (t + i) & 0xff; //modulo 256.
102         }
103         /*
104          * Update checksum.     
105          */
106         t = checksum[CONFIG_MD2_BLOCK_LEN - 1];
107
108         for(i=0; i< CONFIG_MD2_BLOCK_LEN; i++)
109         {
110                 checksum[i]  ^= md2_perm [block[i] ^ t];
111                 t = checksum[i];
112         }
113         
114         /*
115          * Update state and clean compute array. 
116          */
117         memcpy(state, compute_array, CONFIG_MD2_BLOCK_LEN);
118         memset(compute_array, 0, sizeof(compute_array));
119 }
120
121 /**
122  * Algorithm initialization.
123  *
124  * \param empty context.
125  */
126 void md2_init(Md2Context *context)
127 {
128         context->counter=0;
129         memset(context->state, 0, sizeof(context->state));
130         memset(context->checksum, 0, sizeof(context->checksum));
131
132 }
133 /**
134  * Update bock.
135  *
136  *
137  *
138  */
139 void md2_update(Md2Context *context, void *block_in, size_t block_len)
140 {
141
142 }
143
144 /**
145  * 
146  */
147 void md2_end(Md2Context *context, void *msg_digest)
148 {
149
150 }