| 1 |
|
| #ifdef __cplusplus |
| 2 |
|
| extern "C" { |
| 3 |
|
| #endif |
| 4 |
|
| |
| 5 |
|
| #include "ulib/chacha.h" |
| 6 |
|
| #include "ulib/splitmix.h" |
| 7 |
|
| #include "ulib/xoshiro.h" |
| 8 |
|
| |
| 9 |
|
| #ifdef __cplusplus |
| 10 |
|
| } |
| 11 |
|
| #endif |
| 12 |
|
| |
| 13 |
|
| /* perl versions broken on some platforms */ |
| 14 |
|
| #undef U8TO16_LE |
| 15 |
|
| #define U8TO16_LE(p) ( \ |
| 16 |
|
| ((U16)((p)[0]) ) | \ |
| 17 |
|
| ((U16)((p)[1]) << 8) \ |
| 18 |
|
| ) |
| 19 |
|
| #undef U8TO32_LE |
| 20 |
|
| #define U8TO32_LE(p) ( \ |
| 21 |
|
| ((U32)((p)[0]) ) | \ |
| 22 |
|
| ((U32)((p)[1]) << 8) | \ |
| 23 |
|
| ((U32)((p)[2]) << 16) | \ |
| 24 |
|
| ((U32)((p)[3]) << 24) \ |
| 25 |
|
| ) |
| 26 |
|
| #undef U8TO64_LE |
| 27 |
|
| #define U8TO64_LE(p) ( \ |
| 28 |
|
| ((U64)((p)[0]) ) | \ |
| 29 |
|
| ((U64)((p)[1]) << 8) | \ |
| 30 |
|
| ((U64)((p)[2]) << 16) | \ |
| 31 |
|
| ((U64)((p)[3]) << 24) | \ |
| 32 |
|
| ((U64)((p)[4]) << 32) | \ |
| 33 |
|
| ((U64)((p)[5]) << 40) | \ |
| 34 |
|
| ((U64)((p)[6]) << 48) | \ |
| 35 |
|
| ((U64)((p)[7]) << 56) \ |
| 36 |
|
| ) |
| 37 |
|
| #undef U32TO8_LE |
| 38 |
|
| #define U32TO8_LE(p, v) do { \ |
| 39 |
|
| U32 _v = v; \ |
| 40 |
|
| (p)[0] = (((_v) ) & 0xFFU); \ |
| 41 |
|
| (p)[1] = (((_v) >> 8) & 0xFFU); \ |
| 42 |
|
| (p)[2] = (((_v) >> 16) & 0xFFU); \ |
| 43 |
|
| (p)[3] = (((_v) >> 24) & 0xFFU); \ |
| 44 |
|
| } while (0) |
| 45 |
|
| |
| 46 |
|
| /* perls ROTL32 broken too */ |
| 47 |
|
| #define rotl32(x,r) ((((U32)(x)) << (r)) | (((U32)(x)) >> (32 - (r)))) |
| 48 |
|
| |
| 49 |
|
| #define QROUND(a,b,c,d) \ |
| 50 |
|
| a += b; d = rotl32(d ^ a, 16); \ |
| 51 |
|
| c += d; b = rotl32(b ^ c, 12); \ |
| 52 |
|
| a += b; d = rotl32(d ^ a, 8); \ |
| 53 |
|
| c += d; b = rotl32(b ^ c, 7); |
| 54 |
|
| |
| 55 |
|
| |
| 56 |
204 |
| static void chacha_init(pUCXT, const UCHAR *seed, IV init_buffer) { |
| 57 |
204 |
| chacha_t *cc = &SMEM->cc; |
| 58 |
204 |
| U32 *x = (U32*)&cc->state; |
| 59 |
|
| |
| 60 |
204 |
| x[ 0] = 0x61707865; |
| 61 |
204 |
| x[ 1] = 0x3320646e; |
| 62 |
204 |
| x[ 2] = 0x79622d32; |
| 63 |
204 |
| x[ 3] = 0x6b206574; |
| 64 |
204 |
| x[ 4] = U8TO32_LE(seed + 0); |
| 65 |
204 |
| x[ 5] = U8TO32_LE(seed + 4); |
| 66 |
204 |
| x[ 6] = U8TO32_LE(seed + 8); |
| 67 |
204 |
| x[ 7] = U8TO32_LE(seed + 12); |
| 68 |
204 |
| x[ 8] = U8TO32_LE(seed + 16); |
| 69 |
204 |
| x[ 9] = U8TO32_LE(seed + 20); |
| 70 |
204 |
| x[10] = U8TO32_LE(seed + 24); |
| 71 |
204 |
| x[11] = U8TO32_LE(seed + 28); |
| 72 |
204 |
| x[12] = 0; |
| 73 |
204 |
| x[13] = 0; |
| 74 |
204 |
| x[14] = U8TO32_LE(seed + 32); |
| 75 |
204 |
| x[15] = U8TO32_LE(seed + 36); |
| 76 |
|
| |
| 77 |
204 |
▶ | if (init_buffer) { |
Branch: 1 branch
| Branch | True | False | Total |
| if (init_buffer) { |
204 |
0 |
204 |
|
| 78 |
204 |
| memset(cc->buf, 0, CC_BUFSZ); |
| 79 |
204 |
| cc->have = 0; |
| 80 |
|
| } |
| 81 |
204 |
| } |
| 82 |
|
| |
| 83 |
13808 |
| static void chacha_core(pUCXT, UCHAR* buf) { |
| 84 |
13808 |
| chacha_t *cc = &SMEM->cc; |
| 85 |
13808 |
| U32 *s = cc->state; |
| 86 |
|
| U32 i, x[16]; |
| 87 |
|
| |
| 88 |
13808 |
| memcpy(x, s, 16*sizeof(U32)); |
| 89 |
|
| |
| 90 |
151888 |
▶ | for (i = 0; i<CC_ROUNDS; i+=2) { |
Branch: 1 branch
| Branch | True | False | Total |
| for (i = 0; i<CC_ROUNDS; i+=2) { |
138080 |
13808 |
151888 |
|
| 91 |
138080 |
| QROUND( x[ 0], x[ 4], x[ 8], x[12] ); |
| 92 |
138080 |
| QROUND( x[ 1], x[ 5], x[ 9], x[13] ); |
| 93 |
138080 |
| QROUND( x[ 2], x[ 6], x[10], x[14] ); |
| 94 |
138080 |
| QROUND( x[ 3], x[ 7], x[11], x[15] ); |
| 95 |
138080 |
| QROUND( x[ 0], x[ 5], x[10], x[15] ); |
| 96 |
138080 |
| QROUND( x[ 1], x[ 6], x[11], x[12] ); |
| 97 |
138080 |
| QROUND( x[ 2], x[ 7], x[ 8], x[13] ); |
| 98 |
138080 |
| QROUND( x[ 3], x[ 4], x[ 9], x[14] ); |
| 99 |
|
| } |
| 100 |
|
| |
| 101 |
234736 |
▶ | for (i = 0; i < 16; i++) |
Branch: 1 branch
| Branch | True | False | Total |
| for (i = 0; i < 16; i++) |
220928 |
13808 |
234736 |
|
| 102 |
220928 |
| x[i] += s[i]; |
| 103 |
|
| |
| 104 |
234736 |
▶ | for (i = 0; i < 16; i++) |
Branch: 1 branch
| Branch | True | False | Total |
| for (i = 0; i < 16; i++) |
220928 |
13808 |
234736 |
|
| 105 |
220928 |
| U32TO8_LE( buf+4*i, x[i] ); |
| 106 |
|
| |
| 107 |
|
| /* inc counter */ |
| 108 |
13808 |
▶ | if (++s[12] == 0) s[13]++; |
Branch: 1 branch
| Branch | True | False | Total |
| if (++s[12] == 0) s[13]++; |
0 |
13808 |
13808 |
|
| 109 |
13808 |
| } |
| 110 |
|
| |
| 111 |
863 |
| static U16 chacha_stream(pUCXT, UCHAR* buf, U16 n) { |
| 112 |
863 |
| U16 r = n; |
| 113 |
|
| UCHAR sbuf[CC_CORESZ]; |
| 114 |
|
| |
| 115 |
14671 |
▶ | while (r >= CC_CORESZ) { |
Branch: 1 branch
| Branch | True | False | Total |
| while (r >= CC_CORESZ) { |
13808 |
863 |
14671 |
|
| 116 |
13808 |
| chacha_core(aUCXT, buf); |
| 117 |
13808 |
| buf += CC_CORESZ; |
| 118 |
13808 |
| r -= CC_CORESZ; |
| 119 |
|
| } |
| 120 |
863 |
▶ | if (r > 0) { |
Branch: 1 branch
| Branch | True | False | Total |
| if (r > 0) { |
0 |
863 |
863 |
|
| 121 |
0 |
| chacha_core(aUCXT, sbuf); |
| 122 |
0 |
| memcpy(buf, sbuf, r); |
| 123 |
|
| } |
| 124 |
863 |
| return n; |
| 125 |
|
| } |
| 126 |
|
| |
| 127 |
863 |
| static U32 chacha_refill(pUCXT) { |
| 128 |
863 |
| chacha_t *cc = &SMEM->cc; |
| 129 |
|
| U64 *cp; |
| 130 |
|
| |
| 131 |
|
| /* refill buffer */ |
| 132 |
863 |
| cc->have = chacha_stream(aUCXT, (UCHAR*)&cc->buf, CC_BUFSZ); |
| 133 |
|
| |
| 134 |
|
| /* reseed with KEYSZ bytes from buffer, then zero */ |
| 135 |
|
| /* |
| 136 |
|
| chacha_init(cc.buf, 0); |
| 137 |
|
| memset(cc.buf, 0, KEYSZ); |
| 138 |
|
| cc.have = BUFSZ - KEYSZ; |
| 139 |
|
| return cc.have; |
| 140 |
|
| */ |
| 141 |
|
| |
| 142 |
|
| /* create new key */ |
| 143 |
|
| /* |
| 144 |
|
| UCHAR seed[40]; |
| 145 |
|
| cp = (U64*)&seed; |
| 146 |
|
| *cp++ = uu_xoshiro_rand(); |
| 147 |
|
| *cp++ = uu_xoshiro_rand(); |
| 148 |
|
| *cp++ = uu_xoshiro_rand(); |
| 149 |
|
| *cp++ = uu_xoshiro_rand(); |
| 150 |
|
| *cp++ = uu_xoshiro_rand(); |
| 151 |
|
| chacha_init((UCHAR*)&seed, 0); |
| 152 |
|
| return cc.have; |
| 153 |
|
| */ |
| 154 |
|
| |
| 155 |
|
| /* salt the state */ |
| 156 |
|
| /* |
| 157 |
|
| cp = (U64*)&cc.state; |
| 158 |
|
| while (cp < (U64*)&cc.buf) |
| 159 |
|
| *cp++ ^= (U32)uu_xoshiro_rand(); |
| 160 |
|
| return cc.have; |
| 161 |
|
| */ |
| 162 |
|
| |
| 163 |
|
| /* salt the buffer */ |
| 164 |
863 |
| cp = (U64*)&cc->buf; |
| 165 |
111327 |
▶ | while (cp < (U64*)&cc->have) |
Branch: 1 branch
| Branch | True | False | Total |
| while (cp < (U64*)&cc->have) |
110464 |
863 |
111327 |
|
| 166 |
110464 |
| *cp++ ^= uu_xoshiro_rand(aUCXT); |
| 167 |
863 |
| return cc->have; |
| 168 |
|
| } |
| 169 |
|
| |
| 170 |
204 |
| void uu_chacha_srand(pUCXT) { |
| 171 |
|
| U64 d, n, *cp; |
| 172 |
|
| UCHAR data[40]; |
| 173 |
|
| |
| 174 |
204 |
| uu_splitmix_srand(aUCXT); |
| 175 |
204 |
| uu_xoshiro_srand(aUCXT); |
| 176 |
|
| |
| 177 |
204 |
| cp = (U64*)&data; |
| 178 |
|
| |
| 179 |
204 |
| *cp++ = uu_xoshiro_rand(aUCXT); |
| 180 |
204 |
| *cp++ = uu_xoshiro_rand(aUCXT); |
| 181 |
204 |
| *cp++ = uu_xoshiro_rand(aUCXT); |
| 182 |
204 |
| *cp++ = uu_xoshiro_rand(aUCXT); |
| 183 |
204 |
| *cp++ = uu_xoshiro_rand(aUCXT); |
| 184 |
|
| |
| 185 |
204 |
| chacha_init(aUCXT, data, 1); |
| 186 |
|
| |
| 187 |
|
| /* stir 8 - 39 times */ |
| 188 |
204 |
| uu_chacha_rand64(aUCXT, &d); |
| 189 |
204 |
| n = 8 + (d >> 59); |
| 190 |
|
| |
| 191 |
4977 |
▶ | while (n-- > 0) |
Branch: 1 branch
| Branch | True | False | Total |
| while (n-- > 0) |
4773 |
204 |
4977 |
|
| 192 |
4773 |
| uu_chacha_rand64(aUCXT, &d); |
| 193 |
204 |
| } |
| 194 |
|
| |
| 195 |
|
| /* API */ |
| 196 |
|
| |
| 197 |
18471 |
| void uu_chacha_rand16(pUCXT, U16 *out) { |
| 198 |
18471 |
| chacha_t *cc = &SMEM->cc; |
| 199 |
|
| UCHAR *ptr; |
| 200 |
|
| |
| 201 |
18471 |
▶ | if (cc->have < 2) chacha_refill(aUCXT); |
Branch: 1 branch
| Branch | True | False | Total |
| if (cc->have < 2) chacha_refill(aUCXT); |
204 |
18267 |
18471 |
|
| 202 |
18471 |
| ptr = cc->buf + CC_BUFSZ - cc->have; |
| 203 |
18471 |
| cc->have -= 2; |
| 204 |
|
| |
| 205 |
18471 |
| *out = U8TO16_LE(ptr); |
| 206 |
18471 |
| } |
| 207 |
|
| |
| 208 |
28 |
| void uu_chacha_rand32(pUCXT, U32 *out) { |
| 209 |
28 |
| chacha_t *cc = &SMEM->cc; |
| 210 |
|
| UCHAR *ptr; |
| 211 |
|
| |
| 212 |
28 |
▶ | if (cc->have < 4) chacha_refill(aUCXT); |
Branch: 1 branch
| Branch | True | False | Total |
| if (cc->have < 4) chacha_refill(aUCXT); |
0 |
28 |
28 |
|
| 213 |
28 |
| ptr = cc->buf + CC_BUFSZ - cc->have; |
| 214 |
28 |
| cc->have -= 4; |
| 215 |
|
| |
| 216 |
28 |
| *out = U8TO32_LE(ptr); |
| 217 |
28 |
| } |
| 218 |
|
| |
| 219 |
59124 |
| void uu_chacha_rand64(pUCXT, U64 *out) { |
| 220 |
59124 |
| chacha_t *cc = &SMEM->cc; |
| 221 |
|
| UCHAR *ptr; |
| 222 |
|
| |
| 223 |
59124 |
▶ | if (cc->have < 8) chacha_refill(aUCXT); |
Branch: 1 branch
| Branch | True | False | Total |
| if (cc->have < 8) chacha_refill(aUCXT); |
659 |
58465 |
59124 |
|
| 224 |
59124 |
| ptr = cc->buf + CC_BUFSZ - cc->have; |
| 225 |
59124 |
| cc->have -= 8; |
| 226 |
|
| |
| 227 |
59124 |
| *out = U8TO64_LE(ptr); |
| 228 |
59124 |
| } |
| 229 |
|
| |
| 230 |
0 |
| void uu_chacha_rand128(pUCXT, void *out) { |
| 231 |
0 |
| chacha_t *cc = &SMEM->cc; |
| 232 |
|
| U64 a, b; |
| 233 |
|
| UCHAR *ptr; |
| 234 |
|
| |
| 235 |
0 |
▶ | if (cc->have < 16) chacha_refill(aUCXT); |
Branch: 1 branch
| Branch | True | False | Total |
| if (cc->have < 16) chacha_refill(aUCXT); |
0 |
0 |
0 |
|
| 236 |
0 |
| ptr = cc->buf + CC_BUFSZ - cc->have; |
| 237 |
0 |
| cc->have -= 16; |
| 238 |
|
| |
| 239 |
0 |
| a = U8TO64_LE(ptr); |
| 240 |
0 |
| b = U8TO64_LE(ptr); |
| 241 |
0 |
| *((U64*)out) = a; |
| 242 |
0 |
| *(((U64*)out)+8) = b; |
| 243 |
0 |
| } |
| 244 |
|
| |
| 245 |
|
| /* ex:set ts=2 sw=2 itab=spaces: */ |