projects / openwrt.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
generic: allow to build myloader mtd parser for 3.2+
[openwrt.git] / target / linux / generic / files / crypto / ocf / cryptosoft.c
1 /*
2 * An OCF module that uses the linux kernel cryptoapi, based on the
3 * original cryptosoft for BSD by Angelos D. Keromytis (angelos@cis.upenn.edu)
4 * but is mostly unrecognisable,
5 *
6 * Written by David McCullough <david_mccullough@mcafee.com>
7 * Copyright (C) 2004-2011 David McCullough
8 * Copyright (C) 2004-2005 Intel Corporation.
9 *
10 * LICENSE TERMS
11 *
12 * The free distribution and use of this software in both source and binary
13 * form is allowed (with or without changes) provided that:
14 *
15 * 1. distributions of this source code include the above copyright
16 * notice, this list of conditions and the following disclaimer;
17 *
18 * 2. distributions in binary form include the above copyright
19 * notice, this list of conditions and the following disclaimer
20 * in the documentation and/or other associated materials;
21 *
22 * 3. the copyright holder's name is not used to endorse products
23 * built using this software without specific written permission.
24 *
25 * ALTERNATIVELY, provided that this notice is retained in full, this product
26 * may be distributed under the terms of the GNU General Public License (GPL),
27 * in which case the provisions of the GPL apply INSTEAD OF those given above.
28 *
29 * DISCLAIMER
30 *
31 * This software is provided 'as is' with no explicit or implied warranties
32 * in respect of its properties, including, but not limited to, correctness
33 * and/or fitness for purpose.
34 * ---------------------------------------------------------------------------
35 */
36
37 #include <linux/version.h>
38 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38) && !defined(AUTOCONF_INCLUDED)
39 #include <linux/config.h>
40 #endif
41 #include <linux/module.h>
42 #include <linux/init.h>
43 #include <linux/list.h>
44 #include <linux/slab.h>
45 #include <linux/sched.h>
46 #include <linux/wait.h>
47 #include <linux/crypto.h>
48 #include <linux/mm.h>
49 #include <linux/skbuff.h>
50 #include <linux/random.h>
51 #include <linux/interrupt.h>
52 #include <linux/spinlock.h>
53 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,10)
54 #include <linux/scatterlist.h>
55 #endif
56 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,29)
57 #include <crypto/hash.h>
58 #endif
59
60 #include <cryptodev.h>
61 #include <uio.h>
62
63 struct {
64 softc_device_decl sc_dev;
65 } swcr_softc;
66
67 #define offset_in_page(p) ((unsigned long)(p) & ~PAGE_MASK)
68
69 #define SW_TYPE_CIPHER 0x01
70 #define SW_TYPE_HMAC 0x02
71 #define SW_TYPE_HASH 0x04
72 #define SW_TYPE_COMP 0x08
73 #define SW_TYPE_BLKCIPHER 0x10
74 #define SW_TYPE_ALG_MASK 0x1f
75
76 #define SW_TYPE_ASYNC 0x8000
77
78 #define SW_TYPE_INUSE 0x10000000
79
80 /* We change some of the above if we have an async interface */
81
82 #define SW_TYPE_ALG_AMASK (SW_TYPE_ALG_MASK | SW_TYPE_ASYNC)
83
84 #define SW_TYPE_ABLKCIPHER (SW_TYPE_BLKCIPHER | SW_TYPE_ASYNC)
85 #define SW_TYPE_AHASH (SW_TYPE_HASH | SW_TYPE_ASYNC)
86 #define SW_TYPE_AHMAC (SW_TYPE_HMAC | SW_TYPE_ASYNC)
87
88 #define SCATTERLIST_MAX 16
89
90 struct swcr_data {
91 struct work_struct workq;
92 int sw_type;
93 int sw_alg;
94 struct crypto_tfm *sw_tfm;
95 spinlock_t sw_tfm_lock;
96 union {
97 struct {
98 char *sw_key;
99 int sw_klen;
100 int sw_mlen;
101 } hmac;
102 void *sw_comp_buf;
103 } u;
104 struct swcr_data *sw_next;
105 };
106
107 struct swcr_req {
108 struct swcr_data *sw_head;
109 struct swcr_data *sw;
110 struct cryptop *crp;
111 struct cryptodesc *crd;
112 struct scatterlist sg[SCATTERLIST_MAX];
113 unsigned char iv[EALG_MAX_BLOCK_LEN];
114 char result[HASH_MAX_LEN];
115 void *crypto_req;
116 };
117
118 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20)
119 static kmem_cache_t *swcr_req_cache;
120 #else
121 static struct kmem_cache *swcr_req_cache;
122 #endif
123
124 #ifndef CRYPTO_TFM_MODE_CBC
125 /*
126 * As of linux-2.6.21 this is no longer defined, and presumably no longer
127 * needed to be passed into the crypto core code.
128 */
129 #define CRYPTO_TFM_MODE_CBC 0
130 #define CRYPTO_TFM_MODE_ECB 0
131 #endif
132
133 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19)
134 /*
135 * Linux 2.6.19 introduced a new Crypto API, setup macro's to convert new
136 * API into old API.
137 */
138
139 /* Symmetric/Block Cipher */
140 struct blkcipher_desc
141 {
142 struct crypto_tfm *tfm;
143 void *info;
144 };
145 #define ecb(X) #X , CRYPTO_TFM_MODE_ECB
146 #define cbc(X) #X , CRYPTO_TFM_MODE_CBC
147 #define crypto_has_blkcipher(X, Y, Z) crypto_alg_available(X, 0)
148 #define crypto_blkcipher_cast(X) X
149 #define crypto_blkcipher_tfm(X) X
150 #define crypto_alloc_blkcipher(X, Y, Z) crypto_alloc_tfm(X, mode)
151 #define crypto_blkcipher_ivsize(X) crypto_tfm_alg_ivsize(X)
152 #define crypto_blkcipher_blocksize(X) crypto_tfm_alg_blocksize(X)
153 #define crypto_blkcipher_setkey(X, Y, Z) crypto_cipher_setkey(X, Y, Z)
154 #define crypto_blkcipher_encrypt_iv(W, X, Y, Z) \
155 crypto_cipher_encrypt_iv((W)->tfm, X, Y, Z, (u8 *)((W)->info))
156 #define crypto_blkcipher_decrypt_iv(W, X, Y, Z) \
157 crypto_cipher_decrypt_iv((W)->tfm, X, Y, Z, (u8 *)((W)->info))
158 #define crypto_blkcipher_set_flags(x, y) /* nop */
159 #define crypto_free_blkcipher(x) crypto_free_tfm(x)
160 #define crypto_free_comp crypto_free_tfm
161 #define crypto_free_hash crypto_free_tfm
162
163 /* Hash/HMAC/Digest */
164 struct hash_desc
165 {
166 struct crypto_tfm *tfm;
167 };
168 #define hmac(X) #X , 0
169 #define crypto_has_hash(X, Y, Z) crypto_alg_available(X, 0)
170 #define crypto_hash_cast(X) X
171 #define crypto_hash_tfm(X) X
172 #define crypto_alloc_hash(X, Y, Z) crypto_alloc_tfm(X, mode)
173 #define crypto_hash_digestsize(X) crypto_tfm_alg_digestsize(X)
174 #define crypto_hash_digest(W, X, Y, Z) \
175 crypto_digest_digest((W)->tfm, X, sg_num, Z)
176
177 /* Asymmetric Cipher */
178 #define crypto_has_cipher(X, Y, Z) crypto_alg_available(X, 0)
179
180 /* Compression */
181 #define crypto_has_comp(X, Y, Z) crypto_alg_available(X, 0)
182 #define crypto_comp_tfm(X) X
183 #define crypto_comp_cast(X) X
184 #define crypto_alloc_comp(X, Y, Z) crypto_alloc_tfm(X, mode)
185 #define plain(X) #X , 0
186 #else
187 #define ecb(X) "ecb(" #X ")" , 0
188 #define cbc(X) "cbc(" #X ")" , 0
189 #define hmac(X) "hmac(" #X ")" , 0
190 #define plain(X) #X , 0
191 #endif /* if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19) */
192
193 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22)
194 /* no ablkcipher in older kernels */
195 #define crypto_alloc_ablkcipher(a,b,c) (NULL)
196 #define crypto_ablkcipher_tfm(x) ((struct crypto_tfm *)(x))
197 #define crypto_ablkcipher_set_flags(a, b) /* nop */
198 #define crypto_ablkcipher_setkey(x, y, z) (-EINVAL)
199 #define crypto_has_ablkcipher(a,b,c) (0)
200 #else
201 #define HAVE_ABLKCIPHER
202 #endif
203
204 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,32)
205 /* no ahash in older kernels */
206 #define crypto_ahash_tfm(x) ((struct crypto_tfm *)(x))
207 #define crypto_alloc_ahash(a,b,c) (NULL)
208 #define crypto_ahash_digestsize(x) 0
209 #else
210 #define HAVE_AHASH
211 #endif
212
213 struct crypto_details {
214 char *alg_name;
215 int mode;
216 int sw_type;
217 };
218
219 static struct crypto_details crypto_details[] = {
220 [CRYPTO_DES_CBC] = { cbc(des), SW_TYPE_BLKCIPHER, },
221 [CRYPTO_3DES_CBC] = { cbc(des3_ede), SW_TYPE_BLKCIPHER, },
222 [CRYPTO_BLF_CBC] = { cbc(blowfish), SW_TYPE_BLKCIPHER, },
223 [CRYPTO_CAST_CBC] = { cbc(cast5), SW_TYPE_BLKCIPHER, },
224 [CRYPTO_SKIPJACK_CBC] = { cbc(skipjack), SW_TYPE_BLKCIPHER, },
225 [CRYPTO_MD5_HMAC] = { hmac(md5), SW_TYPE_HMAC, },
226 [CRYPTO_SHA1_HMAC] = { hmac(sha1), SW_TYPE_HMAC, },
227 [CRYPTO_RIPEMD160_HMAC] = { hmac(ripemd160), SW_TYPE_HMAC, },
228 [CRYPTO_MD5_KPDK] = { plain(md5-kpdk), SW_TYPE_HASH, },
229 [CRYPTO_SHA1_KPDK] = { plain(sha1-kpdk), SW_TYPE_HASH, },
230 [CRYPTO_AES_CBC] = { cbc(aes), SW_TYPE_BLKCIPHER, },
231 [CRYPTO_ARC4] = { ecb(arc4), SW_TYPE_BLKCIPHER, },
232 [CRYPTO_MD5] = { plain(md5), SW_TYPE_HASH, },
233 [CRYPTO_SHA1] = { plain(sha1), SW_TYPE_HASH, },
234 [CRYPTO_NULL_HMAC] = { hmac(digest_null), SW_TYPE_HMAC, },
235 [CRYPTO_NULL_CBC] = { cbc(cipher_null), SW_TYPE_BLKCIPHER, },
236 [CRYPTO_DEFLATE_COMP] = { plain(deflate), SW_TYPE_COMP, },
237 [CRYPTO_SHA2_256_HMAC] = { hmac(sha256), SW_TYPE_HMAC, },
238 [CRYPTO_SHA2_384_HMAC] = { hmac(sha384), SW_TYPE_HMAC, },
239 [CRYPTO_SHA2_512_HMAC] = { hmac(sha512), SW_TYPE_HMAC, },
240 [CRYPTO_CAMELLIA_CBC] = { cbc(camellia), SW_TYPE_BLKCIPHER, },
241 [CRYPTO_SHA2_256] = { plain(sha256), SW_TYPE_HASH, },
242 [CRYPTO_SHA2_384] = { plain(sha384), SW_TYPE_HASH, },
243 [CRYPTO_SHA2_512] = { plain(sha512), SW_TYPE_HASH, },
244 [CRYPTO_RIPEMD160] = { plain(ripemd160), SW_TYPE_HASH, },
245 };
246
247 int32_t swcr_id = -1;
248 module_param(swcr_id, int, 0444);
249 MODULE_PARM_DESC(swcr_id, "Read-Only OCF ID for cryptosoft driver");
250
251 int swcr_fail_if_compression_grows = 1;
252 module_param(swcr_fail_if_compression_grows, int, 0644);
253 MODULE_PARM_DESC(swcr_fail_if_compression_grows,
254 "Treat compression that results in more data as a failure");
255
256 int swcr_no_ahash = 0;
257 module_param(swcr_no_ahash, int, 0644);
258 MODULE_PARM_DESC(swcr_no_ahash,
259 "Do not use async hash/hmac even if available");
260
261 int swcr_no_ablk = 0;
262 module_param(swcr_no_ablk, int, 0644);
263 MODULE_PARM_DESC(swcr_no_ablk,
264 "Do not use async blk ciphers even if available");
265
266 static struct swcr_data **swcr_sessions = NULL;
267 static u_int32_t swcr_sesnum = 0;
268
269 static int swcr_process(device_t, struct cryptop *, int);
270 static int swcr_newsession(device_t, u_int32_t *, struct cryptoini *);
271 static int swcr_freesession(device_t, u_int64_t);
272
273 static device_method_t swcr_methods = {
274 /* crypto device methods */
275 DEVMETHOD(cryptodev_newsession, swcr_newsession),
276 DEVMETHOD(cryptodev_freesession,swcr_freesession),
277 DEVMETHOD(cryptodev_process, swcr_process),
278 };
279
280 #define debug swcr_debug
281 int swcr_debug = 0;
282 module_param(swcr_debug, int, 0644);
283 MODULE_PARM_DESC(swcr_debug, "Enable debug");
284
285 static void swcr_process_req(struct swcr_req *req);
286
287 /*
288 * somethings just need to be run with user context no matter whether
289 * the kernel compression libs use vmalloc/vfree for example.
290 */
291
292 typedef struct {
293 struct work_struct wq;
294 void (*func)(void *arg);
295 void *arg;
296 } execute_later_t;
297
298 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)
299 static void
300 doing_it_now(struct work_struct *wq)
301 {
302 execute_later_t *w = container_of(wq, execute_later_t, wq);
303 (w->func)(w->arg);
304 kfree(w);
305 }
306 #else
307 static void
308 doing_it_now(void *arg)
309 {
310 execute_later_t *w = (execute_later_t *) arg;
311 (w->func)(w->arg);
312 kfree(w);
313 }
314 #endif
315
316 static void
317 execute_later(void (fn)(void *), void *arg)
318 {
319 execute_later_t *w;
320
321 w = (execute_later_t *) kmalloc(sizeof(execute_later_t), SLAB_ATOMIC);
322 if (w) {
323 memset(w, '\0', sizeof(w));
324 w->func = fn;
325 w->arg = arg;
326 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)
327 INIT_WORK(&w->wq, doing_it_now);
328 #else
329 INIT_WORK(&w->wq, doing_it_now, w);
330 #endif
331 schedule_work(&w->wq);
332 }
333 }
334
335 /*
336 * Generate a new software session.
337 */
338 static int
339 swcr_newsession(device_t dev, u_int32_t *sid, struct cryptoini *cri)
340 {
341 struct swcr_data **swd;
342 u_int32_t i;
343 int error;
344 char *algo;
345 int mode;
346
347 dprintk("%s()\n", __FUNCTION__);
348 if (sid == NULL || cri == NULL) {
349 dprintk("%s,%d - EINVAL\n", __FILE__, __LINE__);
350 return EINVAL;
351 }
352
353 if (swcr_sessions) {
354 for (i = 1; i < swcr_sesnum; i++)
355 if (swcr_sessions[i] == NULL)
356 break;
357 } else
358 i = 1; /* NB: to silence compiler warning */
359
360 if (swcr_sessions == NULL || i == swcr_sesnum) {
361 if (swcr_sessions == NULL) {
362 i = 1; /* We leave swcr_sessions[0] empty */
363 swcr_sesnum = CRYPTO_SW_SESSIONS;
364 } else
365 swcr_sesnum *= 2;
366
367 swd = kmalloc(swcr_sesnum * sizeof(struct swcr_data *), SLAB_ATOMIC);
368 if (swd == NULL) {
369 /* Reset session number */
370 if (swcr_sesnum == CRYPTO_SW_SESSIONS)
371 swcr_sesnum = 0;
372 else
373 swcr_sesnum /= 2;
374 dprintk("%s,%d: ENOBUFS\n", __FILE__, __LINE__);
375 return ENOBUFS;
376 }
377 memset(swd, 0, swcr_sesnum * sizeof(struct swcr_data *));
378
379 /* Copy existing sessions */
380 if (swcr_sessions) {
381 memcpy(swd, swcr_sessions,
382 (swcr_sesnum / 2) * sizeof(struct swcr_data *));
383 kfree(swcr_sessions);
384 }
385
386 swcr_sessions = swd;
387 }
388
389 swd = &swcr_sessions[i];
390 *sid = i;
391
392 while (cri) {
393 *swd = (struct swcr_data *) kmalloc(sizeof(struct swcr_data),
394 SLAB_ATOMIC);
395 if (*swd == NULL) {
396 swcr_freesession(NULL, i);
397 dprintk("%s,%d: ENOBUFS\n", __FILE__, __LINE__);
398 return ENOBUFS;
399 }
400 memset(*swd, 0, sizeof(struct swcr_data));
401
402 if (cri->cri_alg < 0 ||
403 cri->cri_alg>=sizeof(crypto_details)/sizeof(crypto_details[0])){
404 printk("cryptosoft: Unknown algorithm 0x%x\n", cri->cri_alg);
405 swcr_freesession(NULL, i);
406 return EINVAL;
407 }
408
409 algo = crypto_details[cri->cri_alg].alg_name;
410 if (!algo || !*algo) {
411 printk("cryptosoft: Unsupported algorithm 0x%x\n", cri->cri_alg);
412 swcr_freesession(NULL, i);
413 return EINVAL;
414 }
415
416 mode = crypto_details[cri->cri_alg].mode;
417 (*swd)->sw_type = crypto_details[cri->cri_alg].sw_type;
418 (*swd)->sw_alg = cri->cri_alg;
419
420 spin_lock_init(&(*swd)->sw_tfm_lock);
421
422 /* Algorithm specific configuration */
423 switch (cri->cri_alg) {
424 case CRYPTO_NULL_CBC:
425 cri->cri_klen = 0; /* make it work with crypto API */
426 break;
427 default:
428 break;
429 }
430
431 if ((*swd)->sw_type & SW_TYPE_BLKCIPHER) {
432 dprintk("%s crypto_alloc_*blkcipher(%s, 0x%x)\n", __FUNCTION__,
433 algo, mode);
434
435 /* try async first */
436 (*swd)->sw_tfm = swcr_no_ablk ? NULL :
437 crypto_ablkcipher_tfm(crypto_alloc_ablkcipher(algo, 0, 0));
438 if ((*swd)->sw_tfm && !IS_ERR((*swd)->sw_tfm)) {
439 dprintk("%s %s cipher is async\n", __FUNCTION__, algo);
440 (*swd)->sw_type |= SW_TYPE_ASYNC;
441 } else {
442 (*swd)->sw_tfm = crypto_blkcipher_tfm(
443 crypto_alloc_blkcipher(algo, 0, CRYPTO_ALG_ASYNC));
444 if ((*swd)->sw_tfm && !IS_ERR((*swd)->sw_tfm))
445 dprintk("%s %s cipher is sync\n", __FUNCTION__, algo);
446 }
447 if (!(*swd)->sw_tfm || IS_ERR((*swd)->sw_tfm)) {
448 int err;
449 dprintk("cryptosoft: crypto_alloc_blkcipher failed(%s, 0x%x)\n",
450 algo,mode);
451 err = IS_ERR((*swd)->sw_tfm) ? -(PTR_ERR((*swd)->sw_tfm)) : EINVAL;
452 (*swd)->sw_tfm = NULL; /* ensure NULL */
453 swcr_freesession(NULL, i);
454 return err;
455 }
456
457 if (debug) {
458 dprintk("%s key:cri->cri_klen=%d,(cri->cri_klen + 7)/8=%d",
459 __FUNCTION__, cri->cri_klen, (cri->cri_klen + 7) / 8);
460 for (i = 0; i < (cri->cri_klen + 7) / 8; i++)
461 dprintk("%s0x%x", (i % 8) ? " " : "\n ",
462 cri->cri_key[i] & 0xff);
463 dprintk("\n");
464 }
465 if ((*swd)->sw_type & SW_TYPE_ASYNC) {
466 /* OCF doesn't enforce keys */
467 crypto_ablkcipher_set_flags(
468 __crypto_ablkcipher_cast((*swd)->sw_tfm),
469 CRYPTO_TFM_REQ_WEAK_KEY);
470 error = crypto_ablkcipher_setkey(
471 __crypto_ablkcipher_cast((*swd)->sw_tfm),
472 cri->cri_key, (cri->cri_klen + 7) / 8);
473 } else {
474 /* OCF doesn't enforce keys */
475 crypto_blkcipher_set_flags(
476 crypto_blkcipher_cast((*swd)->sw_tfm),
477 CRYPTO_TFM_REQ_WEAK_KEY);
478 error = crypto_blkcipher_setkey(
479 crypto_blkcipher_cast((*swd)->sw_tfm),
480 cri->cri_key, (cri->cri_klen + 7) / 8);
481 }
482 if (error) {
483 printk("cryptosoft: setkey failed %d (crt_flags=0x%x)\n", error,
484 (*swd)->sw_tfm->crt_flags);
485 swcr_freesession(NULL, i);
486 return error;
487 }
488 } else if ((*swd)->sw_type & (SW_TYPE_HMAC | SW_TYPE_HASH)) {
489 dprintk("%s crypto_alloc_*hash(%s, 0x%x)\n", __FUNCTION__,
490 algo, mode);
491
492 /* try async first */
493 (*swd)->sw_tfm = swcr_no_ahash ? NULL :
494 crypto_ahash_tfm(crypto_alloc_ahash(algo, 0, 0));
495 if ((*swd)->sw_tfm) {
496 dprintk("%s %s hash is async\n", __FUNCTION__, algo);
497 (*swd)->sw_type |= SW_TYPE_ASYNC;
498 } else {
499 dprintk("%s %s hash is sync\n", __FUNCTION__, algo);
500 (*swd)->sw_tfm = crypto_hash_tfm(
501 crypto_alloc_hash(algo, 0, CRYPTO_ALG_ASYNC));
502 }
503
504 if (!(*swd)->sw_tfm) {
505 dprintk("cryptosoft: crypto_alloc_hash failed(%s,0x%x)\n",
506 algo, mode);
507 swcr_freesession(NULL, i);
508 return EINVAL;
509 }
510
511 (*swd)->u.hmac.sw_klen = (cri->cri_klen + 7) / 8;
512 (*swd)->u.hmac.sw_key = (char *)kmalloc((*swd)->u.hmac.sw_klen,
513 SLAB_ATOMIC);
514 if ((*swd)->u.hmac.sw_key == NULL) {
515 swcr_freesession(NULL, i);
516 dprintk("%s,%d: ENOBUFS\n", __FILE__, __LINE__);
517 return ENOBUFS;
518 }
519 memcpy((*swd)->u.hmac.sw_key, cri->cri_key, (*swd)->u.hmac.sw_klen);
520 if (cri->cri_mlen) {
521 (*swd)->u.hmac.sw_mlen = cri->cri_mlen;
522 } else if ((*swd)->sw_type & SW_TYPE_ASYNC) {
523 (*swd)->u.hmac.sw_mlen = crypto_ahash_digestsize(
524 __crypto_ahash_cast((*swd)->sw_tfm));
525 } else {
526 (*swd)->u.hmac.sw_mlen = crypto_hash_digestsize(
527 crypto_hash_cast((*swd)->sw_tfm));
528 }
529 } else if ((*swd)->sw_type & SW_TYPE_COMP) {
530 (*swd)->sw_tfm = crypto_comp_tfm(
531 crypto_alloc_comp(algo, 0, CRYPTO_ALG_ASYNC));
532 if (!(*swd)->sw_tfm) {
533 dprintk("cryptosoft: crypto_alloc_comp failed(%s,0x%x)\n",
534 algo, mode);
535 swcr_freesession(NULL, i);
536 return EINVAL;
537 }
538 (*swd)->u.sw_comp_buf = kmalloc(CRYPTO_MAX_DATA_LEN, SLAB_ATOMIC);
539 if ((*swd)->u.sw_comp_buf == NULL) {
540 swcr_freesession(NULL, i);
541 dprintk("%s,%d: ENOBUFS\n", __FILE__, __LINE__);
542 return ENOBUFS;
543 }
544 } else {
545 printk("cryptosoft: Unhandled sw_type %d\n", (*swd)->sw_type);
546 swcr_freesession(NULL, i);
547 return EINVAL;
548 }
549
550 cri = cri->cri_next;
551 swd = &((*swd)->sw_next);
552 }
553 return 0;
554 }
555
556 /*
557 * Free a session.
558 */
559 static int
560 swcr_freesession(device_t dev, u_int64_t tid)
561 {
562 struct swcr_data *swd;
563 u_int32_t sid = CRYPTO_SESID2LID(tid);
564
565 dprintk("%s()\n", __FUNCTION__);
566 if (sid > swcr_sesnum || swcr_sessions == NULL ||
567 swcr_sessions[sid] == NULL) {
568 dprintk("%s,%d: EINVAL\n", __FILE__, __LINE__);
569 return(EINVAL);
570 }
571
572 /* Silently accept and return */
573 if (sid == 0)
574 return(0);
575
576 while ((swd = swcr_sessions[sid]) != NULL) {
577 swcr_sessions[sid] = swd->sw_next;
578 if (swd->sw_tfm) {
579 switch (swd->sw_type & SW_TYPE_ALG_AMASK) {
580 #ifdef HAVE_AHASH
581 case SW_TYPE_AHMAC:
582 case SW_TYPE_AHASH:
583 crypto_free_ahash(__crypto_ahash_cast(swd->sw_tfm));
584 break;
585 #endif
586 #ifdef HAVE_ABLKCIPHER
587 case SW_TYPE_ABLKCIPHER:
588 crypto_free_ablkcipher(__crypto_ablkcipher_cast(swd->sw_tfm));
589 break;
590 #endif
591 case SW_TYPE_BLKCIPHER:
592 crypto_free_blkcipher(crypto_blkcipher_cast(swd->sw_tfm));
593 break;
594 case SW_TYPE_HMAC:
595 case SW_TYPE_HASH:
596 crypto_free_hash(crypto_hash_cast(swd->sw_tfm));
597 break;
598 case SW_TYPE_COMP:
599 if (in_interrupt())
600 execute_later((void (*)(void *))crypto_free_comp, (void *)crypto_comp_cast(swd->sw_tfm));
601 else
602 crypto_free_comp(crypto_comp_cast(swd->sw_tfm));
603 break;
604 default:
605 crypto_free_tfm(swd->sw_tfm);
606 break;
607 }
608 swd->sw_tfm = NULL;
609 }
610 if (swd->sw_type & SW_TYPE_COMP) {
611 if (swd->u.sw_comp_buf)
612 kfree(swd->u.sw_comp_buf);
613 } else {
614 if (swd->u.hmac.sw_key)
615 kfree(swd->u.hmac.sw_key);
616 }
617 kfree(swd);
618 }
619 return 0;
620 }
621
622 static void swcr_process_req_complete(struct swcr_req *req)
623 {
624 dprintk("%s()\n", __FUNCTION__);
625
626 if (req->sw->sw_type & SW_TYPE_INUSE) {
627 unsigned long flags;
628 spin_lock_irqsave(&req->sw->sw_tfm_lock, flags);
629 req->sw->sw_type &= ~SW_TYPE_INUSE;
630 spin_unlock_irqrestore(&req->sw->sw_tfm_lock, flags);
631 }
632
633 if (req->crp->crp_etype)
634 goto done;
635
636 switch (req->sw->sw_type & SW_TYPE_ALG_AMASK) {
637 #if defined(HAVE_AHASH)
638 case SW_TYPE_AHMAC:
639 case SW_TYPE_AHASH:
640 crypto_copyback(req->crp->crp_flags, req->crp->crp_buf,
641 req->crd->crd_inject, req->sw->u.hmac.sw_mlen, req->result);
642 ahash_request_free(req->crypto_req);
643 break;
644 #endif
645 #if defined(HAVE_ABLKCIPHER)
646 case SW_TYPE_ABLKCIPHER:
647 ablkcipher_request_free(req->crypto_req);
648 break;
649 #endif
650 case SW_TYPE_CIPHER:
651 case SW_TYPE_HMAC:
652 case SW_TYPE_HASH:
653 case SW_TYPE_COMP:
654 case SW_TYPE_BLKCIPHER:
655 break;
656 default:
657 req->crp->crp_etype = EINVAL;
658 goto done;
659 }
660
661 req->crd = req->crd->crd_next;
662 if (req->crd) {
663 swcr_process_req(req);
664 return;
665 }
666
667 done:
668 dprintk("%s crypto_done %p\n", __FUNCTION__, req);
669 crypto_done(req->crp);
670 kmem_cache_free(swcr_req_cache, req);
671 }
672
673 #if defined(HAVE_ABLKCIPHER) || defined(HAVE_AHASH)
674 static void swcr_process_callback(struct crypto_async_request *creq, int err)
675 {
676 struct swcr_req *req = creq->data;
677
678 dprintk("%s()\n", __FUNCTION__);
679 if (err) {
680 if (err == -EINPROGRESS)
681 return;
682 dprintk("%s() fail %d\n", __FUNCTION__, -err);
683 req->crp->crp_etype = -err;
684 }
685
686 swcr_process_req_complete(req);
687 }
688 #endif /* defined(HAVE_ABLKCIPHER) || defined(HAVE_AHASH) */
689
690
691 static void swcr_process_req(struct swcr_req *req)
692 {
693 struct swcr_data *sw;
694 struct cryptop *crp = req->crp;
695 struct cryptodesc *crd = req->crd;
696 struct sk_buff *skb = (struct sk_buff *) crp->crp_buf;
697 struct uio *uiop = (struct uio *) crp->crp_buf;
698 int sg_num, sg_len, skip;
699
700 dprintk("%s()\n", __FUNCTION__);
701
702 /*
703 * Find the crypto context.
704 *
705 * XXX Note that the logic here prevents us from having
706 * XXX the same algorithm multiple times in a session
707 * XXX (or rather, we can but it won't give us the right
708 * XXX results). To do that, we'd need some way of differentiating
709 * XXX between the various instances of an algorithm (so we can
710 * XXX locate the correct crypto context).
711 */
712 for (sw = req->sw_head; sw && sw->sw_alg != crd->crd_alg; sw = sw->sw_next)
713 ;
714
715 /* No such context ? */
716 if (sw == NULL) {
717 crp->crp_etype = EINVAL;
718 dprintk("%s,%d: EINVAL\n", __FILE__, __LINE__);
719 goto done;
720 }
721
722 /*
723 * for some types we need to ensure only one user as info is stored in
724 * the tfm during an operation that can get corrupted
725 */
726 switch (sw->sw_type & SW_TYPE_ALG_AMASK) {
727 #ifdef HAVE_AHASH
728 case SW_TYPE_AHMAC:
729 case SW_TYPE_AHASH:
730 #endif
731 case SW_TYPE_HMAC:
732 case SW_TYPE_HASH: {
733 unsigned long flags;
734 spin_lock_irqsave(&sw->sw_tfm_lock, flags);
735 if (sw->sw_type & SW_TYPE_INUSE) {
736 spin_unlock_irqrestore(&sw->sw_tfm_lock, flags);
737 execute_later((void (*)(void *))swcr_process_req, (void *)req);
738 return;
739 }
740 sw->sw_type |= SW_TYPE_INUSE;
741 spin_unlock_irqrestore(&sw->sw_tfm_lock, flags);
742 } break;
743 }
744
745 req->sw = sw;
746 skip = crd->crd_skip;
747
748 /*
749 * setup the SG list skip from the start of the buffer
750 */
751 memset(req->sg, 0, sizeof(req->sg));
752 sg_init_table(req->sg, SCATTERLIST_MAX);
753 if (crp->crp_flags & CRYPTO_F_SKBUF) {
754 int i, len;
755
756 sg_num = 0;
757 sg_len = 0;
758
759 if (skip < skb_headlen(skb)) {
760 len = skb_headlen(skb) - skip;
761 if (len + sg_len > crd->crd_len)
762 len = crd->crd_len - sg_len;
763 sg_set_page(&req->sg[sg_num],
764 virt_to_page(skb->data + skip), len,
765 offset_in_page(skb->data + skip));
766 sg_len += len;
767 sg_num++;
768 skip = 0;
769 } else
770 skip -= skb_headlen(skb);
771
772 for (i = 0; sg_len < crd->crd_len &&
773 i < skb_shinfo(skb)->nr_frags &&
774 sg_num < SCATTERLIST_MAX; i++) {
775 if (skip < skb_shinfo(skb)->frags[i].size) {
776 len = skb_shinfo(skb)->frags[i].size - skip;
777 if (len + sg_len > crd->crd_len)
778 len = crd->crd_len - sg_len;
779 sg_set_page(&req->sg[sg_num],
780 skb_frag_page(&skb_shinfo(skb)->frags[i]),
781 len,
782 skb_shinfo(skb)->frags[i].page_offset + skip);
783 sg_len += len;
784 sg_num++;
785 skip = 0;
786 } else
787 skip -= skb_shinfo(skb)->frags[i].size;
788 }
789 } else if (crp->crp_flags & CRYPTO_F_IOV) {
790 int len;
791
792 sg_len = 0;
793 for (sg_num = 0; sg_len < crd->crd_len &&
794 sg_num < uiop->uio_iovcnt &&
795 sg_num < SCATTERLIST_MAX; sg_num++) {
796 if (skip <= uiop->uio_iov[sg_num].iov_len) {
797 len = uiop->uio_iov[sg_num].iov_len - skip;
798 if (len + sg_len > crd->crd_len)
799 len = crd->crd_len - sg_len;
800 sg_set_page(&req->sg[sg_num],
801 virt_to_page(uiop->uio_iov[sg_num].iov_base+skip),
802 len,
803 offset_in_page(uiop->uio_iov[sg_num].iov_base+skip));
804 sg_len += len;
805 skip = 0;
806 } else
807 skip -= uiop->uio_iov[sg_num].iov_len;
808 }
809 } else {
810 sg_len = (crp->crp_ilen - skip);
811 if (sg_len > crd->crd_len)
812 sg_len = crd->crd_len;
813 sg_set_page(&req->sg[0], virt_to_page(crp->crp_buf + skip),
814 sg_len, offset_in_page(crp->crp_buf + skip));
815 sg_num = 1;
816 }
817
818 switch (sw->sw_type & SW_TYPE_ALG_AMASK) {
819
820 #ifdef HAVE_AHASH
821 case SW_TYPE_AHMAC:
822 case SW_TYPE_AHASH:
823 {
824 int ret;
825
826 /* check we have room for the result */
827 if (crp->crp_ilen - crd->crd_inject < sw->u.hmac.sw_mlen) {
828 dprintk("cryptosoft: EINVAL crp_ilen=%d, len=%d, inject=%d "
829 "digestsize=%d\n", crp->crp_ilen, crd->crd_skip + sg_len,
830 crd->crd_inject, sw->u.hmac.sw_mlen);
831 crp->crp_etype = EINVAL;
832 goto done;
833 }
834
835 req->crypto_req =
836 ahash_request_alloc(__crypto_ahash_cast(sw->sw_tfm),GFP_ATOMIC);
837 if (!req->crypto_req) {
838 crp->crp_etype = ENOMEM;
839 dprintk("%s,%d: ENOMEM ahash_request_alloc", __FILE__, __LINE__);
840 goto done;
841 }
842
843 ahash_request_set_callback(req->crypto_req,
844 CRYPTO_TFM_REQ_MAY_BACKLOG, swcr_process_callback, req);
845
846 memset(req->result, 0, sizeof(req->result));
847
848 if (sw->sw_type & SW_TYPE_AHMAC)
849 crypto_ahash_setkey(__crypto_ahash_cast(sw->sw_tfm),
850 sw->u.hmac.sw_key, sw->u.hmac.sw_klen);
851 ahash_request_set_crypt(req->crypto_req, req->sg, req->result, sg_len);
852 ret = crypto_ahash_digest(req->crypto_req);
853 switch (ret) {
854 case -EINPROGRESS:
855 case -EBUSY:
856 return;
857 default:
858 case 0:
859 dprintk("hash OP %s %d\n", ret ? "failed" : "success", ret);
860 crp->crp_etype = ret;
861 goto done;
862 }
863 } break;
864 #endif /* HAVE_AHASH */
865
866 #ifdef HAVE_ABLKCIPHER
867 case SW_TYPE_ABLKCIPHER: {
868 int ret;
869 unsigned char *ivp = req->iv;
870 int ivsize =
871 crypto_ablkcipher_ivsize(__crypto_ablkcipher_cast(sw->sw_tfm));
872
873 if (sg_len < crypto_ablkcipher_blocksize(
874 __crypto_ablkcipher_cast(sw->sw_tfm))) {
875 crp->crp_etype = EINVAL;
876 dprintk("%s,%d: EINVAL len %d < %d\n", __FILE__, __LINE__,
877 sg_len, crypto_ablkcipher_blocksize(
878 __crypto_ablkcipher_cast(sw->sw_tfm)));
879 goto done;
880 }
881
882 if (ivsize > sizeof(req->iv)) {
883 crp->crp_etype = EINVAL;
884 dprintk("%s,%d: EINVAL\n", __FILE__, __LINE__);
885 goto done;
886 }
887
888 req->crypto_req = ablkcipher_request_alloc(
889 __crypto_ablkcipher_cast(sw->sw_tfm), GFP_ATOMIC);
890 if (!req->crypto_req) {
891 crp->crp_etype = ENOMEM;
892 dprintk("%s,%d: ENOMEM ablkcipher_request_alloc",
893 __FILE__, __LINE__);
894 goto done;
895 }
896
897 ablkcipher_request_set_callback(req->crypto_req,
898 CRYPTO_TFM_REQ_MAY_BACKLOG, swcr_process_callback, req);
899
900 if (crd->crd_flags & CRD_F_KEY_EXPLICIT) {
901 int i, error;
902
903 if (debug) {
904 dprintk("%s key:", __FUNCTION__);
905 for (i = 0; i < (crd->crd_klen + 7) / 8; i++)
906 dprintk("%s0x%x", (i % 8) ? " " : "\n ",
907 crd->crd_key[i] & 0xff);
908 dprintk("\n");
909 }
910 /* OCF doesn't enforce keys */
911 crypto_ablkcipher_set_flags(__crypto_ablkcipher_cast(sw->sw_tfm),
912 CRYPTO_TFM_REQ_WEAK_KEY);
913 error = crypto_ablkcipher_setkey(
914 __crypto_ablkcipher_cast(sw->sw_tfm), crd->crd_key,
915 (crd->crd_klen + 7) / 8);
916 if (error) {
917 dprintk("cryptosoft: setkey failed %d (crt_flags=0x%x)\n",
918 error, sw->sw_tfm->crt_flags);
919 crp->crp_etype = -error;
920 }
921 }
922
923 if (crd->crd_flags & CRD_F_ENCRYPT) { /* encrypt */
924
925 if (crd->crd_flags & CRD_F_IV_EXPLICIT)
926 ivp = crd->crd_iv;
927 else
928 get_random_bytes(ivp, ivsize);
929 /*
930 * do we have to copy the IV back to the buffer ?
931 */
932 if ((crd->crd_flags & CRD_F_IV_PRESENT) == 0) {
933 crypto_copyback(crp->crp_flags, crp->crp_buf,
934 crd->crd_inject, ivsize, (caddr_t)ivp);
935 }
936 ablkcipher_request_set_crypt(req->crypto_req, req->sg, req->sg,
937 sg_len, ivp);
938 ret = crypto_ablkcipher_encrypt(req->crypto_req);
939
940 } else { /*decrypt */
941
942 if (crd->crd_flags & CRD_F_IV_EXPLICIT)
943 ivp = crd->crd_iv;
944 else
945 crypto_copydata(crp->crp_flags, crp->crp_buf,
946 crd->crd_inject, ivsize, (caddr_t)ivp);
947 ablkcipher_request_set_crypt(req->crypto_req, req->sg, req->sg,
948 sg_len, ivp);
949 ret = crypto_ablkcipher_decrypt(req->crypto_req);
950 }
951
952 switch (ret) {
953 case -EINPROGRESS:
954 case -EBUSY:
955 return;
956 default:
957 case 0:
958 dprintk("crypto OP %s %d\n", ret ? "failed" : "success", ret);
959 crp->crp_etype = ret;
960 goto done;
961 }
962 } break;
963 #endif /* HAVE_ABLKCIPHER */
964
965 case SW_TYPE_BLKCIPHER: {
966 unsigned char iv[EALG_MAX_BLOCK_LEN];
967 unsigned char *ivp = iv;
968 struct blkcipher_desc desc;
969 int ivsize = crypto_blkcipher_ivsize(crypto_blkcipher_cast(sw->sw_tfm));
970
971 if (sg_len < crypto_blkcipher_blocksize(
972 crypto_blkcipher_cast(sw->sw_tfm))) {
973 crp->crp_etype = EINVAL;
974 dprintk("%s,%d: EINVAL len %d < %d\n", __FILE__, __LINE__,
975 sg_len, crypto_blkcipher_blocksize(
976 crypto_blkcipher_cast(sw->sw_tfm)));
977 goto done;
978 }
979
980 if (ivsize > sizeof(iv)) {
981 crp->crp_etype = EINVAL;
982 dprintk("%s,%d: EINVAL\n", __FILE__, __LINE__);
983 goto done;
984 }
985
986 if (crd->crd_flags & CRD_F_KEY_EXPLICIT) {
987 int i, error;
988
989 if (debug) {
990 dprintk("%s key:", __FUNCTION__);
991 for (i = 0; i < (crd->crd_klen + 7) / 8; i++)
992 dprintk("%s0x%x", (i % 8) ? " " : "\n ",
993 crd->crd_key[i] & 0xff);
994 dprintk("\n");
995 }
996 /* OCF doesn't enforce keys */
997 crypto_blkcipher_set_flags(crypto_blkcipher_cast(sw->sw_tfm),
998 CRYPTO_TFM_REQ_WEAK_KEY);
999 error = crypto_blkcipher_setkey(
1000 crypto_blkcipher_cast(sw->sw_tfm), crd->crd_key,
1001 (crd->crd_klen + 7) / 8);
1002 if (error) {
1003 dprintk("cryptosoft: setkey failed %d (crt_flags=0x%x)\n",
1004 error, sw->sw_tfm->crt_flags);
1005 crp->crp_etype = -error;
1006 }
1007 }
1008
1009 memset(&desc, 0, sizeof(desc));
1010 desc.tfm = crypto_blkcipher_cast(sw->sw_tfm);
1011
1012 if (crd->crd_flags & CRD_F_ENCRYPT) { /* encrypt */
1013
1014 if (crd->crd_flags & CRD_F_IV_EXPLICIT) {
1015 ivp = crd->crd_iv;
1016 } else {
1017 get_random_bytes(ivp, ivsize);
1018 }
1019 /*
1020 * do we have to copy the IV back to the buffer ?
1021 */
1022 if ((crd->crd_flags & CRD_F_IV_PRESENT) == 0) {
1023 crypto_copyback(crp->crp_flags, crp->crp_buf,
1024 crd->crd_inject, ivsize, (caddr_t)ivp);
1025 }
1026 desc.info = ivp;
1027 crypto_blkcipher_encrypt_iv(&desc, req->sg, req->sg, sg_len);
1028
1029 } else { /*decrypt */
1030
1031 if (crd->crd_flags & CRD_F_IV_EXPLICIT) {
1032 ivp = crd->crd_iv;
1033 } else {
1034 crypto_copydata(crp->crp_flags, crp->crp_buf,
1035 crd->crd_inject, ivsize, (caddr_t)ivp);
1036 }
1037 desc.info = ivp;
1038 crypto_blkcipher_decrypt_iv(&desc, req->sg, req->sg, sg_len);
1039 }
1040 } break;
1041
1042 case SW_TYPE_HMAC:
1043 case SW_TYPE_HASH:
1044 {
1045 char result[HASH_MAX_LEN];
1046 struct hash_desc desc;
1047
1048 /* check we have room for the result */
1049 if (crp->crp_ilen - crd->crd_inject < sw->u.hmac.sw_mlen) {
1050 dprintk("cryptosoft: EINVAL crp_ilen=%d, len=%d, inject=%d "
1051 "digestsize=%d\n", crp->crp_ilen, crd->crd_skip + sg_len,
1052 crd->crd_inject, sw->u.hmac.sw_mlen);
1053 crp->crp_etype = EINVAL;
1054 goto done;
1055 }
1056
1057 memset(&desc, 0, sizeof(desc));
1058 desc.tfm = crypto_hash_cast(sw->sw_tfm);
1059
1060 memset(result, 0, sizeof(result));
1061
1062 if (sw->sw_type & SW_TYPE_HMAC) {
1063 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19)
1064 crypto_hmac(sw->sw_tfm, sw->u.hmac.sw_key, &sw->u.hmac.sw_klen,
1065 req->sg, sg_num, result);
1066 #else
1067 crypto_hash_setkey(desc.tfm, sw->u.hmac.sw_key,
1068 sw->u.hmac.sw_klen);
1069 crypto_hash_digest(&desc, req->sg, sg_len, result);
1070 #endif /* LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19) */
1071
1072 } else { /* SW_TYPE_HASH */
1073 crypto_hash_digest(&desc, req->sg, sg_len, result);
1074 }
1075
1076 crypto_copyback(crp->crp_flags, crp->crp_buf,
1077 crd->crd_inject, sw->u.hmac.sw_mlen, result);
1078 }
1079 break;
1080
1081 case SW_TYPE_COMP: {
1082 void *ibuf = NULL;
1083 void *obuf = sw->u.sw_comp_buf;
1084 int ilen = sg_len, olen = CRYPTO_MAX_DATA_LEN;
1085 int ret = 0;
1086
1087 /*
1088 * we need to use an additional copy if there is more than one
1089 * input chunk since the kernel comp routines do not handle
1090 * SG yet. Otherwise we just use the input buffer as is.
1091 * Rather than allocate another buffer we just split the tmp
1092 * buffer we already have.
1093 * Perhaps we should just use zlib directly ?
1094 */
1095 if (sg_num > 1) {
1096 int blk;
1097
1098 ibuf = obuf;
1099 for (blk = 0; blk < sg_num; blk++) {
1100 memcpy(obuf, sg_virt(&req->sg[blk]),
1101 req->sg[blk].length);
1102 obuf += req->sg[blk].length;
1103 }
1104 olen -= sg_len;
1105 } else
1106 ibuf = sg_virt(&req->sg[0]);
1107
1108 if (crd->crd_flags & CRD_F_ENCRYPT) { /* compress */
1109 ret = crypto_comp_compress(crypto_comp_cast(sw->sw_tfm),
1110 ibuf, ilen, obuf, &olen);
1111 if (!ret && olen > crd->crd_len) {
1112 dprintk("cryptosoft: ERANGE compress %d into %d\n",
1113 crd->crd_len, olen);
1114 if (swcr_fail_if_compression_grows)
1115 ret = ERANGE;
1116 }
1117 } else { /* decompress */
1118 ret = crypto_comp_decompress(crypto_comp_cast(sw->sw_tfm),
1119 ibuf, ilen, obuf, &olen);
1120 if (!ret && (olen + crd->crd_inject) > crp->crp_olen) {
1121 dprintk("cryptosoft: ETOOSMALL decompress %d into %d, "
1122 "space for %d,at offset %d\n",
1123 crd->crd_len, olen, crp->crp_olen, crd->crd_inject);
1124 ret = ETOOSMALL;
1125 }
1126 }
1127 if (ret)
1128 dprintk("%s,%d: ret = %d\n", __FILE__, __LINE__, ret);
1129
1130 /*
1131 * on success copy result back,
1132 * linux crpyto API returns -errno, we need to fix that
1133 */
1134 crp->crp_etype = ret < 0 ? -ret : ret;
1135 if (ret == 0) {
1136 /* copy back the result and return it's size */
1137 crypto_copyback(crp->crp_flags, crp->crp_buf,
1138 crd->crd_inject, olen, obuf);
1139 crp->crp_olen = olen;
1140 }
1141 } break;
1142
1143 default:
1144 /* Unknown/unsupported algorithm */
1145 dprintk("%s,%d: EINVAL\n", __FILE__, __LINE__);
1146 crp->crp_etype = EINVAL;
1147 goto done;
1148 }
1149
1150 done:
1151 swcr_process_req_complete(req);
1152 }
1153
1154
1155 /*
1156 * Process a crypto request.
1157 */
1158 static int
1159 swcr_process(device_t dev, struct cryptop *crp, int hint)
1160 {
1161 struct swcr_req *req = NULL;
1162 u_int32_t lid;
1163
1164 dprintk("%s()\n", __FUNCTION__);
1165 /* Sanity check */
1166 if (crp == NULL) {
1167 dprintk("%s,%d: EINVAL\n", __FILE__, __LINE__);
1168 return EINVAL;
1169 }
1170
1171 crp->crp_etype = 0;
1172
1173 if (crp->crp_desc == NULL || crp->crp_buf == NULL) {
1174 dprintk("%s,%d: EINVAL\n", __FILE__, __LINE__);
1175 crp->crp_etype = EINVAL;
1176 goto done;
1177 }
1178
1179 lid = crp->crp_sid & 0xffffffff;
1180 if (lid >= swcr_sesnum || lid == 0 || swcr_sessions == NULL ||
1181 swcr_sessions[lid] == NULL) {
1182 crp->crp_etype = ENOENT;
1183 dprintk("%s,%d: ENOENT\n", __FILE__, __LINE__);
1184 goto done;
1185 }
1186
1187 /*
1188 * do some error checking outside of the loop for SKB and IOV processing
1189 * this leaves us with valid skb or uiop pointers for later
1190 */
1191 if (crp->crp_flags & CRYPTO_F_SKBUF) {
1192 struct sk_buff *skb = (struct sk_buff *) crp->crp_buf;
1193 if (skb_shinfo(skb)->nr_frags >= SCATTERLIST_MAX) {
1194 printk("%s,%d: %d nr_frags > SCATTERLIST_MAX", __FILE__, __LINE__,
1195 skb_shinfo(skb)->nr_frags);
1196 goto done;
1197 }
1198 } else if (crp->crp_flags & CRYPTO_F_IOV) {
1199 struct uio *uiop = (struct uio *) crp->crp_buf;
1200 if (uiop->uio_iovcnt > SCATTERLIST_MAX) {
1201 printk("%s,%d: %d uio_iovcnt > SCATTERLIST_MAX", __FILE__, __LINE__,
1202 uiop->uio_iovcnt);
1203 goto done;
1204 }
1205 }
1206
1207 /*
1208 * setup a new request ready for queuing
1209 */
1210 req = kmem_cache_alloc(swcr_req_cache, SLAB_ATOMIC);
1211 if (req == NULL) {
1212 dprintk("%s,%d: ENOMEM\n", __FILE__, __LINE__);
1213 crp->crp_etype = ENOMEM;
1214 goto done;
1215 }
1216 memset(req, 0, sizeof(*req));
1217
1218 req->sw_head = swcr_sessions[lid];
1219 req->crp = crp;
1220 req->crd = crp->crp_desc;
1221
1222 swcr_process_req(req);
1223 return 0;
1224
1225 done:
1226 crypto_done(crp);
1227 if (req)
1228 kmem_cache_free(swcr_req_cache, req);
1229 return 0;
1230 }
1231
1232
1233 static int
1234 cryptosoft_init(void)
1235 {
1236 int i, sw_type, mode;
1237 char *algo;
1238
1239 dprintk("%s(%p)\n", __FUNCTION__, cryptosoft_init);
1240
1241 swcr_req_cache = kmem_cache_create("cryptosoft_req",
1242 sizeof(struct swcr_req), 0, SLAB_HWCACHE_ALIGN, NULL
1243 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,23)
1244 , NULL
1245 #endif
1246 );
1247 if (!swcr_req_cache) {
1248 printk("cryptosoft: failed to create request cache\n");
1249 return -ENOENT;
1250 }
1251
1252 softc_device_init(&swcr_softc, "cryptosoft", 0, swcr_methods);
1253
1254 swcr_id = crypto_get_driverid(softc_get_device(&swcr_softc),
1255 CRYPTOCAP_F_SOFTWARE | CRYPTOCAP_F_SYNC);
1256 if (swcr_id < 0) {
1257 printk("cryptosoft: Software crypto device cannot initialize!");
1258 return -ENODEV;
1259 }
1260
1261 #define REGISTER(alg) \
1262 crypto_register(swcr_id, alg, 0,0)
1263
1264 for (i = 0; i < sizeof(crypto_details)/sizeof(crypto_details[0]); i++) {
1265 int found;
1266
1267 algo = crypto_details[i].alg_name;
1268 if (!algo || !*algo) {
1269 dprintk("%s:Algorithm %d not supported\n", __FUNCTION__, i);
1270 continue;
1271 }
1272
1273 mode = crypto_details[i].mode;
1274 sw_type = crypto_details[i].sw_type;
1275
1276 found = 0;
1277 switch (sw_type & SW_TYPE_ALG_MASK) {
1278 case SW_TYPE_CIPHER:
1279 found = crypto_has_cipher(algo, 0, CRYPTO_ALG_ASYNC);
1280 break;
1281 case SW_TYPE_HMAC:
1282 found = crypto_has_hash(algo, 0, swcr_no_ahash?CRYPTO_ALG_ASYNC:0);
1283 break;
1284 case SW_TYPE_HASH:
1285 found = crypto_has_hash(algo, 0, swcr_no_ahash?CRYPTO_ALG_ASYNC:0);
1286 break;
1287 case SW_TYPE_COMP:
1288 found = crypto_has_comp(algo, 0, CRYPTO_ALG_ASYNC);
1289 break;
1290 case SW_TYPE_BLKCIPHER:
1291 found = crypto_has_blkcipher(algo, 0, CRYPTO_ALG_ASYNC);
1292 if (!found && !swcr_no_ablk)
1293 found = crypto_has_ablkcipher(algo, 0, 0);
1294 break;
1295 }
1296 if (found) {
1297 REGISTER(i);
1298 } else {
1299 dprintk("%s:Algorithm Type %d not supported (algorithm %d:'%s')\n",
1300 __FUNCTION__, sw_type, i, algo);
1301 }
1302 }
1303 return 0;
1304 }
1305
1306 static void
1307 cryptosoft_exit(void)
1308 {
1309 dprintk("%s()\n", __FUNCTION__);
1310 crypto_unregister_all(swcr_id);
1311 swcr_id = -1;
1312 kmem_cache_destroy(swcr_req_cache);
1313 }
1314
1315 late_initcall(cryptosoft_init);
1316 module_exit(cryptosoft_exit);
1317
1318 MODULE_LICENSE("Dual BSD/GPL");
1319 MODULE_AUTHOR("David McCullough <david_mccullough@mcafee.com>");
1320 MODULE_DESCRIPTION("Cryptosoft (OCF module for kernel crypto)");
Personal OpenWRT clone
This page took 0.110458 seconds and 5 git commands to generate.