dm-crypt.c 42.7 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3
/*
 * Copyright (C) 2003 Christophe Saout <christophe@saout.de>
 * Copyright (C) 2004 Clemens Fruhwirth <clemens@endorphin.org>
4
 * Copyright (C) 2006-2009 Red Hat, Inc. All rights reserved.
L
Linus Torvalds 已提交
5 6 7 8
 *
 * This file is released under the GPL.
 */

M
Milan Broz 已提交
9
#include <linux/completion.h>
10
#include <linux/err.h>
L
Linus Torvalds 已提交
11 12 13 14 15 16 17 18 19
#include <linux/module.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/bio.h>
#include <linux/blkdev.h>
#include <linux/mempool.h>
#include <linux/slab.h>
#include <linux/crypto.h>
#include <linux/workqueue.h>
20
#include <linux/backing-dev.h>
A
Andi Kleen 已提交
21
#include <linux/percpu.h>
A
Arun Sharma 已提交
22
#include <linux/atomic.h>
23
#include <linux/scatterlist.h>
L
Linus Torvalds 已提交
24
#include <asm/page.h>
25
#include <asm/unaligned.h>
M
Milan Broz 已提交
26 27 28
#include <crypto/hash.h>
#include <crypto/md5.h>
#include <crypto/algapi.h>
L
Linus Torvalds 已提交
29

30
#include <linux/device-mapper.h>
L
Linus Torvalds 已提交
31

32
#define DM_MSG_PREFIX "crypt"
L
Linus Torvalds 已提交
33 34 35 36 37

/*
 * context holding the current state of a multi-part conversion
 */
struct convert_context {
M
Milan Broz 已提交
38
	struct completion restart;
L
Linus Torvalds 已提交
39 40 41 42 43 44
	struct bio *bio_in;
	struct bio *bio_out;
	unsigned int offset_in;
	unsigned int offset_out;
	unsigned int idx_in;
	unsigned int idx_out;
45
	sector_t cc_sector;
M
Mikulas Patocka 已提交
46
	atomic_t cc_pending;
L
Linus Torvalds 已提交
47 48
};

49 50 51 52
/*
 * per bio private data
 */
struct dm_crypt_io {
53
	struct crypt_config *cc;
54 55 56 57 58
	struct bio *base_bio;
	struct work_struct work;

	struct convert_context ctx;

M
Mikulas Patocka 已提交
59
	atomic_t io_pending;
60
	int error;
61
	sector_t sector;
M
Milan Broz 已提交
62
	struct dm_crypt_io *base_io;
63 64
};

65
struct dm_crypt_request {
66
	struct convert_context *ctx;
67 68
	struct scatterlist sg_in;
	struct scatterlist sg_out;
69
	sector_t iv_sector;
70 71
};

L
Linus Torvalds 已提交
72 73 74 75
struct crypt_config;

struct crypt_iv_operations {
	int (*ctr)(struct crypt_config *cc, struct dm_target *ti,
M
Milan Broz 已提交
76
		   const char *opts);
L
Linus Torvalds 已提交
77
	void (*dtr)(struct crypt_config *cc);
78
	int (*init)(struct crypt_config *cc);
79
	int (*wipe)(struct crypt_config *cc);
80 81 82 83
	int (*generator)(struct crypt_config *cc, u8 *iv,
			 struct dm_crypt_request *dmreq);
	int (*post)(struct crypt_config *cc, u8 *iv,
		    struct dm_crypt_request *dmreq);
L
Linus Torvalds 已提交
84 85
};

86
struct iv_essiv_private {
87 88
	struct crypto_hash *hash_tfm;
	u8 *salt;
89 90 91 92 93 94
};

struct iv_benbi_private {
	int shift;
};

M
Milan Broz 已提交
95 96 97 98 99 100
#define LMK_SEED_SIZE 64 /* hash + 0 */
struct iv_lmk_private {
	struct crypto_shash *hash_tfm;
	u8 *seed;
};

L
Linus Torvalds 已提交
101 102 103 104
/*
 * Crypt: maps a linear range of a block device
 * and encrypts / decrypts at the same time.
 */
M
Milan Broz 已提交
105
enum flags { DM_CRYPT_SUSPENDED, DM_CRYPT_KEY_VALID };
A
Andi Kleen 已提交
106 107 108 109 110 111 112 113 114 115 116 117

/*
 * Duplicated per-CPU state for cipher.
 */
struct crypt_cpu {
	struct ablkcipher_request *req;
};

/*
 * The fields in here must be read only after initialization,
 * changing state should be in crypt_cpu.
 */
L
Linus Torvalds 已提交
118 119 120 121 122
struct crypt_config {
	struct dm_dev *dev;
	sector_t start;

	/*
M
Milan Broz 已提交
123 124
	 * pool for per bio private data, crypto requests and
	 * encryption requeusts/buffer pages
L
Linus Torvalds 已提交
125 126
	 */
	mempool_t *io_pool;
M
Milan Broz 已提交
127
	mempool_t *req_pool;
L
Linus Torvalds 已提交
128
	mempool_t *page_pool;
M
Milan Broz 已提交
129
	struct bio_set *bs;
L
Linus Torvalds 已提交
130

M
Milan Broz 已提交
131 132
	struct workqueue_struct *io_queue;
	struct workqueue_struct *crypt_queue;
M
Milan Broz 已提交
133

M
Milan Broz 已提交
134
	char *cipher;
135
	char *cipher_string;
M
Milan Broz 已提交
136

L
Linus Torvalds 已提交
137
	struct crypt_iv_operations *iv_gen_ops;
138
	union {
139 140
		struct iv_essiv_private essiv;
		struct iv_benbi_private benbi;
M
Milan Broz 已提交
141
		struct iv_lmk_private lmk;
142
	} iv_gen_private;
L
Linus Torvalds 已提交
143 144 145
	sector_t iv_offset;
	unsigned int iv_size;

A
Andi Kleen 已提交
146 147 148 149 150
	/*
	 * Duplicated per cpu state. Access through
	 * per_cpu_ptr() only.
	 */
	struct crypt_cpu __percpu *cpu;
151 152 153 154

	/* ESSIV: struct crypto_cipher *essiv_tfm */
	void *iv_private;
	struct crypto_ablkcipher **tfms;
M
Milan Broz 已提交
155
	unsigned tfms_count;
A
Andi Kleen 已提交
156

M
Milan Broz 已提交
157 158 159 160 161 162 163 164 165 166 167 168 169 170 171
	/*
	 * Layout of each crypto request:
	 *
	 *   struct ablkcipher_request
	 *      context
	 *      padding
	 *   struct dm_crypt_request
	 *      padding
	 *   IV
	 *
	 * The padding is added so that dm_crypt_request and the IV are
	 * correctly aligned.
	 */
	unsigned int dmreq_start;

M
Milan Broz 已提交
172
	unsigned long flags;
L
Linus Torvalds 已提交
173
	unsigned int key_size;
174 175
	unsigned int key_parts;      /* independent parts in key buffer */
	unsigned int key_extra_size; /* additional keys length */
L
Linus Torvalds 已提交
176 177 178
	u8 key[0];
};

M
Milan Broz 已提交
179
#define MIN_IOS        16
L
Linus Torvalds 已提交
180 181
#define MIN_POOL_PAGES 32

182
static struct kmem_cache *_crypt_io_pool;
L
Linus Torvalds 已提交
183

A
Alasdair G Kergon 已提交
184
static void clone_init(struct dm_crypt_io *, struct bio *);
185
static void kcryptd_queue_crypt(struct dm_crypt_io *io);
186
static u8 *iv_of_dmreq(struct crypt_config *cc, struct dm_crypt_request *dmreq);
O
Olaf Kirch 已提交
187

A
Andi Kleen 已提交
188 189 190 191 192 193 194 195 196 197
static struct crypt_cpu *this_crypt_config(struct crypt_config *cc)
{
	return this_cpu_ptr(cc->cpu);
}

/*
 * Use this to access cipher attributes that are the same for each CPU.
 */
static struct crypto_ablkcipher *any_tfm(struct crypt_config *cc)
{
198
	return cc->tfms[0];
A
Andi Kleen 已提交
199 200
}

L
Linus Torvalds 已提交
201 202 203
/*
 * Different IV generation algorithms:
 *
204
 * plain: the initial vector is the 32-bit little-endian version of the sector
205
 *        number, padded with zeros if necessary.
L
Linus Torvalds 已提交
206
 *
M
Milan Broz 已提交
207 208 209
 * plain64: the initial vector is the 64-bit little-endian version of the sector
 *        number, padded with zeros if necessary.
 *
210 211 212
 * essiv: "encrypted sector|salt initial vector", the sector number is
 *        encrypted with the bulk cipher using a salt as key. The salt
 *        should be derived from the bulk cipher's key via hashing.
L
Linus Torvalds 已提交
213
 *
214 215 216
 * benbi: the 64-bit "big-endian 'narrow block'-count", starting at 1
 *        (needed for LRW-32-AES and possible other narrow block modes)
 *
L
Ludwig Nussel 已提交
217 218 219
 * null: the initial vector is always zero.  Provides compatibility with
 *       obsolete loop_fish2 devices.  Do not use for new devices.
 *
M
Milan Broz 已提交
220 221 222 223 224 225 226 227 228 229 230 231 232 233
 * lmk:  Compatible implementation of the block chaining mode used
 *       by the Loop-AES block device encryption system
 *       designed by Jari Ruusu. See http://loop-aes.sourceforge.net/
 *       It operates on full 512 byte sectors and uses CBC
 *       with an IV derived from the sector number, the data and
 *       optionally extra IV seed.
 *       This means that after decryption the first block
 *       of sector must be tweaked according to decrypted data.
 *       Loop-AES can use three encryption schemes:
 *         version 1: is plain aes-cbc mode
 *         version 2: uses 64 multikey scheme with lmk IV generator
 *         version 3: the same as version 2 with additional IV seed
 *                   (it uses 65 keys, last key is used as IV seed)
 *
L
Linus Torvalds 已提交
234 235 236 237
 * plumb: unimplemented, see:
 * http://article.gmane.org/gmane.linux.kernel.device-mapper.dm-crypt/454
 */

238 239
static int crypt_iv_plain_gen(struct crypt_config *cc, u8 *iv,
			      struct dm_crypt_request *dmreq)
L
Linus Torvalds 已提交
240 241
{
	memset(iv, 0, cc->iv_size);
A
Alasdair G Kergon 已提交
242
	*(__le32 *)iv = cpu_to_le32(dmreq->iv_sector & 0xffffffff);
L
Linus Torvalds 已提交
243 244 245 246

	return 0;
}

M
Milan Broz 已提交
247
static int crypt_iv_plain64_gen(struct crypt_config *cc, u8 *iv,
248
				struct dm_crypt_request *dmreq)
M
Milan Broz 已提交
249 250
{
	memset(iv, 0, cc->iv_size);
A
Alasdair G Kergon 已提交
251
	*(__le64 *)iv = cpu_to_le64(dmreq->iv_sector);
M
Milan Broz 已提交
252 253 254 255

	return 0;
}

256 257 258 259 260 261
/* Initialise ESSIV - compute salt but no local memory allocations */
static int crypt_iv_essiv_init(struct crypt_config *cc)
{
	struct iv_essiv_private *essiv = &cc->iv_gen_private.essiv;
	struct hash_desc desc;
	struct scatterlist sg;
A
Andi Kleen 已提交
262
	struct crypto_cipher *essiv_tfm;
263
	int err;
264 265 266 267 268 269 270 271 272

	sg_init_one(&sg, cc->key, cc->key_size);
	desc.tfm = essiv->hash_tfm;
	desc.flags = CRYPTO_TFM_REQ_MAY_SLEEP;

	err = crypto_hash_digest(&desc, &sg, cc->key_size, essiv->salt);
	if (err)
		return err;

273
	essiv_tfm = cc->iv_private;
A
Andi Kleen 已提交
274

275 276 277 278
	err = crypto_cipher_setkey(essiv_tfm, essiv->salt,
			    crypto_hash_digestsize(essiv->hash_tfm));
	if (err)
		return err;
A
Andi Kleen 已提交
279 280

	return 0;
281 282
}

283 284 285 286 287
/* Wipe salt and reset key derived from volume key */
static int crypt_iv_essiv_wipe(struct crypt_config *cc)
{
	struct iv_essiv_private *essiv = &cc->iv_gen_private.essiv;
	unsigned salt_size = crypto_hash_digestsize(essiv->hash_tfm);
A
Andi Kleen 已提交
288
	struct crypto_cipher *essiv_tfm;
289
	int r, err = 0;
290 291 292

	memset(essiv->salt, 0, salt_size);

293 294 295 296
	essiv_tfm = cc->iv_private;
	r = crypto_cipher_setkey(essiv_tfm, essiv->salt, salt_size);
	if (r)
		err = r;
A
Andi Kleen 已提交
297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331

	return err;
}

/* Set up per cpu cipher state */
static struct crypto_cipher *setup_essiv_cpu(struct crypt_config *cc,
					     struct dm_target *ti,
					     u8 *salt, unsigned saltsize)
{
	struct crypto_cipher *essiv_tfm;
	int err;

	/* Setup the essiv_tfm with the given salt */
	essiv_tfm = crypto_alloc_cipher(cc->cipher, 0, CRYPTO_ALG_ASYNC);
	if (IS_ERR(essiv_tfm)) {
		ti->error = "Error allocating crypto tfm for ESSIV";
		return essiv_tfm;
	}

	if (crypto_cipher_blocksize(essiv_tfm) !=
	    crypto_ablkcipher_ivsize(any_tfm(cc))) {
		ti->error = "Block size of ESSIV cipher does "
			    "not match IV size of block cipher";
		crypto_free_cipher(essiv_tfm);
		return ERR_PTR(-EINVAL);
	}

	err = crypto_cipher_setkey(essiv_tfm, salt, saltsize);
	if (err) {
		ti->error = "Failed to set key for ESSIV cipher";
		crypto_free_cipher(essiv_tfm);
		return ERR_PTR(err);
	}

	return essiv_tfm;
332 333
}

334 335
static void crypt_iv_essiv_dtr(struct crypt_config *cc)
{
A
Andi Kleen 已提交
336
	struct crypto_cipher *essiv_tfm;
337 338
	struct iv_essiv_private *essiv = &cc->iv_gen_private.essiv;

339 340 341 342 343
	crypto_free_hash(essiv->hash_tfm);
	essiv->hash_tfm = NULL;

	kzfree(essiv->salt);
	essiv->salt = NULL;
A
Andi Kleen 已提交
344

345
	essiv_tfm = cc->iv_private;
A
Andi Kleen 已提交
346

347 348
	if (essiv_tfm)
		crypto_free_cipher(essiv_tfm);
A
Andi Kleen 已提交
349

350
	cc->iv_private = NULL;
351 352
}

L
Linus Torvalds 已提交
353
static int crypt_iv_essiv_ctr(struct crypt_config *cc, struct dm_target *ti,
M
Milan Broz 已提交
354
			      const char *opts)
L
Linus Torvalds 已提交
355
{
356 357 358
	struct crypto_cipher *essiv_tfm = NULL;
	struct crypto_hash *hash_tfm = NULL;
	u8 *salt = NULL;
359
	int err;
L
Linus Torvalds 已提交
360

361
	if (!opts) {
362
		ti->error = "Digest algorithm missing for ESSIV mode";
L
Linus Torvalds 已提交
363 364 365
		return -EINVAL;
	}

366
	/* Allocate hash algorithm */
367 368
	hash_tfm = crypto_alloc_hash(opts, 0, CRYPTO_ALG_ASYNC);
	if (IS_ERR(hash_tfm)) {
369
		ti->error = "Error initializing ESSIV hash";
370 371
		err = PTR_ERR(hash_tfm);
		goto bad;
L
Linus Torvalds 已提交
372 373
	}

374
	salt = kzalloc(crypto_hash_digestsize(hash_tfm), GFP_KERNEL);
375
	if (!salt) {
376
		ti->error = "Error kmallocing salt storage in ESSIV";
377 378
		err = -ENOMEM;
		goto bad;
L
Linus Torvalds 已提交
379 380
	}

381 382 383
	cc->iv_gen_private.essiv.salt = salt;
	cc->iv_gen_private.essiv.hash_tfm = hash_tfm;

384 385 386 387 388
	essiv_tfm = setup_essiv_cpu(cc, ti, salt,
				crypto_hash_digestsize(hash_tfm));
	if (IS_ERR(essiv_tfm)) {
		crypt_iv_essiv_dtr(cc);
		return PTR_ERR(essiv_tfm);
A
Andi Kleen 已提交
389
	}
390
	cc->iv_private = essiv_tfm;
A
Andi Kleen 已提交
391

L
Linus Torvalds 已提交
392
	return 0;
393 394 395 396

bad:
	if (hash_tfm && !IS_ERR(hash_tfm))
		crypto_free_hash(hash_tfm);
397
	kfree(salt);
398
	return err;
L
Linus Torvalds 已提交
399 400
}

401 402
static int crypt_iv_essiv_gen(struct crypt_config *cc, u8 *iv,
			      struct dm_crypt_request *dmreq)
L
Linus Torvalds 已提交
403
{
404
	struct crypto_cipher *essiv_tfm = cc->iv_private;
A
Andi Kleen 已提交
405

L
Linus Torvalds 已提交
406
	memset(iv, 0, cc->iv_size);
A
Alasdair G Kergon 已提交
407
	*(__le64 *)iv = cpu_to_le64(dmreq->iv_sector);
A
Andi Kleen 已提交
408 409
	crypto_cipher_encrypt_one(essiv_tfm, iv, iv);

L
Linus Torvalds 已提交
410 411 412
	return 0;
}

413 414 415
static int crypt_iv_benbi_ctr(struct crypt_config *cc, struct dm_target *ti,
			      const char *opts)
{
A
Andi Kleen 已提交
416
	unsigned bs = crypto_ablkcipher_blocksize(any_tfm(cc));
417
	int log = ilog2(bs);
418 419 420 421 422 423 424 425 426 427 428 429 430 431

	/* we need to calculate how far we must shift the sector count
	 * to get the cipher block count, we use this shift in _gen */

	if (1 << log != bs) {
		ti->error = "cypher blocksize is not a power of 2";
		return -EINVAL;
	}

	if (log > 9) {
		ti->error = "cypher blocksize is > 512";
		return -EINVAL;
	}

432
	cc->iv_gen_private.benbi.shift = 9 - log;
433 434 435 436 437 438 439 440

	return 0;
}

static void crypt_iv_benbi_dtr(struct crypt_config *cc)
{
}

441 442
static int crypt_iv_benbi_gen(struct crypt_config *cc, u8 *iv,
			      struct dm_crypt_request *dmreq)
443
{
444 445
	__be64 val;

446
	memset(iv, 0, cc->iv_size - sizeof(u64)); /* rest is cleared below */
447

448
	val = cpu_to_be64(((u64)dmreq->iv_sector << cc->iv_gen_private.benbi.shift) + 1);
449
	put_unaligned(val, (__be64 *)(iv + cc->iv_size - sizeof(u64)));
450

L
Linus Torvalds 已提交
451 452 453
	return 0;
}

454 455
static int crypt_iv_null_gen(struct crypt_config *cc, u8 *iv,
			     struct dm_crypt_request *dmreq)
L
Ludwig Nussel 已提交
456 457 458 459 460 461
{
	memset(iv, 0, cc->iv_size);

	return 0;
}

M
Milan Broz 已提交
462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533
static void crypt_iv_lmk_dtr(struct crypt_config *cc)
{
	struct iv_lmk_private *lmk = &cc->iv_gen_private.lmk;

	if (lmk->hash_tfm && !IS_ERR(lmk->hash_tfm))
		crypto_free_shash(lmk->hash_tfm);
	lmk->hash_tfm = NULL;

	kzfree(lmk->seed);
	lmk->seed = NULL;
}

static int crypt_iv_lmk_ctr(struct crypt_config *cc, struct dm_target *ti,
			    const char *opts)
{
	struct iv_lmk_private *lmk = &cc->iv_gen_private.lmk;

	lmk->hash_tfm = crypto_alloc_shash("md5", 0, 0);
	if (IS_ERR(lmk->hash_tfm)) {
		ti->error = "Error initializing LMK hash";
		return PTR_ERR(lmk->hash_tfm);
	}

	/* No seed in LMK version 2 */
	if (cc->key_parts == cc->tfms_count) {
		lmk->seed = NULL;
		return 0;
	}

	lmk->seed = kzalloc(LMK_SEED_SIZE, GFP_KERNEL);
	if (!lmk->seed) {
		crypt_iv_lmk_dtr(cc);
		ti->error = "Error kmallocing seed storage in LMK";
		return -ENOMEM;
	}

	return 0;
}

static int crypt_iv_lmk_init(struct crypt_config *cc)
{
	struct iv_lmk_private *lmk = &cc->iv_gen_private.lmk;
	int subkey_size = cc->key_size / cc->key_parts;

	/* LMK seed is on the position of LMK_KEYS + 1 key */
	if (lmk->seed)
		memcpy(lmk->seed, cc->key + (cc->tfms_count * subkey_size),
		       crypto_shash_digestsize(lmk->hash_tfm));

	return 0;
}

static int crypt_iv_lmk_wipe(struct crypt_config *cc)
{
	struct iv_lmk_private *lmk = &cc->iv_gen_private.lmk;

	if (lmk->seed)
		memset(lmk->seed, 0, LMK_SEED_SIZE);

	return 0;
}

static int crypt_iv_lmk_one(struct crypt_config *cc, u8 *iv,
			    struct dm_crypt_request *dmreq,
			    u8 *data)
{
	struct iv_lmk_private *lmk = &cc->iv_gen_private.lmk;
	struct {
		struct shash_desc desc;
		char ctx[crypto_shash_descsize(lmk->hash_tfm)];
	} sdesc;
	struct md5_state md5state;
534
	__le32 buf[4];
M
Milan Broz 已提交
535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582
	int i, r;

	sdesc.desc.tfm = lmk->hash_tfm;
	sdesc.desc.flags = CRYPTO_TFM_REQ_MAY_SLEEP;

	r = crypto_shash_init(&sdesc.desc);
	if (r)
		return r;

	if (lmk->seed) {
		r = crypto_shash_update(&sdesc.desc, lmk->seed, LMK_SEED_SIZE);
		if (r)
			return r;
	}

	/* Sector is always 512B, block size 16, add data of blocks 1-31 */
	r = crypto_shash_update(&sdesc.desc, data + 16, 16 * 31);
	if (r)
		return r;

	/* Sector is cropped to 56 bits here */
	buf[0] = cpu_to_le32(dmreq->iv_sector & 0xFFFFFFFF);
	buf[1] = cpu_to_le32((((u64)dmreq->iv_sector >> 32) & 0x00FFFFFF) | 0x80000000);
	buf[2] = cpu_to_le32(4024);
	buf[3] = 0;
	r = crypto_shash_update(&sdesc.desc, (u8 *)buf, sizeof(buf));
	if (r)
		return r;

	/* No MD5 padding here */
	r = crypto_shash_export(&sdesc.desc, &md5state);
	if (r)
		return r;

	for (i = 0; i < MD5_HASH_WORDS; i++)
		__cpu_to_le32s(&md5state.hash[i]);
	memcpy(iv, &md5state.hash, cc->iv_size);

	return 0;
}

static int crypt_iv_lmk_gen(struct crypt_config *cc, u8 *iv,
			    struct dm_crypt_request *dmreq)
{
	u8 *src;
	int r = 0;

	if (bio_data_dir(dmreq->ctx->bio_in) == WRITE) {
583
		src = kmap_atomic(sg_page(&dmreq->sg_in));
M
Milan Broz 已提交
584
		r = crypt_iv_lmk_one(cc, iv, dmreq, src + dmreq->sg_in.offset);
585
		kunmap_atomic(src);
M
Milan Broz 已提交
586 587 588 589 590 591 592 593 594 595 596 597 598 599 600
	} else
		memset(iv, 0, cc->iv_size);

	return r;
}

static int crypt_iv_lmk_post(struct crypt_config *cc, u8 *iv,
			     struct dm_crypt_request *dmreq)
{
	u8 *dst;
	int r;

	if (bio_data_dir(dmreq->ctx->bio_in) == WRITE)
		return 0;

601
	dst = kmap_atomic(sg_page(&dmreq->sg_out));
M
Milan Broz 已提交
602 603 604 605 606 607
	r = crypt_iv_lmk_one(cc, iv, dmreq, dst + dmreq->sg_out.offset);

	/* Tweak the first block of plaintext sector */
	if (!r)
		crypto_xor(dst + dmreq->sg_out.offset, iv, cc->iv_size);

608
	kunmap_atomic(dst);
M
Milan Broz 已提交
609 610 611
	return r;
}

L
Linus Torvalds 已提交
612 613 614 615
static struct crypt_iv_operations crypt_iv_plain_ops = {
	.generator = crypt_iv_plain_gen
};

M
Milan Broz 已提交
616 617 618 619
static struct crypt_iv_operations crypt_iv_plain64_ops = {
	.generator = crypt_iv_plain64_gen
};

L
Linus Torvalds 已提交
620 621 622
static struct crypt_iv_operations crypt_iv_essiv_ops = {
	.ctr       = crypt_iv_essiv_ctr,
	.dtr       = crypt_iv_essiv_dtr,
623
	.init      = crypt_iv_essiv_init,
624
	.wipe      = crypt_iv_essiv_wipe,
L
Linus Torvalds 已提交
625 626 627
	.generator = crypt_iv_essiv_gen
};

628 629 630 631 632
static struct crypt_iv_operations crypt_iv_benbi_ops = {
	.ctr	   = crypt_iv_benbi_ctr,
	.dtr	   = crypt_iv_benbi_dtr,
	.generator = crypt_iv_benbi_gen
};
L
Linus Torvalds 已提交
633

L
Ludwig Nussel 已提交
634 635 636 637
static struct crypt_iv_operations crypt_iv_null_ops = {
	.generator = crypt_iv_null_gen
};

M
Milan Broz 已提交
638 639 640 641 642 643 644 645 646
static struct crypt_iv_operations crypt_iv_lmk_ops = {
	.ctr	   = crypt_iv_lmk_ctr,
	.dtr	   = crypt_iv_lmk_dtr,
	.init	   = crypt_iv_lmk_init,
	.wipe	   = crypt_iv_lmk_wipe,
	.generator = crypt_iv_lmk_gen,
	.post	   = crypt_iv_lmk_post
};

M
Milan Broz 已提交
647 648 649
static void crypt_convert_init(struct crypt_config *cc,
			       struct convert_context *ctx,
			       struct bio *bio_out, struct bio *bio_in,
650
			       sector_t sector)
L
Linus Torvalds 已提交
651 652 653 654 655 656 657
{
	ctx->bio_in = bio_in;
	ctx->bio_out = bio_out;
	ctx->offset_in = 0;
	ctx->offset_out = 0;
	ctx->idx_in = bio_in ? bio_in->bi_idx : 0;
	ctx->idx_out = bio_out ? bio_out->bi_idx : 0;
658
	ctx->cc_sector = sector + cc->iv_offset;
M
Milan Broz 已提交
659
	init_completion(&ctx->restart);
L
Linus Torvalds 已提交
660 661
}

662 663 664 665 666 667 668 669 670 671 672 673
static struct dm_crypt_request *dmreq_of_req(struct crypt_config *cc,
					     struct ablkcipher_request *req)
{
	return (struct dm_crypt_request *)((char *)req + cc->dmreq_start);
}

static struct ablkcipher_request *req_of_dmreq(struct crypt_config *cc,
					       struct dm_crypt_request *dmreq)
{
	return (struct ablkcipher_request *)((char *)dmreq - cc->dmreq_start);
}

674 675 676 677 678 679 680
static u8 *iv_of_dmreq(struct crypt_config *cc,
		       struct dm_crypt_request *dmreq)
{
	return (u8 *)ALIGN((unsigned long)(dmreq + 1),
		crypto_ablkcipher_alignmask(any_tfm(cc)) + 1);
}

681
static int crypt_convert_block(struct crypt_config *cc,
M
Milan Broz 已提交
682 683
			       struct convert_context *ctx,
			       struct ablkcipher_request *req)
684 685 686
{
	struct bio_vec *bv_in = bio_iovec_idx(ctx->bio_in, ctx->idx_in);
	struct bio_vec *bv_out = bio_iovec_idx(ctx->bio_out, ctx->idx_out);
M
Milan Broz 已提交
687 688
	struct dm_crypt_request *dmreq;
	u8 *iv;
M
Mikulas Patocka 已提交
689
	int r;
M
Milan Broz 已提交
690

691
	dmreq = dmreq_of_req(cc, req);
692
	iv = iv_of_dmreq(cc, dmreq);
693

694
	dmreq->iv_sector = ctx->cc_sector;
695
	dmreq->ctx = ctx;
M
Milan Broz 已提交
696 697
	sg_init_table(&dmreq->sg_in, 1);
	sg_set_page(&dmreq->sg_in, bv_in->bv_page, 1 << SECTOR_SHIFT,
698 699
		    bv_in->bv_offset + ctx->offset_in);

M
Milan Broz 已提交
700 701
	sg_init_table(&dmreq->sg_out, 1);
	sg_set_page(&dmreq->sg_out, bv_out->bv_page, 1 << SECTOR_SHIFT,
702 703 704 705 706 707 708 709 710 711 712 713 714 715
		    bv_out->bv_offset + ctx->offset_out);

	ctx->offset_in += 1 << SECTOR_SHIFT;
	if (ctx->offset_in >= bv_in->bv_len) {
		ctx->offset_in = 0;
		ctx->idx_in++;
	}

	ctx->offset_out += 1 << SECTOR_SHIFT;
	if (ctx->offset_out >= bv_out->bv_len) {
		ctx->offset_out = 0;
		ctx->idx_out++;
	}

M
Milan Broz 已提交
716
	if (cc->iv_gen_ops) {
717
		r = cc->iv_gen_ops->generator(cc, iv, dmreq);
M
Milan Broz 已提交
718 719 720 721 722 723 724 725 726 727 728 729
		if (r < 0)
			return r;
	}

	ablkcipher_request_set_crypt(req, &dmreq->sg_in, &dmreq->sg_out,
				     1 << SECTOR_SHIFT, iv);

	if (bio_data_dir(ctx->bio_in) == WRITE)
		r = crypto_ablkcipher_encrypt(req);
	else
		r = crypto_ablkcipher_decrypt(req);

730 731 732
	if (!r && cc->iv_gen_ops && cc->iv_gen_ops->post)
		r = cc->iv_gen_ops->post(cc, iv, dmreq);

M
Milan Broz 已提交
733
	return r;
734 735
}

M
Milan Broz 已提交
736 737
static void kcryptd_async_done(struct crypto_async_request *async_req,
			       int error);
A
Andi Kleen 已提交
738

M
Milan Broz 已提交
739 740 741
static void crypt_alloc_req(struct crypt_config *cc,
			    struct convert_context *ctx)
{
A
Andi Kleen 已提交
742
	struct crypt_cpu *this_cc = this_crypt_config(cc);
743
	unsigned key_index = ctx->cc_sector & (cc->tfms_count - 1);
A
Andi Kleen 已提交
744 745 746 747

	if (!this_cc->req)
		this_cc->req = mempool_alloc(cc->req_pool, GFP_NOIO);

748
	ablkcipher_request_set_tfm(this_cc->req, cc->tfms[key_index]);
A
Andi Kleen 已提交
749 750 751
	ablkcipher_request_set_callback(this_cc->req,
	    CRYPTO_TFM_REQ_MAY_BACKLOG | CRYPTO_TFM_REQ_MAY_SLEEP,
	    kcryptd_async_done, dmreq_of_req(cc, this_cc->req));
M
Milan Broz 已提交
752 753
}

L
Linus Torvalds 已提交
754 755 756 757
/*
 * Encrypt / decrypt data from one bio to another one (can be the same one)
 */
static int crypt_convert(struct crypt_config *cc,
M
Milan Broz 已提交
758
			 struct convert_context *ctx)
L
Linus Torvalds 已提交
759
{
A
Andi Kleen 已提交
760
	struct crypt_cpu *this_cc = this_crypt_config(cc);
M
Milan Broz 已提交
761
	int r;
L
Linus Torvalds 已提交
762

M
Mikulas Patocka 已提交
763
	atomic_set(&ctx->cc_pending, 1);
M
Milan Broz 已提交
764

L
Linus Torvalds 已提交
765 766 767
	while(ctx->idx_in < ctx->bio_in->bi_vcnt &&
	      ctx->idx_out < ctx->bio_out->bi_vcnt) {

M
Milan Broz 已提交
768 769
		crypt_alloc_req(cc, ctx);

M
Mikulas Patocka 已提交
770
		atomic_inc(&ctx->cc_pending);
M
Milan Broz 已提交
771

A
Andi Kleen 已提交
772
		r = crypt_convert_block(cc, ctx, this_cc->req);
M
Milan Broz 已提交
773 774

		switch (r) {
M
Milan Broz 已提交
775
		/* async */
M
Milan Broz 已提交
776 777 778 779 780
		case -EBUSY:
			wait_for_completion(&ctx->restart);
			INIT_COMPLETION(ctx->restart);
			/* fall through*/
		case -EINPROGRESS:
A
Andi Kleen 已提交
781
			this_cc->req = NULL;
782
			ctx->cc_sector++;
M
Milan Broz 已提交
783 784 785
			continue;

		/* sync */
M
Milan Broz 已提交
786
		case 0:
M
Mikulas Patocka 已提交
787
			atomic_dec(&ctx->cc_pending);
788
			ctx->cc_sector++;
M
Milan Broz 已提交
789
			cond_resched();
M
Milan Broz 已提交
790 791
			continue;

M
Milan Broz 已提交
792 793
		/* error */
		default:
M
Mikulas Patocka 已提交
794
			atomic_dec(&ctx->cc_pending);
M
Milan Broz 已提交
795 796
			return r;
		}
L
Linus Torvalds 已提交
797 798
	}

M
Milan Broz 已提交
799
	return 0;
L
Linus Torvalds 已提交
800 801 802 803 804
}

/*
 * Generate a new unfragmented bio with the given size
 * This should never violate the device limitations
805 806
 * May return a smaller bio when running out of pages, indicated by
 * *out_of_pages set to 1.
L
Linus Torvalds 已提交
807
 */
808 809
static struct bio *crypt_alloc_buffer(struct dm_crypt_io *io, unsigned size,
				      unsigned *out_of_pages)
L
Linus Torvalds 已提交
810
{
811
	struct crypt_config *cc = io->cc;
812
	struct bio *clone;
L
Linus Torvalds 已提交
813
	unsigned int nr_iovecs = (size + PAGE_SIZE - 1) >> PAGE_SHIFT;
814
	gfp_t gfp_mask = GFP_NOIO | __GFP_HIGHMEM;
M
Milan Broz 已提交
815 816
	unsigned i, len;
	struct page *page;
L
Linus Torvalds 已提交
817

O
Olaf Kirch 已提交
818
	clone = bio_alloc_bioset(GFP_NOIO, nr_iovecs, cc->bs);
819
	if (!clone)
L
Linus Torvalds 已提交
820 821
		return NULL;

O
Olaf Kirch 已提交
822
	clone_init(io, clone);
823
	*out_of_pages = 0;
M
Milan Broz 已提交
824

825
	for (i = 0; i < nr_iovecs; i++) {
M
Milan Broz 已提交
826
		page = mempool_alloc(cc->page_pool, gfp_mask);
827 828
		if (!page) {
			*out_of_pages = 1;
L
Linus Torvalds 已提交
829
			break;
830
		}
L
Linus Torvalds 已提交
831 832

		/*
M
Mikulas Patocka 已提交
833 834 835
		 * If additional pages cannot be allocated without waiting,
		 * return a partially-allocated bio.  The caller will then try
		 * to allocate more bios while submitting this partial bio.
L
Linus Torvalds 已提交
836
		 */
M
Mikulas Patocka 已提交
837
		gfp_mask = (gfp_mask | __GFP_NOWARN) & ~__GFP_WAIT;
L
Linus Torvalds 已提交
838

M
Milan Broz 已提交
839 840 841 842 843 844
		len = (size > PAGE_SIZE) ? PAGE_SIZE : size;

		if (!bio_add_page(clone, page, len, 0)) {
			mempool_free(page, cc->page_pool);
			break;
		}
L
Linus Torvalds 已提交
845

M
Milan Broz 已提交
846
		size -= len;
L
Linus Torvalds 已提交
847 848
	}

849 850
	if (!clone->bi_size) {
		bio_put(clone);
L
Linus Torvalds 已提交
851 852 853
		return NULL;
	}

854
	return clone;
L
Linus Torvalds 已提交
855 856
}

N
Neil Brown 已提交
857
static void crypt_free_buffer_pages(struct crypt_config *cc, struct bio *clone)
L
Linus Torvalds 已提交
858
{
N
Neil Brown 已提交
859
	unsigned int i;
L
Linus Torvalds 已提交
860 861
	struct bio_vec *bv;

862
	bio_for_each_segment_all(bv, clone, i) {
L
Linus Torvalds 已提交
863 864 865 866 867 868
		BUG_ON(!bv->bv_page);
		mempool_free(bv->bv_page, cc->page_pool);
		bv->bv_page = NULL;
	}
}

869
static struct dm_crypt_io *crypt_io_alloc(struct crypt_config *cc,
M
Milan Broz 已提交
870 871 872 873 874
					  struct bio *bio, sector_t sector)
{
	struct dm_crypt_io *io;

	io = mempool_alloc(cc->io_pool, GFP_NOIO);
875
	io->cc = cc;
M
Milan Broz 已提交
876 877 878
	io->base_bio = bio;
	io->sector = sector;
	io->error = 0;
M
Milan Broz 已提交
879
	io->base_io = NULL;
M
Mikulas Patocka 已提交
880
	atomic_set(&io->io_pending, 0);
M
Milan Broz 已提交
881 882 883 884

	return io;
}

M
Milan Broz 已提交
885 886
static void crypt_inc_pending(struct dm_crypt_io *io)
{
M
Mikulas Patocka 已提交
887
	atomic_inc(&io->io_pending);
M
Milan Broz 已提交
888 889
}

L
Linus Torvalds 已提交
890 891 892
/*
 * One of the bios was finished. Check for completion of
 * the whole request and correctly clean up the buffer.
M
Milan Broz 已提交
893
 * If base_io is set, wait for the last fragment to complete.
L
Linus Torvalds 已提交
894
 */
895
static void crypt_dec_pending(struct dm_crypt_io *io)
L
Linus Torvalds 已提交
896
{
897
	struct crypt_config *cc = io->cc;
898 899 900
	struct bio *base_bio = io->base_bio;
	struct dm_crypt_io *base_io = io->base_io;
	int error = io->error;
L
Linus Torvalds 已提交
901

M
Mikulas Patocka 已提交
902
	if (!atomic_dec_and_test(&io->io_pending))
L
Linus Torvalds 已提交
903 904
		return;

905 906 907 908
	mempool_free(io, cc->io_pool);

	if (likely(!base_io))
		bio_endio(base_bio, error);
M
Milan Broz 已提交
909
	else {
910 911 912
		if (error && !base_io->error)
			base_io->error = error;
		crypt_dec_pending(base_io);
M
Milan Broz 已提交
913
	}
L
Linus Torvalds 已提交
914 915 916
}

/*
M
Milan Broz 已提交
917
 * kcryptd/kcryptd_io:
L
Linus Torvalds 已提交
918 919
 *
 * Needed because it would be very unwise to do decryption in an
920
 * interrupt context.
M
Milan Broz 已提交
921 922 923 924 925 926 927 928
 *
 * kcryptd performs the actual encryption or decryption.
 *
 * kcryptd_io performs the IO submission.
 *
 * They must be separated as otherwise the final stages could be
 * starved by new requests which can block in the first stages due
 * to memory allocation.
A
Andi Kleen 已提交
929 930 931
 *
 * The work is done per CPU global for all dm-crypt instances.
 * They should not depend on each other and do not block.
L
Linus Torvalds 已提交
932
 */
933
static void crypt_endio(struct bio *clone, int error)
934
{
A
Alasdair G Kergon 已提交
935
	struct dm_crypt_io *io = clone->bi_private;
936
	struct crypt_config *cc = io->cc;
M
Milan Broz 已提交
937
	unsigned rw = bio_data_dir(clone);
938

M
Milan Broz 已提交
939 940 941
	if (unlikely(!bio_flagged(clone, BIO_UPTODATE) && !error))
		error = -EIO;

942
	/*
943
	 * free the processed pages
944
	 */
M
Milan Broz 已提交
945
	if (rw == WRITE)
N
Neil Brown 已提交
946
		crypt_free_buffer_pages(cc, clone);
947 948 949

	bio_put(clone);

M
Milan Broz 已提交
950 951 952 953
	if (rw == READ && !error) {
		kcryptd_queue_crypt(io);
		return;
	}
954 955 956 957 958

	if (unlikely(error))
		io->error = error;

	crypt_dec_pending(io);
959 960
}

A
Alasdair G Kergon 已提交
961
static void clone_init(struct dm_crypt_io *io, struct bio *clone)
962
{
963
	struct crypt_config *cc = io->cc;
964 965 966 967 968 969 970

	clone->bi_private = io;
	clone->bi_end_io  = crypt_endio;
	clone->bi_bdev    = cc->dev->bdev;
	clone->bi_rw      = io->base_bio->bi_rw;
}

971
static int kcryptd_io_read(struct dm_crypt_io *io, gfp_t gfp)
972
{
973
	struct crypt_config *cc = io->cc;
974 975
	struct bio *base_bio = io->base_bio;
	struct bio *clone;
976

977 978 979 980 981
	/*
	 * The block layer might modify the bvec array, so always
	 * copy the required bvecs because we need the original
	 * one in order to decrypt the whole bio data *afterwards*.
	 */
982
	clone = bio_clone_bioset(base_bio, gfp, cc->bs);
J
Jens Axboe 已提交
983
	if (!clone)
984
		return 1;
985

986 987
	crypt_inc_pending(io);

988
	clone_init(io, clone);
989
	clone->bi_sector = cc->start + io->sector;
990

991
	generic_make_request(clone);
992
	return 0;
993 994
}

995 996
static void kcryptd_io_write(struct dm_crypt_io *io)
{
M
Milan Broz 已提交
997 998
	struct bio *clone = io->ctx.bio_out;
	generic_make_request(clone);
999 1000
}

1001 1002 1003 1004
static void kcryptd_io(struct work_struct *work)
{
	struct dm_crypt_io *io = container_of(work, struct dm_crypt_io, work);

1005 1006 1007 1008 1009 1010
	if (bio_data_dir(io->base_bio) == READ) {
		crypt_inc_pending(io);
		if (kcryptd_io_read(io, GFP_NOIO))
			io->error = -ENOMEM;
		crypt_dec_pending(io);
	} else
1011 1012 1013 1014 1015
		kcryptd_io_write(io);
}

static void kcryptd_queue_io(struct dm_crypt_io *io)
{
1016
	struct crypt_config *cc = io->cc;
1017 1018 1019 1020 1021

	INIT_WORK(&io->work, kcryptd_io);
	queue_work(cc->io_queue, &io->work);
}

1022
static void kcryptd_crypt_write_io_submit(struct dm_crypt_io *io, int async)
1023
{
M
Milan Broz 已提交
1024
	struct bio *clone = io->ctx.bio_out;
1025
	struct crypt_config *cc = io->cc;
M
Milan Broz 已提交
1026

1027
	if (unlikely(io->error < 0)) {
M
Milan Broz 已提交
1028 1029
		crypt_free_buffer_pages(cc, clone);
		bio_put(clone);
1030
		crypt_dec_pending(io);
M
Milan Broz 已提交
1031 1032 1033 1034 1035 1036 1037
		return;
	}

	/* crypt_convert should have filled the clone bio */
	BUG_ON(io->ctx.idx_out < clone->bi_vcnt);

	clone->bi_sector = cc->start + io->sector;
M
Milan Broz 已提交
1038

M
Milan Broz 已提交
1039 1040
	if (async)
		kcryptd_queue_io(io);
1041
	else
M
Milan Broz 已提交
1042
		generic_make_request(clone);
1043 1044
}

M
Milan Broz 已提交
1045
static void kcryptd_crypt_write_convert(struct dm_crypt_io *io)
1046
{
1047
	struct crypt_config *cc = io->cc;
1048
	struct bio *clone;
M
Milan Broz 已提交
1049
	struct dm_crypt_io *new_io;
M
Milan Broz 已提交
1050
	int crypt_finished;
1051
	unsigned out_of_pages = 0;
M
Milan Broz 已提交
1052
	unsigned remaining = io->base_bio->bi_size;
M
Milan Broz 已提交
1053
	sector_t sector = io->sector;
M
Milan Broz 已提交
1054
	int r;
1055

M
Milan Broz 已提交
1056 1057 1058 1059
	/*
	 * Prevent io from disappearing until this function completes.
	 */
	crypt_inc_pending(io);
M
Milan Broz 已提交
1060
	crypt_convert_init(cc, &io->ctx, NULL, io->base_bio, sector);
M
Milan Broz 已提交
1061

1062 1063 1064 1065 1066
	/*
	 * The allocated buffers can be smaller than the whole bio,
	 * so repeat the whole process until all the data can be handled.
	 */
	while (remaining) {
1067
		clone = crypt_alloc_buffer(io, remaining, &out_of_pages);
1068
		if (unlikely(!clone)) {
1069
			io->error = -ENOMEM;
M
Milan Broz 已提交
1070
			break;
1071
		}
1072

1073 1074
		io->ctx.bio_out = clone;
		io->ctx.idx_out = 0;
1075

M
Milan Broz 已提交
1076
		remaining -= clone->bi_size;
M
Milan Broz 已提交
1077
		sector += bio_sectors(clone);
1078

M
Milan Broz 已提交
1079
		crypt_inc_pending(io);
1080

M
Milan Broz 已提交
1081
		r = crypt_convert(cc, &io->ctx);
1082 1083 1084
		if (r < 0)
			io->error = -EIO;

M
Mikulas Patocka 已提交
1085
		crypt_finished = atomic_dec_and_test(&io->ctx.cc_pending);
1086

M
Milan Broz 已提交
1087 1088
		/* Encryption was already finished, submit io now */
		if (crypt_finished) {
1089
			kcryptd_crypt_write_io_submit(io, 0);
M
Milan Broz 已提交
1090 1091 1092 1093 1094

			/*
			 * If there was an error, do not try next fragments.
			 * For async, error is processed in async handler.
			 */
1095
			if (unlikely(r < 0))
M
Milan Broz 已提交
1096
				break;
M
Milan Broz 已提交
1097 1098

			io->sector = sector;
M
Milan Broz 已提交
1099
		}
1100

1101 1102 1103 1104 1105
		/*
		 * Out of memory -> run queues
		 * But don't wait if split was due to the io size restriction
		 */
		if (unlikely(out_of_pages))
1106
			congestion_wait(BLK_RW_ASYNC, HZ/100);
1107

M
Milan Broz 已提交
1108 1109 1110 1111 1112
		/*
		 * With async crypto it is unsafe to share the crypto context
		 * between fragments, so switch to a new dm_crypt_io structure.
		 */
		if (unlikely(!crypt_finished && remaining)) {
1113
			new_io = crypt_io_alloc(io->cc, io->base_bio,
M
Milan Broz 已提交
1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134
						sector);
			crypt_inc_pending(new_io);
			crypt_convert_init(cc, &new_io->ctx, NULL,
					   io->base_bio, sector);
			new_io->ctx.idx_in = io->ctx.idx_in;
			new_io->ctx.offset_in = io->ctx.offset_in;

			/*
			 * Fragments after the first use the base_io
			 * pending count.
			 */
			if (!io->base_io)
				new_io->base_io = io;
			else {
				new_io->base_io = io->base_io;
				crypt_inc_pending(io->base_io);
				crypt_dec_pending(io);
			}

			io = new_io;
		}
1135
	}
M
Milan Broz 已提交
1136 1137

	crypt_dec_pending(io);
1138 1139
}

1140
static void kcryptd_crypt_read_done(struct dm_crypt_io *io)
1141 1142 1143 1144
{
	crypt_dec_pending(io);
}

1145
static void kcryptd_crypt_read_convert(struct dm_crypt_io *io)
1146
{
1147
	struct crypt_config *cc = io->cc;
1148
	int r = 0;
L
Linus Torvalds 已提交
1149

M
Milan Broz 已提交
1150
	crypt_inc_pending(io);
M
Milan Broz 已提交
1151

1152
	crypt_convert_init(cc, &io->ctx, io->base_bio, io->base_bio,
1153
			   io->sector);
L
Linus Torvalds 已提交
1154

1155
	r = crypt_convert(cc, &io->ctx);
1156 1157
	if (r < 0)
		io->error = -EIO;
1158

M
Mikulas Patocka 已提交
1159
	if (atomic_dec_and_test(&io->ctx.cc_pending))
1160
		kcryptd_crypt_read_done(io);
M
Milan Broz 已提交
1161 1162

	crypt_dec_pending(io);
L
Linus Torvalds 已提交
1163 1164
}

M
Milan Broz 已提交
1165 1166 1167
static void kcryptd_async_done(struct crypto_async_request *async_req,
			       int error)
{
1168 1169
	struct dm_crypt_request *dmreq = async_req->data;
	struct convert_context *ctx = dmreq->ctx;
M
Milan Broz 已提交
1170
	struct dm_crypt_io *io = container_of(ctx, struct dm_crypt_io, ctx);
1171
	struct crypt_config *cc = io->cc;
M
Milan Broz 已提交
1172 1173 1174 1175 1176 1177

	if (error == -EINPROGRESS) {
		complete(&ctx->restart);
		return;
	}

1178 1179 1180
	if (!error && cc->iv_gen_ops && cc->iv_gen_ops->post)
		error = cc->iv_gen_ops->post(cc, iv_of_dmreq(cc, dmreq), dmreq);

1181 1182 1183
	if (error < 0)
		io->error = -EIO;

1184
	mempool_free(req_of_dmreq(cc, dmreq), cc->req_pool);
M
Milan Broz 已提交
1185

M
Mikulas Patocka 已提交
1186
	if (!atomic_dec_and_test(&ctx->cc_pending))
M
Milan Broz 已提交
1187 1188 1189
		return;

	if (bio_data_dir(io->base_bio) == READ)
1190
		kcryptd_crypt_read_done(io);
M
Milan Broz 已提交
1191
	else
1192
		kcryptd_crypt_write_io_submit(io, 1);
M
Milan Broz 已提交
1193 1194
}

1195
static void kcryptd_crypt(struct work_struct *work)
L
Linus Torvalds 已提交
1196
{
A
Alasdair G Kergon 已提交
1197
	struct dm_crypt_io *io = container_of(work, struct dm_crypt_io, work);
1198

M
Milan Broz 已提交
1199
	if (bio_data_dir(io->base_bio) == READ)
1200
		kcryptd_crypt_read_convert(io);
1201
	else
1202
		kcryptd_crypt_write_convert(io);
M
Milan Broz 已提交
1203 1204
}

1205
static void kcryptd_queue_crypt(struct dm_crypt_io *io)
M
Milan Broz 已提交
1206
{
1207
	struct crypt_config *cc = io->cc;
M
Milan Broz 已提交
1208

1209 1210
	INIT_WORK(&io->work, kcryptd_crypt);
	queue_work(cc->crypt_queue, &io->work);
L
Linus Torvalds 已提交
1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222
}

/*
 * Decode key from its hex representation
 */
static int crypt_decode_key(u8 *key, char *hex, unsigned int size)
{
	char buffer[3];
	unsigned int i;

	buffer[2] = '\0';

1223
	for (i = 0; i < size; i++) {
L
Linus Torvalds 已提交
1224 1225 1226
		buffer[0] = *hex++;
		buffer[1] = *hex++;

M
majianpeng 已提交
1227
		if (kstrtou8(buffer, 16, &key[i]))
L
Linus Torvalds 已提交
1228 1229 1230 1231 1232 1233 1234 1235 1236
			return -EINVAL;
	}

	if (*hex != '\0')
		return -EINVAL;

	return 0;
}

1237
static void crypt_free_tfms(struct crypt_config *cc)
M
Milan Broz 已提交
1238 1239 1240
{
	unsigned i;

1241 1242 1243
	if (!cc->tfms)
		return;

M
Milan Broz 已提交
1244
	for (i = 0; i < cc->tfms_count; i++)
1245 1246 1247
		if (cc->tfms[i] && !IS_ERR(cc->tfms[i])) {
			crypto_free_ablkcipher(cc->tfms[i]);
			cc->tfms[i] = NULL;
M
Milan Broz 已提交
1248
		}
1249 1250 1251

	kfree(cc->tfms);
	cc->tfms = NULL;
M
Milan Broz 已提交
1252 1253
}

1254
static int crypt_alloc_tfms(struct crypt_config *cc, char *ciphermode)
M
Milan Broz 已提交
1255 1256 1257 1258
{
	unsigned i;
	int err;

1259 1260 1261 1262 1263
	cc->tfms = kmalloc(cc->tfms_count * sizeof(struct crypto_ablkcipher *),
			   GFP_KERNEL);
	if (!cc->tfms)
		return -ENOMEM;

M
Milan Broz 已提交
1264
	for (i = 0; i < cc->tfms_count; i++) {
1265 1266 1267 1268
		cc->tfms[i] = crypto_alloc_ablkcipher(ciphermode, 0, 0);
		if (IS_ERR(cc->tfms[i])) {
			err = PTR_ERR(cc->tfms[i]);
			crypt_free_tfms(cc);
M
Milan Broz 已提交
1269 1270 1271 1272 1273 1274 1275
			return err;
		}
	}

	return 0;
}

A
Andi Kleen 已提交
1276 1277
static int crypt_setkey_allcpus(struct crypt_config *cc)
{
1278
	unsigned subkey_size;
1279 1280
	int err = 0, i, r;

1281 1282 1283
	/* Ignore extra keys (which are used for IV etc) */
	subkey_size = (cc->key_size - cc->key_extra_size) >> ilog2(cc->tfms_count);

1284 1285 1286 1287 1288 1289
	for (i = 0; i < cc->tfms_count; i++) {
		r = crypto_ablkcipher_setkey(cc->tfms[i],
					     cc->key + (i * subkey_size),
					     subkey_size);
		if (r)
			err = r;
A
Andi Kleen 已提交
1290 1291 1292 1293 1294
	}

	return err;
}

M
Milan Broz 已提交
1295 1296
static int crypt_set_key(struct crypt_config *cc, char *key)
{
1297 1298 1299
	int r = -EINVAL;
	int key_string_len = strlen(key);

M
Milan Broz 已提交
1300
	/* The key size may not be changed. */
1301 1302
	if (cc->key_size != (key_string_len >> 1))
		goto out;
M
Milan Broz 已提交
1303

M
Milan Broz 已提交
1304 1305
	/* Hyphen (which gives a key_size of zero) means there is no key. */
	if (!cc->key_size && strcmp(key, "-"))
1306
		goto out;
M
Milan Broz 已提交
1307

M
Milan Broz 已提交
1308
	if (cc->key_size && crypt_decode_key(cc->key, key, cc->key_size) < 0)
1309
		goto out;
M
Milan Broz 已提交
1310 1311 1312

	set_bit(DM_CRYPT_KEY_VALID, &cc->flags);

1313 1314 1315 1316 1317 1318 1319
	r = crypt_setkey_allcpus(cc);

out:
	/* Hex key string not needed after here, so wipe it. */
	memset(key, '0', key_string_len);

	return r;
M
Milan Broz 已提交
1320 1321 1322 1323 1324 1325
}

static int crypt_wipe_key(struct crypt_config *cc)
{
	clear_bit(DM_CRYPT_KEY_VALID, &cc->flags);
	memset(&cc->key, 0, cc->key_size * sizeof(u8));
A
Andi Kleen 已提交
1326 1327

	return crypt_setkey_allcpus(cc);
M
Milan Broz 已提交
1328 1329
}

1330 1331 1332
static void crypt_dtr(struct dm_target *ti)
{
	struct crypt_config *cc = ti->private;
A
Andi Kleen 已提交
1333 1334
	struct crypt_cpu *cpu_cc;
	int cpu;
1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345

	ti->private = NULL;

	if (!cc)
		return;

	if (cc->io_queue)
		destroy_workqueue(cc->io_queue);
	if (cc->crypt_queue)
		destroy_workqueue(cc->crypt_queue);

A
Andi Kleen 已提交
1346 1347 1348 1349 1350 1351 1352
	if (cc->cpu)
		for_each_possible_cpu(cpu) {
			cpu_cc = per_cpu_ptr(cc->cpu, cpu);
			if (cpu_cc->req)
				mempool_free(cpu_cc->req, cc->req_pool);
		}

1353 1354
	crypt_free_tfms(cc);

1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370
	if (cc->bs)
		bioset_free(cc->bs);

	if (cc->page_pool)
		mempool_destroy(cc->page_pool);
	if (cc->req_pool)
		mempool_destroy(cc->req_pool);
	if (cc->io_pool)
		mempool_destroy(cc->io_pool);

	if (cc->iv_gen_ops && cc->iv_gen_ops->dtr)
		cc->iv_gen_ops->dtr(cc);

	if (cc->dev)
		dm_put_device(ti, cc->dev);

A
Andi Kleen 已提交
1371 1372 1373
	if (cc->cpu)
		free_percpu(cc->cpu);

M
Milan Broz 已提交
1374
	kzfree(cc->cipher);
1375
	kzfree(cc->cipher_string);
1376 1377 1378 1379 1380

	/* Must zero key material before freeing */
	kzfree(cc);
}

M
Milan Broz 已提交
1381 1382
static int crypt_ctr_cipher(struct dm_target *ti,
			    char *cipher_in, char *key)
L
Linus Torvalds 已提交
1383
{
M
Milan Broz 已提交
1384
	struct crypt_config *cc = ti->private;
M
Milan Broz 已提交
1385
	char *tmp, *cipher, *chainmode, *ivmode, *ivopts, *keycount;
M
Milan Broz 已提交
1386
	char *cipher_api = NULL;
1387
	int ret = -EINVAL;
1388
	char dummy;
L
Linus Torvalds 已提交
1389

M
Milan Broz 已提交
1390 1391 1392
	/* Convert to crypto api definition? */
	if (strchr(cipher_in, '(')) {
		ti->error = "Bad cipher specification";
L
Linus Torvalds 已提交
1393 1394 1395
		return -EINVAL;
	}

1396 1397 1398 1399
	cc->cipher_string = kstrdup(cipher_in, GFP_KERNEL);
	if (!cc->cipher_string)
		goto bad_mem;

M
Milan Broz 已提交
1400 1401
	/*
	 * Legacy dm-crypt cipher specification
M
Milan Broz 已提交
1402
	 * cipher[:keycount]-mode-iv:ivopts
M
Milan Broz 已提交
1403 1404
	 */
	tmp = cipher_in;
M
Milan Broz 已提交
1405 1406 1407 1408 1409
	keycount = strsep(&tmp, "-");
	cipher = strsep(&keycount, ":");

	if (!keycount)
		cc->tfms_count = 1;
1410
	else if (sscanf(keycount, "%u%c", &cc->tfms_count, &dummy) != 1 ||
M
Milan Broz 已提交
1411 1412 1413 1414 1415
		 !is_power_of_2(cc->tfms_count)) {
		ti->error = "Bad cipher key count specification";
		return -EINVAL;
	}
	cc->key_parts = cc->tfms_count;
1416
	cc->key_extra_size = 0;
M
Milan Broz 已提交
1417 1418 1419 1420 1421

	cc->cipher = kstrdup(cipher, GFP_KERNEL);
	if (!cc->cipher)
		goto bad_mem;

L
Linus Torvalds 已提交
1422 1423 1424 1425 1426
	chainmode = strsep(&tmp, "-");
	ivopts = strsep(&tmp, "-");
	ivmode = strsep(&ivopts, ":");

	if (tmp)
M
Milan Broz 已提交
1427
		DMWARN("Ignoring unexpected additional cipher options");
L
Linus Torvalds 已提交
1428

1429
	cc->cpu = __alloc_percpu(sizeof(*(cc->cpu)),
M
Milan Broz 已提交
1430
				 __alignof__(struct crypt_cpu));
A
Andi Kleen 已提交
1431 1432 1433 1434 1435
	if (!cc->cpu) {
		ti->error = "Cannot allocate per cpu state";
		goto bad_mem;
	}

1436 1437 1438 1439
	/*
	 * For compatibility with the original dm-crypt mapping format, if
	 * only the cipher name is supplied, use cbc-plain.
	 */
M
Milan Broz 已提交
1440
	if (!chainmode || (!strcmp(chainmode, "plain") && !ivmode)) {
L
Linus Torvalds 已提交
1441 1442 1443 1444
		chainmode = "cbc";
		ivmode = "plain";
	}

1445
	if (strcmp(chainmode, "ecb") && !ivmode) {
M
Milan Broz 已提交
1446 1447
		ti->error = "IV mechanism required";
		return -EINVAL;
L
Linus Torvalds 已提交
1448 1449
	}

M
Milan Broz 已提交
1450 1451 1452 1453 1454 1455 1456 1457 1458
	cipher_api = kmalloc(CRYPTO_MAX_ALG_NAME, GFP_KERNEL);
	if (!cipher_api)
		goto bad_mem;

	ret = snprintf(cipher_api, CRYPTO_MAX_ALG_NAME,
		       "%s(%s)", chainmode, cipher);
	if (ret < 0) {
		kfree(cipher_api);
		goto bad_mem;
L
Linus Torvalds 已提交
1459 1460
	}

M
Milan Broz 已提交
1461
	/* Allocate cipher */
1462 1463 1464 1465
	ret = crypt_alloc_tfms(cc, cipher_api);
	if (ret < 0) {
		ti->error = "Error allocating crypto tfm";
		goto bad;
L
Linus Torvalds 已提交
1466 1467
	}

M
Milan Broz 已提交
1468
	/* Initialize IV */
A
Andi Kleen 已提交
1469
	cc->iv_size = crypto_ablkcipher_ivsize(any_tfm(cc));
M
Milan Broz 已提交
1470 1471 1472 1473 1474 1475 1476 1477 1478 1479
	if (cc->iv_size)
		/* at least a 64 bit sector number should fit in our buffer */
		cc->iv_size = max(cc->iv_size,
				  (unsigned int)(sizeof(u64) / sizeof(u8)));
	else if (ivmode) {
		DMWARN("Selected cipher does not support IVs");
		ivmode = NULL;
	}

	/* Choose ivmode, see comments at iv code. */
L
Linus Torvalds 已提交
1480 1481 1482 1483
	if (ivmode == NULL)
		cc->iv_gen_ops = NULL;
	else if (strcmp(ivmode, "plain") == 0)
		cc->iv_gen_ops = &crypt_iv_plain_ops;
M
Milan Broz 已提交
1484 1485
	else if (strcmp(ivmode, "plain64") == 0)
		cc->iv_gen_ops = &crypt_iv_plain64_ops;
L
Linus Torvalds 已提交
1486 1487
	else if (strcmp(ivmode, "essiv") == 0)
		cc->iv_gen_ops = &crypt_iv_essiv_ops;
1488 1489
	else if (strcmp(ivmode, "benbi") == 0)
		cc->iv_gen_ops = &crypt_iv_benbi_ops;
L
Ludwig Nussel 已提交
1490 1491
	else if (strcmp(ivmode, "null") == 0)
		cc->iv_gen_ops = &crypt_iv_null_ops;
M
Milan Broz 已提交
1492 1493 1494 1495 1496 1497
	else if (strcmp(ivmode, "lmk") == 0) {
		cc->iv_gen_ops = &crypt_iv_lmk_ops;
		/* Version 2 and 3 is recognised according
		 * to length of provided multi-key string.
		 * If present (version 3), last key is used as IV seed.
		 */
1498
		if (cc->key_size % cc->key_parts) {
M
Milan Broz 已提交
1499
			cc->key_parts++;
1500 1501
			cc->key_extra_size = cc->key_size / cc->key_parts;
		}
M
Milan Broz 已提交
1502
	} else {
M
Milan Broz 已提交
1503
		ret = -EINVAL;
1504
		ti->error = "Invalid IV mode";
1505
		goto bad;
L
Linus Torvalds 已提交
1506 1507
	}

1508 1509 1510 1511 1512 1513 1514
	/* Initialize and set key */
	ret = crypt_set_key(cc, key);
	if (ret < 0) {
		ti->error = "Error decoding and setting key";
		goto bad;
	}

1515 1516 1517 1518 1519 1520 1521 1522
	/* Allocate IV */
	if (cc->iv_gen_ops && cc->iv_gen_ops->ctr) {
		ret = cc->iv_gen_ops->ctr(cc, ti, ivopts);
		if (ret < 0) {
			ti->error = "Error creating IV";
			goto bad;
		}
	}
L
Linus Torvalds 已提交
1523

1524 1525 1526 1527 1528 1529 1530
	/* Initialize IV (set keys for ESSIV etc) */
	if (cc->iv_gen_ops && cc->iv_gen_ops->init) {
		ret = cc->iv_gen_ops->init(cc);
		if (ret < 0) {
			ti->error = "Error initialising IV";
			goto bad;
		}
1531 1532
	}

M
Milan Broz 已提交
1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549
	ret = 0;
bad:
	kfree(cipher_api);
	return ret;

bad_mem:
	ti->error = "Cannot allocate cipher strings";
	return -ENOMEM;
}

/*
 * Construct an encryption mapping:
 * <cipher> <key> <iv_offset> <dev_path> <start>
 */
static int crypt_ctr(struct dm_target *ti, unsigned int argc, char **argv)
{
	struct crypt_config *cc;
1550
	unsigned int key_size, opt_params;
M
Milan Broz 已提交
1551 1552
	unsigned long long tmpll;
	int ret;
1553 1554
	struct dm_arg_set as;
	const char *opt_string;
1555
	char dummy;
1556 1557 1558 1559

	static struct dm_arg _args[] = {
		{0, 1, "Invalid number of feature args"},
	};
M
Milan Broz 已提交
1560

1561
	if (argc < 5) {
M
Milan Broz 已提交
1562 1563
		ti->error = "Not enough arguments";
		return -EINVAL;
L
Linus Torvalds 已提交
1564 1565
	}

M
Milan Broz 已提交
1566 1567 1568 1569 1570 1571 1572
	key_size = strlen(argv[1]) >> 1;

	cc = kzalloc(sizeof(*cc) + key_size * sizeof(u8), GFP_KERNEL);
	if (!cc) {
		ti->error = "Cannot allocate encryption context";
		return -ENOMEM;
	}
M
Milan Broz 已提交
1573
	cc->key_size = key_size;
M
Milan Broz 已提交
1574 1575 1576 1577 1578 1579

	ti->private = cc;
	ret = crypt_ctr_cipher(ti, argv[0], argv[1]);
	if (ret < 0)
		goto bad;

1580
	ret = -ENOMEM;
1581
	cc->io_pool = mempool_create_slab_pool(MIN_IOS, _crypt_io_pool);
L
Linus Torvalds 已提交
1582
	if (!cc->io_pool) {
1583
		ti->error = "Cannot allocate crypt io mempool";
1584
		goto bad;
L
Linus Torvalds 已提交
1585 1586
	}

M
Milan Broz 已提交
1587
	cc->dmreq_start = sizeof(struct ablkcipher_request);
A
Andi Kleen 已提交
1588
	cc->dmreq_start += crypto_ablkcipher_reqsize(any_tfm(cc));
M
Milan Broz 已提交
1589
	cc->dmreq_start = ALIGN(cc->dmreq_start, crypto_tfm_ctx_alignment());
A
Andi Kleen 已提交
1590
	cc->dmreq_start += crypto_ablkcipher_alignmask(any_tfm(cc)) &
M
Milan Broz 已提交
1591
			   ~(crypto_tfm_ctx_alignment() - 1);
M
Milan Broz 已提交
1592 1593 1594 1595 1596

	cc->req_pool = mempool_create_kmalloc_pool(MIN_IOS, cc->dmreq_start +
			sizeof(struct dm_crypt_request) + cc->iv_size);
	if (!cc->req_pool) {
		ti->error = "Cannot allocate crypt request mempool";
1597
		goto bad;
M
Milan Broz 已提交
1598 1599
	}

1600
	cc->page_pool = mempool_create_page_pool(MIN_POOL_PAGES, 0);
L
Linus Torvalds 已提交
1601
	if (!cc->page_pool) {
1602
		ti->error = "Cannot allocate page mempool";
1603
		goto bad;
L
Linus Torvalds 已提交
1604 1605
	}

1606
	cc->bs = bioset_create(MIN_IOS, 0);
M
Milan Broz 已提交
1607 1608
	if (!cc->bs) {
		ti->error = "Cannot allocate crypt bioset";
1609
		goto bad;
M
Milan Broz 已提交
1610 1611
	}

1612
	ret = -EINVAL;
1613
	if (sscanf(argv[2], "%llu%c", &tmpll, &dummy) != 1) {
1614
		ti->error = "Invalid iv_offset sector";
1615
		goto bad;
L
Linus Torvalds 已提交
1616
	}
A
Andrew Morton 已提交
1617
	cc->iv_offset = tmpll;
L
Linus Torvalds 已提交
1618

1619 1620 1621 1622 1623
	if (dm_get_device(ti, argv[3], dm_table_get_mode(ti->table), &cc->dev)) {
		ti->error = "Device lookup failed";
		goto bad;
	}

1624
	if (sscanf(argv[4], "%llu%c", &tmpll, &dummy) != 1) {
1625
		ti->error = "Invalid device sector";
1626
		goto bad;
L
Linus Torvalds 已提交
1627
	}
A
Andrew Morton 已提交
1628
	cc->start = tmpll;
L
Linus Torvalds 已提交
1629

1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645
	argv += 5;
	argc -= 5;

	/* Optional parameters */
	if (argc) {
		as.argc = argc;
		as.argv = argv;

		ret = dm_read_arg_group(_args, &as, &opt_params, &ti->error);
		if (ret)
			goto bad;

		opt_string = dm_shift_arg(&as);

		if (opt_params == 1 && opt_string &&
		    !strcasecmp(opt_string, "allow_discards"))
1646
			ti->num_discard_bios = 1;
1647 1648 1649 1650 1651 1652 1653
		else if (opt_params) {
			ret = -EINVAL;
			ti->error = "Invalid feature arguments";
			goto bad;
		}
	}

1654
	ret = -ENOMEM;
T
Tejun Heo 已提交
1655
	cc->io_queue = alloc_workqueue("kcryptd_io", WQ_MEM_RECLAIM, 1);
M
Milan Broz 已提交
1656 1657
	if (!cc->io_queue) {
		ti->error = "Couldn't create kcryptd io queue";
1658
		goto bad;
M
Milan Broz 已提交
1659 1660
	}

A
Andi Kleen 已提交
1661
	cc->crypt_queue = alloc_workqueue("kcryptd",
T
Tejun Heo 已提交
1662
					  WQ_CPU_INTENSIVE | WQ_MEM_RECLAIM, 1);
M
Milan Broz 已提交
1663
	if (!cc->crypt_queue) {
1664
		ti->error = "Couldn't create kcryptd queue";
1665
		goto bad;
1666 1667
	}

1668
	ti->num_flush_bios = 1;
1669
	ti->discard_zeroes_data_unsupported = true;
1670

L
Linus Torvalds 已提交
1671 1672
	return 0;

1673 1674 1675
bad:
	crypt_dtr(ti);
	return ret;
L
Linus Torvalds 已提交
1676 1677
}

M
Mikulas Patocka 已提交
1678
static int crypt_map(struct dm_target *ti, struct bio *bio)
L
Linus Torvalds 已提交
1679
{
A
Alasdair G Kergon 已提交
1680
	struct dm_crypt_io *io;
1681
	struct crypt_config *cc = ti->private;
M
Mikulas Patocka 已提交
1682

1683 1684 1685 1686 1687 1688
	/*
	 * If bio is REQ_FLUSH or REQ_DISCARD, just bypass crypt queues.
	 * - for REQ_FLUSH device-mapper core ensures that no IO is in-flight
	 * - for REQ_DISCARD caller must use flush if IO ordering matters
	 */
	if (unlikely(bio->bi_rw & (REQ_FLUSH | REQ_DISCARD))) {
M
Mikulas Patocka 已提交
1689
		bio->bi_bdev = cc->dev->bdev;
1690 1691
		if (bio_sectors(bio))
			bio->bi_sector = cc->start + dm_target_offset(ti, bio->bi_sector);
M
Mikulas Patocka 已提交
1692 1693
		return DM_MAPIO_REMAPPED;
	}
L
Linus Torvalds 已提交
1694

1695
	io = crypt_io_alloc(cc, bio, dm_target_offset(ti, bio->bi_sector));
M
Milan Broz 已提交
1696

1697 1698 1699 1700
	if (bio_data_dir(io->base_bio) == READ) {
		if (kcryptd_io_read(io, GFP_NOWAIT))
			kcryptd_queue_io(io);
	} else
M
Milan Broz 已提交
1701
		kcryptd_queue_crypt(io);
L
Linus Torvalds 已提交
1702

1703
	return DM_MAPIO_SUBMITTED;
L
Linus Torvalds 已提交
1704 1705
}

1706 1707
static void crypt_status(struct dm_target *ti, status_type_t type,
			 unsigned status_flags, char *result, unsigned maxlen)
L
Linus Torvalds 已提交
1708
{
M
Milan Broz 已提交
1709
	struct crypt_config *cc = ti->private;
1710
	unsigned i, sz = 0;
L
Linus Torvalds 已提交
1711 1712 1713 1714 1715 1716 1717

	switch (type) {
	case STATUSTYPE_INFO:
		result[0] = '\0';
		break;

	case STATUSTYPE_TABLE:
1718
		DMEMIT("%s ", cc->cipher_string);
L
Linus Torvalds 已提交
1719

1720 1721 1722 1723 1724
		if (cc->key_size > 0)
			for (i = 0; i < cc->key_size; i++)
				DMEMIT("%02x", cc->key[i]);
		else
			DMEMIT("-");
L
Linus Torvalds 已提交
1725

A
Andrew Morton 已提交
1726 1727
		DMEMIT(" %llu %s %llu", (unsigned long long)cc->iv_offset,
				cc->dev->name, (unsigned long long)cc->start);
1728

1729
		if (ti->num_discard_bios)
1730 1731
			DMEMIT(" 1 allow_discards");

L
Linus Torvalds 已提交
1732 1733 1734 1735
		break;
	}
}

M
Milan Broz 已提交
1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768
static void crypt_postsuspend(struct dm_target *ti)
{
	struct crypt_config *cc = ti->private;

	set_bit(DM_CRYPT_SUSPENDED, &cc->flags);
}

static int crypt_preresume(struct dm_target *ti)
{
	struct crypt_config *cc = ti->private;

	if (!test_bit(DM_CRYPT_KEY_VALID, &cc->flags)) {
		DMERR("aborting resume - crypt key is not set.");
		return -EAGAIN;
	}

	return 0;
}

static void crypt_resume(struct dm_target *ti)
{
	struct crypt_config *cc = ti->private;

	clear_bit(DM_CRYPT_SUSPENDED, &cc->flags);
}

/* Message interface
 *	key set <key>
 *	key wipe
 */
static int crypt_message(struct dm_target *ti, unsigned argc, char **argv)
{
	struct crypt_config *cc = ti->private;
1769
	int ret = -EINVAL;
M
Milan Broz 已提交
1770 1771 1772 1773

	if (argc < 2)
		goto error;

1774
	if (!strcasecmp(argv[0], "key")) {
M
Milan Broz 已提交
1775 1776 1777 1778
		if (!test_bit(DM_CRYPT_SUSPENDED, &cc->flags)) {
			DMWARN("not suspended during key manipulation.");
			return -EINVAL;
		}
1779
		if (argc == 3 && !strcasecmp(argv[1], "set")) {
1780 1781 1782 1783 1784 1785 1786
			ret = crypt_set_key(cc, argv[2]);
			if (ret)
				return ret;
			if (cc->iv_gen_ops && cc->iv_gen_ops->init)
				ret = cc->iv_gen_ops->init(cc);
			return ret;
		}
1787
		if (argc == 2 && !strcasecmp(argv[1], "wipe")) {
1788 1789 1790 1791 1792
			if (cc->iv_gen_ops && cc->iv_gen_ops->wipe) {
				ret = cc->iv_gen_ops->wipe(cc);
				if (ret)
					return ret;
			}
M
Milan Broz 已提交
1793
			return crypt_wipe_key(cc);
1794
		}
M
Milan Broz 已提交
1795 1796 1797 1798 1799 1800 1801
	}

error:
	DMWARN("unrecognised message received.");
	return -EINVAL;
}

M
Milan Broz 已提交
1802 1803 1804 1805 1806 1807 1808 1809 1810 1811
static int crypt_merge(struct dm_target *ti, struct bvec_merge_data *bvm,
		       struct bio_vec *biovec, int max_size)
{
	struct crypt_config *cc = ti->private;
	struct request_queue *q = bdev_get_queue(cc->dev->bdev);

	if (!q->merge_bvec_fn)
		return max_size;

	bvm->bi_bdev = cc->dev->bdev;
1812
	bvm->bi_sector = cc->start + dm_target_offset(ti, bvm->bi_sector);
M
Milan Broz 已提交
1813 1814 1815 1816

	return min(max_size, q->merge_bvec_fn(q, bvm, biovec));
}

1817 1818 1819 1820 1821
static int crypt_iterate_devices(struct dm_target *ti,
				 iterate_devices_callout_fn fn, void *data)
{
	struct crypt_config *cc = ti->private;

1822
	return fn(ti, cc->dev, cc->start, ti->len, data);
1823 1824
}

L
Linus Torvalds 已提交
1825 1826
static struct target_type crypt_target = {
	.name   = "crypt",
1827
	.version = {1, 12, 1},
L
Linus Torvalds 已提交
1828 1829 1830 1831 1832
	.module = THIS_MODULE,
	.ctr    = crypt_ctr,
	.dtr    = crypt_dtr,
	.map    = crypt_map,
	.status = crypt_status,
M
Milan Broz 已提交
1833 1834 1835 1836
	.postsuspend = crypt_postsuspend,
	.preresume = crypt_preresume,
	.resume = crypt_resume,
	.message = crypt_message,
M
Milan Broz 已提交
1837
	.merge  = crypt_merge,
1838
	.iterate_devices = crypt_iterate_devices,
L
Linus Torvalds 已提交
1839 1840 1841 1842 1843 1844
};

static int __init dm_crypt_init(void)
{
	int r;

A
Alasdair G Kergon 已提交
1845
	_crypt_io_pool = KMEM_CACHE(dm_crypt_io, 0);
L
Linus Torvalds 已提交
1846 1847 1848 1849 1850
	if (!_crypt_io_pool)
		return -ENOMEM;

	r = dm_register_target(&crypt_target);
	if (r < 0) {
1851
		DMERR("register failed %d", r);
1852
		kmem_cache_destroy(_crypt_io_pool);
L
Linus Torvalds 已提交
1853 1854 1855 1856 1857 1858 1859
	}

	return r;
}

static void __exit dm_crypt_exit(void)
{
1860
	dm_unregister_target(&crypt_target);
L
Linus Torvalds 已提交
1861 1862 1863 1864 1865 1866 1867 1868 1869
	kmem_cache_destroy(_crypt_io_pool);
}

module_init(dm_crypt_init);
module_exit(dm_crypt_exit);

MODULE_AUTHOR("Christophe Saout <christophe@saout.de>");
MODULE_DESCRIPTION(DM_NAME " target for transparent encryption / decryption");
MODULE_LICENSE("GPL");