Revert "Revert "and added files""
[bcm963xx.git] / userapps / opensource / sshd / libtomcrypt / xtea.c
1 #include "mycrypt.h"
2
3 #ifdef XTEA
4
5 const struct _cipher_descriptor xtea_desc =
6 {
7     "xtea",
8     1,
9     16, 16, 8, 32,
10     &xtea_setup,
11     &xtea_ecb_encrypt,
12     &xtea_ecb_decrypt,
13     &xtea_test,
14     &xtea_keysize
15 };
16
17 int xtea_setup(const unsigned char *key, int keylen, int num_rounds, symmetric_key *skey)
18 {
19    unsigned long x, sum, K[4];
20    
21    _ARGCHK(key != NULL);
22    _ARGCHK(skey != NULL);
23
24    /* check arguments */
25    if (keylen != 16) {
26       return CRYPT_INVALID_KEYSIZE;
27    }
28
29    if (num_rounds != 0 && num_rounds != 32) {
30       return CRYPT_INVALID_ROUNDS;
31    }
32
33    /* load key */
34    LOAD32L(K[0], key+0);
35    LOAD32L(K[1], key+4);
36    LOAD32L(K[2], key+8);
37    LOAD32L(K[3], key+12);
38    
39    for (x = sum = 0; x < 32; x++) {
40        skey->xtea.A[x] = (sum + K[sum&3]) & 0xFFFFFFFFUL;
41        sum = (sum + 0x9E3779B9UL) & 0xFFFFFFFFUL;
42        skey->xtea.B[x] = (sum + K[(sum>>11)&3]) & 0xFFFFFFFFUL;
43    }
44    
45 #ifdef CLEAN_STACK
46    zeromem(&K, sizeof(K));
47 #endif   
48    
49    return CRYPT_OK;
50 }
51
52 void xtea_ecb_encrypt(const unsigned char *pt, unsigned char *ct, symmetric_key *key)
53 {
54    unsigned long y, z;
55    int r;
56
57    _ARGCHK(pt != NULL);
58    _ARGCHK(ct != NULL);
59    _ARGCHK(key != NULL);
60
61    LOAD32L(y, &pt[0]);
62    LOAD32L(z, &pt[4]);
63    for (r = 0; r < 32; r += 4) {
64        y = (y + ((((z<<4)^(z>>5)) + z) ^ key->xtea.A[r])) & 0xFFFFFFFFUL;
65        z = (z + ((((y<<4)^(y>>5)) + y) ^ key->xtea.B[r])) & 0xFFFFFFFFUL;
66
67        y = (y + ((((z<<4)^(z>>5)) + z) ^ key->xtea.A[r+1])) & 0xFFFFFFFFUL;
68        z = (z + ((((y<<4)^(y>>5)) + y) ^ key->xtea.B[r+1])) & 0xFFFFFFFFUL;
69
70        y = (y + ((((z<<4)^(z>>5)) + z) ^ key->xtea.A[r+2])) & 0xFFFFFFFFUL;
71        z = (z + ((((y<<4)^(y>>5)) + y) ^ key->xtea.B[r+2])) & 0xFFFFFFFFUL;
72
73        y = (y + ((((z<<4)^(z>>5)) + z) ^ key->xtea.A[r+3])) & 0xFFFFFFFFUL;
74        z = (z + ((((y<<4)^(y>>5)) + y) ^ key->xtea.B[r+3])) & 0xFFFFFFFFUL;
75    }
76    STORE32L(y, &ct[0]);
77    STORE32L(z, &ct[4]);
78 }
79
80 void xtea_ecb_decrypt(const unsigned char *ct, unsigned char *pt, symmetric_key *key)
81 {
82    unsigned long y, z;
83    int r;
84
85    _ARGCHK(pt != NULL);
86    _ARGCHK(ct != NULL);
87    _ARGCHK(key != NULL);
88
89    LOAD32L(y, &ct[0]);
90    LOAD32L(z, &ct[4]);
91    for (r = 31; r >= 0; r -= 4) {
92        z = (z - ((((y<<4)^(y>>5)) + y) ^ key->xtea.B[r])) & 0xFFFFFFFFUL;
93        y = (y - ((((z<<4)^(z>>5)) + z) ^ key->xtea.A[r])) & 0xFFFFFFFFUL;
94
95        z = (z - ((((y<<4)^(y>>5)) + y) ^ key->xtea.B[r-1])) & 0xFFFFFFFFUL;
96        y = (y - ((((z<<4)^(z>>5)) + z) ^ key->xtea.A[r-1])) & 0xFFFFFFFFUL;
97
98        z = (z - ((((y<<4)^(y>>5)) + y) ^ key->xtea.B[r-2])) & 0xFFFFFFFFUL;
99        y = (y - ((((z<<4)^(z>>5)) + z) ^ key->xtea.A[r-2])) & 0xFFFFFFFFUL;
100
101        z = (z - ((((y<<4)^(y>>5)) + y) ^ key->xtea.B[r-3])) & 0xFFFFFFFFUL;
102        y = (y - ((((z<<4)^(z>>5)) + z) ^ key->xtea.A[r-3])) & 0xFFFFFFFFUL;
103    }
104    STORE32L(y, &pt[0]);
105    STORE32L(z, &pt[4]);
106 }
107
108 int xtea_test(void)
109 {
110  #ifndef LTC_TEST
111     return CRYPT_NOP;
112  #else    
113    static const unsigned char key[16] = 
114       { 0x78, 0x56, 0x34, 0x12, 0xf0, 0xcd, 0xcb, 0x9a,
115         0x48, 0x37, 0x26, 0x15, 0xc0, 0xbf, 0xae, 0x9d };
116    static const unsigned char pt[8] = 
117       { 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08 };
118    static const unsigned char ct[8] = 
119       { 0x75, 0xd7, 0xc5, 0xbf, 0xcf, 0x58, 0xc9, 0x3f };
120    unsigned char tmp[2][8];
121    symmetric_key skey;
122    int err;
123
124    if ((err = xtea_setup(key, 16, 0, &skey)) != CRYPT_OK)  {
125       return err;
126    }
127    xtea_ecb_encrypt(pt, tmp[0], &skey);
128    xtea_ecb_decrypt(tmp[0], tmp[1], &skey);
129
130    if (memcmp(tmp[0], ct, 8) != 0 || memcmp(tmp[1], pt, 8) != 0) { 
131       return CRYPT_FAIL_TESTVECTOR;
132    }
133
134    return CRYPT_OK;
135  #endif
136 }
137
138 int xtea_keysize(int *desired_keysize)
139 {
140    _ARGCHK(desired_keysize != NULL);
141    if (*desired_keysize < 16) {
142       return CRYPT_INVALID_KEYSIZE; 
143    }
144    *desired_keysize = 16;
145    return CRYPT_OK;
146 }
147
148
149 #endif
150
151
152