USB: usbtmc: fix switch statment
[linux-2.6/mini2440.git] / crypto / ansi_cprng.c
blob0fac8ffc2fb7ef5dc6d39cca05d0292b584bb472
1 /*
2 * PRNG: Pseudo Random Number Generator
3 * Based on NIST Recommended PRNG From ANSI X9.31 Appendix A.2.4 using
4 * AES 128 cipher
6 * (C) Neil Horman <nhorman@tuxdriver.com>
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * any later version.
16 #include <crypto/internal/rng.h>
17 #include <linux/err.h>
18 #include <linux/init.h>
19 #include <linux/module.h>
20 #include <linux/moduleparam.h>
21 #include <linux/string.h>
23 #include "internal.h"
25 #define DEFAULT_PRNG_KEY "0123456789abcdef"
26 #define DEFAULT_PRNG_KSZ 16
27 #define DEFAULT_BLK_SZ 16
28 #define DEFAULT_V_SEED "zaybxcwdveuftgsh"
31 * Flags for the prng_context flags field
34 #define PRNG_FIXED_SIZE 0x1
35 #define PRNG_NEED_RESET 0x2
38 * Note: DT is our counter value
39 * I is our intermediate value
40 * V is our seed vector
41 * See http://csrc.nist.gov/groups/STM/cavp/documents/rng/931rngext.pdf
42 * for implementation details
46 struct prng_context {
47 spinlock_t prng_lock;
48 unsigned char rand_data[DEFAULT_BLK_SZ];
49 unsigned char last_rand_data[DEFAULT_BLK_SZ];
50 unsigned char DT[DEFAULT_BLK_SZ];
51 unsigned char I[DEFAULT_BLK_SZ];
52 unsigned char V[DEFAULT_BLK_SZ];
53 u32 rand_data_valid;
54 struct crypto_cipher *tfm;
55 u32 flags;
58 static int dbg;
60 static void hexdump(char *note, unsigned char *buf, unsigned int len)
62 if (dbg) {
63 printk(KERN_CRIT "%s", note);
64 print_hex_dump(KERN_CONT, "", DUMP_PREFIX_OFFSET,
65 16, 1,
66 buf, len, false);
70 #define dbgprint(format, args...) do {\
71 if (dbg)\
72 printk(format, ##args);\
73 } while (0)
75 static void xor_vectors(unsigned char *in1, unsigned char *in2,
76 unsigned char *out, unsigned int size)
78 int i;
80 for (i = 0; i < size; i++)
81 out[i] = in1[i] ^ in2[i];
85 * Returns DEFAULT_BLK_SZ bytes of random data per call
86 * returns 0 if generation succeded, <0 if something went wrong
88 static int _get_more_prng_bytes(struct prng_context *ctx)
90 int i;
91 unsigned char tmp[DEFAULT_BLK_SZ];
92 unsigned char *output = NULL;
95 dbgprint(KERN_CRIT "Calling _get_more_prng_bytes for context %p\n",
96 ctx);
98 hexdump("Input DT: ", ctx->DT, DEFAULT_BLK_SZ);
99 hexdump("Input I: ", ctx->I, DEFAULT_BLK_SZ);
100 hexdump("Input V: ", ctx->V, DEFAULT_BLK_SZ);
103 * This algorithm is a 3 stage state machine
105 for (i = 0; i < 3; i++) {
107 switch (i) {
108 case 0:
110 * Start by encrypting the counter value
111 * This gives us an intermediate value I
113 memcpy(tmp, ctx->DT, DEFAULT_BLK_SZ);
114 output = ctx->I;
115 hexdump("tmp stage 0: ", tmp, DEFAULT_BLK_SZ);
116 break;
117 case 1:
120 * Next xor I with our secret vector V
121 * encrypt that result to obtain our
122 * pseudo random data which we output
124 xor_vectors(ctx->I, ctx->V, tmp, DEFAULT_BLK_SZ);
125 hexdump("tmp stage 1: ", tmp, DEFAULT_BLK_SZ);
126 output = ctx->rand_data;
127 break;
128 case 2:
130 * First check that we didn't produce the same
131 * random data that we did last time around through this
133 if (!memcmp(ctx->rand_data, ctx->last_rand_data,
134 DEFAULT_BLK_SZ)) {
135 printk(KERN_ERR
136 "ctx %p Failed repetition check!\n",
137 ctx);
138 ctx->flags |= PRNG_NEED_RESET;
139 return -EINVAL;
141 memcpy(ctx->last_rand_data, ctx->rand_data,
142 DEFAULT_BLK_SZ);
145 * Lastly xor the random data with I
146 * and encrypt that to obtain a new secret vector V
148 xor_vectors(ctx->rand_data, ctx->I, tmp,
149 DEFAULT_BLK_SZ);
150 output = ctx->V;
151 hexdump("tmp stage 2: ", tmp, DEFAULT_BLK_SZ);
152 break;
156 /* do the encryption */
157 crypto_cipher_encrypt_one(ctx->tfm, output, tmp);
162 * Now update our DT value
164 for (i = DEFAULT_BLK_SZ - 1; i >= 0; i--) {
165 ctx->DT[i] += 1;
166 if (ctx->DT[i] != 0)
167 break;
170 dbgprint("Returning new block for context %p\n", ctx);
171 ctx->rand_data_valid = 0;
173 hexdump("Output DT: ", ctx->DT, DEFAULT_BLK_SZ);
174 hexdump("Output I: ", ctx->I, DEFAULT_BLK_SZ);
175 hexdump("Output V: ", ctx->V, DEFAULT_BLK_SZ);
176 hexdump("New Random Data: ", ctx->rand_data, DEFAULT_BLK_SZ);
178 return 0;
181 /* Our exported functions */
182 static int get_prng_bytes(char *buf, size_t nbytes, struct prng_context *ctx)
184 unsigned long flags;
185 unsigned char *ptr = buf;
186 unsigned int byte_count = (unsigned int)nbytes;
187 int err;
190 if (nbytes < 0)
191 return -EINVAL;
193 spin_lock_irqsave(&ctx->prng_lock, flags);
195 err = -EINVAL;
196 if (ctx->flags & PRNG_NEED_RESET)
197 goto done;
200 * If the FIXED_SIZE flag is on, only return whole blocks of
201 * pseudo random data
203 err = -EINVAL;
204 if (ctx->flags & PRNG_FIXED_SIZE) {
205 if (nbytes < DEFAULT_BLK_SZ)
206 goto done;
207 byte_count = DEFAULT_BLK_SZ;
210 err = byte_count;
212 dbgprint(KERN_CRIT "getting %d random bytes for context %p\n",
213 byte_count, ctx);
216 remainder:
217 if (ctx->rand_data_valid == DEFAULT_BLK_SZ) {
218 if (_get_more_prng_bytes(ctx) < 0) {
219 memset(buf, 0, nbytes);
220 err = -EINVAL;
221 goto done;
226 * Copy any data less than an entire block
228 if (byte_count < DEFAULT_BLK_SZ) {
229 empty_rbuf:
230 for (; ctx->rand_data_valid < DEFAULT_BLK_SZ;
231 ctx->rand_data_valid++) {
232 *ptr = ctx->rand_data[ctx->rand_data_valid];
233 ptr++;
234 byte_count--;
235 if (byte_count == 0)
236 goto done;
241 * Now copy whole blocks
243 for (; byte_count >= DEFAULT_BLK_SZ; byte_count -= DEFAULT_BLK_SZ) {
244 if (ctx->rand_data_valid == DEFAULT_BLK_SZ) {
245 if (_get_more_prng_bytes(ctx) < 0) {
246 memset(buf, 0, nbytes);
247 err = -EINVAL;
248 goto done;
251 if (ctx->rand_data_valid > 0)
252 goto empty_rbuf;
253 memcpy(ptr, ctx->rand_data, DEFAULT_BLK_SZ);
254 ctx->rand_data_valid += DEFAULT_BLK_SZ;
255 ptr += DEFAULT_BLK_SZ;
259 * Now go back and get any remaining partial block
261 if (byte_count)
262 goto remainder;
264 done:
265 spin_unlock_irqrestore(&ctx->prng_lock, flags);
266 dbgprint(KERN_CRIT "returning %d from get_prng_bytes in context %p\n",
267 err, ctx);
268 return err;
271 static void free_prng_context(struct prng_context *ctx)
273 crypto_free_cipher(ctx->tfm);
276 static int reset_prng_context(struct prng_context *ctx,
277 unsigned char *key, size_t klen,
278 unsigned char *V, unsigned char *DT)
280 int ret;
281 int rc = -EINVAL;
282 unsigned char *prng_key;
284 spin_lock(&ctx->prng_lock);
285 ctx->flags |= PRNG_NEED_RESET;
287 prng_key = (key != NULL) ? key : (unsigned char *)DEFAULT_PRNG_KEY;
289 if (!key)
290 klen = DEFAULT_PRNG_KSZ;
292 if (V)
293 memcpy(ctx->V, V, DEFAULT_BLK_SZ);
294 else
295 memcpy(ctx->V, DEFAULT_V_SEED, DEFAULT_BLK_SZ);
297 if (DT)
298 memcpy(ctx->DT, DT, DEFAULT_BLK_SZ);
299 else
300 memset(ctx->DT, 0, DEFAULT_BLK_SZ);
302 memset(ctx->rand_data, 0, DEFAULT_BLK_SZ);
303 memset(ctx->last_rand_data, 0, DEFAULT_BLK_SZ);
305 if (ctx->tfm)
306 crypto_free_cipher(ctx->tfm);
308 ctx->tfm = crypto_alloc_cipher("aes", 0, 0);
309 if (IS_ERR(ctx->tfm)) {
310 dbgprint(KERN_CRIT "Failed to alloc tfm for context %p\n",
311 ctx);
312 ctx->tfm = NULL;
313 goto out;
316 ctx->rand_data_valid = DEFAULT_BLK_SZ;
318 ret = crypto_cipher_setkey(ctx->tfm, prng_key, klen);
319 if (ret) {
320 dbgprint(KERN_CRIT "PRNG: setkey() failed flags=%x\n",
321 crypto_cipher_get_flags(ctx->tfm));
322 crypto_free_cipher(ctx->tfm);
323 goto out;
326 rc = 0;
327 ctx->flags &= ~PRNG_NEED_RESET;
328 out:
329 spin_unlock(&ctx->prng_lock);
331 return rc;
335 static int cprng_init(struct crypto_tfm *tfm)
337 struct prng_context *ctx = crypto_tfm_ctx(tfm);
339 spin_lock_init(&ctx->prng_lock);
341 return reset_prng_context(ctx, NULL, DEFAULT_PRNG_KSZ, NULL, NULL);
344 static void cprng_exit(struct crypto_tfm *tfm)
346 free_prng_context(crypto_tfm_ctx(tfm));
349 static int cprng_get_random(struct crypto_rng *tfm, u8 *rdata,
350 unsigned int dlen)
352 struct prng_context *prng = crypto_rng_ctx(tfm);
354 return get_prng_bytes(rdata, dlen, prng);
358 * This is the cprng_registered reset method the seed value is
359 * interpreted as the tuple { V KEY DT}
360 * V and KEY are required during reset, and DT is optional, detected
361 * as being present by testing the length of the seed
363 static int cprng_reset(struct crypto_rng *tfm, u8 *seed, unsigned int slen)
365 struct prng_context *prng = crypto_rng_ctx(tfm);
366 u8 *key = seed + DEFAULT_BLK_SZ;
367 u8 *dt = NULL;
369 if (slen < DEFAULT_PRNG_KSZ + DEFAULT_BLK_SZ)
370 return -EINVAL;
372 if (slen >= (2 * DEFAULT_BLK_SZ + DEFAULT_PRNG_KSZ))
373 dt = key + DEFAULT_PRNG_KSZ;
375 reset_prng_context(prng, key, DEFAULT_PRNG_KSZ, seed, dt);
377 if (prng->flags & PRNG_NEED_RESET)
378 return -EINVAL;
379 return 0;
382 static struct crypto_alg rng_alg = {
383 .cra_name = "stdrng",
384 .cra_driver_name = "ansi_cprng",
385 .cra_priority = 100,
386 .cra_flags = CRYPTO_ALG_TYPE_RNG,
387 .cra_ctxsize = sizeof(struct prng_context),
388 .cra_type = &crypto_rng_type,
389 .cra_module = THIS_MODULE,
390 .cra_list = LIST_HEAD_INIT(rng_alg.cra_list),
391 .cra_init = cprng_init,
392 .cra_exit = cprng_exit,
393 .cra_u = {
394 .rng = {
395 .rng_make_random = cprng_get_random,
396 .rng_reset = cprng_reset,
397 .seedsize = DEFAULT_PRNG_KSZ + 2*DEFAULT_BLK_SZ,
403 /* Module initalization */
404 static int __init prng_mod_init(void)
406 int ret = 0;
408 if (fips_enabled)
409 rng_alg.cra_priority += 200;
411 ret = crypto_register_alg(&rng_alg);
413 if (ret)
414 goto out;
415 out:
416 return 0;
419 static void __exit prng_mod_fini(void)
421 crypto_unregister_alg(&rng_alg);
422 return;
425 MODULE_LICENSE("GPL");
426 MODULE_DESCRIPTION("Software Pseudo Random Number Generator");
427 MODULE_AUTHOR("Neil Horman <nhorman@tuxdriver.com>");
428 module_param(dbg, int, 0);
429 MODULE_PARM_DESC(dbg, "Boolean to enable debugging (0/1 == off/on)");
430 module_init(prng_mod_init);
431 module_exit(prng_mod_fini);
432 MODULE_ALIAS("stdrng");