ebab49f8cc1dca518a46b93a2985ef5caaf93214
[sfrench/cifs-2.6.git] / drivers / md / dm-crypt.c
1 /*
2  * Copyright (C) 2003 Christophe Saout <christophe@saout.de>
3  * Copyright (C) 2004 Clemens Fruhwirth <clemens@endorphin.org>
4  * Copyright (C) 2006-2008 Red Hat, Inc. All rights reserved.
5  *
6  * This file is released under the GPL.
7  */
8
9 #include <linux/completion.h>
10 #include <linux/err.h>
11 #include <linux/module.h>
12 #include <linux/init.h>
13 #include <linux/kernel.h>
14 #include <linux/bio.h>
15 #include <linux/blkdev.h>
16 #include <linux/mempool.h>
17 #include <linux/slab.h>
18 #include <linux/crypto.h>
19 #include <linux/workqueue.h>
20 #include <linux/backing-dev.h>
21 #include <asm/atomic.h>
22 #include <linux/scatterlist.h>
23 #include <asm/page.h>
24 #include <asm/unaligned.h>
25
26 #include <linux/device-mapper.h>
27
28 #define DM_MSG_PREFIX "crypt"
29 #define MESG_STR(x) x, sizeof(x)
30
31 /*
32  * context holding the current state of a multi-part conversion
33  */
34 struct convert_context {
35         struct completion restart;
36         struct bio *bio_in;
37         struct bio *bio_out;
38         unsigned int offset_in;
39         unsigned int offset_out;
40         unsigned int idx_in;
41         unsigned int idx_out;
42         sector_t sector;
43         atomic_t pending;
44 };
45
46 /*
47  * per bio private data
48  */
49 struct dm_crypt_io {
50         struct dm_target *target;
51         struct bio *base_bio;
52         struct work_struct work;
53
54         struct convert_context ctx;
55
56         atomic_t pending;
57         int error;
58         sector_t sector;
59         struct dm_crypt_io *base_io;
60 };
61
62 struct dm_crypt_request {
63         struct convert_context *ctx;
64         struct scatterlist sg_in;
65         struct scatterlist sg_out;
66 };
67
68 struct crypt_config;
69
70 struct crypt_iv_operations {
71         int (*ctr)(struct crypt_config *cc, struct dm_target *ti,
72                    const char *opts);
73         void (*dtr)(struct crypt_config *cc);
74         const char *(*status)(struct crypt_config *cc);
75         int (*generator)(struct crypt_config *cc, u8 *iv, sector_t sector);
76 };
77
78 /*
79  * Crypt: maps a linear range of a block device
80  * and encrypts / decrypts at the same time.
81  */
82 enum flags { DM_CRYPT_SUSPENDED, DM_CRYPT_KEY_VALID };
83 struct crypt_config {
84         struct dm_dev *dev;
85         sector_t start;
86
87         /*
88          * pool for per bio private data, crypto requests and
89          * encryption requeusts/buffer pages
90          */
91         mempool_t *io_pool;
92         mempool_t *req_pool;
93         mempool_t *page_pool;
94         struct bio_set *bs;
95
96         struct workqueue_struct *io_queue;
97         struct workqueue_struct *crypt_queue;
98
99         /*
100          * crypto related data
101          */
102         struct crypt_iv_operations *iv_gen_ops;
103         char *iv_mode;
104         union {
105                 struct crypto_cipher *essiv_tfm;
106                 int benbi_shift;
107         } iv_gen_private;
108         sector_t iv_offset;
109         unsigned int iv_size;
110
111         /*
112          * Layout of each crypto request:
113          *
114          *   struct ablkcipher_request
115          *      context
116          *      padding
117          *   struct dm_crypt_request
118          *      padding
119          *   IV
120          *
121          * The padding is added so that dm_crypt_request and the IV are
122          * correctly aligned.
123          */
124         unsigned int dmreq_start;
125         struct ablkcipher_request *req;
126
127         char cipher[CRYPTO_MAX_ALG_NAME];
128         char chainmode[CRYPTO_MAX_ALG_NAME];
129         struct crypto_ablkcipher *tfm;
130         unsigned long flags;
131         unsigned int key_size;
132         u8 key[0];
133 };
134
135 #define MIN_IOS        16
136 #define MIN_POOL_PAGES 32
137 #define MIN_BIO_PAGES  8
138
139 static struct kmem_cache *_crypt_io_pool;
140
141 static void clone_init(struct dm_crypt_io *, struct bio *);
142 static void kcryptd_queue_crypt(struct dm_crypt_io *io);
143
144 /*
145  * Different IV generation algorithms:
146  *
147  * plain: the initial vector is the 32-bit little-endian version of the sector
148  *        number, padded with zeros if necessary.
149  *
150  * essiv: "encrypted sector|salt initial vector", the sector number is
151  *        encrypted with the bulk cipher using a salt as key. The salt
152  *        should be derived from the bulk cipher's key via hashing.
153  *
154  * benbi: the 64-bit "big-endian 'narrow block'-count", starting at 1
155  *        (needed for LRW-32-AES and possible other narrow block modes)
156  *
157  * null: the initial vector is always zero.  Provides compatibility with
158  *       obsolete loop_fish2 devices.  Do not use for new devices.
159  *
160  * plumb: unimplemented, see:
161  * http://article.gmane.org/gmane.linux.kernel.device-mapper.dm-crypt/454
162  */
163
164 static int crypt_iv_plain_gen(struct crypt_config *cc, u8 *iv, sector_t sector)
165 {
166         memset(iv, 0, cc->iv_size);
167         *(u32 *)iv = cpu_to_le32(sector & 0xffffffff);
168
169         return 0;
170 }
171
172 static int crypt_iv_essiv_ctr(struct crypt_config *cc, struct dm_target *ti,
173                               const char *opts)
174 {
175         struct crypto_cipher *essiv_tfm;
176         struct crypto_hash *hash_tfm;
177         struct hash_desc desc;
178         struct scatterlist sg;
179         unsigned int saltsize;
180         u8 *salt;
181         int err;
182
183         if (opts == NULL) {
184                 ti->error = "Digest algorithm missing for ESSIV mode";
185                 return -EINVAL;
186         }
187
188         /* Hash the cipher key with the given hash algorithm */
189         hash_tfm = crypto_alloc_hash(opts, 0, CRYPTO_ALG_ASYNC);
190         if (IS_ERR(hash_tfm)) {
191                 ti->error = "Error initializing ESSIV hash";
192                 return PTR_ERR(hash_tfm);
193         }
194
195         saltsize = crypto_hash_digestsize(hash_tfm);
196         salt = kmalloc(saltsize, GFP_KERNEL);
197         if (salt == NULL) {
198                 ti->error = "Error kmallocing salt storage in ESSIV";
199                 crypto_free_hash(hash_tfm);
200                 return -ENOMEM;
201         }
202
203         sg_init_one(&sg, cc->key, cc->key_size);
204         desc.tfm = hash_tfm;
205         desc.flags = CRYPTO_TFM_REQ_MAY_SLEEP;
206         err = crypto_hash_digest(&desc, &sg, cc->key_size, salt);
207         crypto_free_hash(hash_tfm);
208
209         if (err) {
210                 ti->error = "Error calculating hash in ESSIV";
211                 kfree(salt);
212                 return err;
213         }
214
215         /* Setup the essiv_tfm with the given salt */
216         essiv_tfm = crypto_alloc_cipher(cc->cipher, 0, CRYPTO_ALG_ASYNC);
217         if (IS_ERR(essiv_tfm)) {
218                 ti->error = "Error allocating crypto tfm for ESSIV";
219                 kfree(salt);
220                 return PTR_ERR(essiv_tfm);
221         }
222         if (crypto_cipher_blocksize(essiv_tfm) !=
223             crypto_ablkcipher_ivsize(cc->tfm)) {
224                 ti->error = "Block size of ESSIV cipher does "
225                             "not match IV size of block cipher";
226                 crypto_free_cipher(essiv_tfm);
227                 kfree(salt);
228                 return -EINVAL;
229         }
230         err = crypto_cipher_setkey(essiv_tfm, salt, saltsize);
231         if (err) {
232                 ti->error = "Failed to set key for ESSIV cipher";
233                 crypto_free_cipher(essiv_tfm);
234                 kfree(salt);
235                 return err;
236         }
237         kfree(salt);
238
239         cc->iv_gen_private.essiv_tfm = essiv_tfm;
240         return 0;
241 }
242
243 static void crypt_iv_essiv_dtr(struct crypt_config *cc)
244 {
245         crypto_free_cipher(cc->iv_gen_private.essiv_tfm);
246         cc->iv_gen_private.essiv_tfm = NULL;
247 }
248
249 static int crypt_iv_essiv_gen(struct crypt_config *cc, u8 *iv, sector_t sector)
250 {
251         memset(iv, 0, cc->iv_size);
252         *(u64 *)iv = cpu_to_le64(sector);
253         crypto_cipher_encrypt_one(cc->iv_gen_private.essiv_tfm, iv, iv);
254         return 0;
255 }
256
257 static int crypt_iv_benbi_ctr(struct crypt_config *cc, struct dm_target *ti,
258                               const char *opts)
259 {
260         unsigned bs = crypto_ablkcipher_blocksize(cc->tfm);
261         int log = ilog2(bs);
262
263         /* we need to calculate how far we must shift the sector count
264          * to get the cipher block count, we use this shift in _gen */
265
266         if (1 << log != bs) {
267                 ti->error = "cypher blocksize is not a power of 2";
268                 return -EINVAL;
269         }
270
271         if (log > 9) {
272                 ti->error = "cypher blocksize is > 512";
273                 return -EINVAL;
274         }
275
276         cc->iv_gen_private.benbi_shift = 9 - log;
277
278         return 0;
279 }
280
281 static void crypt_iv_benbi_dtr(struct crypt_config *cc)
282 {
283 }
284
285 static int crypt_iv_benbi_gen(struct crypt_config *cc, u8 *iv, sector_t sector)
286 {
287         __be64 val;
288
289         memset(iv, 0, cc->iv_size - sizeof(u64)); /* rest is cleared below */
290
291         val = cpu_to_be64(((u64)sector << cc->iv_gen_private.benbi_shift) + 1);
292         put_unaligned(val, (__be64 *)(iv + cc->iv_size - sizeof(u64)));
293
294         return 0;
295 }
296
297 static int crypt_iv_null_gen(struct crypt_config *cc, u8 *iv, sector_t sector)
298 {
299         memset(iv, 0, cc->iv_size);
300
301         return 0;
302 }
303
304 static struct crypt_iv_operations crypt_iv_plain_ops = {
305         .generator = crypt_iv_plain_gen
306 };
307
308 static struct crypt_iv_operations crypt_iv_essiv_ops = {
309         .ctr       = crypt_iv_essiv_ctr,
310         .dtr       = crypt_iv_essiv_dtr,
311         .generator = crypt_iv_essiv_gen
312 };
313
314 static struct crypt_iv_operations crypt_iv_benbi_ops = {
315         .ctr       = crypt_iv_benbi_ctr,
316         .dtr       = crypt_iv_benbi_dtr,
317         .generator = crypt_iv_benbi_gen
318 };
319
320 static struct crypt_iv_operations crypt_iv_null_ops = {
321         .generator = crypt_iv_null_gen
322 };
323
324 static void crypt_convert_init(struct crypt_config *cc,
325                                struct convert_context *ctx,
326                                struct bio *bio_out, struct bio *bio_in,
327                                sector_t sector)
328 {
329         ctx->bio_in = bio_in;
330         ctx->bio_out = bio_out;
331         ctx->offset_in = 0;
332         ctx->offset_out = 0;
333         ctx->idx_in = bio_in ? bio_in->bi_idx : 0;
334         ctx->idx_out = bio_out ? bio_out->bi_idx : 0;
335         ctx->sector = sector + cc->iv_offset;
336         init_completion(&ctx->restart);
337 }
338
339 static struct dm_crypt_request *dmreq_of_req(struct crypt_config *cc,
340                                              struct ablkcipher_request *req)
341 {
342         return (struct dm_crypt_request *)((char *)req + cc->dmreq_start);
343 }
344
345 static struct ablkcipher_request *req_of_dmreq(struct crypt_config *cc,
346                                                struct dm_crypt_request *dmreq)
347 {
348         return (struct ablkcipher_request *)((char *)dmreq - cc->dmreq_start);
349 }
350
351 static int crypt_convert_block(struct crypt_config *cc,
352                                struct convert_context *ctx,
353                                struct ablkcipher_request *req)
354 {
355         struct bio_vec *bv_in = bio_iovec_idx(ctx->bio_in, ctx->idx_in);
356         struct bio_vec *bv_out = bio_iovec_idx(ctx->bio_out, ctx->idx_out);
357         struct dm_crypt_request *dmreq;
358         u8 *iv;
359         int r = 0;
360
361         dmreq = dmreq_of_req(cc, req);
362         iv = (u8 *)ALIGN((unsigned long)(dmreq + 1),
363                          crypto_ablkcipher_alignmask(cc->tfm) + 1);
364
365         dmreq->ctx = ctx;
366         sg_init_table(&dmreq->sg_in, 1);
367         sg_set_page(&dmreq->sg_in, bv_in->bv_page, 1 << SECTOR_SHIFT,
368                     bv_in->bv_offset + ctx->offset_in);
369
370         sg_init_table(&dmreq->sg_out, 1);
371         sg_set_page(&dmreq->sg_out, bv_out->bv_page, 1 << SECTOR_SHIFT,
372                     bv_out->bv_offset + ctx->offset_out);
373
374         ctx->offset_in += 1 << SECTOR_SHIFT;
375         if (ctx->offset_in >= bv_in->bv_len) {
376                 ctx->offset_in = 0;
377                 ctx->idx_in++;
378         }
379
380         ctx->offset_out += 1 << SECTOR_SHIFT;
381         if (ctx->offset_out >= bv_out->bv_len) {
382                 ctx->offset_out = 0;
383                 ctx->idx_out++;
384         }
385
386         if (cc->iv_gen_ops) {
387                 r = cc->iv_gen_ops->generator(cc, iv, ctx->sector);
388                 if (r < 0)
389                         return r;
390         }
391
392         ablkcipher_request_set_crypt(req, &dmreq->sg_in, &dmreq->sg_out,
393                                      1 << SECTOR_SHIFT, iv);
394
395         if (bio_data_dir(ctx->bio_in) == WRITE)
396                 r = crypto_ablkcipher_encrypt(req);
397         else
398                 r = crypto_ablkcipher_decrypt(req);
399
400         return r;
401 }
402
403 static void kcryptd_async_done(struct crypto_async_request *async_req,
404                                int error);
405 static void crypt_alloc_req(struct crypt_config *cc,
406                             struct convert_context *ctx)
407 {
408         if (!cc->req)
409                 cc->req = mempool_alloc(cc->req_pool, GFP_NOIO);
410         ablkcipher_request_set_tfm(cc->req, cc->tfm);
411         ablkcipher_request_set_callback(cc->req, CRYPTO_TFM_REQ_MAY_BACKLOG |
412                                         CRYPTO_TFM_REQ_MAY_SLEEP,
413                                         kcryptd_async_done,
414                                         dmreq_of_req(cc, cc->req));
415 }
416
417 /*
418  * Encrypt / decrypt data from one bio to another one (can be the same one)
419  */
420 static int crypt_convert(struct crypt_config *cc,
421                          struct convert_context *ctx)
422 {
423         int r;
424
425         atomic_set(&ctx->pending, 1);
426
427         while(ctx->idx_in < ctx->bio_in->bi_vcnt &&
428               ctx->idx_out < ctx->bio_out->bi_vcnt) {
429
430                 crypt_alloc_req(cc, ctx);
431
432                 atomic_inc(&ctx->pending);
433
434                 r = crypt_convert_block(cc, ctx, cc->req);
435
436                 switch (r) {
437                 /* async */
438                 case -EBUSY:
439                         wait_for_completion(&ctx->restart);
440                         INIT_COMPLETION(ctx->restart);
441                         /* fall through*/
442                 case -EINPROGRESS:
443                         cc->req = NULL;
444                         ctx->sector++;
445                         continue;
446
447                 /* sync */
448                 case 0:
449                         atomic_dec(&ctx->pending);
450                         ctx->sector++;
451                         cond_resched();
452                         continue;
453
454                 /* error */
455                 default:
456                         atomic_dec(&ctx->pending);
457                         return r;
458                 }
459         }
460
461         return 0;
462 }
463
464 static void dm_crypt_bio_destructor(struct bio *bio)
465 {
466         struct dm_crypt_io *io = bio->bi_private;
467         struct crypt_config *cc = io->target->private;
468
469         bio_free(bio, cc->bs);
470 }
471
472 /*
473  * Generate a new unfragmented bio with the given size
474  * This should never violate the device limitations
475  * May return a smaller bio when running out of pages, indicated by
476  * *out_of_pages set to 1.
477  */
478 static struct bio *crypt_alloc_buffer(struct dm_crypt_io *io, unsigned size,
479                                       unsigned *out_of_pages)
480 {
481         struct crypt_config *cc = io->target->private;
482         struct bio *clone;
483         unsigned int nr_iovecs = (size + PAGE_SIZE - 1) >> PAGE_SHIFT;
484         gfp_t gfp_mask = GFP_NOIO | __GFP_HIGHMEM;
485         unsigned i, len;
486         struct page *page;
487
488         clone = bio_alloc_bioset(GFP_NOIO, nr_iovecs, cc->bs);
489         if (!clone)
490                 return NULL;
491
492         clone_init(io, clone);
493         *out_of_pages = 0;
494
495         for (i = 0; i < nr_iovecs; i++) {
496                 page = mempool_alloc(cc->page_pool, gfp_mask);
497                 if (!page) {
498                         *out_of_pages = 1;
499                         break;
500                 }
501
502                 /*
503                  * if additional pages cannot be allocated without waiting,
504                  * return a partially allocated bio, the caller will then try
505                  * to allocate additional bios while submitting this partial bio
506                  */
507                 if (i == (MIN_BIO_PAGES - 1))
508                         gfp_mask = (gfp_mask | __GFP_NOWARN) & ~__GFP_WAIT;
509
510                 len = (size > PAGE_SIZE) ? PAGE_SIZE : size;
511
512                 if (!bio_add_page(clone, page, len, 0)) {
513                         mempool_free(page, cc->page_pool);
514                         break;
515                 }
516
517                 size -= len;
518         }
519
520         if (!clone->bi_size) {
521                 bio_put(clone);
522                 return NULL;
523         }
524
525         return clone;
526 }
527
528 static void crypt_free_buffer_pages(struct crypt_config *cc, struct bio *clone)
529 {
530         unsigned int i;
531         struct bio_vec *bv;
532
533         for (i = 0; i < clone->bi_vcnt; i++) {
534                 bv = bio_iovec_idx(clone, i);
535                 BUG_ON(!bv->bv_page);
536                 mempool_free(bv->bv_page, cc->page_pool);
537                 bv->bv_page = NULL;
538         }
539 }
540
541 static struct dm_crypt_io *crypt_io_alloc(struct dm_target *ti,
542                                           struct bio *bio, sector_t sector)
543 {
544         struct crypt_config *cc = ti->private;
545         struct dm_crypt_io *io;
546
547         io = mempool_alloc(cc->io_pool, GFP_NOIO);
548         io->target = ti;
549         io->base_bio = bio;
550         io->sector = sector;
551         io->error = 0;
552         io->base_io = NULL;
553         atomic_set(&io->pending, 0);
554
555         return io;
556 }
557
558 static void crypt_inc_pending(struct dm_crypt_io *io)
559 {
560         atomic_inc(&io->pending);
561 }
562
563 /*
564  * One of the bios was finished. Check for completion of
565  * the whole request and correctly clean up the buffer.
566  * If base_io is set, wait for the last fragment to complete.
567  */
568 static void crypt_dec_pending(struct dm_crypt_io *io)
569 {
570         struct crypt_config *cc = io->target->private;
571
572         if (!atomic_dec_and_test(&io->pending))
573                 return;
574
575         if (likely(!io->base_io))
576                 bio_endio(io->base_bio, io->error);
577         else {
578                 if (io->error && !io->base_io->error)
579                         io->base_io->error = io->error;
580                 crypt_dec_pending(io->base_io);
581         }
582
583         mempool_free(io, cc->io_pool);
584 }
585
586 /*
587  * kcryptd/kcryptd_io:
588  *
589  * Needed because it would be very unwise to do decryption in an
590  * interrupt context.
591  *
592  * kcryptd performs the actual encryption or decryption.
593  *
594  * kcryptd_io performs the IO submission.
595  *
596  * They must be separated as otherwise the final stages could be
597  * starved by new requests which can block in the first stages due
598  * to memory allocation.
599  */
600 static void crypt_endio(struct bio *clone, int error)
601 {
602         struct dm_crypt_io *io = clone->bi_private;
603         struct crypt_config *cc = io->target->private;
604         unsigned rw = bio_data_dir(clone);
605
606         if (unlikely(!bio_flagged(clone, BIO_UPTODATE) && !error))
607                 error = -EIO;
608
609         /*
610          * free the processed pages
611          */
612         if (rw == WRITE)
613                 crypt_free_buffer_pages(cc, clone);
614
615         bio_put(clone);
616
617         if (rw == READ && !error) {
618                 kcryptd_queue_crypt(io);
619                 return;
620         }
621
622         if (unlikely(error))
623                 io->error = error;
624
625         crypt_dec_pending(io);
626 }
627
628 static void clone_init(struct dm_crypt_io *io, struct bio *clone)
629 {
630         struct crypt_config *cc = io->target->private;
631
632         clone->bi_private = io;
633         clone->bi_end_io  = crypt_endio;
634         clone->bi_bdev    = cc->dev->bdev;
635         clone->bi_rw      = io->base_bio->bi_rw;
636         clone->bi_destructor = dm_crypt_bio_destructor;
637 }
638
639 static void kcryptd_io_read(struct dm_crypt_io *io)
640 {
641         struct crypt_config *cc = io->target->private;
642         struct bio *base_bio = io->base_bio;
643         struct bio *clone;
644
645         crypt_inc_pending(io);
646
647         /*
648          * The block layer might modify the bvec array, so always
649          * copy the required bvecs because we need the original
650          * one in order to decrypt the whole bio data *afterwards*.
651          */
652         clone = bio_alloc_bioset(GFP_NOIO, bio_segments(base_bio), cc->bs);
653         if (unlikely(!clone)) {
654                 io->error = -ENOMEM;
655                 crypt_dec_pending(io);
656                 return;
657         }
658
659         clone_init(io, clone);
660         clone->bi_idx = 0;
661         clone->bi_vcnt = bio_segments(base_bio);
662         clone->bi_size = base_bio->bi_size;
663         clone->bi_sector = cc->start + io->sector;
664         memcpy(clone->bi_io_vec, bio_iovec(base_bio),
665                sizeof(struct bio_vec) * clone->bi_vcnt);
666
667         generic_make_request(clone);
668 }
669
670 static void kcryptd_io_write(struct dm_crypt_io *io)
671 {
672         struct bio *clone = io->ctx.bio_out;
673         generic_make_request(clone);
674 }
675
676 static void kcryptd_io(struct work_struct *work)
677 {
678         struct dm_crypt_io *io = container_of(work, struct dm_crypt_io, work);
679
680         if (bio_data_dir(io->base_bio) == READ)
681                 kcryptd_io_read(io);
682         else
683                 kcryptd_io_write(io);
684 }
685
686 static void kcryptd_queue_io(struct dm_crypt_io *io)
687 {
688         struct crypt_config *cc = io->target->private;
689
690         INIT_WORK(&io->work, kcryptd_io);
691         queue_work(cc->io_queue, &io->work);
692 }
693
694 static void kcryptd_crypt_write_io_submit(struct dm_crypt_io *io,
695                                           int error, int async)
696 {
697         struct bio *clone = io->ctx.bio_out;
698         struct crypt_config *cc = io->target->private;
699
700         if (unlikely(error < 0)) {
701                 crypt_free_buffer_pages(cc, clone);
702                 bio_put(clone);
703                 io->error = -EIO;
704                 crypt_dec_pending(io);
705                 return;
706         }
707
708         /* crypt_convert should have filled the clone bio */
709         BUG_ON(io->ctx.idx_out < clone->bi_vcnt);
710
711         clone->bi_sector = cc->start + io->sector;
712
713         if (async)
714                 kcryptd_queue_io(io);
715         else
716                 generic_make_request(clone);
717 }
718
719 static void kcryptd_crypt_write_convert(struct dm_crypt_io *io)
720 {
721         struct crypt_config *cc = io->target->private;
722         struct bio *clone;
723         struct dm_crypt_io *new_io;
724         int crypt_finished;
725         unsigned out_of_pages = 0;
726         unsigned remaining = io->base_bio->bi_size;
727         sector_t sector = io->sector;
728         int r;
729
730         /*
731          * Prevent io from disappearing until this function completes.
732          */
733         crypt_inc_pending(io);
734         crypt_convert_init(cc, &io->ctx, NULL, io->base_bio, sector);
735
736         /*
737          * The allocated buffers can be smaller than the whole bio,
738          * so repeat the whole process until all the data can be handled.
739          */
740         while (remaining) {
741                 clone = crypt_alloc_buffer(io, remaining, &out_of_pages);
742                 if (unlikely(!clone)) {
743                         io->error = -ENOMEM;
744                         break;
745                 }
746
747                 io->ctx.bio_out = clone;
748                 io->ctx.idx_out = 0;
749
750                 remaining -= clone->bi_size;
751                 sector += bio_sectors(clone);
752
753                 crypt_inc_pending(io);
754                 r = crypt_convert(cc, &io->ctx);
755                 crypt_finished = atomic_dec_and_test(&io->ctx.pending);
756
757                 /* Encryption was already finished, submit io now */
758                 if (crypt_finished) {
759                         kcryptd_crypt_write_io_submit(io, r, 0);
760
761                         /*
762                          * If there was an error, do not try next fragments.
763                          * For async, error is processed in async handler.
764                          */
765                         if (unlikely(r < 0))
766                                 break;
767
768                         io->sector = sector;
769                 }
770
771                 /*
772                  * Out of memory -> run queues
773                  * But don't wait if split was due to the io size restriction
774                  */
775                 if (unlikely(out_of_pages))
776                         congestion_wait(WRITE, HZ/100);
777
778                 /*
779                  * With async crypto it is unsafe to share the crypto context
780                  * between fragments, so switch to a new dm_crypt_io structure.
781                  */
782                 if (unlikely(!crypt_finished && remaining)) {
783                         new_io = crypt_io_alloc(io->target, io->base_bio,
784                                                 sector);
785                         crypt_inc_pending(new_io);
786                         crypt_convert_init(cc, &new_io->ctx, NULL,
787                                            io->base_bio, sector);
788                         new_io->ctx.idx_in = io->ctx.idx_in;
789                         new_io->ctx.offset_in = io->ctx.offset_in;
790
791                         /*
792                          * Fragments after the first use the base_io
793                          * pending count.
794                          */
795                         if (!io->base_io)
796                                 new_io->base_io = io;
797                         else {
798                                 new_io->base_io = io->base_io;
799                                 crypt_inc_pending(io->base_io);
800                                 crypt_dec_pending(io);
801                         }
802
803                         io = new_io;
804                 }
805         }
806
807         crypt_dec_pending(io);
808 }
809
810 static void kcryptd_crypt_read_done(struct dm_crypt_io *io, int error)
811 {
812         if (unlikely(error < 0))
813                 io->error = -EIO;
814
815         crypt_dec_pending(io);
816 }
817
818 static void kcryptd_crypt_read_convert(struct dm_crypt_io *io)
819 {
820         struct crypt_config *cc = io->target->private;
821         int r = 0;
822
823         crypt_inc_pending(io);
824
825         crypt_convert_init(cc, &io->ctx, io->base_bio, io->base_bio,
826                            io->sector);
827
828         r = crypt_convert(cc, &io->ctx);
829
830         if (atomic_dec_and_test(&io->ctx.pending))
831                 kcryptd_crypt_read_done(io, r);
832
833         crypt_dec_pending(io);
834 }
835
836 static void kcryptd_async_done(struct crypto_async_request *async_req,
837                                int error)
838 {
839         struct dm_crypt_request *dmreq = async_req->data;
840         struct convert_context *ctx = dmreq->ctx;
841         struct dm_crypt_io *io = container_of(ctx, struct dm_crypt_io, ctx);
842         struct crypt_config *cc = io->target->private;
843
844         if (error == -EINPROGRESS) {
845                 complete(&ctx->restart);
846                 return;
847         }
848
849         mempool_free(req_of_dmreq(cc, dmreq), cc->req_pool);
850
851         if (!atomic_dec_and_test(&ctx->pending))
852                 return;
853
854         if (bio_data_dir(io->base_bio) == READ)
855                 kcryptd_crypt_read_done(io, error);
856         else
857                 kcryptd_crypt_write_io_submit(io, error, 1);
858 }
859
860 static void kcryptd_crypt(struct work_struct *work)
861 {
862         struct dm_crypt_io *io = container_of(work, struct dm_crypt_io, work);
863
864         if (bio_data_dir(io->base_bio) == READ)
865                 kcryptd_crypt_read_convert(io);
866         else
867                 kcryptd_crypt_write_convert(io);
868 }
869
870 static void kcryptd_queue_crypt(struct dm_crypt_io *io)
871 {
872         struct crypt_config *cc = io->target->private;
873
874         INIT_WORK(&io->work, kcryptd_crypt);
875         queue_work(cc->crypt_queue, &io->work);
876 }
877
878 /*
879  * Decode key from its hex representation
880  */
881 static int crypt_decode_key(u8 *key, char *hex, unsigned int size)
882 {
883         char buffer[3];
884         char *endp;
885         unsigned int i;
886
887         buffer[2] = '\0';
888
889         for (i = 0; i < size; i++) {
890                 buffer[0] = *hex++;
891                 buffer[1] = *hex++;
892
893                 key[i] = (u8)simple_strtoul(buffer, &endp, 16);
894
895                 if (endp != &buffer[2])
896                         return -EINVAL;
897         }
898
899         if (*hex != '\0')
900                 return -EINVAL;
901
902         return 0;
903 }
904
905 /*
906  * Encode key into its hex representation
907  */
908 static void crypt_encode_key(char *hex, u8 *key, unsigned int size)
909 {
910         unsigned int i;
911
912         for (i = 0; i < size; i++) {
913                 sprintf(hex, "%02x", *key);
914                 hex += 2;
915                 key++;
916         }
917 }
918
919 static int crypt_set_key(struct crypt_config *cc, char *key)
920 {
921         unsigned key_size = strlen(key) >> 1;
922
923         if (cc->key_size && cc->key_size != key_size)
924                 return -EINVAL;
925
926         cc->key_size = key_size; /* initial settings */
927
928         if ((!key_size && strcmp(key, "-")) ||
929            (key_size && crypt_decode_key(cc->key, key, key_size) < 0))
930                 return -EINVAL;
931
932         set_bit(DM_CRYPT_KEY_VALID, &cc->flags);
933
934         return 0;
935 }
936
937 static int crypt_wipe_key(struct crypt_config *cc)
938 {
939         clear_bit(DM_CRYPT_KEY_VALID, &cc->flags);
940         memset(&cc->key, 0, cc->key_size * sizeof(u8));
941         return 0;
942 }
943
944 /*
945  * Construct an encryption mapping:
946  * <cipher> <key> <iv_offset> <dev_path> <start>
947  */
948 static int crypt_ctr(struct dm_target *ti, unsigned int argc, char **argv)
949 {
950         struct crypt_config *cc;
951         struct crypto_ablkcipher *tfm;
952         char *tmp;
953         char *cipher;
954         char *chainmode;
955         char *ivmode;
956         char *ivopts;
957         unsigned int key_size;
958         unsigned long long tmpll;
959
960         if (argc != 5) {
961                 ti->error = "Not enough arguments";
962                 return -EINVAL;
963         }
964
965         tmp = argv[0];
966         cipher = strsep(&tmp, "-");
967         chainmode = strsep(&tmp, "-");
968         ivopts = strsep(&tmp, "-");
969         ivmode = strsep(&ivopts, ":");
970
971         if (tmp)
972                 DMWARN("Unexpected additional cipher options");
973
974         key_size = strlen(argv[1]) >> 1;
975
976         cc = kzalloc(sizeof(*cc) + key_size * sizeof(u8), GFP_KERNEL);
977         if (cc == NULL) {
978                 ti->error =
979                         "Cannot allocate transparent encryption context";
980                 return -ENOMEM;
981         }
982
983         if (crypt_set_key(cc, argv[1])) {
984                 ti->error = "Error decoding key";
985                 goto bad_cipher;
986         }
987
988         /* Compatiblity mode for old dm-crypt cipher strings */
989         if (!chainmode || (strcmp(chainmode, "plain") == 0 && !ivmode)) {
990                 chainmode = "cbc";
991                 ivmode = "plain";
992         }
993
994         if (strcmp(chainmode, "ecb") && !ivmode) {
995                 ti->error = "This chaining mode requires an IV mechanism";
996                 goto bad_cipher;
997         }
998
999         if (snprintf(cc->cipher, CRYPTO_MAX_ALG_NAME, "%s(%s)",
1000                      chainmode, cipher) >= CRYPTO_MAX_ALG_NAME) {
1001                 ti->error = "Chain mode + cipher name is too long";
1002                 goto bad_cipher;
1003         }
1004
1005         tfm = crypto_alloc_ablkcipher(cc->cipher, 0, 0);
1006         if (IS_ERR(tfm)) {
1007                 ti->error = "Error allocating crypto tfm";
1008                 goto bad_cipher;
1009         }
1010
1011         strcpy(cc->cipher, cipher);
1012         strcpy(cc->chainmode, chainmode);
1013         cc->tfm = tfm;
1014
1015         /*
1016          * Choose ivmode. Valid modes: "plain", "essiv:<esshash>", "benbi".
1017          * See comments at iv code
1018          */
1019
1020         if (ivmode == NULL)
1021                 cc->iv_gen_ops = NULL;
1022         else if (strcmp(ivmode, "plain") == 0)
1023                 cc->iv_gen_ops = &crypt_iv_plain_ops;
1024         else if (strcmp(ivmode, "essiv") == 0)
1025                 cc->iv_gen_ops = &crypt_iv_essiv_ops;
1026         else if (strcmp(ivmode, "benbi") == 0)
1027                 cc->iv_gen_ops = &crypt_iv_benbi_ops;
1028         else if (strcmp(ivmode, "null") == 0)
1029                 cc->iv_gen_ops = &crypt_iv_null_ops;
1030         else {
1031                 ti->error = "Invalid IV mode";
1032                 goto bad_ivmode;
1033         }
1034
1035         if (cc->iv_gen_ops && cc->iv_gen_ops->ctr &&
1036             cc->iv_gen_ops->ctr(cc, ti, ivopts) < 0)
1037                 goto bad_ivmode;
1038
1039         cc->iv_size = crypto_ablkcipher_ivsize(tfm);
1040         if (cc->iv_size)
1041                 /* at least a 64 bit sector number should fit in our buffer */
1042                 cc->iv_size = max(cc->iv_size,
1043                                   (unsigned int)(sizeof(u64) / sizeof(u8)));
1044         else {
1045                 if (cc->iv_gen_ops) {
1046                         DMWARN("Selected cipher does not support IVs");
1047                         if (cc->iv_gen_ops->dtr)
1048                                 cc->iv_gen_ops->dtr(cc);
1049                         cc->iv_gen_ops = NULL;
1050                 }
1051         }
1052
1053         cc->io_pool = mempool_create_slab_pool(MIN_IOS, _crypt_io_pool);
1054         if (!cc->io_pool) {
1055                 ti->error = "Cannot allocate crypt io mempool";
1056                 goto bad_slab_pool;
1057         }
1058
1059         cc->dmreq_start = sizeof(struct ablkcipher_request);
1060         cc->dmreq_start += crypto_ablkcipher_reqsize(tfm);
1061         cc->dmreq_start = ALIGN(cc->dmreq_start, crypto_tfm_ctx_alignment());
1062         cc->dmreq_start += crypto_ablkcipher_alignmask(tfm) &
1063                            ~(crypto_tfm_ctx_alignment() - 1);
1064
1065         cc->req_pool = mempool_create_kmalloc_pool(MIN_IOS, cc->dmreq_start +
1066                         sizeof(struct dm_crypt_request) + cc->iv_size);
1067         if (!cc->req_pool) {
1068                 ti->error = "Cannot allocate crypt request mempool";
1069                 goto bad_req_pool;
1070         }
1071         cc->req = NULL;
1072
1073         cc->page_pool = mempool_create_page_pool(MIN_POOL_PAGES, 0);
1074         if (!cc->page_pool) {
1075                 ti->error = "Cannot allocate page mempool";
1076                 goto bad_page_pool;
1077         }
1078
1079         cc->bs = bioset_create(MIN_IOS, 0);
1080         if (!cc->bs) {
1081                 ti->error = "Cannot allocate crypt bioset";
1082                 goto bad_bs;
1083         }
1084
1085         if (crypto_ablkcipher_setkey(tfm, cc->key, key_size) < 0) {
1086                 ti->error = "Error setting key";
1087                 goto bad_device;
1088         }
1089
1090         if (sscanf(argv[2], "%llu", &tmpll) != 1) {
1091                 ti->error = "Invalid iv_offset sector";
1092                 goto bad_device;
1093         }
1094         cc->iv_offset = tmpll;
1095
1096         if (sscanf(argv[4], "%llu", &tmpll) != 1) {
1097                 ti->error = "Invalid device sector";
1098                 goto bad_device;
1099         }
1100         cc->start = tmpll;
1101
1102         if (dm_get_device(ti, argv[3], cc->start, ti->len,
1103                           dm_table_get_mode(ti->table), &cc->dev)) {
1104                 ti->error = "Device lookup failed";
1105                 goto bad_device;
1106         }
1107
1108         if (ivmode && cc->iv_gen_ops) {
1109                 if (ivopts)
1110                         *(ivopts - 1) = ':';
1111                 cc->iv_mode = kmalloc(strlen(ivmode) + 1, GFP_KERNEL);
1112                 if (!cc->iv_mode) {
1113                         ti->error = "Error kmallocing iv_mode string";
1114                         goto bad_ivmode_string;
1115                 }
1116                 strcpy(cc->iv_mode, ivmode);
1117         } else
1118                 cc->iv_mode = NULL;
1119
1120         cc->io_queue = create_singlethread_workqueue("kcryptd_io");
1121         if (!cc->io_queue) {
1122                 ti->error = "Couldn't create kcryptd io queue";
1123                 goto bad_io_queue;
1124         }
1125
1126         cc->crypt_queue = create_singlethread_workqueue("kcryptd");
1127         if (!cc->crypt_queue) {
1128                 ti->error = "Couldn't create kcryptd queue";
1129                 goto bad_crypt_queue;
1130         }
1131
1132         ti->private = cc;
1133         return 0;
1134
1135 bad_crypt_queue:
1136         destroy_workqueue(cc->io_queue);
1137 bad_io_queue:
1138         kfree(cc->iv_mode);
1139 bad_ivmode_string:
1140         dm_put_device(ti, cc->dev);
1141 bad_device:
1142         bioset_free(cc->bs);
1143 bad_bs:
1144         mempool_destroy(cc->page_pool);
1145 bad_page_pool:
1146         mempool_destroy(cc->req_pool);
1147 bad_req_pool:
1148         mempool_destroy(cc->io_pool);
1149 bad_slab_pool:
1150         if (cc->iv_gen_ops && cc->iv_gen_ops->dtr)
1151                 cc->iv_gen_ops->dtr(cc);
1152 bad_ivmode:
1153         crypto_free_ablkcipher(tfm);
1154 bad_cipher:
1155         /* Must zero key material before freeing */
1156         memset(cc, 0, sizeof(*cc) + cc->key_size * sizeof(u8));
1157         kfree(cc);
1158         return -EINVAL;
1159 }
1160
1161 static void crypt_dtr(struct dm_target *ti)
1162 {
1163         struct crypt_config *cc = (struct crypt_config *) ti->private;
1164
1165         destroy_workqueue(cc->io_queue);
1166         destroy_workqueue(cc->crypt_queue);
1167
1168         if (cc->req)
1169                 mempool_free(cc->req, cc->req_pool);
1170
1171         bioset_free(cc->bs);
1172         mempool_destroy(cc->page_pool);
1173         mempool_destroy(cc->req_pool);
1174         mempool_destroy(cc->io_pool);
1175
1176         kfree(cc->iv_mode);
1177         if (cc->iv_gen_ops && cc->iv_gen_ops->dtr)
1178                 cc->iv_gen_ops->dtr(cc);
1179         crypto_free_ablkcipher(cc->tfm);
1180         dm_put_device(ti, cc->dev);
1181
1182         /* Must zero key material before freeing */
1183         memset(cc, 0, sizeof(*cc) + cc->key_size * sizeof(u8));
1184         kfree(cc);
1185 }
1186
1187 static int crypt_map(struct dm_target *ti, struct bio *bio,
1188                      union map_info *map_context)
1189 {
1190         struct dm_crypt_io *io;
1191
1192         io = crypt_io_alloc(ti, bio, bio->bi_sector - ti->begin);
1193
1194         if (bio_data_dir(io->base_bio) == READ)
1195                 kcryptd_queue_io(io);
1196         else
1197                 kcryptd_queue_crypt(io);
1198
1199         return DM_MAPIO_SUBMITTED;
1200 }
1201
1202 static int crypt_status(struct dm_target *ti, status_type_t type,
1203                         char *result, unsigned int maxlen)
1204 {
1205         struct crypt_config *cc = (struct crypt_config *) ti->private;
1206         unsigned int sz = 0;
1207
1208         switch (type) {
1209         case STATUSTYPE_INFO:
1210                 result[0] = '\0';
1211                 break;
1212
1213         case STATUSTYPE_TABLE:
1214                 if (cc->iv_mode)
1215                         DMEMIT("%s-%s-%s ", cc->cipher, cc->chainmode,
1216                                cc->iv_mode);
1217                 else
1218                         DMEMIT("%s-%s ", cc->cipher, cc->chainmode);
1219
1220                 if (cc->key_size > 0) {
1221                         if ((maxlen - sz) < ((cc->key_size << 1) + 1))
1222                                 return -ENOMEM;
1223
1224                         crypt_encode_key(result + sz, cc->key, cc->key_size);
1225                         sz += cc->key_size << 1;
1226                 } else {
1227                         if (sz >= maxlen)
1228                                 return -ENOMEM;
1229                         result[sz++] = '-';
1230                 }
1231
1232                 DMEMIT(" %llu %s %llu", (unsigned long long)cc->iv_offset,
1233                                 cc->dev->name, (unsigned long long)cc->start);
1234                 break;
1235         }
1236         return 0;
1237 }
1238
1239 static void crypt_postsuspend(struct dm_target *ti)
1240 {
1241         struct crypt_config *cc = ti->private;
1242
1243         set_bit(DM_CRYPT_SUSPENDED, &cc->flags);
1244 }
1245
1246 static int crypt_preresume(struct dm_target *ti)
1247 {
1248         struct crypt_config *cc = ti->private;
1249
1250         if (!test_bit(DM_CRYPT_KEY_VALID, &cc->flags)) {
1251                 DMERR("aborting resume - crypt key is not set.");
1252                 return -EAGAIN;
1253         }
1254
1255         return 0;
1256 }
1257
1258 static void crypt_resume(struct dm_target *ti)
1259 {
1260         struct crypt_config *cc = ti->private;
1261
1262         clear_bit(DM_CRYPT_SUSPENDED, &cc->flags);
1263 }
1264
1265 /* Message interface
1266  *      key set <key>
1267  *      key wipe
1268  */
1269 static int crypt_message(struct dm_target *ti, unsigned argc, char **argv)
1270 {
1271         struct crypt_config *cc = ti->private;
1272
1273         if (argc < 2)
1274                 goto error;
1275
1276         if (!strnicmp(argv[0], MESG_STR("key"))) {
1277                 if (!test_bit(DM_CRYPT_SUSPENDED, &cc->flags)) {
1278                         DMWARN("not suspended during key manipulation.");
1279                         return -EINVAL;
1280                 }
1281                 if (argc == 3 && !strnicmp(argv[1], MESG_STR("set")))
1282                         return crypt_set_key(cc, argv[2]);
1283                 if (argc == 2 && !strnicmp(argv[1], MESG_STR("wipe")))
1284                         return crypt_wipe_key(cc);
1285         }
1286
1287 error:
1288         DMWARN("unrecognised message received.");
1289         return -EINVAL;
1290 }
1291
1292 static int crypt_merge(struct dm_target *ti, struct bvec_merge_data *bvm,
1293                        struct bio_vec *biovec, int max_size)
1294 {
1295         struct crypt_config *cc = ti->private;
1296         struct request_queue *q = bdev_get_queue(cc->dev->bdev);
1297
1298         if (!q->merge_bvec_fn)
1299                 return max_size;
1300
1301         bvm->bi_bdev = cc->dev->bdev;
1302         bvm->bi_sector = cc->start + bvm->bi_sector - ti->begin;
1303
1304         return min(max_size, q->merge_bvec_fn(q, bvm, biovec));
1305 }
1306
1307 static struct target_type crypt_target = {
1308         .name   = "crypt",
1309         .version= {1, 6, 0},
1310         .module = THIS_MODULE,
1311         .ctr    = crypt_ctr,
1312         .dtr    = crypt_dtr,
1313         .map    = crypt_map,
1314         .status = crypt_status,
1315         .postsuspend = crypt_postsuspend,
1316         .preresume = crypt_preresume,
1317         .resume = crypt_resume,
1318         .message = crypt_message,
1319         .merge  = crypt_merge,
1320 };
1321
1322 static int __init dm_crypt_init(void)
1323 {
1324         int r;
1325
1326         _crypt_io_pool = KMEM_CACHE(dm_crypt_io, 0);
1327         if (!_crypt_io_pool)
1328                 return -ENOMEM;
1329
1330         r = dm_register_target(&crypt_target);
1331         if (r < 0) {
1332                 DMERR("register failed %d", r);
1333                 kmem_cache_destroy(_crypt_io_pool);
1334         }
1335
1336         return r;
1337 }
1338
1339 static void __exit dm_crypt_exit(void)
1340 {
1341         dm_unregister_target(&crypt_target);
1342         kmem_cache_destroy(_crypt_io_pool);
1343 }
1344
1345 module_init(dm_crypt_init);
1346 module_exit(dm_crypt_exit);
1347
1348 MODULE_AUTHOR("Christophe Saout <christophe@saout.de>");
1349 MODULE_DESCRIPTION(DM_NAME " target for transparent encryption / decryption");
1350 MODULE_LICENSE("GPL");