dm-crypt.c 77.1 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
2
 * Copyright (C) 2003 Jana Saout <jana@saout.de>
L
Linus Torvalds 已提交
3
 * Copyright (C) 2004 Clemens Fruhwirth <clemens@endorphin.org>
4 5
 * Copyright (C) 2006-2017 Red Hat, Inc. All rights reserved.
 * Copyright (C) 2013-2017 Milan Broz <gmazyland@gmail.com>
L
Linus Torvalds 已提交
6 7 8 9
 *
 * This file is released under the GPL.
 */

M
Milan Broz 已提交
10
#include <linux/completion.h>
11
#include <linux/err.h>
L
Linus Torvalds 已提交
12 13 14
#include <linux/module.h>
#include <linux/init.h>
#include <linux/kernel.h>
15
#include <linux/key.h>
L
Linus Torvalds 已提交
16 17 18 19 20 21
#include <linux/bio.h>
#include <linux/blkdev.h>
#include <linux/mempool.h>
#include <linux/slab.h>
#include <linux/crypto.h>
#include <linux/workqueue.h>
22
#include <linux/kthread.h>
23
#include <linux/backing-dev.h>
A
Arun Sharma 已提交
24
#include <linux/atomic.h>
25
#include <linux/scatterlist.h>
M
Mikulas Patocka 已提交
26
#include <linux/rbtree.h>
27
#include <linux/ctype.h>
L
Linus Torvalds 已提交
28
#include <asm/page.h>
29
#include <asm/unaligned.h>
M
Milan Broz 已提交
30 31 32
#include <crypto/hash.h>
#include <crypto/md5.h>
#include <crypto/algapi.h>
H
Herbert Xu 已提交
33
#include <crypto/skcipher.h>
34 35 36
#include <crypto/aead.h>
#include <crypto/authenc.h>
#include <linux/rtnetlink.h> /* for struct rtattr and RTA macros only */
37
#include <keys/user-type.h>
L
Linus Torvalds 已提交
38

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

41
#define DM_MSG_PREFIX "crypt"
L
Linus Torvalds 已提交
42 43 44 45 46

/*
 * context holding the current state of a multi-part conversion
 */
struct convert_context {
M
Milan Broz 已提交
47
	struct completion restart;
L
Linus Torvalds 已提交
48 49
	struct bio *bio_in;
	struct bio *bio_out;
50 51
	struct bvec_iter iter_in;
	struct bvec_iter iter_out;
52
	sector_t cc_sector;
M
Mikulas Patocka 已提交
53
	atomic_t cc_pending;
54 55 56 57 58
	union {
		struct skcipher_request *req;
		struct aead_request *req_aead;
	} r;

L
Linus Torvalds 已提交
59 60
};

61 62 63 64
/*
 * per bio private data
 */
struct dm_crypt_io {
65
	struct crypt_config *cc;
66
	struct bio *base_bio;
67 68
	u8 *integrity_metadata;
	bool integrity_metadata_from_pool;
69 70 71 72
	struct work_struct work;

	struct convert_context ctx;

M
Mikulas Patocka 已提交
73
	atomic_t io_pending;
74
	blk_status_t error;
75
	sector_t sector;
76

M
Mikulas Patocka 已提交
77
	struct rb_node rb_node;
M
Mikulas Patocka 已提交
78
} CRYPTO_MINALIGN_ATTR;
79

80
struct dm_crypt_request {
81
	struct convert_context *ctx;
82 83
	struct scatterlist sg_in[4];
	struct scatterlist sg_out[4];
84
	sector_t iv_sector;
85 86
};

L
Linus Torvalds 已提交
87 88 89 90
struct crypt_config;

struct crypt_iv_operations {
	int (*ctr)(struct crypt_config *cc, struct dm_target *ti,
M
Milan Broz 已提交
91
		   const char *opts);
L
Linus Torvalds 已提交
92
	void (*dtr)(struct crypt_config *cc);
93
	int (*init)(struct crypt_config *cc);
94
	int (*wipe)(struct crypt_config *cc);
95 96 97 98
	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 已提交
99 100
};

101
struct iv_essiv_private {
H
Herbert Xu 已提交
102
	struct crypto_ahash *hash_tfm;
103
	u8 *salt;
104 105 106 107 108 109
};

struct iv_benbi_private {
	int shift;
};

M
Milan Broz 已提交
110 111 112 113 114 115
#define LMK_SEED_SIZE 64 /* hash + 0 */
struct iv_lmk_private {
	struct crypto_shash *hash_tfm;
	u8 *seed;
};

116 117 118 119 120 121 122
#define TCW_WHITENING_SIZE 16
struct iv_tcw_private {
	struct crypto_shash *crc32_tfm;
	u8 *iv_seed;
	u8 *whitening;
};

L
Linus Torvalds 已提交
123 124 125 126
/*
 * Crypt: maps a linear range of a block device
 * and encrypts / decrypts at the same time.
 */
127
enum flags { DM_CRYPT_SUSPENDED, DM_CRYPT_KEY_VALID,
R
Rabin Vincent 已提交
128
	     DM_CRYPT_SAME_CPU, DM_CRYPT_NO_OFFLOAD };
A
Andi Kleen 已提交
129

130 131
enum cipher_flags {
	CRYPT_MODE_INTEGRITY_AEAD,	/* Use authenticated mode for cihper */
132
	CRYPT_IV_LARGE_SECTORS,		/* Calculate IV from sector_size, not 512B sectors */
133 134
};

A
Andi Kleen 已提交
135
/*
136
 * The fields in here must be read only after initialization.
A
Andi Kleen 已提交
137
 */
L
Linus Torvalds 已提交
138 139 140 141 142
struct crypt_config {
	struct dm_dev *dev;
	sector_t start;

	/*
143 144
	 * pool for per bio private data, crypto requests,
	 * encryption requeusts/buffer pages and integrity tags
L
Linus Torvalds 已提交
145
	 */
M
Milan Broz 已提交
146
	mempool_t *req_pool;
L
Linus Torvalds 已提交
147
	mempool_t *page_pool;
148 149 150
	mempool_t *tag_pool;
	unsigned tag_pool_max_sectors;

M
Milan Broz 已提交
151
	struct bio_set *bs;
152
	struct mutex bio_alloc_lock;
L
Linus Torvalds 已提交
153

M
Milan Broz 已提交
154 155
	struct workqueue_struct *io_queue;
	struct workqueue_struct *crypt_queue;
M
Milan Broz 已提交
156

157 158
	struct task_struct *write_thread;
	wait_queue_head_t write_thread_wait;
M
Mikulas Patocka 已提交
159
	struct rb_root write_tree;
160

M
Milan Broz 已提交
161
	char *cipher;
162
	char *cipher_string;
163
	char *cipher_auth;
164
	char *key_string;
M
Milan Broz 已提交
165

166
	const struct crypt_iv_operations *iv_gen_ops;
167
	union {
168 169
		struct iv_essiv_private essiv;
		struct iv_benbi_private benbi;
M
Milan Broz 已提交
170
		struct iv_lmk_private lmk;
171
		struct iv_tcw_private tcw;
172
	} iv_gen_private;
L
Linus Torvalds 已提交
173 174
	sector_t iv_offset;
	unsigned int iv_size;
175 176
	unsigned short int sector_size;
	unsigned char sector_shift;
L
Linus Torvalds 已提交
177

178 179
	/* ESSIV: struct crypto_cipher *essiv_tfm */
	void *iv_private;
180 181 182 183
	union {
		struct crypto_skcipher **tfms;
		struct crypto_aead **tfms_aead;
	} cipher_tfm;
M
Milan Broz 已提交
184
	unsigned tfms_count;
185
	unsigned long cipher_flags;
A
Andi Kleen 已提交
186

M
Milan Broz 已提交
187 188 189
	/*
	 * Layout of each crypto request:
	 *
H
Herbert Xu 已提交
190
	 *   struct skcipher_request
M
Milan Broz 已提交
191 192 193 194 195 196 197 198 199 200 201
	 *      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
Mikulas Patocka 已提交
202 203
	unsigned int per_bio_data_size;

M
Milan Broz 已提交
204
	unsigned long flags;
L
Linus Torvalds 已提交
205
	unsigned int key_size;
206 207
	unsigned int key_parts;      /* independent parts in key buffer */
	unsigned int key_extra_size; /* additional keys length */
208 209 210 211 212 213 214
	unsigned int key_mac_size;   /* MAC key size for authenc(...) */

	unsigned int integrity_tag_size;
	unsigned int integrity_iv_size;
	unsigned int on_disk_tag_size;

	u8 *authenc_key; /* space for keys in authenc() format (if used) */
L
Linus Torvalds 已提交
215 216 217
	u8 key[0];
};

218 219 220
#define MIN_IOS		64
#define MAX_TAG_SIZE	480
#define POOL_ENTRY_SIZE	512
L
Linus Torvalds 已提交
221

A
Alasdair G Kergon 已提交
222
static void clone_init(struct dm_crypt_io *, struct bio *);
223
static void kcryptd_queue_crypt(struct dm_crypt_io *io);
224 225
static struct scatterlist *crypt_get_sg_data(struct crypt_config *cc,
					     struct scatterlist *sg);
O
Olaf Kirch 已提交
226

A
Andi Kleen 已提交
227
/*
228
 * Use this to access cipher attributes that are independent of the key.
A
Andi Kleen 已提交
229
 */
H
Herbert Xu 已提交
230
static struct crypto_skcipher *any_tfm(struct crypt_config *cc)
A
Andi Kleen 已提交
231
{
232 233 234 235 236 237
	return cc->cipher_tfm.tfms[0];
}

static struct crypto_aead *any_tfm_aead(struct crypt_config *cc)
{
	return cc->cipher_tfm.tfms_aead[0];
A
Andi Kleen 已提交
238 239
}

L
Linus Torvalds 已提交
240 241 242
/*
 * Different IV generation algorithms:
 *
243
 * plain: the initial vector is the 32-bit little-endian version of the sector
244
 *        number, padded with zeros if necessary.
L
Linus Torvalds 已提交
245
 *
M
Milan Broz 已提交
246 247 248
 * plain64: the initial vector is the 64-bit little-endian version of the sector
 *        number, padded with zeros if necessary.
 *
249 250 251
 * plain64be: the initial vector is the 64-bit big-endian version of the sector
 *        number, padded with zeros if necessary.
 *
252 253 254
 * 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 已提交
255
 *
256 257 258
 * 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 已提交
259 260 261
 * null: the initial vector is always zero.  Provides compatibility with
 *       obsolete loop_fish2 devices.  Do not use for new devices.
 *
M
Milan Broz 已提交
262 263 264 265 266 267 268 269 270 271 272 273 274 275
 * 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)
 *
276 277
 * tcw:  Compatible implementation of the block chaining mode used
 *       by the TrueCrypt device encryption system (prior to version 4.1).
278
 *       For more info see: https://gitlab.com/cryptsetup/cryptsetup/wikis/TrueCryptOnDiskFormat
279 280 281 282 283 284 285
 *       It operates on full 512 byte sectors and uses CBC
 *       with an IV derived from initial key and the sector number.
 *       In addition, whitening value is applied on every sector, whitening
 *       is calculated from initial key, sector number and mixed using CRC32.
 *       Note that this encryption scheme is vulnerable to watermarking attacks
 *       and should be used for old compatible containers access only.
 *
L
Linus Torvalds 已提交
286 287 288 289
 * plumb: unimplemented, see:
 * http://article.gmane.org/gmane.linux.kernel.device-mapper.dm-crypt/454
 */

290 291
static int crypt_iv_plain_gen(struct crypt_config *cc, u8 *iv,
			      struct dm_crypt_request *dmreq)
L
Linus Torvalds 已提交
292 293
{
	memset(iv, 0, cc->iv_size);
A
Alasdair G Kergon 已提交
294
	*(__le32 *)iv = cpu_to_le32(dmreq->iv_sector & 0xffffffff);
L
Linus Torvalds 已提交
295 296 297 298

	return 0;
}

M
Milan Broz 已提交
299
static int crypt_iv_plain64_gen(struct crypt_config *cc, u8 *iv,
300
				struct dm_crypt_request *dmreq)
M
Milan Broz 已提交
301 302
{
	memset(iv, 0, cc->iv_size);
A
Alasdair G Kergon 已提交
303
	*(__le64 *)iv = cpu_to_le64(dmreq->iv_sector);
M
Milan Broz 已提交
304 305 306 307

	return 0;
}

308 309 310 311 312 313 314 315 316 317
static int crypt_iv_plain64be_gen(struct crypt_config *cc, u8 *iv,
				  struct dm_crypt_request *dmreq)
{
	memset(iv, 0, cc->iv_size);
	/* iv_size is at least of size u64; usually it is 16 bytes */
	*(__be64 *)&iv[cc->iv_size - sizeof(u64)] = cpu_to_be64(dmreq->iv_sector);

	return 0;
}

318 319 320 321
/* 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;
H
Herbert Xu 已提交
322
	AHASH_REQUEST_ON_STACK(req, essiv->hash_tfm);
323
	struct scatterlist sg;
A
Andi Kleen 已提交
324
	struct crypto_cipher *essiv_tfm;
325
	int err;
326 327

	sg_init_one(&sg, cc->key, cc->key_size);
H
Herbert Xu 已提交
328 329 330
	ahash_request_set_tfm(req, essiv->hash_tfm);
	ahash_request_set_callback(req, CRYPTO_TFM_REQ_MAY_SLEEP, NULL, NULL);
	ahash_request_set_crypt(req, &sg, essiv->salt, cc->key_size);
331

H
Herbert Xu 已提交
332 333
	err = crypto_ahash_digest(req);
	ahash_request_zero(req);
334 335 336
	if (err)
		return err;

337
	essiv_tfm = cc->iv_private;
A
Andi Kleen 已提交
338

339
	err = crypto_cipher_setkey(essiv_tfm, essiv->salt,
H
Herbert Xu 已提交
340
			    crypto_ahash_digestsize(essiv->hash_tfm));
341 342
	if (err)
		return err;
A
Andi Kleen 已提交
343 344

	return 0;
345 346
}

347 348 349 350
/* 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;
H
Herbert Xu 已提交
351
	unsigned salt_size = crypto_ahash_digestsize(essiv->hash_tfm);
A
Andi Kleen 已提交
352
	struct crypto_cipher *essiv_tfm;
353
	int r, err = 0;
354 355 356

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

357 358 359 360
	essiv_tfm = cc->iv_private;
	r = crypto_cipher_setkey(essiv_tfm, essiv->salt, salt_size);
	if (r)
		err = r;
A
Andi Kleen 已提交
361 362 363 364

	return err;
}

365 366 367 368 369
/* Allocate the cipher for ESSIV */
static struct crypto_cipher *alloc_essiv_cipher(struct crypt_config *cc,
						struct dm_target *ti,
						const u8 *salt,
						unsigned int saltsize)
A
Andi Kleen 已提交
370 371 372 373 374 375 376 377 378 379 380
{
	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;
	}

381
	if (crypto_cipher_blocksize(essiv_tfm) != cc->iv_size) {
A
Andi Kleen 已提交
382 383 384 385 386 387 388 389 390 391 392 393 394 395
		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;
396 397
}

398 399
static void crypt_iv_essiv_dtr(struct crypt_config *cc)
{
A
Andi Kleen 已提交
400
	struct crypto_cipher *essiv_tfm;
401 402
	struct iv_essiv_private *essiv = &cc->iv_gen_private.essiv;

H
Herbert Xu 已提交
403
	crypto_free_ahash(essiv->hash_tfm);
404 405 406 407
	essiv->hash_tfm = NULL;

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

409
	essiv_tfm = cc->iv_private;
A
Andi Kleen 已提交
410

411 412
	if (essiv_tfm)
		crypto_free_cipher(essiv_tfm);
A
Andi Kleen 已提交
413

414
	cc->iv_private = NULL;
415 416
}

L
Linus Torvalds 已提交
417
static int crypt_iv_essiv_ctr(struct crypt_config *cc, struct dm_target *ti,
M
Milan Broz 已提交
418
			      const char *opts)
L
Linus Torvalds 已提交
419
{
420
	struct crypto_cipher *essiv_tfm = NULL;
H
Herbert Xu 已提交
421
	struct crypto_ahash *hash_tfm = NULL;
422
	u8 *salt = NULL;
423
	int err;
L
Linus Torvalds 已提交
424

425
	if (!opts) {
426
		ti->error = "Digest algorithm missing for ESSIV mode";
L
Linus Torvalds 已提交
427 428 429
		return -EINVAL;
	}

430
	/* Allocate hash algorithm */
H
Herbert Xu 已提交
431
	hash_tfm = crypto_alloc_ahash(opts, 0, CRYPTO_ALG_ASYNC);
432
	if (IS_ERR(hash_tfm)) {
433
		ti->error = "Error initializing ESSIV hash";
434 435
		err = PTR_ERR(hash_tfm);
		goto bad;
L
Linus Torvalds 已提交
436 437
	}

H
Herbert Xu 已提交
438
	salt = kzalloc(crypto_ahash_digestsize(hash_tfm), GFP_KERNEL);
439
	if (!salt) {
440
		ti->error = "Error kmallocing salt storage in ESSIV";
441 442
		err = -ENOMEM;
		goto bad;
L
Linus Torvalds 已提交
443 444
	}

445 446 447
	cc->iv_gen_private.essiv.salt = salt;
	cc->iv_gen_private.essiv.hash_tfm = hash_tfm;

448 449
	essiv_tfm = alloc_essiv_cipher(cc, ti, salt,
				       crypto_ahash_digestsize(hash_tfm));
450 451 452
	if (IS_ERR(essiv_tfm)) {
		crypt_iv_essiv_dtr(cc);
		return PTR_ERR(essiv_tfm);
A
Andi Kleen 已提交
453
	}
454
	cc->iv_private = essiv_tfm;
A
Andi Kleen 已提交
455

L
Linus Torvalds 已提交
456
	return 0;
457 458 459

bad:
	if (hash_tfm && !IS_ERR(hash_tfm))
H
Herbert Xu 已提交
460
		crypto_free_ahash(hash_tfm);
461
	kfree(salt);
462
	return err;
L
Linus Torvalds 已提交
463 464
}

465 466
static int crypt_iv_essiv_gen(struct crypt_config *cc, u8 *iv,
			      struct dm_crypt_request *dmreq)
L
Linus Torvalds 已提交
467
{
468
	struct crypto_cipher *essiv_tfm = cc->iv_private;
A
Andi Kleen 已提交
469

L
Linus Torvalds 已提交
470
	memset(iv, 0, cc->iv_size);
A
Alasdair G Kergon 已提交
471
	*(__le64 *)iv = cpu_to_le64(dmreq->iv_sector);
A
Andi Kleen 已提交
472 473
	crypto_cipher_encrypt_one(essiv_tfm, iv, iv);

L
Linus Torvalds 已提交
474 475 476
	return 0;
}

477 478 479
static int crypt_iv_benbi_ctr(struct crypt_config *cc, struct dm_target *ti,
			      const char *opts)
{
H
Herbert Xu 已提交
480
	unsigned bs = crypto_skcipher_blocksize(any_tfm(cc));
481
	int log = ilog2(bs);
482 483 484 485 486 487 488 489 490 491 492 493 494 495

	/* 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;
	}

496
	cc->iv_gen_private.benbi.shift = 9 - log;
497 498 499 500 501 502 503 504

	return 0;
}

static void crypt_iv_benbi_dtr(struct crypt_config *cc)
{
}

505 506
static int crypt_iv_benbi_gen(struct crypt_config *cc, u8 *iv,
			      struct dm_crypt_request *dmreq)
507
{
508 509
	__be64 val;

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

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

L
Linus Torvalds 已提交
515 516 517
	return 0;
}

518 519
static int crypt_iv_null_gen(struct crypt_config *cc, u8 *iv,
			     struct dm_crypt_request *dmreq)
L
Ludwig Nussel 已提交
520 521 522 523 524 525
{
	memset(iv, 0, cc->iv_size);

	return 0;
}

M
Milan Broz 已提交
526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542
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;

543 544 545 546 547
	if (cc->sector_size != (1 << SECTOR_SHIFT)) {
		ti->error = "Unsupported sector size for LMK";
		return -EINVAL;
	}

M
Milan Broz 已提交
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 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597
	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;
598
	SHASH_DESC_ON_STACK(desc, lmk->hash_tfm);
M
Milan Broz 已提交
599
	struct md5_state md5state;
600
	__le32 buf[4];
M
Milan Broz 已提交
601 602
	int i, r;

603 604
	desc->tfm = lmk->hash_tfm;
	desc->flags = CRYPTO_TFM_REQ_MAY_SLEEP;
M
Milan Broz 已提交
605

606
	r = crypto_shash_init(desc);
M
Milan Broz 已提交
607 608 609 610
	if (r)
		return r;

	if (lmk->seed) {
611
		r = crypto_shash_update(desc, lmk->seed, LMK_SEED_SIZE);
M
Milan Broz 已提交
612 613 614 615 616
		if (r)
			return r;
	}

	/* Sector is always 512B, block size 16, add data of blocks 1-31 */
617
	r = crypto_shash_update(desc, data + 16, 16 * 31);
M
Milan Broz 已提交
618 619 620 621 622 623 624 625
	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;
626
	r = crypto_shash_update(desc, (u8 *)buf, sizeof(buf));
M
Milan Broz 已提交
627 628 629 630
	if (r)
		return r;

	/* No MD5 padding here */
631
	r = crypto_shash_export(desc, &md5state);
M
Milan Broz 已提交
632 633 634 635 636 637 638 639 640 641 642 643 644
	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)
{
645
	struct scatterlist *sg;
M
Milan Broz 已提交
646 647 648 649
	u8 *src;
	int r = 0;

	if (bio_data_dir(dmreq->ctx->bio_in) == WRITE) {
650 651 652
		sg = crypt_get_sg_data(cc, dmreq->sg_in);
		src = kmap_atomic(sg_page(sg));
		r = crypt_iv_lmk_one(cc, iv, dmreq, src + sg->offset);
653
		kunmap_atomic(src);
M
Milan Broz 已提交
654 655 656 657 658 659 660 661 662
	} 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)
{
663
	struct scatterlist *sg;
M
Milan Broz 已提交
664 665 666 667 668 669
	u8 *dst;
	int r;

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

670 671 672
	sg = crypt_get_sg_data(cc, dmreq->sg_out);
	dst = kmap_atomic(sg_page(sg));
	r = crypt_iv_lmk_one(cc, iv, dmreq, dst + sg->offset);
M
Milan Broz 已提交
673 674 675

	/* Tweak the first block of plaintext sector */
	if (!r)
676
		crypto_xor(dst + sg->offset, iv, cc->iv_size);
M
Milan Broz 已提交
677

678
	kunmap_atomic(dst);
M
Milan Broz 已提交
679 680 681
	return r;
}

682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700
static void crypt_iv_tcw_dtr(struct crypt_config *cc)
{
	struct iv_tcw_private *tcw = &cc->iv_gen_private.tcw;

	kzfree(tcw->iv_seed);
	tcw->iv_seed = NULL;
	kzfree(tcw->whitening);
	tcw->whitening = NULL;

	if (tcw->crc32_tfm && !IS_ERR(tcw->crc32_tfm))
		crypto_free_shash(tcw->crc32_tfm);
	tcw->crc32_tfm = NULL;
}

static int crypt_iv_tcw_ctr(struct crypt_config *cc, struct dm_target *ti,
			    const char *opts)
{
	struct iv_tcw_private *tcw = &cc->iv_gen_private.tcw;

701 702 703 704 705
	if (cc->sector_size != (1 << SECTOR_SHIFT)) {
		ti->error = "Unsupported sector size for TCW";
		return -EINVAL;
	}

706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754
	if (cc->key_size <= (cc->iv_size + TCW_WHITENING_SIZE)) {
		ti->error = "Wrong key size for TCW";
		return -EINVAL;
	}

	tcw->crc32_tfm = crypto_alloc_shash("crc32", 0, 0);
	if (IS_ERR(tcw->crc32_tfm)) {
		ti->error = "Error initializing CRC32 in TCW";
		return PTR_ERR(tcw->crc32_tfm);
	}

	tcw->iv_seed = kzalloc(cc->iv_size, GFP_KERNEL);
	tcw->whitening = kzalloc(TCW_WHITENING_SIZE, GFP_KERNEL);
	if (!tcw->iv_seed || !tcw->whitening) {
		crypt_iv_tcw_dtr(cc);
		ti->error = "Error allocating seed storage in TCW";
		return -ENOMEM;
	}

	return 0;
}

static int crypt_iv_tcw_init(struct crypt_config *cc)
{
	struct iv_tcw_private *tcw = &cc->iv_gen_private.tcw;
	int key_offset = cc->key_size - cc->iv_size - TCW_WHITENING_SIZE;

	memcpy(tcw->iv_seed, &cc->key[key_offset], cc->iv_size);
	memcpy(tcw->whitening, &cc->key[key_offset + cc->iv_size],
	       TCW_WHITENING_SIZE);

	return 0;
}

static int crypt_iv_tcw_wipe(struct crypt_config *cc)
{
	struct iv_tcw_private *tcw = &cc->iv_gen_private.tcw;

	memset(tcw->iv_seed, 0, cc->iv_size);
	memset(tcw->whitening, 0, TCW_WHITENING_SIZE);

	return 0;
}

static int crypt_iv_tcw_whitening(struct crypt_config *cc,
				  struct dm_crypt_request *dmreq,
				  u8 *data)
{
	struct iv_tcw_private *tcw = &cc->iv_gen_private.tcw;
755
	__le64 sector = cpu_to_le64(dmreq->iv_sector);
756
	u8 buf[TCW_WHITENING_SIZE];
757
	SHASH_DESC_ON_STACK(desc, tcw->crc32_tfm);
758 759 760
	int i, r;

	/* xor whitening with sector number */
761 762
	crypto_xor_cpy(buf, tcw->whitening, (u8 *)&sector, 8);
	crypto_xor_cpy(&buf[8], tcw->whitening + 8, (u8 *)&sector, 8);
763 764

	/* calculate crc32 for every 32bit part and xor it */
765 766
	desc->tfm = tcw->crc32_tfm;
	desc->flags = CRYPTO_TFM_REQ_MAY_SLEEP;
767
	for (i = 0; i < 4; i++) {
768
		r = crypto_shash_init(desc);
769 770
		if (r)
			goto out;
771
		r = crypto_shash_update(desc, &buf[i * 4], 4);
772 773
		if (r)
			goto out;
774
		r = crypto_shash_final(desc, &buf[i * 4]);
775 776 777 778 779 780 781 782 783 784
		if (r)
			goto out;
	}
	crypto_xor(&buf[0], &buf[12], 4);
	crypto_xor(&buf[4], &buf[8], 4);

	/* apply whitening (8 bytes) to whole sector */
	for (i = 0; i < ((1 << SECTOR_SHIFT) / 8); i++)
		crypto_xor(data + i * 8, buf, 8);
out:
785
	memzero_explicit(buf, sizeof(buf));
786 787 788 789 790 791
	return r;
}

static int crypt_iv_tcw_gen(struct crypt_config *cc, u8 *iv,
			    struct dm_crypt_request *dmreq)
{
792
	struct scatterlist *sg;
793
	struct iv_tcw_private *tcw = &cc->iv_gen_private.tcw;
794
	__le64 sector = cpu_to_le64(dmreq->iv_sector);
795 796 797 798 799
	u8 *src;
	int r = 0;

	/* Remove whitening from ciphertext */
	if (bio_data_dir(dmreq->ctx->bio_in) != WRITE) {
800 801 802
		sg = crypt_get_sg_data(cc, dmreq->sg_in);
		src = kmap_atomic(sg_page(sg));
		r = crypt_iv_tcw_whitening(cc, dmreq, src + sg->offset);
803 804 805 806
		kunmap_atomic(src);
	}

	/* Calculate IV */
807
	crypto_xor_cpy(iv, tcw->iv_seed, (u8 *)&sector, 8);
808
	if (cc->iv_size > 8)
809 810
		crypto_xor_cpy(&iv[8], tcw->iv_seed + 8, (u8 *)&sector,
			       cc->iv_size - 8);
811 812 813 814 815 816 817

	return r;
}

static int crypt_iv_tcw_post(struct crypt_config *cc, u8 *iv,
			     struct dm_crypt_request *dmreq)
{
818
	struct scatterlist *sg;
819 820 821 822 823 824 825
	u8 *dst;
	int r;

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

	/* Apply whitening on ciphertext */
826 827 828
	sg = crypt_get_sg_data(cc, dmreq->sg_out);
	dst = kmap_atomic(sg_page(sg));
	r = crypt_iv_tcw_whitening(cc, dmreq, dst + sg->offset);
829 830 831 832 833
	kunmap_atomic(dst);

	return r;
}

834 835 836 837 838 839 840 841
static int crypt_iv_random_gen(struct crypt_config *cc, u8 *iv,
				struct dm_crypt_request *dmreq)
{
	/* Used only for writes, there must be an additional space to store IV */
	get_random_bytes(iv, cc->iv_size);
	return 0;
}

842
static const struct crypt_iv_operations crypt_iv_plain_ops = {
L
Linus Torvalds 已提交
843 844 845
	.generator = crypt_iv_plain_gen
};

846
static const struct crypt_iv_operations crypt_iv_plain64_ops = {
M
Milan Broz 已提交
847 848 849
	.generator = crypt_iv_plain64_gen
};

850 851 852 853
static const struct crypt_iv_operations crypt_iv_plain64be_ops = {
	.generator = crypt_iv_plain64be_gen
};

854
static const struct crypt_iv_operations crypt_iv_essiv_ops = {
L
Linus Torvalds 已提交
855 856
	.ctr       = crypt_iv_essiv_ctr,
	.dtr       = crypt_iv_essiv_dtr,
857
	.init      = crypt_iv_essiv_init,
858
	.wipe      = crypt_iv_essiv_wipe,
L
Linus Torvalds 已提交
859 860 861
	.generator = crypt_iv_essiv_gen
};

862
static const struct crypt_iv_operations crypt_iv_benbi_ops = {
863 864 865 866
	.ctr	   = crypt_iv_benbi_ctr,
	.dtr	   = crypt_iv_benbi_dtr,
	.generator = crypt_iv_benbi_gen
};
L
Linus Torvalds 已提交
867

868
static const struct crypt_iv_operations crypt_iv_null_ops = {
L
Ludwig Nussel 已提交
869 870 871
	.generator = crypt_iv_null_gen
};

872
static const struct crypt_iv_operations crypt_iv_lmk_ops = {
M
Milan Broz 已提交
873 874 875 876 877 878 879 880
	.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
};

881
static const struct crypt_iv_operations crypt_iv_tcw_ops = {
882 883 884 885 886 887 888 889
	.ctr	   = crypt_iv_tcw_ctr,
	.dtr	   = crypt_iv_tcw_dtr,
	.init	   = crypt_iv_tcw_init,
	.wipe	   = crypt_iv_tcw_wipe,
	.generator = crypt_iv_tcw_gen,
	.post	   = crypt_iv_tcw_post
};

890 891 892 893 894 895 896 897 898 899 900 901 902 903
static struct crypt_iv_operations crypt_iv_random_ops = {
	.generator = crypt_iv_random_gen
};

/*
 * Integrity extensions
 */
static bool crypt_integrity_aead(struct crypt_config *cc)
{
	return test_bit(CRYPT_MODE_INTEGRITY_AEAD, &cc->cipher_flags);
}

static bool crypt_integrity_hmac(struct crypt_config *cc)
{
904
	return crypt_integrity_aead(cc) && cc->key_mac_size;
905 906 907 908 909 910
}

/* Get sg containing data */
static struct scatterlist *crypt_get_sg_data(struct crypt_config *cc,
					     struct scatterlist *sg)
{
911
	if (unlikely(crypt_integrity_aead(cc)))
912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953
		return &sg[2];

	return sg;
}

static int dm_crypt_integrity_io_alloc(struct dm_crypt_io *io, struct bio *bio)
{
	struct bio_integrity_payload *bip;
	unsigned int tag_len;
	int ret;

	if (!bio_sectors(bio) || !io->cc->on_disk_tag_size)
		return 0;

	bip = bio_integrity_alloc(bio, GFP_NOIO, 1);
	if (IS_ERR(bip))
		return PTR_ERR(bip);

	tag_len = io->cc->on_disk_tag_size * bio_sectors(bio);

	bip->bip_iter.bi_size = tag_len;
	bip->bip_iter.bi_sector = io->cc->start + io->sector;

	ret = bio_integrity_add_page(bio, virt_to_page(io->integrity_metadata),
				     tag_len, offset_in_page(io->integrity_metadata));
	if (unlikely(ret != tag_len))
		return -ENOMEM;

	return 0;
}

static int crypt_integrity_ctr(struct crypt_config *cc, struct dm_target *ti)
{
#ifdef CONFIG_BLK_DEV_INTEGRITY
	struct blk_integrity *bi = blk_get_integrity(cc->dev->bdev->bd_disk);

	/* From now we require underlying device with our integrity profile */
	if (!bi || strcasecmp(bi->profile->name, "DM-DIF-EXT-TAG")) {
		ti->error = "Integrity profile not supported.";
		return -EINVAL;
	}

954 955
	if (bi->tag_size != cc->on_disk_tag_size ||
	    bi->tuple_size != cc->on_disk_tag_size) {
956 957 958
		ti->error = "Integrity profile tag size mismatch.";
		return -EINVAL;
	}
959 960 961 962
	if (1 << bi->interval_exp != cc->sector_size) {
		ti->error = "Integrity profile sector size mismatch.";
		return -EINVAL;
	}
963

964
	if (crypt_integrity_aead(cc)) {
965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988
		cc->integrity_tag_size = cc->on_disk_tag_size - cc->integrity_iv_size;
		DMINFO("Integrity AEAD, tag size %u, IV size %u.",
		       cc->integrity_tag_size, cc->integrity_iv_size);

		if (crypto_aead_setauthsize(any_tfm_aead(cc), cc->integrity_tag_size)) {
			ti->error = "Integrity AEAD auth tag size is not supported.";
			return -EINVAL;
		}
	} else if (cc->integrity_iv_size)
		DMINFO("Additional per-sector space %u bytes for IV.",
		       cc->integrity_iv_size);

	if ((cc->integrity_tag_size + cc->integrity_iv_size) != bi->tag_size) {
		ti->error = "Not enough space for integrity tag in the profile.";
		return -EINVAL;
	}

	return 0;
#else
	ti->error = "Integrity profile not supported.";
	return -EINVAL;
#endif
}

M
Milan Broz 已提交
989 990 991
static void crypt_convert_init(struct crypt_config *cc,
			       struct convert_context *ctx,
			       struct bio *bio_out, struct bio *bio_in,
992
			       sector_t sector)
L
Linus Torvalds 已提交
993 994 995
{
	ctx->bio_in = bio_in;
	ctx->bio_out = bio_out;
996 997 998 999
	if (bio_in)
		ctx->iter_in = bio_in->bi_iter;
	if (bio_out)
		ctx->iter_out = bio_out->bi_iter;
1000
	ctx->cc_sector = sector + cc->iv_offset;
M
Milan Broz 已提交
1001
	init_completion(&ctx->restart);
L
Linus Torvalds 已提交
1002 1003
}

1004
static struct dm_crypt_request *dmreq_of_req(struct crypt_config *cc,
1005
					     void *req)
1006 1007 1008 1009
{
	return (struct dm_crypt_request *)((char *)req + cc->dmreq_start);
}

1010
static void *req_of_dmreq(struct crypt_config *cc, struct dm_crypt_request *dmreq)
1011
{
1012
	return (void *)((char *)dmreq - cc->dmreq_start);
1013 1014
}

1015 1016 1017
static u8 *iv_of_dmreq(struct crypt_config *cc,
		       struct dm_crypt_request *dmreq)
{
1018
	if (crypt_integrity_aead(cc))
1019 1020 1021 1022 1023
		return (u8 *)ALIGN((unsigned long)(dmreq + 1),
			crypto_aead_alignmask(any_tfm_aead(cc)) + 1);
	else
		return (u8 *)ALIGN((unsigned long)(dmreq + 1),
			crypto_skcipher_alignmask(any_tfm(cc)) + 1);
1024 1025
}

1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066
static u8 *org_iv_of_dmreq(struct crypt_config *cc,
		       struct dm_crypt_request *dmreq)
{
	return iv_of_dmreq(cc, dmreq) + cc->iv_size;
}

static uint64_t *org_sector_of_dmreq(struct crypt_config *cc,
		       struct dm_crypt_request *dmreq)
{
	u8 *ptr = iv_of_dmreq(cc, dmreq) + cc->iv_size + cc->iv_size;
	return (uint64_t*) ptr;
}

static unsigned int *org_tag_of_dmreq(struct crypt_config *cc,
		       struct dm_crypt_request *dmreq)
{
	u8 *ptr = iv_of_dmreq(cc, dmreq) + cc->iv_size +
		  cc->iv_size + sizeof(uint64_t);
	return (unsigned int*)ptr;
}

static void *tag_from_dmreq(struct crypt_config *cc,
				struct dm_crypt_request *dmreq)
{
	struct convert_context *ctx = dmreq->ctx;
	struct dm_crypt_io *io = container_of(ctx, struct dm_crypt_io, ctx);

	return &io->integrity_metadata[*org_tag_of_dmreq(cc, dmreq) *
		cc->on_disk_tag_size];
}

static void *iv_tag_from_dmreq(struct crypt_config *cc,
			       struct dm_crypt_request *dmreq)
{
	return tag_from_dmreq(cc, dmreq) + cc->integrity_tag_size;
}

static int crypt_convert_block_aead(struct crypt_config *cc,
				     struct convert_context *ctx,
				     struct aead_request *req,
				     unsigned int tag_offset)
1067
{
1068 1069
	struct bio_vec bv_in = bio_iter_iovec(ctx->bio_in, ctx->iter_in);
	struct bio_vec bv_out = bio_iter_iovec(ctx->bio_out, ctx->iter_out);
M
Milan Broz 已提交
1070
	struct dm_crypt_request *dmreq;
1071 1072 1073 1074 1075
	u8 *iv, *org_iv, *tag_iv, *tag;
	uint64_t *sector;
	int r = 0;

	BUG_ON(cc->integrity_iv_size && cc->integrity_iv_size != cc->iv_size);
M
Milan Broz 已提交
1076

1077 1078 1079
	/* Reject unexpected unaligned bio. */
	if (unlikely(bv_in.bv_offset & (cc->sector_size - 1)))
		return -EIO;
M
Milan Broz 已提交
1080

1081
	dmreq = dmreq_of_req(cc, req);
1082
	dmreq->iv_sector = ctx->cc_sector;
1083
	if (test_bit(CRYPT_IV_LARGE_SECTORS, &cc->cipher_flags))
1084
		dmreq->iv_sector >>= cc->sector_shift;
1085 1086 1087 1088 1089 1090 1091
	dmreq->ctx = ctx;

	*org_tag_of_dmreq(cc, dmreq) = tag_offset;

	sector = org_sector_of_dmreq(cc, dmreq);
	*sector = cpu_to_le64(ctx->cc_sector - cc->iv_offset);

1092
	iv = iv_of_dmreq(cc, dmreq);
1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104
	org_iv = org_iv_of_dmreq(cc, dmreq);
	tag = tag_from_dmreq(cc, dmreq);
	tag_iv = iv_tag_from_dmreq(cc, dmreq);

	/* AEAD request:
	 *  |----- AAD -------|------ DATA -------|-- AUTH TAG --|
	 *  | (authenticated) | (auth+encryption) |              |
	 *  | sector_LE |  IV |  sector in/out    |  tag in/out  |
	 */
	sg_init_table(dmreq->sg_in, 4);
	sg_set_buf(&dmreq->sg_in[0], sector, sizeof(uint64_t));
	sg_set_buf(&dmreq->sg_in[1], org_iv, cc->iv_size);
1105
	sg_set_page(&dmreq->sg_in[2], bv_in.bv_page, cc->sector_size, bv_in.bv_offset);
1106 1107 1108 1109 1110
	sg_set_buf(&dmreq->sg_in[3], tag, cc->integrity_tag_size);

	sg_init_table(dmreq->sg_out, 4);
	sg_set_buf(&dmreq->sg_out[0], sector, sizeof(uint64_t));
	sg_set_buf(&dmreq->sg_out[1], org_iv, cc->iv_size);
1111
	sg_set_page(&dmreq->sg_out[2], bv_out.bv_page, cc->sector_size, bv_out.bv_offset);
1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132
	sg_set_buf(&dmreq->sg_out[3], tag, cc->integrity_tag_size);

	if (cc->iv_gen_ops) {
		/* For READs use IV stored in integrity metadata */
		if (cc->integrity_iv_size && bio_data_dir(ctx->bio_in) != WRITE) {
			memcpy(org_iv, tag_iv, cc->iv_size);
		} else {
			r = cc->iv_gen_ops->generator(cc, org_iv, dmreq);
			if (r < 0)
				return r;
			/* Store generated IV in integrity metadata */
			if (cc->integrity_iv_size)
				memcpy(tag_iv, org_iv, cc->iv_size);
		}
		/* Working copy of IV, to be modified in crypto API */
		memcpy(iv, org_iv, cc->iv_size);
	}

	aead_request_set_ad(req, sizeof(uint64_t) + cc->iv_size);
	if (bio_data_dir(ctx->bio_in) == WRITE) {
		aead_request_set_crypt(req, dmreq->sg_in, dmreq->sg_out,
1133
				       cc->sector_size, iv);
1134 1135 1136 1137 1138 1139
		r = crypto_aead_encrypt(req);
		if (cc->integrity_tag_size + cc->integrity_iv_size != cc->on_disk_tag_size)
			memset(tag + cc->integrity_tag_size + cc->integrity_iv_size, 0,
			       cc->on_disk_tag_size - (cc->integrity_tag_size + cc->integrity_iv_size));
	} else {
		aead_request_set_crypt(req, dmreq->sg_in, dmreq->sg_out,
1140
				       cc->sector_size + cc->integrity_tag_size, iv);
1141 1142 1143 1144 1145 1146 1147 1148 1149 1150
		r = crypto_aead_decrypt(req);
	}

	if (r == -EBADMSG)
		DMERR_LIMIT("INTEGRITY AEAD ERROR, sector %llu",
			    (unsigned long long)le64_to_cpu(*sector));

	if (!r && cc->iv_gen_ops && cc->iv_gen_ops->post)
		r = cc->iv_gen_ops->post(cc, org_iv, dmreq);

1151 1152
	bio_advance_iter(ctx->bio_in, &ctx->iter_in, cc->sector_size);
	bio_advance_iter(ctx->bio_out, &ctx->iter_out, cc->sector_size);
1153

1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168
	return r;
}

static int crypt_convert_block_skcipher(struct crypt_config *cc,
					struct convert_context *ctx,
					struct skcipher_request *req,
					unsigned int tag_offset)
{
	struct bio_vec bv_in = bio_iter_iovec(ctx->bio_in, ctx->iter_in);
	struct bio_vec bv_out = bio_iter_iovec(ctx->bio_out, ctx->iter_out);
	struct scatterlist *sg_in, *sg_out;
	struct dm_crypt_request *dmreq;
	u8 *iv, *org_iv, *tag_iv;
	uint64_t *sector;
	int r = 0;
1169

1170 1171 1172 1173
	/* Reject unexpected unaligned bio. */
	if (unlikely(bv_in.bv_offset & (cc->sector_size - 1)))
		return -EIO;

1174
	dmreq = dmreq_of_req(cc, req);
1175
	dmreq->iv_sector = ctx->cc_sector;
1176
	if (test_bit(CRYPT_IV_LARGE_SECTORS, &cc->cipher_flags))
1177
		dmreq->iv_sector >>= cc->sector_shift;
1178
	dmreq->ctx = ctx;
1179

1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191
	*org_tag_of_dmreq(cc, dmreq) = tag_offset;

	iv = iv_of_dmreq(cc, dmreq);
	org_iv = org_iv_of_dmreq(cc, dmreq);
	tag_iv = iv_tag_from_dmreq(cc, dmreq);

	sector = org_sector_of_dmreq(cc, dmreq);
	*sector = cpu_to_le64(ctx->cc_sector - cc->iv_offset);

	/* For skcipher we use only the first sg item */
	sg_in  = &dmreq->sg_in[0];
	sg_out = &dmreq->sg_out[0];
1192

1193
	sg_init_table(sg_in, 1);
1194
	sg_set_page(sg_in, bv_in.bv_page, cc->sector_size, bv_in.bv_offset);
1195 1196

	sg_init_table(sg_out, 1);
1197
	sg_set_page(sg_out, bv_out.bv_page, cc->sector_size, bv_out.bv_offset);
1198

M
Milan Broz 已提交
1199
	if (cc->iv_gen_ops) {
1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212
		/* For READs use IV stored in integrity metadata */
		if (cc->integrity_iv_size && bio_data_dir(ctx->bio_in) != WRITE) {
			memcpy(org_iv, tag_iv, cc->integrity_iv_size);
		} else {
			r = cc->iv_gen_ops->generator(cc, org_iv, dmreq);
			if (r < 0)
				return r;
			/* Store generated IV in integrity metadata */
			if (cc->integrity_iv_size)
				memcpy(tag_iv, org_iv, cc->integrity_iv_size);
		}
		/* Working copy of IV, to be modified in crypto API */
		memcpy(iv, org_iv, cc->iv_size);
M
Milan Broz 已提交
1213 1214
	}

1215
	skcipher_request_set_crypt(req, sg_in, sg_out, cc->sector_size, iv);
M
Milan Broz 已提交
1216 1217

	if (bio_data_dir(ctx->bio_in) == WRITE)
H
Herbert Xu 已提交
1218
		r = crypto_skcipher_encrypt(req);
M
Milan Broz 已提交
1219
	else
H
Herbert Xu 已提交
1220
		r = crypto_skcipher_decrypt(req);
M
Milan Broz 已提交
1221

1222
	if (!r && cc->iv_gen_ops && cc->iv_gen_ops->post)
1223 1224
		r = cc->iv_gen_ops->post(cc, org_iv, dmreq);

1225 1226
	bio_advance_iter(ctx->bio_in, &ctx->iter_in, cc->sector_size);
	bio_advance_iter(ctx->bio_out, &ctx->iter_out, cc->sector_size);
1227

M
Milan Broz 已提交
1228
	return r;
1229 1230
}

M
Milan Broz 已提交
1231 1232
static void kcryptd_async_done(struct crypto_async_request *async_req,
			       int error);
A
Andi Kleen 已提交
1233

1234 1235
static void crypt_alloc_req_skcipher(struct crypt_config *cc,
				     struct convert_context *ctx)
M
Milan Broz 已提交
1236
{
1237
	unsigned key_index = ctx->cc_sector & (cc->tfms_count - 1);
A
Andi Kleen 已提交
1238

1239 1240
	if (!ctx->r.req)
		ctx->r.req = mempool_alloc(cc->req_pool, GFP_NOIO);
A
Andi Kleen 已提交
1241

1242
	skcipher_request_set_tfm(ctx->r.req, cc->cipher_tfm.tfms[key_index]);
1243 1244 1245 1246 1247

	/*
	 * Use REQ_MAY_BACKLOG so a cipher driver internally backlogs
	 * requests if driver request queue is full.
	 */
1248
	skcipher_request_set_callback(ctx->r.req,
A
Andi Kleen 已提交
1249
	    CRYPTO_TFM_REQ_MAY_BACKLOG | CRYPTO_TFM_REQ_MAY_SLEEP,
1250
	    kcryptd_async_done, dmreq_of_req(cc, ctx->r.req));
M
Milan Broz 已提交
1251 1252
}

1253 1254 1255 1256 1257
static void crypt_alloc_req_aead(struct crypt_config *cc,
				 struct convert_context *ctx)
{
	if (!ctx->r.req_aead)
		ctx->r.req_aead = mempool_alloc(cc->req_pool, GFP_NOIO);
A
Andi Kleen 已提交
1258

1259
	aead_request_set_tfm(ctx->r.req_aead, cc->cipher_tfm.tfms_aead[0]);
1260 1261 1262 1263 1264

	/*
	 * Use REQ_MAY_BACKLOG so a cipher driver internally backlogs
	 * requests if driver request queue is full.
	 */
1265
	aead_request_set_callback(ctx->r.req_aead,
A
Andi Kleen 已提交
1266
	    CRYPTO_TFM_REQ_MAY_BACKLOG | CRYPTO_TFM_REQ_MAY_SLEEP,
1267 1268 1269 1270 1271 1272
	    kcryptd_async_done, dmreq_of_req(cc, ctx->r.req_aead));
}

static void crypt_alloc_req(struct crypt_config *cc,
			    struct convert_context *ctx)
{
1273
	if (crypt_integrity_aead(cc))
1274 1275 1276
		crypt_alloc_req_aead(cc, ctx);
	else
		crypt_alloc_req_skcipher(cc, ctx);
M
Milan Broz 已提交
1277 1278
}

1279 1280
static void crypt_free_req_skcipher(struct crypt_config *cc,
				    struct skcipher_request *req, struct bio *base_bio)
M
Mikulas Patocka 已提交
1281 1282 1283
{
	struct dm_crypt_io *io = dm_per_bio_data(base_bio, cc->per_bio_data_size);

H
Herbert Xu 已提交
1284
	if ((struct skcipher_request *)(io + 1) != req)
M
Mikulas Patocka 已提交
1285 1286 1287
		mempool_free(req, cc->req_pool);
}

1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298
static void crypt_free_req_aead(struct crypt_config *cc,
				struct aead_request *req, struct bio *base_bio)
{
	struct dm_crypt_io *io = dm_per_bio_data(base_bio, cc->per_bio_data_size);

	if ((struct aead_request *)(io + 1) != req)
		mempool_free(req, cc->req_pool);
}

static void crypt_free_req(struct crypt_config *cc, void *req, struct bio *base_bio)
{
1299
	if (crypt_integrity_aead(cc))
1300 1301 1302 1303 1304
		crypt_free_req_aead(cc, req, base_bio);
	else
		crypt_free_req_skcipher(cc, req, base_bio);
}

L
Linus Torvalds 已提交
1305 1306 1307
/*
 * Encrypt / decrypt data from one bio to another one (can be the same one)
 */
1308
static blk_status_t crypt_convert(struct crypt_config *cc,
M
Milan Broz 已提交
1309
			 struct convert_context *ctx)
L
Linus Torvalds 已提交
1310
{
1311
	unsigned int tag_offset = 0;
1312
	unsigned int sector_step = cc->sector_size >> SECTOR_SHIFT;
M
Milan Broz 已提交
1313
	int r;
L
Linus Torvalds 已提交
1314

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

1317
	while (ctx->iter_in.bi_size && ctx->iter_out.bi_size) {
L
Linus Torvalds 已提交
1318

M
Milan Broz 已提交
1319
		crypt_alloc_req(cc, ctx);
M
Mikulas Patocka 已提交
1320
		atomic_inc(&ctx->cc_pending);
M
Milan Broz 已提交
1321

1322
		if (crypt_integrity_aead(cc))
1323 1324 1325
			r = crypt_convert_block_aead(cc, ctx, ctx->r.req_aead, tag_offset);
		else
			r = crypt_convert_block_skcipher(cc, ctx, ctx->r.req, tag_offset);
M
Milan Broz 已提交
1326 1327

		switch (r) {
1328 1329 1330 1331
		/*
		 * The request was queued by a crypto driver
		 * but the driver request queue is full, let's wait.
		 */
M
Milan Broz 已提交
1332 1333
		case -EBUSY:
			wait_for_completion(&ctx->restart);
1334
			reinit_completion(&ctx->restart);
1335 1336 1337 1338 1339
			/* fall through */
		/*
		 * The request is queued and processed asynchronously,
		 * completion function kcryptd_async_done() will be called.
		 */
1340
		case -EINPROGRESS:
1341
			ctx->r.req = NULL;
1342
			ctx->cc_sector += sector_step;
1343
			tag_offset++;
M
Milan Broz 已提交
1344
			continue;
1345 1346 1347
		/*
		 * The request was already processed (synchronously).
		 */
M
Milan Broz 已提交
1348
		case 0:
M
Mikulas Patocka 已提交
1349
			atomic_dec(&ctx->cc_pending);
1350
			ctx->cc_sector += sector_step;
1351
			tag_offset++;
M
Milan Broz 已提交
1352
			cond_resched();
M
Milan Broz 已提交
1353
			continue;
1354 1355 1356 1357 1358
		/*
		 * There was a data integrity error.
		 */
		case -EBADMSG:
			atomic_dec(&ctx->cc_pending);
1359
			return BLK_STS_PROTECTION;
1360 1361 1362
		/*
		 * There was an error while processing the request.
		 */
M
Milan Broz 已提交
1363
		default:
M
Mikulas Patocka 已提交
1364
			atomic_dec(&ctx->cc_pending);
1365
			return BLK_STS_IOERR;
M
Milan Broz 已提交
1366
		}
L
Linus Torvalds 已提交
1367 1368
	}

M
Milan Broz 已提交
1369
	return 0;
L
Linus Torvalds 已提交
1370 1371
}

1372 1373
static void crypt_free_buffer_pages(struct crypt_config *cc, struct bio *clone);

L
Linus Torvalds 已提交
1374 1375
/*
 * Generate a new unfragmented bio with the given size
1376 1377
 * This should never violate the device limitations (but only because
 * max_segment_size is being constrained to PAGE_SIZE).
1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389
 *
 * This function may be called concurrently. If we allocate from the mempool
 * concurrently, there is a possibility of deadlock. For example, if we have
 * mempool of 256 pages, two processes, each wanting 256, pages allocate from
 * the mempool concurrently, it may deadlock in a situation where both processes
 * have allocated 128 pages and the mempool is exhausted.
 *
 * In order to avoid this scenario we allocate the pages under a mutex.
 *
 * In order to not degrade performance with excessive locking, we try
 * non-blocking allocations without a mutex first but on failure we fallback
 * to blocking allocations with a mutex.
L
Linus Torvalds 已提交
1390
 */
1391
static struct bio *crypt_alloc_buffer(struct dm_crypt_io *io, unsigned size)
L
Linus Torvalds 已提交
1392
{
1393
	struct crypt_config *cc = io->cc;
1394
	struct bio *clone;
L
Linus Torvalds 已提交
1395
	unsigned int nr_iovecs = (size + PAGE_SIZE - 1) >> PAGE_SHIFT;
1396 1397
	gfp_t gfp_mask = GFP_NOWAIT | __GFP_HIGHMEM;
	unsigned i, len, remaining_size;
M
Milan Broz 已提交
1398
	struct page *page;
L
Linus Torvalds 已提交
1399

1400
retry:
1401
	if (unlikely(gfp_mask & __GFP_DIRECT_RECLAIM))
1402 1403
		mutex_lock(&cc->bio_alloc_lock);

O
Olaf Kirch 已提交
1404
	clone = bio_alloc_bioset(GFP_NOIO, nr_iovecs, cc->bs);
1405
	if (!clone)
1406
		goto out;
L
Linus Torvalds 已提交
1407

O
Olaf Kirch 已提交
1408
	clone_init(io, clone);
M
Milan Broz 已提交
1409

1410 1411
	remaining_size = size;

1412
	for (i = 0; i < nr_iovecs; i++) {
M
Milan Broz 已提交
1413
		page = mempool_alloc(cc->page_pool, gfp_mask);
1414 1415 1416
		if (!page) {
			crypt_free_buffer_pages(cc, clone);
			bio_put(clone);
1417
			gfp_mask |= __GFP_DIRECT_RECLAIM;
1418 1419
			goto retry;
		}
L
Linus Torvalds 已提交
1420

1421
		len = (remaining_size > PAGE_SIZE) ? PAGE_SIZE : remaining_size;
M
Milan Broz 已提交
1422

M
Ming Lei 已提交
1423
		bio_add_page(clone, page, len, 0);
L
Linus Torvalds 已提交
1424

1425
		remaining_size -= len;
L
Linus Torvalds 已提交
1426 1427
	}

1428 1429 1430 1431 1432 1433 1434
	/* Allocate space for integrity tags */
	if (dm_crypt_integrity_io_alloc(io, clone)) {
		crypt_free_buffer_pages(cc, clone);
		bio_put(clone);
		clone = NULL;
	}
out:
1435
	if (unlikely(gfp_mask & __GFP_DIRECT_RECLAIM))
1436 1437
		mutex_unlock(&cc->bio_alloc_lock);

1438
	return clone;
L
Linus Torvalds 已提交
1439 1440
}

N
Neil Brown 已提交
1441
static void crypt_free_buffer_pages(struct crypt_config *cc, struct bio *clone)
L
Linus Torvalds 已提交
1442
{
N
Neil Brown 已提交
1443
	unsigned int i;
L
Linus Torvalds 已提交
1444 1445
	struct bio_vec *bv;

1446
	bio_for_each_segment_all(bv, clone, i) {
L
Linus Torvalds 已提交
1447 1448 1449 1450 1451 1452
		BUG_ON(!bv->bv_page);
		mempool_free(bv->bv_page, cc->page_pool);
		bv->bv_page = NULL;
	}
}

M
Mikulas Patocka 已提交
1453 1454
static void crypt_io_init(struct dm_crypt_io *io, struct crypt_config *cc,
			  struct bio *bio, sector_t sector)
M
Milan Broz 已提交
1455
{
1456
	io->cc = cc;
M
Milan Broz 已提交
1457 1458 1459
	io->base_bio = bio;
	io->sector = sector;
	io->error = 0;
1460 1461 1462
	io->ctx.r.req = NULL;
	io->integrity_metadata = NULL;
	io->integrity_metadata_from_pool = false;
M
Mikulas Patocka 已提交
1463
	atomic_set(&io->io_pending, 0);
M
Milan Broz 已提交
1464 1465
}

M
Milan Broz 已提交
1466 1467
static void crypt_inc_pending(struct dm_crypt_io *io)
{
M
Mikulas Patocka 已提交
1468
	atomic_inc(&io->io_pending);
M
Milan Broz 已提交
1469 1470
}

L
Linus Torvalds 已提交
1471 1472 1473 1474
/*
 * One of the bios was finished. Check for completion of
 * the whole request and correctly clean up the buffer.
 */
1475
static void crypt_dec_pending(struct dm_crypt_io *io)
L
Linus Torvalds 已提交
1476
{
1477
	struct crypt_config *cc = io->cc;
1478
	struct bio *base_bio = io->base_bio;
1479
	blk_status_t error = io->error;
L
Linus Torvalds 已提交
1480

M
Mikulas Patocka 已提交
1481
	if (!atomic_dec_and_test(&io->io_pending))
L
Linus Torvalds 已提交
1482 1483
		return;

1484 1485 1486 1487 1488 1489 1490
	if (io->ctx.r.req)
		crypt_free_req(cc, io->ctx.r.req, base_bio);

	if (unlikely(io->integrity_metadata_from_pool))
		mempool_free(io->integrity_metadata, io->cc->tag_pool);
	else
		kfree(io->integrity_metadata);
1491

1492
	base_bio->bi_status = error;
1493
	bio_endio(base_bio);
L
Linus Torvalds 已提交
1494 1495 1496
}

/*
M
Milan Broz 已提交
1497
 * kcryptd/kcryptd_io:
L
Linus Torvalds 已提交
1498 1499
 *
 * Needed because it would be very unwise to do decryption in an
1500
 * interrupt context.
M
Milan Broz 已提交
1501 1502 1503 1504 1505 1506 1507 1508
 *
 * 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 已提交
1509 1510 1511
 *
 * 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 已提交
1512
 */
1513
static void crypt_endio(struct bio *clone)
1514
{
A
Alasdair G Kergon 已提交
1515
	struct dm_crypt_io *io = clone->bi_private;
1516
	struct crypt_config *cc = io->cc;
M
Milan Broz 已提交
1517
	unsigned rw = bio_data_dir(clone);
1518
	blk_status_t error;
1519 1520

	/*
1521
	 * free the processed pages
1522
	 */
M
Milan Broz 已提交
1523
	if (rw == WRITE)
N
Neil Brown 已提交
1524
		crypt_free_buffer_pages(cc, clone);
1525

1526
	error = clone->bi_status;
1527 1528
	bio_put(clone);

1529
	if (rw == READ && !error) {
M
Milan Broz 已提交
1530 1531 1532
		kcryptd_queue_crypt(io);
		return;
	}
1533

1534 1535
	if (unlikely(error))
		io->error = error;
1536 1537

	crypt_dec_pending(io);
1538 1539
}

A
Alasdair G Kergon 已提交
1540
static void clone_init(struct dm_crypt_io *io, struct bio *clone)
1541
{
1542
	struct crypt_config *cc = io->cc;
1543 1544 1545

	clone->bi_private = io;
	clone->bi_end_io  = crypt_endio;
1546
	bio_set_dev(clone, cc->dev->bdev);
1547
	clone->bi_opf	  = io->base_bio->bi_opf;
1548 1549
}

1550
static int kcryptd_io_read(struct dm_crypt_io *io, gfp_t gfp)
1551
{
1552
	struct crypt_config *cc = io->cc;
1553
	struct bio *clone;
1554

1555
	/*
1556 1557 1558 1559
	 * We need the original biovec array in order to decrypt
	 * the whole bio data *afterwards* -- thanks to immutable
	 * biovecs we don't need to worry about the block layer
	 * modifying the biovec array; so leverage bio_clone_fast().
1560
	 */
1561
	clone = bio_clone_fast(io->base_bio, gfp, cc->bs);
J
Jens Axboe 已提交
1562
	if (!clone)
1563
		return 1;
1564

1565 1566
	crypt_inc_pending(io);

1567
	clone_init(io, clone);
1568
	clone->bi_iter.bi_sector = cc->start + io->sector;
1569

1570 1571 1572 1573 1574 1575
	if (dm_crypt_integrity_io_alloc(io, clone)) {
		crypt_dec_pending(io);
		bio_put(clone);
		return 1;
	}

1576
	generic_make_request(clone);
1577
	return 0;
1578 1579
}

1580 1581 1582 1583 1584 1585
static void kcryptd_io_read_work(struct work_struct *work)
{
	struct dm_crypt_io *io = container_of(work, struct dm_crypt_io, work);

	crypt_inc_pending(io);
	if (kcryptd_io_read(io, GFP_NOIO))
1586
		io->error = BLK_STS_RESOURCE;
1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597
	crypt_dec_pending(io);
}

static void kcryptd_queue_read(struct dm_crypt_io *io)
{
	struct crypt_config *cc = io->cc;

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

1598 1599
static void kcryptd_io_write(struct dm_crypt_io *io)
{
M
Milan Broz 已提交
1600
	struct bio *clone = io->ctx.bio_out;
1601

M
Milan Broz 已提交
1602
	generic_make_request(clone);
1603 1604
}

M
Mikulas Patocka 已提交
1605 1606
#define crypt_io_from_node(node) rb_entry((node), struct dm_crypt_io, rb_node)

1607
static int dmcrypt_write(void *data)
1608
{
1609
	struct crypt_config *cc = data;
M
Mikulas Patocka 已提交
1610 1611
	struct dm_crypt_io *io;

1612
	while (1) {
M
Mikulas Patocka 已提交
1613
		struct rb_root write_tree;
1614
		struct blk_plug plug;
1615

1616
		DECLARE_WAITQUEUE(wait, current);
1617

1618 1619
		spin_lock_irq(&cc->write_thread_wait.lock);
continue_locked:
1620

M
Mikulas Patocka 已提交
1621
		if (!RB_EMPTY_ROOT(&cc->write_tree))
1622 1623
			goto pop_from_list;

R
Rabin Vincent 已提交
1624
		set_current_state(TASK_INTERRUPTIBLE);
1625 1626 1627 1628
		__add_wait_queue(&cc->write_thread_wait, &wait);

		spin_unlock_irq(&cc->write_thread_wait.lock);

R
Rabin Vincent 已提交
1629
		if (unlikely(kthread_should_stop())) {
1630
			set_current_state(TASK_RUNNING);
R
Rabin Vincent 已提交
1631 1632 1633 1634
			remove_wait_queue(&cc->write_thread_wait, &wait);
			break;
		}

1635 1636
		schedule();

1637
		set_current_state(TASK_RUNNING);
1638 1639 1640 1641 1642
		spin_lock_irq(&cc->write_thread_wait.lock);
		__remove_wait_queue(&cc->write_thread_wait, &wait);
		goto continue_locked;

pop_from_list:
M
Mikulas Patocka 已提交
1643 1644
		write_tree = cc->write_tree;
		cc->write_tree = RB_ROOT;
1645 1646
		spin_unlock_irq(&cc->write_thread_wait.lock);

M
Mikulas Patocka 已提交
1647 1648 1649 1650 1651 1652
		BUG_ON(rb_parent(write_tree.rb_node));

		/*
		 * Note: we cannot walk the tree here with rb_next because
		 * the structures may be freed when kcryptd_io_write is called.
		 */
1653 1654
		blk_start_plug(&plug);
		do {
M
Mikulas Patocka 已提交
1655 1656
			io = crypt_io_from_node(rb_first(&write_tree));
			rb_erase(&io->rb_node, &write_tree);
1657
			kcryptd_io_write(io);
M
Mikulas Patocka 已提交
1658
		} while (!RB_EMPTY_ROOT(&write_tree));
1659 1660 1661
		blk_finish_plug(&plug);
	}
	return 0;
1662 1663
}

1664
static void kcryptd_crypt_write_io_submit(struct dm_crypt_io *io, int async)
1665
{
M
Milan Broz 已提交
1666
	struct bio *clone = io->ctx.bio_out;
1667
	struct crypt_config *cc = io->cc;
1668
	unsigned long flags;
M
Mikulas Patocka 已提交
1669 1670
	sector_t sector;
	struct rb_node **rbp, *parent;
M
Milan Broz 已提交
1671

1672
	if (unlikely(io->error)) {
M
Milan Broz 已提交
1673 1674
		crypt_free_buffer_pages(cc, clone);
		bio_put(clone);
1675
		crypt_dec_pending(io);
M
Milan Broz 已提交
1676 1677 1678 1679
		return;
	}

	/* crypt_convert should have filled the clone bio */
1680
	BUG_ON(io->ctx.iter_out.bi_size);
M
Milan Broz 已提交
1681

1682
	clone->bi_iter.bi_sector = cc->start + io->sector;
M
Milan Broz 已提交
1683

1684 1685 1686 1687 1688
	if (likely(!async) && test_bit(DM_CRYPT_NO_OFFLOAD, &cc->flags)) {
		generic_make_request(clone);
		return;
	}

1689
	spin_lock_irqsave(&cc->write_thread_wait.lock, flags);
M
Mikulas Patocka 已提交
1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702
	rbp = &cc->write_tree.rb_node;
	parent = NULL;
	sector = io->sector;
	while (*rbp) {
		parent = *rbp;
		if (sector < crypt_io_from_node(parent)->sector)
			rbp = &(*rbp)->rb_left;
		else
			rbp = &(*rbp)->rb_right;
	}
	rb_link_node(&io->rb_node, parent, rbp);
	rb_insert_color(&io->rb_node, &cc->write_tree);

1703 1704
	wake_up_locked(&cc->write_thread_wait);
	spin_unlock_irqrestore(&cc->write_thread_wait.lock, flags);
1705 1706
}

M
Milan Broz 已提交
1707
static void kcryptd_crypt_write_convert(struct dm_crypt_io *io)
1708
{
1709
	struct crypt_config *cc = io->cc;
1710
	struct bio *clone;
M
Milan Broz 已提交
1711
	int crypt_finished;
M
Milan Broz 已提交
1712
	sector_t sector = io->sector;
1713
	blk_status_t r;
1714

M
Milan Broz 已提交
1715 1716 1717 1718
	/*
	 * Prevent io from disappearing until this function completes.
	 */
	crypt_inc_pending(io);
M
Milan Broz 已提交
1719
	crypt_convert_init(cc, &io->ctx, NULL, io->base_bio, sector);
M
Milan Broz 已提交
1720

1721 1722
	clone = crypt_alloc_buffer(io, io->base_bio->bi_iter.bi_size);
	if (unlikely(!clone)) {
1723
		io->error = BLK_STS_IOERR;
1724 1725
		goto dec;
	}
M
Milan Broz 已提交
1726

1727 1728
	io->ctx.bio_out = clone;
	io->ctx.iter_out = clone->bi_iter;
M
Milan Broz 已提交
1729

1730
	sector += bio_sectors(clone);
1731

1732 1733
	crypt_inc_pending(io);
	r = crypt_convert(cc, &io->ctx);
1734
	if (r)
1735
		io->error = r;
1736
	crypt_finished = atomic_dec_and_test(&io->ctx.cc_pending);
1737

1738 1739 1740 1741
	/* Encryption was already finished, submit io now */
	if (crypt_finished) {
		kcryptd_crypt_write_io_submit(io, 0);
		io->sector = sector;
1742
	}
M
Milan Broz 已提交
1743

1744
dec:
M
Milan Broz 已提交
1745
	crypt_dec_pending(io);
1746 1747
}

1748
static void kcryptd_crypt_read_done(struct dm_crypt_io *io)
1749 1750 1751 1752
{
	crypt_dec_pending(io);
}

1753
static void kcryptd_crypt_read_convert(struct dm_crypt_io *io)
1754
{
1755
	struct crypt_config *cc = io->cc;
1756
	blk_status_t r;
L
Linus Torvalds 已提交
1757

M
Milan Broz 已提交
1758
	crypt_inc_pending(io);
M
Milan Broz 已提交
1759

1760
	crypt_convert_init(cc, &io->ctx, io->base_bio, io->base_bio,
1761
			   io->sector);
L
Linus Torvalds 已提交
1762

1763
	r = crypt_convert(cc, &io->ctx);
1764
	if (r)
1765
		io->error = r;
1766

M
Mikulas Patocka 已提交
1767
	if (atomic_dec_and_test(&io->ctx.cc_pending))
1768
		kcryptd_crypt_read_done(io);
M
Milan Broz 已提交
1769 1770

	crypt_dec_pending(io);
L
Linus Torvalds 已提交
1771 1772
}

M
Milan Broz 已提交
1773 1774 1775
static void kcryptd_async_done(struct crypto_async_request *async_req,
			       int error)
{
1776 1777
	struct dm_crypt_request *dmreq = async_req->data;
	struct convert_context *ctx = dmreq->ctx;
M
Milan Broz 已提交
1778
	struct dm_crypt_io *io = container_of(ctx, struct dm_crypt_io, ctx);
1779
	struct crypt_config *cc = io->cc;
M
Milan Broz 已提交
1780

1781 1782 1783 1784 1785
	/*
	 * A request from crypto driver backlog is going to be processed now,
	 * finish the completion and continue in crypt_convert().
	 * (Callback will be called for the second time for this request.)
	 */
1786 1787
	if (error == -EINPROGRESS) {
		complete(&ctx->restart);
M
Milan Broz 已提交
1788
		return;
1789
	}
M
Milan Broz 已提交
1790

1791
	if (!error && cc->iv_gen_ops && cc->iv_gen_ops->post)
1792
		error = cc->iv_gen_ops->post(cc, org_iv_of_dmreq(cc, dmreq), dmreq);
1793

1794 1795 1796
	if (error == -EBADMSG) {
		DMERR_LIMIT("INTEGRITY AEAD ERROR, sector %llu",
			    (unsigned long long)le64_to_cpu(*org_sector_of_dmreq(cc, dmreq)));
1797
		io->error = BLK_STS_PROTECTION;
1798
	} else if (error < 0)
1799
		io->error = BLK_STS_IOERR;
1800

M
Mikulas Patocka 已提交
1801
	crypt_free_req(cc, req_of_dmreq(cc, dmreq), io->base_bio);
M
Milan Broz 已提交
1802

M
Mikulas Patocka 已提交
1803
	if (!atomic_dec_and_test(&ctx->cc_pending))
1804
		return;
M
Milan Broz 已提交
1805 1806

	if (bio_data_dir(io->base_bio) == READ)
1807
		kcryptd_crypt_read_done(io);
M
Milan Broz 已提交
1808
	else
1809
		kcryptd_crypt_write_io_submit(io, 1);
M
Milan Broz 已提交
1810 1811
}

1812
static void kcryptd_crypt(struct work_struct *work)
L
Linus Torvalds 已提交
1813
{
A
Alasdair G Kergon 已提交
1814
	struct dm_crypt_io *io = container_of(work, struct dm_crypt_io, work);
1815

M
Milan Broz 已提交
1816
	if (bio_data_dir(io->base_bio) == READ)
1817
		kcryptd_crypt_read_convert(io);
1818
	else
1819
		kcryptd_crypt_write_convert(io);
M
Milan Broz 已提交
1820 1821
}

1822
static void kcryptd_queue_crypt(struct dm_crypt_io *io)
M
Milan Broz 已提交
1823
{
1824
	struct crypt_config *cc = io->cc;
M
Milan Broz 已提交
1825

1826 1827
	INIT_WORK(&io->work, kcryptd_crypt);
	queue_work(cc->crypt_queue, &io->work);
L
Linus Torvalds 已提交
1828 1829
}

1830
static void crypt_free_tfms_aead(struct crypt_config *cc)
L
Linus Torvalds 已提交
1831
{
1832 1833
	if (!cc->cipher_tfm.tfms_aead)
		return;
L
Linus Torvalds 已提交
1834

1835 1836 1837
	if (cc->cipher_tfm.tfms_aead[0] && !IS_ERR(cc->cipher_tfm.tfms_aead[0])) {
		crypto_free_aead(cc->cipher_tfm.tfms_aead[0]);
		cc->cipher_tfm.tfms_aead[0] = NULL;
L
Linus Torvalds 已提交
1838 1839
	}

1840 1841
	kfree(cc->cipher_tfm.tfms_aead);
	cc->cipher_tfm.tfms_aead = NULL;
L
Linus Torvalds 已提交
1842 1843
}

1844
static void crypt_free_tfms_skcipher(struct crypt_config *cc)
M
Milan Broz 已提交
1845 1846 1847
{
	unsigned i;

1848
	if (!cc->cipher_tfm.tfms)
1849 1850
		return;

M
Milan Broz 已提交
1851
	for (i = 0; i < cc->tfms_count; i++)
1852 1853 1854
		if (cc->cipher_tfm.tfms[i] && !IS_ERR(cc->cipher_tfm.tfms[i])) {
			crypto_free_skcipher(cc->cipher_tfm.tfms[i]);
			cc->cipher_tfm.tfms[i] = NULL;
M
Milan Broz 已提交
1855
		}
1856

1857 1858
	kfree(cc->cipher_tfm.tfms);
	cc->cipher_tfm.tfms = NULL;
M
Milan Broz 已提交
1859 1860
}

1861 1862
static void crypt_free_tfms(struct crypt_config *cc)
{
1863
	if (crypt_integrity_aead(cc))
1864 1865 1866 1867 1868 1869
		crypt_free_tfms_aead(cc);
	else
		crypt_free_tfms_skcipher(cc);
}

static int crypt_alloc_tfms_skcipher(struct crypt_config *cc, char *ciphermode)
M
Milan Broz 已提交
1870 1871 1872 1873
{
	unsigned i;
	int err;

1874 1875 1876
	cc->cipher_tfm.tfms = kzalloc(cc->tfms_count *
				      sizeof(struct crypto_skcipher *), GFP_KERNEL);
	if (!cc->cipher_tfm.tfms)
1877 1878
		return -ENOMEM;

M
Milan Broz 已提交
1879
	for (i = 0; i < cc->tfms_count; i++) {
1880 1881 1882
		cc->cipher_tfm.tfms[i] = crypto_alloc_skcipher(ciphermode, 0, 0);
		if (IS_ERR(cc->cipher_tfm.tfms[i])) {
			err = PTR_ERR(cc->cipher_tfm.tfms[i]);
1883
			crypt_free_tfms(cc);
M
Milan Broz 已提交
1884 1885 1886 1887 1888 1889 1890
			return err;
		}
	}

	return 0;
}

1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910
static int crypt_alloc_tfms_aead(struct crypt_config *cc, char *ciphermode)
{
	int err;

	cc->cipher_tfm.tfms = kmalloc(sizeof(struct crypto_aead *), GFP_KERNEL);
	if (!cc->cipher_tfm.tfms)
		return -ENOMEM;

	cc->cipher_tfm.tfms_aead[0] = crypto_alloc_aead(ciphermode, 0, 0);
	if (IS_ERR(cc->cipher_tfm.tfms_aead[0])) {
		err = PTR_ERR(cc->cipher_tfm.tfms_aead[0]);
		crypt_free_tfms(cc);
		return err;
	}

	return 0;
}

static int crypt_alloc_tfms(struct crypt_config *cc, char *ciphermode)
{
1911
	if (crypt_integrity_aead(cc))
1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948
		return crypt_alloc_tfms_aead(cc, ciphermode);
	else
		return crypt_alloc_tfms_skcipher(cc, ciphermode);
}

static unsigned crypt_subkey_size(struct crypt_config *cc)
{
	return (cc->key_size - cc->key_extra_size) >> ilog2(cc->tfms_count);
}

static unsigned crypt_authenckey_size(struct crypt_config *cc)
{
	return crypt_subkey_size(cc) + RTA_SPACE(sizeof(struct crypto_authenc_key_param));
}

/*
 * If AEAD is composed like authenc(hmac(sha256),xts(aes)),
 * the key must be for some reason in special format.
 * This funcion converts cc->key to this special format.
 */
static void crypt_copy_authenckey(char *p, const void *key,
				  unsigned enckeylen, unsigned authkeylen)
{
	struct crypto_authenc_key_param *param;
	struct rtattr *rta;

	rta = (struct rtattr *)p;
	param = RTA_DATA(rta);
	param->enckeylen = cpu_to_be32(enckeylen);
	rta->rta_len = RTA_LENGTH(sizeof(*param));
	rta->rta_type = CRYPTO_AUTHENC_KEYA_PARAM;
	p += RTA_SPACE(sizeof(*param));
	memcpy(p, key + enckeylen, authkeylen);
	p += authkeylen;
	memcpy(p, key, enckeylen);
}

1949
static int crypt_setkey(struct crypt_config *cc)
A
Andi Kleen 已提交
1950
{
1951
	unsigned subkey_size;
1952 1953
	int err = 0, i, r;

1954
	/* Ignore extra keys (which are used for IV etc) */
1955
	subkey_size = crypt_subkey_size(cc);
1956

1957 1958 1959 1960
	if (crypt_integrity_hmac(cc))
		crypt_copy_authenckey(cc->authenc_key, cc->key,
				      subkey_size - cc->key_mac_size,
				      cc->key_mac_size);
1961
	for (i = 0; i < cc->tfms_count; i++) {
1962
		if (crypt_integrity_hmac(cc))
1963 1964
			r = crypto_aead_setkey(cc->cipher_tfm.tfms_aead[i],
				cc->authenc_key, crypt_authenckey_size(cc));
1965 1966 1967 1968
		else if (crypt_integrity_aead(cc))
			r = crypto_aead_setkey(cc->cipher_tfm.tfms_aead[i],
					       cc->key + (i * subkey_size),
					       subkey_size);
1969 1970 1971 1972
		else
			r = crypto_skcipher_setkey(cc->cipher_tfm.tfms[i],
						   cc->key + (i * subkey_size),
						   subkey_size);
1973 1974
		if (r)
			err = r;
A
Andi Kleen 已提交
1975 1976
	}

1977 1978 1979
	if (crypt_integrity_hmac(cc))
		memzero_explicit(cc->authenc_key, crypt_authenckey_size(cc));

A
Andi Kleen 已提交
1980 1981 1982
	return err;
}

1983 1984
#ifdef CONFIG_KEYS

1985 1986 1987 1988 1989 1990 1991 1992
static bool contains_whitespace(const char *str)
{
	while (*str)
		if (isspace(*str++))
			return true;
	return false;
}

1993 1994 1995 1996 1997 1998 1999
static int crypt_set_keyring_key(struct crypt_config *cc, const char *key_string)
{
	char *new_key_string, *key_desc;
	int ret;
	struct key *key;
	const struct user_key_payload *ukp;

2000 2001 2002 2003 2004 2005 2006 2007 2008
	/*
	 * Reject key_string with whitespace. dm core currently lacks code for
	 * proper whitespace escaping in arguments on DM_TABLE_STATUS path.
	 */
	if (contains_whitespace(key_string)) {
		DMERR("whitespace chars not allowed in key string");
		return -EINVAL;
	}

2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028
	/* look for next ':' separating key_type from key_description */
	key_desc = strpbrk(key_string, ":");
	if (!key_desc || key_desc == key_string || !strlen(key_desc + 1))
		return -EINVAL;

	if (strncmp(key_string, "logon:", key_desc - key_string + 1) &&
	    strncmp(key_string, "user:", key_desc - key_string + 1))
		return -EINVAL;

	new_key_string = kstrdup(key_string, GFP_KERNEL);
	if (!new_key_string)
		return -ENOMEM;

	key = request_key(key_string[0] == 'l' ? &key_type_logon : &key_type_user,
			  key_desc + 1, NULL);
	if (IS_ERR(key)) {
		kzfree(new_key_string);
		return PTR_ERR(key);
	}

2029
	down_read(&key->sem);
2030

2031
	ukp = user_key_payload_locked(key);
2032
	if (!ukp) {
2033
		up_read(&key->sem);
2034 2035 2036 2037 2038 2039
		key_put(key);
		kzfree(new_key_string);
		return -EKEYREVOKED;
	}

	if (cc->key_size != ukp->datalen) {
2040
		up_read(&key->sem);
2041 2042 2043 2044 2045 2046 2047
		key_put(key);
		kzfree(new_key_string);
		return -EINVAL;
	}

	memcpy(cc->key, ukp->data, cc->key_size);

2048
	up_read(&key->sem);
2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105
	key_put(key);

	/* clear the flag since following operations may invalidate previously valid key */
	clear_bit(DM_CRYPT_KEY_VALID, &cc->flags);

	ret = crypt_setkey(cc);

	/* wipe the kernel key payload copy in each case */
	memset(cc->key, 0, cc->key_size * sizeof(u8));

	if (!ret) {
		set_bit(DM_CRYPT_KEY_VALID, &cc->flags);
		kzfree(cc->key_string);
		cc->key_string = new_key_string;
	} else
		kzfree(new_key_string);

	return ret;
}

static int get_key_size(char **key_string)
{
	char *colon, dummy;
	int ret;

	if (*key_string[0] != ':')
		return strlen(*key_string) >> 1;

	/* look for next ':' in key string */
	colon = strpbrk(*key_string + 1, ":");
	if (!colon)
		return -EINVAL;

	if (sscanf(*key_string + 1, "%u%c", &ret, &dummy) != 2 || dummy != ':')
		return -EINVAL;

	*key_string = colon;

	/* remaining key string should be :<logon|user>:<key_desc> */

	return ret;
}

#else

static int crypt_set_keyring_key(struct crypt_config *cc, const char *key_string)
{
	return -EINVAL;
}

static int get_key_size(char **key_string)
{
	return (*key_string[0] == ':') ? -EINVAL : strlen(*key_string) >> 1;
}

#endif

M
Milan Broz 已提交
2106 2107
static int crypt_set_key(struct crypt_config *cc, char *key)
{
2108 2109 2110
	int r = -EINVAL;
	int key_string_len = strlen(key);

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

2115 2116 2117
	/* ':' means the key is in kernel keyring, short-circuit normal key processing */
	if (key[0] == ':') {
		r = crypt_set_keyring_key(cc, key + 1);
2118
		goto out;
2119
	}
M
Milan Broz 已提交
2120

2121 2122
	/* clear the flag since following operations may invalidate previously valid key */
	clear_bit(DM_CRYPT_KEY_VALID, &cc->flags);
M
Milan Broz 已提交
2123

2124 2125 2126 2127
	/* wipe references to any kernel keyring key */
	kzfree(cc->key_string);
	cc->key_string = NULL;

2128 2129
	/* Decode key from its hex representation. */
	if (cc->key_size && hex2bin(cc->key, key, cc->key_size) < 0)
2130
		goto out;
M
Milan Broz 已提交
2131

2132
	r = crypt_setkey(cc);
2133 2134
	if (!r)
		set_bit(DM_CRYPT_KEY_VALID, &cc->flags);
2135 2136 2137 2138 2139 2140

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

	return r;
M
Milan Broz 已提交
2141 2142 2143 2144
}

static int crypt_wipe_key(struct crypt_config *cc)
{
2145 2146
	int r;

M
Milan Broz 已提交
2147
	clear_bit(DM_CRYPT_KEY_VALID, &cc->flags);
2148
	get_random_bytes(&cc->key, cc->key_size);
2149 2150
	kzfree(cc->key_string);
	cc->key_string = NULL;
2151 2152
	r = crypt_setkey(cc);
	memset(&cc->key, 0, cc->key_size * sizeof(u8));
A
Andi Kleen 已提交
2153

2154
	return r;
M
Milan Broz 已提交
2155 2156
}

2157 2158 2159 2160 2161 2162 2163 2164 2165
static void crypt_dtr(struct dm_target *ti)
{
	struct crypt_config *cc = ti->private;

	ti->private = NULL;

	if (!cc)
		return;

R
Rabin Vincent 已提交
2166
	if (cc->write_thread)
2167 2168
		kthread_stop(cc->write_thread);

2169 2170 2171 2172 2173
	if (cc->io_queue)
		destroy_workqueue(cc->io_queue);
	if (cc->crypt_queue)
		destroy_workqueue(cc->crypt_queue);

2174 2175
	crypt_free_tfms(cc);

2176 2177 2178
	if (cc->bs)
		bioset_free(cc->bs);

2179 2180
	mempool_destroy(cc->page_pool);
	mempool_destroy(cc->req_pool);
2181
	mempool_destroy(cc->tag_pool);
2182 2183 2184 2185 2186 2187 2188

	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);

M
Milan Broz 已提交
2189
	kzfree(cc->cipher);
2190
	kzfree(cc->cipher_string);
2191
	kzfree(cc->key_string);
2192 2193
	kzfree(cc->cipher_auth);
	kzfree(cc->authenc_key);
2194 2195 2196 2197 2198

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

2199 2200 2201 2202
static int crypt_ctr_ivmode(struct dm_target *ti, const char *ivmode)
{
	struct crypt_config *cc = ti->private;

2203
	if (crypt_integrity_aead(cc))
2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223
		cc->iv_size = crypto_aead_ivsize(any_tfm_aead(cc));
	else
		cc->iv_size = crypto_skcipher_ivsize(any_tfm(cc));

	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. */
	if (ivmode == NULL)
		cc->iv_gen_ops = NULL;
	else if (strcmp(ivmode, "plain") == 0)
		cc->iv_gen_ops = &crypt_iv_plain_ops;
	else if (strcmp(ivmode, "plain64") == 0)
		cc->iv_gen_ops = &crypt_iv_plain64_ops;
2224 2225
	else if (strcmp(ivmode, "plain64be") == 0)
		cc->iv_gen_ops = &crypt_iv_plain64be_ops;
2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259
	else if (strcmp(ivmode, "essiv") == 0)
		cc->iv_gen_ops = &crypt_iv_essiv_ops;
	else if (strcmp(ivmode, "benbi") == 0)
		cc->iv_gen_ops = &crypt_iv_benbi_ops;
	else if (strcmp(ivmode, "null") == 0)
		cc->iv_gen_ops = &crypt_iv_null_ops;
	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.
		 * All keys (including IV seed) are always the same size.
		 */
		if (cc->key_size % cc->key_parts) {
			cc->key_parts++;
			cc->key_extra_size = cc->key_size / cc->key_parts;
		}
	} else if (strcmp(ivmode, "tcw") == 0) {
		cc->iv_gen_ops = &crypt_iv_tcw_ops;
		cc->key_parts += 2; /* IV + whitening */
		cc->key_extra_size = cc->iv_size + TCW_WHITENING_SIZE;
	} else if (strcmp(ivmode, "random") == 0) {
		cc->iv_gen_ops = &crypt_iv_random_ops;
		/* Need storage space in integrity fields. */
		cc->integrity_iv_size = cc->iv_size;
	} else {
		ti->error = "Invalid IV mode";
		return -EINVAL;
	}

	return 0;
}

2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396
/*
 * Workaround to parse cipher algorithm from crypto API spec.
 * The cc->cipher is currently used only in ESSIV.
 * This should be probably done by crypto-api calls (once available...)
 */
static int crypt_ctr_blkdev_cipher(struct crypt_config *cc)
{
	const char *alg_name = NULL;
	char *start, *end;

	if (crypt_integrity_aead(cc)) {
		alg_name = crypto_tfm_alg_name(crypto_aead_tfm(any_tfm_aead(cc)));
		if (!alg_name)
			return -EINVAL;
		if (crypt_integrity_hmac(cc)) {
			alg_name = strchr(alg_name, ',');
			if (!alg_name)
				return -EINVAL;
		}
		alg_name++;
	} else {
		alg_name = crypto_tfm_alg_name(crypto_skcipher_tfm(any_tfm(cc)));
		if (!alg_name)
			return -EINVAL;
	}

	start = strchr(alg_name, '(');
	end = strchr(alg_name, ')');

	if (!start && !end) {
		cc->cipher = kstrdup(alg_name, GFP_KERNEL);
		return cc->cipher ? 0 : -ENOMEM;
	}

	if (!start || !end || ++start >= end)
		return -EINVAL;

	cc->cipher = kzalloc(end - start + 1, GFP_KERNEL);
	if (!cc->cipher)
		return -ENOMEM;

	strncpy(cc->cipher, start, end - start);

	return 0;
}

/*
 * Workaround to parse HMAC algorithm from AEAD crypto API spec.
 * The HMAC is needed to calculate tag size (HMAC digest size).
 * This should be probably done by crypto-api calls (once available...)
 */
static int crypt_ctr_auth_cipher(struct crypt_config *cc, char *cipher_api)
{
	char *start, *end, *mac_alg = NULL;
	struct crypto_ahash *mac;

	if (!strstarts(cipher_api, "authenc("))
		return 0;

	start = strchr(cipher_api, '(');
	end = strchr(cipher_api, ',');
	if (!start || !end || ++start > end)
		return -EINVAL;

	mac_alg = kzalloc(end - start + 1, GFP_KERNEL);
	if (!mac_alg)
		return -ENOMEM;
	strncpy(mac_alg, start, end - start);

	mac = crypto_alloc_ahash(mac_alg, 0, 0);
	kfree(mac_alg);

	if (IS_ERR(mac))
		return PTR_ERR(mac);

	cc->key_mac_size = crypto_ahash_digestsize(mac);
	crypto_free_ahash(mac);

	cc->authenc_key = kmalloc(crypt_authenckey_size(cc), GFP_KERNEL);
	if (!cc->authenc_key)
		return -ENOMEM;

	return 0;
}

static int crypt_ctr_cipher_new(struct dm_target *ti, char *cipher_in, char *key,
				char **ivmode, char **ivopts)
{
	struct crypt_config *cc = ti->private;
	char *tmp, *cipher_api;
	int ret = -EINVAL;

	cc->tfms_count = 1;

	/*
	 * New format (capi: prefix)
	 * capi:cipher_api_spec-iv:ivopts
	 */
	tmp = &cipher_in[strlen("capi:")];
	cipher_api = strsep(&tmp, "-");
	*ivmode = strsep(&tmp, ":");
	*ivopts = tmp;

	if (*ivmode && !strcmp(*ivmode, "lmk"))
		cc->tfms_count = 64;

	cc->key_parts = cc->tfms_count;

	/* Allocate cipher */
	ret = crypt_alloc_tfms(cc, cipher_api);
	if (ret < 0) {
		ti->error = "Error allocating crypto tfm";
		return ret;
	}

	/* Alloc AEAD, can be used only in new format. */
	if (crypt_integrity_aead(cc)) {
		ret = crypt_ctr_auth_cipher(cc, cipher_api);
		if (ret < 0) {
			ti->error = "Invalid AEAD cipher spec";
			return -ENOMEM;
		}
		cc->iv_size = crypto_aead_ivsize(any_tfm_aead(cc));
	} else
		cc->iv_size = crypto_skcipher_ivsize(any_tfm(cc));

	ret = crypt_ctr_blkdev_cipher(cc);
	if (ret < 0) {
		ti->error = "Cannot allocate cipher string";
		return -ENOMEM;
	}

	return 0;
}

static int crypt_ctr_cipher_old(struct dm_target *ti, char *cipher_in, char *key,
				char **ivmode, char **ivopts)
L
Linus Torvalds 已提交
2397
{
M
Milan Broz 已提交
2398
	struct crypt_config *cc = ti->private;
2399
	char *tmp, *cipher, *chainmode, *keycount;
M
Milan Broz 已提交
2400
	char *cipher_api = NULL;
2401
	int ret = -EINVAL;
2402
	char dummy;
L
Linus Torvalds 已提交
2403

2404
	if (strchr(cipher_in, '(') || crypt_integrity_aead(cc)) {
M
Milan Broz 已提交
2405
		ti->error = "Bad cipher specification";
L
Linus Torvalds 已提交
2406 2407 2408
		return -EINVAL;
	}

M
Milan Broz 已提交
2409 2410
	/*
	 * Legacy dm-crypt cipher specification
M
Milan Broz 已提交
2411
	 * cipher[:keycount]-mode-iv:ivopts
M
Milan Broz 已提交
2412 2413
	 */
	tmp = cipher_in;
M
Milan Broz 已提交
2414 2415 2416 2417 2418
	keycount = strsep(&tmp, "-");
	cipher = strsep(&keycount, ":");

	if (!keycount)
		cc->tfms_count = 1;
2419
	else if (sscanf(keycount, "%u%c", &cc->tfms_count, &dummy) != 1 ||
M
Milan Broz 已提交
2420 2421 2422 2423 2424
		 !is_power_of_2(cc->tfms_count)) {
		ti->error = "Bad cipher key count specification";
		return -EINVAL;
	}
	cc->key_parts = cc->tfms_count;
M
Milan Broz 已提交
2425 2426 2427 2428 2429

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

L
Linus Torvalds 已提交
2430
	chainmode = strsep(&tmp, "-");
2431 2432
	*ivopts = strsep(&tmp, "-");
	*ivmode = strsep(&*ivopts, ":");
L
Linus Torvalds 已提交
2433 2434

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

2437 2438 2439 2440
	/*
	 * For compatibility with the original dm-crypt mapping format, if
	 * only the cipher name is supplied, use cbc-plain.
	 */
2441
	if (!chainmode || (!strcmp(chainmode, "plain") && !*ivmode)) {
L
Linus Torvalds 已提交
2442
		chainmode = "cbc";
2443
		*ivmode = "plain";
L
Linus Torvalds 已提交
2444 2445
	}

2446
	if (strcmp(chainmode, "ecb") && !*ivmode) {
M
Milan Broz 已提交
2447 2448
		ti->error = "IV mechanism required";
		return -EINVAL;
L
Linus Torvalds 已提交
2449 2450
	}

M
Milan Broz 已提交
2451 2452 2453 2454 2455 2456 2457 2458 2459
	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 已提交
2460 2461
	}

M
Milan Broz 已提交
2462
	/* Allocate cipher */
2463 2464 2465
	ret = crypt_alloc_tfms(cc, cipher_api);
	if (ret < 0) {
		ti->error = "Error allocating crypto tfm";
2466 2467
		kfree(cipher_api);
		return ret;
L
Linus Torvalds 已提交
2468
	}
2469
	kfree(cipher_api);
L
Linus Torvalds 已提交
2470

2471 2472 2473 2474 2475
	return 0;
bad_mem:
	ti->error = "Cannot allocate cipher strings";
	return -ENOMEM;
}
M
Milan Broz 已提交
2476

2477 2478 2479 2480 2481 2482 2483 2484 2485 2486
static int crypt_ctr_cipher(struct dm_target *ti, char *cipher_in, char *key)
{
	struct crypt_config *cc = ti->private;
	char *ivmode = NULL, *ivopts = NULL;
	int ret;

	cc->cipher_string = kstrdup(cipher_in, GFP_KERNEL);
	if (!cc->cipher_string) {
		ti->error = "Cannot allocate cipher strings";
		return -ENOMEM;
L
Linus Torvalds 已提交
2487 2488
	}

2489 2490 2491 2492 2493 2494 2495
	if (strstarts(cipher_in, "capi:"))
		ret = crypt_ctr_cipher_new(ti, cipher_in, key, &ivmode, &ivopts);
	else
		ret = crypt_ctr_cipher_old(ti, cipher_in, key, &ivmode, &ivopts);
	if (ret)
		return ret;

M
Milan Broz 已提交
2496
	/* Initialize IV */
2497 2498
	ret = crypt_ctr_ivmode(ti, ivmode);
	if (ret < 0)
2499
		return ret;
L
Linus Torvalds 已提交
2500

2501 2502 2503 2504
	/* Initialize and set key */
	ret = crypt_set_key(cc, key);
	if (ret < 0) {
		ti->error = "Error decoding and setting key";
2505
		return ret;
2506 2507
	}

2508 2509 2510 2511 2512
	/* 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";
2513
			return ret;
2514 2515
		}
	}
L
Linus Torvalds 已提交
2516

2517 2518 2519 2520 2521
	/* 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";
2522
			return ret;
2523
		}
2524 2525
	}

M
Milan Broz 已提交
2526 2527 2528
	return ret;
}

2529 2530 2531 2532
static int crypt_ctr_optional(struct dm_target *ti, unsigned int argc, char **argv)
{
	struct crypt_config *cc = ti->private;
	struct dm_arg_set as;
E
Eric Biggers 已提交
2533
	static const struct dm_arg _args[] = {
2534
		{0, 6, "Invalid number of feature args"},
2535 2536 2537
	};
	unsigned int opt_params, val;
	const char *opt_string, *sval;
2538
	char dummy;
2539 2540 2541 2542 2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576 2577 2578 2579 2580
	int ret;

	/* Optional parameters */
	as.argc = argc;
	as.argv = argv;

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

	while (opt_params--) {
		opt_string = dm_shift_arg(&as);
		if (!opt_string) {
			ti->error = "Not enough feature arguments";
			return -EINVAL;
		}

		if (!strcasecmp(opt_string, "allow_discards"))
			ti->num_discard_bios = 1;

		else if (!strcasecmp(opt_string, "same_cpu_crypt"))
			set_bit(DM_CRYPT_SAME_CPU, &cc->flags);

		else if (!strcasecmp(opt_string, "submit_from_crypt_cpus"))
			set_bit(DM_CRYPT_NO_OFFLOAD, &cc->flags);
		else if (sscanf(opt_string, "integrity:%u:", &val) == 1) {
			if (val == 0 || val > MAX_TAG_SIZE) {
				ti->error = "Invalid integrity arguments";
				return -EINVAL;
			}
			cc->on_disk_tag_size = val;
			sval = strchr(opt_string + strlen("integrity:"), ':') + 1;
			if (!strcasecmp(sval, "aead")) {
				set_bit(CRYPT_MODE_INTEGRITY_AEAD, &cc->cipher_flags);
			} else  if (strcasecmp(sval, "none")) {
				ti->error = "Unknown integrity profile";
				return -EINVAL;
			}

			cc->cipher_auth = kstrdup(sval, GFP_KERNEL);
			if (!cc->cipher_auth)
				return -ENOMEM;
2581
		} else if (sscanf(opt_string, "sector_size:%hu%c", &cc->sector_size, &dummy) == 1) {
2582 2583
			if (cc->sector_size < (1 << SECTOR_SHIFT) ||
			    cc->sector_size > 4096 ||
2584
			    (cc->sector_size & (cc->sector_size - 1))) {
2585 2586 2587
				ti->error = "Invalid feature value for sector_size";
				return -EINVAL;
			}
2588 2589 2590 2591
			if (ti->len & ((cc->sector_size >> SECTOR_SHIFT) - 1)) {
				ti->error = "Device size is not multiple of sector_size feature";
				return -EINVAL;
			}
2592
			cc->sector_shift = __ffs(cc->sector_size) - SECTOR_SHIFT;
2593 2594 2595
		} else if (!strcasecmp(opt_string, "iv_large_sectors"))
			set_bit(CRYPT_IV_LARGE_SECTORS, &cc->cipher_flags);
		else {
2596 2597 2598 2599 2600 2601
			ti->error = "Invalid feature arguments";
			return -EINVAL;
		}
	}

	return 0;
M
Milan Broz 已提交
2602 2603 2604 2605
}

/*
 * Construct an encryption mapping:
2606
 * <cipher> [<key>|:<key_size>:<user|logon>:<key_description>] <iv_offset> <dev_path> <start>
M
Milan Broz 已提交
2607 2608 2609 2610
 */
static int crypt_ctr(struct dm_target *ti, unsigned int argc, char **argv)
{
	struct crypt_config *cc;
2611
	int key_size;
2612
	unsigned int align_mask;
M
Milan Broz 已提交
2613 2614
	unsigned long long tmpll;
	int ret;
2615
	size_t iv_size_padding, additional_req_size;
2616
	char dummy;
2617 2618

	if (argc < 5) {
M
Milan Broz 已提交
2619 2620
		ti->error = "Not enough arguments";
		return -EINVAL;
L
Linus Torvalds 已提交
2621 2622
	}

2623 2624 2625 2626 2627
	key_size = get_key_size(&argv[1]);
	if (key_size < 0) {
		ti->error = "Cannot parse key size";
		return -EINVAL;
	}
M
Milan Broz 已提交
2628 2629 2630 2631 2632 2633

	cc = kzalloc(sizeof(*cc) + key_size * sizeof(u8), GFP_KERNEL);
	if (!cc) {
		ti->error = "Cannot allocate encryption context";
		return -ENOMEM;
	}
M
Milan Broz 已提交
2634
	cc->key_size = key_size;
2635
	cc->sector_size = (1 << SECTOR_SHIFT);
2636
	cc->sector_shift = 0;
M
Milan Broz 已提交
2637 2638

	ti->private = cc;
2639 2640 2641 2642 2643 2644 2645 2646

	/* Optional parameters need to be read before cipher constructor */
	if (argc > 5) {
		ret = crypt_ctr_optional(ti, argc - 5, &argv[5]);
		if (ret)
			goto bad;
	}

M
Milan Broz 已提交
2647 2648 2649 2650
	ret = crypt_ctr_cipher(ti, argv[0], argv[1]);
	if (ret < 0)
		goto bad;

2651
	if (crypt_integrity_aead(cc)) {
2652 2653 2654 2655 2656 2657 2658 2659
		cc->dmreq_start = sizeof(struct aead_request);
		cc->dmreq_start += crypto_aead_reqsize(any_tfm_aead(cc));
		align_mask = crypto_aead_alignmask(any_tfm_aead(cc));
	} else {
		cc->dmreq_start = sizeof(struct skcipher_request);
		cc->dmreq_start += crypto_skcipher_reqsize(any_tfm(cc));
		align_mask = crypto_skcipher_alignmask(any_tfm(cc));
	}
2660 2661
	cc->dmreq_start = ALIGN(cc->dmreq_start, __alignof__(struct dm_crypt_request));

2662
	if (align_mask < CRYPTO_MINALIGN) {
2663 2664
		/* Allocate the padding exactly */
		iv_size_padding = -(cc->dmreq_start + sizeof(struct dm_crypt_request))
2665
				& align_mask;
2666 2667 2668 2669 2670 2671
	} else {
		/*
		 * If the cipher requires greater alignment than kmalloc
		 * alignment, we don't know the exact position of the
		 * initialization vector. We must assume worst case.
		 */
2672
		iv_size_padding = align_mask;
2673
	}
M
Milan Broz 已提交
2674

2675
	ret = -ENOMEM;
2676 2677 2678 2679 2680 2681 2682 2683 2684

	/*  ...| IV + padding | original IV | original sec. number | bio tag offset | */
	additional_req_size = sizeof(struct dm_crypt_request) +
		iv_size_padding + cc->iv_size +
		cc->iv_size +
		sizeof(uint64_t) +
		sizeof(unsigned int);

	cc->req_pool = mempool_create_kmalloc_pool(MIN_IOS, cc->dmreq_start + additional_req_size);
M
Milan Broz 已提交
2685 2686
	if (!cc->req_pool) {
		ti->error = "Cannot allocate crypt request mempool";
2687
		goto bad;
M
Milan Broz 已提交
2688 2689
	}

2690
	cc->per_bio_data_size = ti->per_io_data_size =
2691
		ALIGN(sizeof(struct dm_crypt_io) + cc->dmreq_start + additional_req_size,
2692
		      ARCH_KMALLOC_MINALIGN);
M
Mikulas Patocka 已提交
2693

2694
	cc->page_pool = mempool_create_page_pool(BIO_MAX_PAGES, 0);
L
Linus Torvalds 已提交
2695
	if (!cc->page_pool) {
2696
		ti->error = "Cannot allocate page mempool";
2697
		goto bad;
L
Linus Torvalds 已提交
2698 2699
	}

2700 2701
	cc->bs = bioset_create(MIN_IOS, 0, (BIOSET_NEED_BVECS |
					    BIOSET_NEED_RESCUER));
M
Milan Broz 已提交
2702 2703
	if (!cc->bs) {
		ti->error = "Cannot allocate crypt bioset";
2704
		goto bad;
M
Milan Broz 已提交
2705 2706
	}

2707 2708
	mutex_init(&cc->bio_alloc_lock);

2709
	ret = -EINVAL;
2710 2711
	if ((sscanf(argv[2], "%llu%c", &tmpll, &dummy) != 1) ||
	    (tmpll & ((cc->sector_size >> SECTOR_SHIFT) - 1))) {
2712
		ti->error = "Invalid iv_offset sector";
2713
		goto bad;
L
Linus Torvalds 已提交
2714
	}
A
Andrew Morton 已提交
2715
	cc->iv_offset = tmpll;
L
Linus Torvalds 已提交
2716

2717 2718
	ret = dm_get_device(ti, argv[3], dm_table_get_mode(ti->table), &cc->dev);
	if (ret) {
2719 2720 2721 2722
		ti->error = "Device lookup failed";
		goto bad;
	}

2723
	ret = -EINVAL;
2724
	if (sscanf(argv[4], "%llu%c", &tmpll, &dummy) != 1) {
2725
		ti->error = "Invalid device sector";
2726
		goto bad;
L
Linus Torvalds 已提交
2727
	}
A
Andrew Morton 已提交
2728
	cc->start = tmpll;
L
Linus Torvalds 已提交
2729

2730
	if (crypt_integrity_aead(cc) || cc->integrity_iv_size) {
2731
		ret = crypt_integrity_ctr(cc, ti);
2732 2733 2734
		if (ret)
			goto bad;

2735 2736 2737
		cc->tag_pool_max_sectors = POOL_ENTRY_SIZE / cc->on_disk_tag_size;
		if (!cc->tag_pool_max_sectors)
			cc->tag_pool_max_sectors = 1;
2738

2739 2740 2741 2742 2743
		cc->tag_pool = mempool_create_kmalloc_pool(MIN_IOS,
			cc->tag_pool_max_sectors * cc->on_disk_tag_size);
		if (!cc->tag_pool) {
			ti->error = "Cannot allocate integrity tags mempool";
			goto bad;
2744
		}
2745 2746

		cc->tag_pool_max_sectors <<= cc->sector_shift;
2747 2748
	}

2749
	ret = -ENOMEM;
2750
	cc->io_queue = alloc_workqueue("kcryptd_io", WQ_HIGHPRI | WQ_CPU_INTENSIVE | WQ_MEM_RECLAIM, 1);
M
Milan Broz 已提交
2751 2752
	if (!cc->io_queue) {
		ti->error = "Couldn't create kcryptd io queue";
2753
		goto bad;
M
Milan Broz 已提交
2754 2755
	}

2756
	if (test_bit(DM_CRYPT_SAME_CPU, &cc->flags))
2757
		cc->crypt_queue = alloc_workqueue("kcryptd", WQ_HIGHPRI | WQ_CPU_INTENSIVE | WQ_MEM_RECLAIM, 1);
2758
	else
2759 2760
		cc->crypt_queue = alloc_workqueue("kcryptd",
						  WQ_HIGHPRI | WQ_CPU_INTENSIVE | WQ_MEM_RECLAIM | WQ_UNBOUND,
2761
						  num_online_cpus());
M
Milan Broz 已提交
2762
	if (!cc->crypt_queue) {
2763
		ti->error = "Couldn't create kcryptd queue";
2764
		goto bad;
2765 2766
	}

2767
	init_waitqueue_head(&cc->write_thread_wait);
M
Mikulas Patocka 已提交
2768
	cc->write_tree = RB_ROOT;
2769 2770 2771 2772 2773 2774 2775 2776 2777 2778

	cc->write_thread = kthread_create(dmcrypt_write, cc, "dmcrypt_write");
	if (IS_ERR(cc->write_thread)) {
		ret = PTR_ERR(cc->write_thread);
		cc->write_thread = NULL;
		ti->error = "Couldn't spawn write thread";
		goto bad;
	}
	wake_up_process(cc->write_thread);

2779
	ti->num_flush_bios = 1;
2780

L
Linus Torvalds 已提交
2781 2782
	return 0;

2783 2784 2785
bad:
	crypt_dtr(ti);
	return ret;
L
Linus Torvalds 已提交
2786 2787
}

M
Mikulas Patocka 已提交
2788
static int crypt_map(struct dm_target *ti, struct bio *bio)
L
Linus Torvalds 已提交
2789
{
A
Alasdair G Kergon 已提交
2790
	struct dm_crypt_io *io;
2791
	struct crypt_config *cc = ti->private;
M
Mikulas Patocka 已提交
2792

2793
	/*
2794 2795
	 * If bio is REQ_PREFLUSH or REQ_OP_DISCARD, just bypass crypt queues.
	 * - for REQ_PREFLUSH device-mapper core ensures that no IO is in-flight
M
Mike Christie 已提交
2796
	 * - for REQ_OP_DISCARD caller must use flush if IO ordering matters
2797
	 */
J
Jens Axboe 已提交
2798
	if (unlikely(bio->bi_opf & REQ_PREFLUSH ||
2799
	    bio_op(bio) == REQ_OP_DISCARD)) {
2800
		bio_set_dev(bio, cc->dev->bdev);
2801
		if (bio_sectors(bio))
2802 2803
			bio->bi_iter.bi_sector = cc->start +
				dm_target_offset(ti, bio->bi_iter.bi_sector);
M
Mikulas Patocka 已提交
2804 2805
		return DM_MAPIO_REMAPPED;
	}
L
Linus Torvalds 已提交
2806

2807 2808 2809 2810
	/*
	 * Check if bio is too large, split as needed.
	 */
	if (unlikely(bio->bi_iter.bi_size > (BIO_MAX_PAGES << PAGE_SHIFT)) &&
2811
	    (bio_data_dir(bio) == WRITE || cc->on_disk_tag_size))
2812 2813
		dm_accept_partial_bio(bio, ((BIO_MAX_PAGES << PAGE_SHIFT) >> SECTOR_SHIFT));

2814 2815 2816 2817 2818
	/*
	 * Ensure that bio is a multiple of internal sector encryption size
	 * and is aligned to this size as defined in IO hints.
	 */
	if (unlikely((bio->bi_iter.bi_sector & ((cc->sector_size >> SECTOR_SHIFT) - 1)) != 0))
2819
		return DM_MAPIO_KILL;
2820 2821

	if (unlikely(bio->bi_iter.bi_size & (cc->sector_size - 1)))
2822
		return DM_MAPIO_KILL;
2823

M
Mikulas Patocka 已提交
2824 2825
	io = dm_per_bio_data(bio, cc->per_bio_data_size);
	crypt_io_init(io, cc, bio, dm_target_offset(ti, bio->bi_iter.bi_sector));
2826 2827

	if (cc->on_disk_tag_size) {
2828
		unsigned tag_len = cc->on_disk_tag_size * (bio_sectors(bio) >> cc->sector_shift);
2829 2830

		if (unlikely(tag_len > KMALLOC_MAX_SIZE) ||
2831
		    unlikely(!(io->integrity_metadata = kmalloc(tag_len,
2832 2833 2834 2835 2836 2837 2838 2839
				GFP_NOIO | __GFP_NORETRY | __GFP_NOMEMALLOC | __GFP_NOWARN)))) {
			if (bio_sectors(bio) > cc->tag_pool_max_sectors)
				dm_accept_partial_bio(bio, cc->tag_pool_max_sectors);
			io->integrity_metadata = mempool_alloc(cc->tag_pool, GFP_NOIO);
			io->integrity_metadata_from_pool = true;
		}
	}

2840
	if (crypt_integrity_aead(cc))
2841 2842 2843
		io->ctx.r.req_aead = (struct aead_request *)(io + 1);
	else
		io->ctx.r.req = (struct skcipher_request *)(io + 1);
M
Milan Broz 已提交
2844

2845 2846
	if (bio_data_dir(io->base_bio) == READ) {
		if (kcryptd_io_read(io, GFP_NOWAIT))
2847
			kcryptd_queue_read(io);
2848
	} else
M
Milan Broz 已提交
2849
		kcryptd_queue_crypt(io);
L
Linus Torvalds 已提交
2850

2851
	return DM_MAPIO_SUBMITTED;
L
Linus Torvalds 已提交
2852 2853
}

2854 2855
static void crypt_status(struct dm_target *ti, status_type_t type,
			 unsigned status_flags, char *result, unsigned maxlen)
L
Linus Torvalds 已提交
2856
{
M
Milan Broz 已提交
2857
	struct crypt_config *cc = ti->private;
2858
	unsigned i, sz = 0;
2859
	int num_feature_args = 0;
L
Linus Torvalds 已提交
2860 2861 2862 2863 2864 2865 2866

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

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

2869 2870 2871 2872 2873 2874 2875
		if (cc->key_size > 0) {
			if (cc->key_string)
				DMEMIT(":%u:%s", cc->key_size, cc->key_string);
			else
				for (i = 0; i < cc->key_size; i++)
					DMEMIT("%02x", cc->key[i]);
		} else
2876
			DMEMIT("-");
L
Linus Torvalds 已提交
2877

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

2881 2882
		num_feature_args += !!ti->num_discard_bios;
		num_feature_args += test_bit(DM_CRYPT_SAME_CPU, &cc->flags);
2883
		num_feature_args += test_bit(DM_CRYPT_NO_OFFLOAD, &cc->flags);
2884
		num_feature_args += cc->sector_size != (1 << SECTOR_SHIFT);
2885
		num_feature_args += test_bit(CRYPT_IV_LARGE_SECTORS, &cc->cipher_flags);
2886 2887
		if (cc->on_disk_tag_size)
			num_feature_args++;
2888 2889 2890 2891 2892 2893
		if (num_feature_args) {
			DMEMIT(" %d", num_feature_args);
			if (ti->num_discard_bios)
				DMEMIT(" allow_discards");
			if (test_bit(DM_CRYPT_SAME_CPU, &cc->flags))
				DMEMIT(" same_cpu_crypt");
2894 2895
			if (test_bit(DM_CRYPT_NO_OFFLOAD, &cc->flags))
				DMEMIT(" submit_from_crypt_cpus");
2896 2897
			if (cc->on_disk_tag_size)
				DMEMIT(" integrity:%u:%s", cc->on_disk_tag_size, cc->cipher_auth);
2898 2899 2900 2901
			if (cc->sector_size != (1 << SECTOR_SHIFT))
				DMEMIT(" sector_size:%d", cc->sector_size);
			if (test_bit(CRYPT_IV_LARGE_SECTORS, &cc->cipher_flags))
				DMEMIT(" iv_large_sectors");
2902
		}
2903

L
Linus Torvalds 已提交
2904 2905 2906 2907
		break;
	}
}

M
Milan Broz 已提交
2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921 2922 2923 2924 2925 2926 2927 2928 2929 2930 2931 2932 2933 2934 2935 2936 2937 2938 2939 2940
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;
2941
	int key_size, ret = -EINVAL;
M
Milan Broz 已提交
2942 2943 2944 2945

	if (argc < 2)
		goto error;

2946
	if (!strcasecmp(argv[0], "key")) {
M
Milan Broz 已提交
2947 2948 2949 2950
		if (!test_bit(DM_CRYPT_SUSPENDED, &cc->flags)) {
			DMWARN("not suspended during key manipulation.");
			return -EINVAL;
		}
2951
		if (argc == 3 && !strcasecmp(argv[1], "set")) {
2952 2953 2954 2955 2956 2957 2958
			/* The key size may not be changed. */
			key_size = get_key_size(&argv[2]);
			if (key_size < 0 || cc->key_size != key_size) {
				memset(argv[2], '0', strlen(argv[2]));
				return -EINVAL;
			}

2959 2960 2961 2962 2963 2964 2965
			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;
		}
2966
		if (argc == 2 && !strcasecmp(argv[1], "wipe")) {
2967 2968 2969 2970 2971
			if (cc->iv_gen_ops && cc->iv_gen_ops->wipe) {
				ret = cc->iv_gen_ops->wipe(cc);
				if (ret)
					return ret;
			}
M
Milan Broz 已提交
2972
			return crypt_wipe_key(cc);
2973
		}
M
Milan Broz 已提交
2974 2975 2976 2977 2978 2979 2980
	}

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

2981 2982 2983 2984 2985
static int crypt_iterate_devices(struct dm_target *ti,
				 iterate_devices_callout_fn fn, void *data)
{
	struct crypt_config *cc = ti->private;

2986
	return fn(ti, cc->dev, cc->start, ti->len, data);
2987 2988
}

2989 2990
static void crypt_io_hints(struct dm_target *ti, struct queue_limits *limits)
{
2991 2992
	struct crypt_config *cc = ti->private;

2993 2994 2995 2996 2997 2998 2999
	/*
	 * Unfortunate constraint that is required to avoid the potential
	 * for exceeding underlying device's max_segments limits -- due to
	 * crypt_alloc_buffer() possibly allocating pages for the encryption
	 * bio that are not as physically contiguous as the original bio.
	 */
	limits->max_segment_size = PAGE_SIZE;
3000 3001 3002 3003 3004 3005

	if (cc->sector_size != (1 << SECTOR_SHIFT)) {
		limits->logical_block_size = cc->sector_size;
		limits->physical_block_size = cc->sector_size;
		blk_limits_io_min(limits, cc->sector_size);
	}
3006 3007
}

L
Linus Torvalds 已提交
3008 3009
static struct target_type crypt_target = {
	.name   = "crypt",
3010
	.version = {1, 18, 0},
L
Linus Torvalds 已提交
3011 3012 3013 3014 3015
	.module = THIS_MODULE,
	.ctr    = crypt_ctr,
	.dtr    = crypt_dtr,
	.map    = crypt_map,
	.status = crypt_status,
M
Milan Broz 已提交
3016 3017 3018 3019
	.postsuspend = crypt_postsuspend,
	.preresume = crypt_preresume,
	.resume = crypt_resume,
	.message = crypt_message,
3020
	.iterate_devices = crypt_iterate_devices,
3021
	.io_hints = crypt_io_hints,
L
Linus Torvalds 已提交
3022 3023 3024 3025 3026 3027 3028
};

static int __init dm_crypt_init(void)
{
	int r;

	r = dm_register_target(&crypt_target);
3029
	if (r < 0)
3030
		DMERR("register failed %d", r);
L
Linus Torvalds 已提交
3031 3032 3033 3034 3035 3036

	return r;
}

static void __exit dm_crypt_exit(void)
{
3037
	dm_unregister_target(&crypt_target);
L
Linus Torvalds 已提交
3038 3039 3040 3041 3042
}

module_init(dm_crypt_init);
module_exit(dm_crypt_exit);

3043
MODULE_AUTHOR("Jana Saout <jana@saout.de>");
L
Linus Torvalds 已提交
3044 3045
MODULE_DESCRIPTION(DM_NAME " target for transparent encryption / decryption");
MODULE_LICENSE("GPL");