gcm.c 36.5 KB
Newer Older
M
Mikko Herranen 已提交
1 2 3 4 5 6 7 8 9 10 11
/*
 * GCM: Galois/Counter Mode.
 *
 * Copyright (c) 2007 Nokia Siemens Networks - Mikko Herranen <mh1@iki.fi>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published
 * by the Free Software Foundation.
 */

#include <crypto/gf128mul.h>
H
Herbert Xu 已提交
12
#include <crypto/internal/aead.h>
13
#include <crypto/internal/skcipher.h>
14
#include <crypto/internal/hash.h>
15
#include <crypto/scatterwalk.h>
16 17
#include <crypto/hash.h>
#include "internal.h"
18
#include <linux/completion.h>
M
Mikko Herranen 已提交
19 20 21 22 23 24 25
#include <linux/err.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/slab.h>

struct gcm_instance_ctx {
26
	struct crypto_skcipher_spawn ctr;
27
	struct crypto_ahash_spawn ghash;
M
Mikko Herranen 已提交
28 29 30 31
};

struct crypto_gcm_ctx {
	struct crypto_ablkcipher *ctr;
32
	struct crypto_ahash *ghash;
M
Mikko Herranen 已提交
33 34
};

H
Herbert Xu 已提交
35 36 37 38 39
struct crypto_rfc4106_ctx {
	struct crypto_aead *child;
	u8 nonce[4];
};

40 41 42 43 44
struct crypto_rfc4543_instance_ctx {
	struct crypto_aead_spawn aead;
	struct crypto_skcipher_spawn null;
};

45 46
struct crypto_rfc4543_ctx {
	struct crypto_aead *child;
47
	struct crypto_blkcipher *null;
48 49 50 51 52
	u8 nonce[4];
};

struct crypto_rfc4543_req_ctx {
	u8 auth_tag[16];
53
	u8 assocbuf[32];
54 55 56 57 58 59
	struct scatterlist cipher[1];
	struct scatterlist payload[2];
	struct scatterlist assoc[2];
	struct aead_request subreq;
};

M
Mikko Herranen 已提交
60
struct crypto_gcm_ghash_ctx {
61 62
	unsigned int cryptlen;
	struct scatterlist *src;
63
	void (*complete)(struct aead_request *req, int err);
M
Mikko Herranen 已提交
64 65 66 67
};

struct crypto_gcm_req_priv_ctx {
	u8 auth_tag[16];
H
Herbert Xu 已提交
68
	u8 iauth_tag[16];
69 70
	struct scatterlist src[2];
	struct scatterlist dst[2];
71 72 73 74 75
	struct crypto_gcm_ghash_ctx ghash_ctx;
	union {
		struct ahash_request ahreq;
		struct ablkcipher_request abreq;
	} u;
M
Mikko Herranen 已提交
76 77
};

78 79 80 81 82
struct crypto_gcm_setkey_result {
	int err;
	struct completion completion;
};

83 84
static void *gcm_zeroes;

85 86 87 88 89 90 91 92
static inline struct crypto_gcm_req_priv_ctx *crypto_gcm_reqctx(
	struct aead_request *req)
{
	unsigned long align = crypto_aead_alignmask(crypto_aead_reqtfm(req));

	return (void *)PTR_ALIGN((u8 *)aead_request_ctx(req), align + 1);
}

93
static void crypto_gcm_setkey_done(struct crypto_async_request *req, int err)
M
Mikko Herranen 已提交
94
{
95
	struct crypto_gcm_setkey_result *result = req->data;
M
Mikko Herranen 已提交
96

97 98 99 100 101
	if (err == -EINPROGRESS)
		return;

	result->err = err;
	complete(&result->completion);
M
Mikko Herranen 已提交
102 103 104 105 106 107
}

static int crypto_gcm_setkey(struct crypto_aead *aead, const u8 *key,
			     unsigned int keylen)
{
	struct crypto_gcm_ctx *ctx = crypto_aead_ctx(aead);
108
	struct crypto_ahash *ghash = ctx->ghash;
M
Mikko Herranen 已提交
109
	struct crypto_ablkcipher *ctr = ctx->ctr;
110 111 112 113 114 115 116 117 118 119
	struct {
		be128 hash;
		u8 iv[8];

		struct crypto_gcm_setkey_result result;

		struct scatterlist sg[1];
		struct ablkcipher_request req;
	} *data;
	int err;
M
Mikko Herranen 已提交
120 121 122 123 124 125 126

	crypto_ablkcipher_clear_flags(ctr, CRYPTO_TFM_REQ_MASK);
	crypto_ablkcipher_set_flags(ctr, crypto_aead_get_flags(aead) &
				   CRYPTO_TFM_REQ_MASK);

	err = crypto_ablkcipher_setkey(ctr, key, keylen);
	if (err)
127
		return err;
M
Mikko Herranen 已提交
128 129 130 131

	crypto_aead_set_flags(aead, crypto_ablkcipher_get_flags(ctr) &
				       CRYPTO_TFM_RES_MASK);

132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154
	data = kzalloc(sizeof(*data) + crypto_ablkcipher_reqsize(ctr),
		       GFP_KERNEL);
	if (!data)
		return -ENOMEM;

	init_completion(&data->result.completion);
	sg_init_one(data->sg, &data->hash, sizeof(data->hash));
	ablkcipher_request_set_tfm(&data->req, ctr);
	ablkcipher_request_set_callback(&data->req, CRYPTO_TFM_REQ_MAY_SLEEP |
						    CRYPTO_TFM_REQ_MAY_BACKLOG,
					crypto_gcm_setkey_done,
					&data->result);
	ablkcipher_request_set_crypt(&data->req, data->sg, data->sg,
				     sizeof(data->hash), data->iv);

	err = crypto_ablkcipher_encrypt(&data->req);
	if (err == -EINPROGRESS || err == -EBUSY) {
		err = wait_for_completion_interruptible(
			&data->result.completion);
		if (!err)
			err = data->result.err;
	}

M
Mikko Herranen 已提交
155 156 157
	if (err)
		goto out;

158 159 160 161 162 163
	crypto_ahash_clear_flags(ghash, CRYPTO_TFM_REQ_MASK);
	crypto_ahash_set_flags(ghash, crypto_aead_get_flags(aead) &
			       CRYPTO_TFM_REQ_MASK);
	err = crypto_ahash_setkey(ghash, (u8 *)&data->hash, sizeof(be128));
	crypto_aead_set_flags(aead, crypto_ahash_get_flags(ghash) &
			      CRYPTO_TFM_RES_MASK);
M
Mikko Herranen 已提交
164

165 166
out:
	kfree(data);
M
Mikko Herranen 已提交
167 168 169
	return err;
}

H
Herbert Xu 已提交
170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188
static int crypto_gcm_setauthsize(struct crypto_aead *tfm,
				  unsigned int authsize)
{
	switch (authsize) {
	case 4:
	case 8:
	case 12:
	case 13:
	case 14:
	case 15:
	case 16:
		break;
	default:
		return -EINVAL;
	}

	return 0;
}

189 190 191
static void crypto_gcm_init_crypt(struct ablkcipher_request *ablk_req,
				  struct aead_request *req,
				  unsigned int cryptlen)
M
Mikko Herranen 已提交
192 193 194
{
	struct crypto_aead *aead = crypto_aead_reqtfm(req);
	struct crypto_gcm_ctx *ctx = crypto_aead_ctx(aead);
195
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212
	struct scatterlist *dst;
	__be32 counter = cpu_to_be32(1);

	memset(pctx->auth_tag, 0, sizeof(pctx->auth_tag));
	memcpy(req->iv + 12, &counter, 4);

	sg_init_table(pctx->src, 2);
	sg_set_buf(pctx->src, pctx->auth_tag, sizeof(pctx->auth_tag));
	scatterwalk_sg_chain(pctx->src, 2, req->src);

	dst = pctx->src;
	if (req->src != req->dst) {
		sg_init_table(pctx->dst, 2);
		sg_set_buf(pctx->dst, pctx->auth_tag, sizeof(pctx->auth_tag));
		scatterwalk_sg_chain(pctx->dst, 2, req->dst);
		dst = pctx->dst;
	}
M
Mikko Herranen 已提交
213 214

	ablkcipher_request_set_tfm(ablk_req, ctx->ctr);
215 216 217
	ablkcipher_request_set_crypt(ablk_req, pctx->src, dst,
				     cryptlen + sizeof(pctx->auth_tag),
				     req->iv);
218 219 220 221 222 223 224 225 226 227
}

static inline unsigned int gcm_remain(unsigned int len)
{
	len &= 0xfU;
	return len ? 16 - len : 0;
}

static void gcm_hash_len_done(struct crypto_async_request *areq, int err);
static void gcm_hash_final_done(struct crypto_async_request *areq, int err);
M
Mikko Herranen 已提交
228

229 230
static int gcm_hash_update(struct aead_request *req,
			   struct crypto_gcm_req_priv_ctx *pctx,
M
Mark Rustad 已提交
231
			   crypto_completion_t compl,
232 233 234 235
			   struct scatterlist *src,
			   unsigned int len)
{
	struct ahash_request *ahreq = &pctx->u.ahreq;
M
Mikko Herranen 已提交
236

237
	ahash_request_set_callback(ahreq, aead_request_flags(req),
M
Mark Rustad 已提交
238
				   compl, req);
239 240 241
	ahash_request_set_crypt(ahreq, src, NULL, len);

	return crypto_ahash_update(ahreq);
M
Mikko Herranen 已提交
242 243
}

244 245 246
static int gcm_hash_remain(struct aead_request *req,
			   struct crypto_gcm_req_priv_ctx *pctx,
			   unsigned int remain,
M
Mark Rustad 已提交
247
			   crypto_completion_t compl)
M
Mikko Herranen 已提交
248
{
249 250 251
	struct ahash_request *ahreq = &pctx->u.ahreq;

	ahash_request_set_callback(ahreq, aead_request_flags(req),
M
Mark Rustad 已提交
252
				   compl, req);
253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289
	sg_init_one(pctx->src, gcm_zeroes, remain);
	ahash_request_set_crypt(ahreq, pctx->src, NULL, remain);

	return crypto_ahash_update(ahreq);
}

static int gcm_hash_len(struct aead_request *req,
			struct crypto_gcm_req_priv_ctx *pctx)
{
	struct ahash_request *ahreq = &pctx->u.ahreq;
	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
	u128 lengths;

	lengths.a = cpu_to_be64(req->assoclen * 8);
	lengths.b = cpu_to_be64(gctx->cryptlen * 8);
	memcpy(pctx->iauth_tag, &lengths, 16);
	sg_init_one(pctx->src, pctx->iauth_tag, 16);
	ahash_request_set_callback(ahreq, aead_request_flags(req),
				   gcm_hash_len_done, req);
	ahash_request_set_crypt(ahreq, pctx->src,
				NULL, sizeof(lengths));

	return crypto_ahash_update(ahreq);
}

static int gcm_hash_final(struct aead_request *req,
			  struct crypto_gcm_req_priv_ctx *pctx)
{
	struct ahash_request *ahreq = &pctx->u.ahreq;

	ahash_request_set_callback(ahreq, aead_request_flags(req),
				   gcm_hash_final_done, req);
	ahash_request_set_crypt(ahreq, NULL, pctx->iauth_tag, 0);

	return crypto_ahash_final(ahreq);
}

290
static void __gcm_hash_final_done(struct aead_request *req, int err)
291
{
292
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
293 294 295 296
	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;

	if (!err)
		crypto_xor(pctx->auth_tag, pctx->iauth_tag, 16);
M
Mikko Herranen 已提交
297

298
	gctx->complete(req, err);
299 300
}

301
static void gcm_hash_final_done(struct crypto_async_request *areq, int err)
302 303
{
	struct aead_request *req = areq->data;
304 305 306 307 308 309

	__gcm_hash_final_done(req, err);
}

static void __gcm_hash_len_done(struct aead_request *req, int err)
{
310 311 312 313 314 315 316 317
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);

	if (!err) {
		err = gcm_hash_final(req, pctx);
		if (err == -EINPROGRESS || err == -EBUSY)
			return;
	}

318
	__gcm_hash_final_done(req, err);
319 320
}

321
static void gcm_hash_len_done(struct crypto_async_request *areq, int err)
322 323
{
	struct aead_request *req = areq->data;
324 325 326 327 328 329

	__gcm_hash_len_done(req, err);
}

static void __gcm_hash_crypt_remain_done(struct aead_request *req, int err)
{
330 331 332 333 334 335 336 337
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);

	if (!err) {
		err = gcm_hash_len(req, pctx);
		if (err == -EINPROGRESS || err == -EBUSY)
			return;
	}

338
	__gcm_hash_len_done(req, err);
339 340
}

341 342
static void gcm_hash_crypt_remain_done(struct crypto_async_request *areq,
				       int err)
343 344
{
	struct aead_request *req = areq->data;
345 346 347 348 349 350

	__gcm_hash_crypt_remain_done(req, err);
}

static void __gcm_hash_crypt_done(struct aead_request *req, int err)
{
351 352 353 354 355 356 357 358 359 360 361 362 363
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
	unsigned int remain;

	if (!err) {
		remain = gcm_remain(gctx->cryptlen);
		BUG_ON(!remain);
		err = gcm_hash_remain(req, pctx, remain,
				      gcm_hash_crypt_remain_done);
		if (err == -EINPROGRESS || err == -EBUSY)
			return;
	}

364
	__gcm_hash_crypt_remain_done(req, err);
365 366
}

367
static void gcm_hash_crypt_done(struct crypto_async_request *areq, int err)
368 369
{
	struct aead_request *req = areq->data;
370 371 372 373 374 375

	__gcm_hash_crypt_done(req, err);
}

static void __gcm_hash_assoc_remain_done(struct aead_request *req, int err)
{
376 377
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
M
Mark Rustad 已提交
378
	crypto_completion_t compl;
379 380 381 382
	unsigned int remain = 0;

	if (!err && gctx->cryptlen) {
		remain = gcm_remain(gctx->cryptlen);
M
Mark Rustad 已提交
383
		compl = remain ? gcm_hash_crypt_done :
384
			gcm_hash_crypt_remain_done;
M
Mark Rustad 已提交
385
		err = gcm_hash_update(req, pctx, compl,
386 387 388 389 390 391
				      gctx->src, gctx->cryptlen);
		if (err == -EINPROGRESS || err == -EBUSY)
			return;
	}

	if (remain)
392
		__gcm_hash_crypt_done(req, err);
393
	else
394
		__gcm_hash_crypt_remain_done(req, err);
395 396
}

397 398
static void gcm_hash_assoc_remain_done(struct crypto_async_request *areq,
				       int err)
399 400
{
	struct aead_request *req = areq->data;
401 402 403 404 405 406

	__gcm_hash_assoc_remain_done(req, err);
}

static void __gcm_hash_assoc_done(struct aead_request *req, int err)
{
407 408 409 410 411 412 413 414 415 416 417 418
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
	unsigned int remain;

	if (!err) {
		remain = gcm_remain(req->assoclen);
		BUG_ON(!remain);
		err = gcm_hash_remain(req, pctx, remain,
				      gcm_hash_assoc_remain_done);
		if (err == -EINPROGRESS || err == -EBUSY)
			return;
	}

419
	__gcm_hash_assoc_remain_done(req, err);
420 421
}

422
static void gcm_hash_assoc_done(struct crypto_async_request *areq, int err)
423 424
{
	struct aead_request *req = areq->data;
425 426 427 428 429 430

	__gcm_hash_assoc_done(req, err);
}

static void __gcm_hash_init_done(struct aead_request *req, int err)
{
431
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
M
Mark Rustad 已提交
432
	crypto_completion_t compl;
433 434 435 436
	unsigned int remain = 0;

	if (!err && req->assoclen) {
		remain = gcm_remain(req->assoclen);
M
Mark Rustad 已提交
437
		compl = remain ? gcm_hash_assoc_done :
438
			gcm_hash_assoc_remain_done;
M
Mark Rustad 已提交
439
		err = gcm_hash_update(req, pctx, compl,
440 441 442 443 444 445
				      req->assoc, req->assoclen);
		if (err == -EINPROGRESS || err == -EBUSY)
			return;
	}

	if (remain)
446
		__gcm_hash_assoc_done(req, err);
447
	else
448 449 450 451 452 453 454 455
		__gcm_hash_assoc_remain_done(req, err);
}

static void gcm_hash_init_done(struct crypto_async_request *areq, int err)
{
	struct aead_request *req = areq->data;

	__gcm_hash_init_done(req, err);
456 457 458 459 460 461 462 463 464
}

static int gcm_hash(struct aead_request *req,
		    struct crypto_gcm_req_priv_ctx *pctx)
{
	struct ahash_request *ahreq = &pctx->u.ahreq;
	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
	struct crypto_gcm_ctx *ctx = crypto_tfm_ctx(req->base.tfm);
	unsigned int remain;
M
Mark Rustad 已提交
465
	crypto_completion_t compl;
466 467 468 469 470 471 472 473 474 475
	int err;

	ahash_request_set_tfm(ahreq, ctx->ghash);

	ahash_request_set_callback(ahreq, aead_request_flags(req),
				   gcm_hash_init_done, req);
	err = crypto_ahash_init(ahreq);
	if (err)
		return err;
	remain = gcm_remain(req->assoclen);
M
Mark Rustad 已提交
476 477
	compl = remain ? gcm_hash_assoc_done : gcm_hash_assoc_remain_done;
	err = gcm_hash_update(req, pctx, compl, req->assoc, req->assoclen);
478 479 480 481 482 483 484 485 486
	if (err)
		return err;
	if (remain) {
		err = gcm_hash_remain(req, pctx, remain,
				      gcm_hash_assoc_remain_done);
		if (err)
			return err;
	}
	remain = gcm_remain(gctx->cryptlen);
M
Mark Rustad 已提交
487 488
	compl = remain ? gcm_hash_crypt_done : gcm_hash_crypt_remain_done;
	err = gcm_hash_update(req, pctx, compl, gctx->src, gctx->cryptlen);
489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511
	if (err)
		return err;
	if (remain) {
		err = gcm_hash_remain(req, pctx, remain,
				      gcm_hash_crypt_remain_done);
		if (err)
			return err;
	}
	err = gcm_hash_len(req, pctx);
	if (err)
		return err;
	err = gcm_hash_final(req, pctx);
	if (err)
		return err;

	return 0;
}

static void gcm_enc_copy_hash(struct aead_request *req,
			      struct crypto_gcm_req_priv_ctx *pctx)
{
	struct crypto_aead *aead = crypto_aead_reqtfm(req);
	u8 *auth_tag = pctx->auth_tag;
M
Mikko Herranen 已提交
512

H
Herbert Xu 已提交
513 514 515 516
	scatterwalk_map_and_copy(auth_tag, req->dst, req->cryptlen,
				 crypto_aead_authsize(aead), 1);
}

517
static void gcm_enc_hash_done(struct aead_request *req, int err)
H
Herbert Xu 已提交
518
{
519
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
H
Herbert Xu 已提交
520 521

	if (!err)
522
		gcm_enc_copy_hash(req, pctx);
H
Herbert Xu 已提交
523

M
Mikko Herranen 已提交
524 525 526
	aead_request_complete(req, err);
}

527
static void gcm_encrypt_done(struct crypto_async_request *areq, int err)
528 529 530 531 532 533 534 535
{
	struct aead_request *req = areq->data;
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);

	if (!err) {
		err = gcm_hash(req, pctx);
		if (err == -EINPROGRESS || err == -EBUSY)
			return;
536 537 538 539
		else if (!err) {
			crypto_xor(pctx->auth_tag, pctx->iauth_tag, 16);
			gcm_enc_copy_hash(req, pctx);
		}
540 541
	}

542
	aead_request_complete(req, err);
543 544
}

M
Mikko Herranen 已提交
545 546
static int crypto_gcm_encrypt(struct aead_request *req)
{
547
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
548 549
	struct ablkcipher_request *abreq = &pctx->u.abreq;
	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
550 551 552 553
	int err;

	crypto_gcm_init_crypt(abreq, req, req->cryptlen);
	ablkcipher_request_set_callback(abreq, aead_request_flags(req),
554 555 556 557 558
					gcm_encrypt_done, req);

	gctx->src = req->dst;
	gctx->cryptlen = req->cryptlen;
	gctx->complete = gcm_enc_hash_done;
M
Mikko Herranen 已提交
559

560
	err = crypto_ablkcipher_encrypt(abreq);
M
Mikko Herranen 已提交
561 562 563
	if (err)
		return err;

564 565 566 567 568 569 570 571
	err = gcm_hash(req, pctx);
	if (err)
		return err;

	crypto_xor(pctx->auth_tag, pctx->iauth_tag, 16);
	gcm_enc_copy_hash(req, pctx);

	return 0;
M
Mikko Herranen 已提交
572 573
}

574 575
static int crypto_gcm_verify(struct aead_request *req,
			     struct crypto_gcm_req_priv_ctx *pctx)
576 577 578 579 580 581 582
{
	struct crypto_aead *aead = crypto_aead_reqtfm(req);
	u8 *auth_tag = pctx->auth_tag;
	u8 *iauth_tag = pctx->iauth_tag;
	unsigned int authsize = crypto_aead_authsize(aead);
	unsigned int cryptlen = req->cryptlen - authsize;

583
	crypto_xor(auth_tag, iauth_tag, 16);
584
	scatterwalk_map_and_copy(iauth_tag, req->src, cryptlen, authsize, 0);
585
	return crypto_memneq(iauth_tag, auth_tag, authsize) ? -EBADMSG : 0;
586 587
}

588
static void gcm_decrypt_done(struct crypto_async_request *areq, int err)
M
Mikko Herranen 已提交
589
{
590
	struct aead_request *req = areq->data;
591
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
592 593

	if (!err)
594
		err = crypto_gcm_verify(req, pctx);
595 596

	aead_request_complete(req, err);
M
Mikko Herranen 已提交
597 598
}

599
static void gcm_dec_hash_done(struct aead_request *req, int err)
600 601 602 603 604 605 606 607 608 609 610 611
{
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
	struct ablkcipher_request *abreq = &pctx->u.abreq;
	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;

	if (!err) {
		ablkcipher_request_set_callback(abreq, aead_request_flags(req),
						gcm_decrypt_done, req);
		crypto_gcm_init_crypt(abreq, req, gctx->cryptlen);
		err = crypto_ablkcipher_decrypt(abreq);
		if (err == -EINPROGRESS || err == -EBUSY)
			return;
612 613
		else if (!err)
			err = crypto_gcm_verify(req, pctx);
614 615
	}

616
	aead_request_complete(req, err);
617 618
}

M
Mikko Herranen 已提交
619 620
static int crypto_gcm_decrypt(struct aead_request *req)
{
H
Herbert Xu 已提交
621
	struct crypto_aead *aead = crypto_aead_reqtfm(req);
622
	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
623 624
	struct ablkcipher_request *abreq = &pctx->u.abreq;
	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
H
Herbert Xu 已提交
625
	unsigned int authsize = crypto_aead_authsize(aead);
626
	unsigned int cryptlen = req->cryptlen;
M
Mikko Herranen 已提交
627 628
	int err;

H
Herbert Xu 已提交
629
	if (cryptlen < authsize)
M
Mikko Herranen 已提交
630
		return -EINVAL;
H
Herbert Xu 已提交
631
	cryptlen -= authsize;
M
Mikko Herranen 已提交
632

633 634 635
	gctx->src = req->src;
	gctx->cryptlen = cryptlen;
	gctx->complete = gcm_dec_hash_done;
M
Mikko Herranen 已提交
636

637 638 639
	err = gcm_hash(req, pctx);
	if (err)
		return err;
M
Mikko Herranen 已提交
640

641 642 643
	ablkcipher_request_set_callback(abreq, aead_request_flags(req),
					gcm_decrypt_done, req);
	crypto_gcm_init_crypt(abreq, req, cryptlen);
644 645 646
	err = crypto_ablkcipher_decrypt(abreq);
	if (err)
		return err;
M
Mikko Herranen 已提交
647

648
	return crypto_gcm_verify(req, pctx);
M
Mikko Herranen 已提交
649 650 651 652 653 654 655 656
}

static int crypto_gcm_init_tfm(struct crypto_tfm *tfm)
{
	struct crypto_instance *inst = (void *)tfm->__crt_alg;
	struct gcm_instance_ctx *ictx = crypto_instance_ctx(inst);
	struct crypto_gcm_ctx *ctx = crypto_tfm_ctx(tfm);
	struct crypto_ablkcipher *ctr;
657
	struct crypto_ahash *ghash;
M
Mikko Herranen 已提交
658 659 660
	unsigned long align;
	int err;

661 662 663 664
	ghash = crypto_spawn_ahash(&ictx->ghash);
	if (IS_ERR(ghash))
		return PTR_ERR(ghash);

665
	ctr = crypto_spawn_skcipher(&ictx->ctr);
M
Mikko Herranen 已提交
666 667
	err = PTR_ERR(ctr);
	if (IS_ERR(ctr))
668
		goto err_free_hash;
M
Mikko Herranen 已提交
669 670

	ctx->ctr = ctr;
671
	ctx->ghash = ghash;
M
Mikko Herranen 已提交
672

673
	align = crypto_tfm_alg_alignmask(tfm);
M
Mikko Herranen 已提交
674
	align &= ~(crypto_tfm_ctx_alignment() - 1);
675
	tfm->crt_aead.reqsize = align +
676 677 678 679 680
		offsetof(struct crypto_gcm_req_priv_ctx, u) +
		max(sizeof(struct ablkcipher_request) +
		    crypto_ablkcipher_reqsize(ctr),
		    sizeof(struct ahash_request) +
		    crypto_ahash_reqsize(ghash));
M
Mikko Herranen 已提交
681 682

	return 0;
683 684 685 686

err_free_hash:
	crypto_free_ahash(ghash);
	return err;
M
Mikko Herranen 已提交
687 688 689 690 691 692
}

static void crypto_gcm_exit_tfm(struct crypto_tfm *tfm)
{
	struct crypto_gcm_ctx *ctx = crypto_tfm_ctx(tfm);

693
	crypto_free_ahash(ctx->ghash);
M
Mikko Herranen 已提交
694 695 696
	crypto_free_ablkcipher(ctx->ctr);
}

697 698
static struct crypto_instance *crypto_gcm_alloc_common(struct rtattr **tb,
						       const char *full_name,
699 700
						       const char *ctr_name,
						       const char *ghash_name)
M
Mikko Herranen 已提交
701
{
702
	struct crypto_attr_type *algt;
M
Mikko Herranen 已提交
703 704
	struct crypto_instance *inst;
	struct crypto_alg *ctr;
705 706
	struct crypto_alg *ghash_alg;
	struct ahash_alg *ghash_ahash_alg;
M
Mikko Herranen 已提交
707 708 709
	struct gcm_instance_ctx *ctx;
	int err;

710 711
	algt = crypto_get_attr_type(tb);
	if (IS_ERR(algt))
J
Julia Lawall 已提交
712
		return ERR_CAST(algt);
M
Mikko Herranen 已提交
713

714 715
	if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
		return ERR_PTR(-EINVAL);
M
Mikko Herranen 已提交
716

717 718 719 720
	ghash_alg = crypto_find_alg(ghash_name, &crypto_ahash_type,
				    CRYPTO_ALG_TYPE_HASH,
				    CRYPTO_ALG_TYPE_AHASH_MASK);
	if (IS_ERR(ghash_alg))
J
Julia Lawall 已提交
721
		return ERR_CAST(ghash_alg);
722 723

	err = -ENOMEM;
724 725
	inst = kzalloc(sizeof(*inst) + sizeof(*ctx), GFP_KERNEL);
	if (!inst)
726
		goto out_put_ghash;
M
Mikko Herranen 已提交
727

728
	ctx = crypto_instance_ctx(inst);
729 730 731 732 733 734
	ghash_ahash_alg = container_of(ghash_alg, struct ahash_alg, halg.base);
	err = crypto_init_ahash_spawn(&ctx->ghash, &ghash_ahash_alg->halg,
				      inst);
	if (err)
		goto err_free_inst;

735 736 737 738 739
	crypto_set_skcipher_spawn(&ctx->ctr, inst);
	err = crypto_grab_skcipher(&ctx->ctr, ctr_name, 0,
				   crypto_requires_sync(algt->type,
							algt->mask));
	if (err)
740
		goto err_drop_ghash;
741 742

	ctr = crypto_skcipher_spawn_alg(&ctx->ctr);
M
Mikko Herranen 已提交
743

744
	/* We only support 16-byte blocks. */
745
	if (ctr->cra_ablkcipher.ivsize != 16)
746 747 748 749 750
		goto out_put_ctr;

	/* Not a stream cipher? */
	err = -EINVAL;
	if (ctr->cra_blocksize != 1)
M
Mikko Herranen 已提交
751 752 753
		goto out_put_ctr;

	err = -ENAMETOOLONG;
754
	if (snprintf(inst->alg.cra_driver_name, CRYPTO_MAX_ALG_NAME,
755 756
		     "gcm_base(%s,%s)", ctr->cra_driver_name,
		     ghash_alg->cra_driver_name) >=
757
	    CRYPTO_MAX_ALG_NAME)
758
		goto out_put_ctr;
M
Mikko Herranen 已提交
759

760 761
	memcpy(inst->alg.cra_name, full_name, CRYPTO_MAX_ALG_NAME);

762 763
	inst->alg.cra_flags = CRYPTO_ALG_TYPE_AEAD;
	inst->alg.cra_flags |= ctr->cra_flags & CRYPTO_ALG_ASYNC;
M
Mikko Herranen 已提交
764
	inst->alg.cra_priority = ctr->cra_priority;
765
	inst->alg.cra_blocksize = 1;
766
	inst->alg.cra_alignmask = ctr->cra_alignmask | (__alignof__(u64) - 1);
M
Mikko Herranen 已提交
767
	inst->alg.cra_type = &crypto_aead_type;
768
	inst->alg.cra_aead.ivsize = 16;
769
	inst->alg.cra_aead.maxauthsize = 16;
M
Mikko Herranen 已提交
770 771 772 773
	inst->alg.cra_ctxsize = sizeof(struct crypto_gcm_ctx);
	inst->alg.cra_init = crypto_gcm_init_tfm;
	inst->alg.cra_exit = crypto_gcm_exit_tfm;
	inst->alg.cra_aead.setkey = crypto_gcm_setkey;
H
Herbert Xu 已提交
774
	inst->alg.cra_aead.setauthsize = crypto_gcm_setauthsize;
M
Mikko Herranen 已提交
775 776 777 778
	inst->alg.cra_aead.encrypt = crypto_gcm_encrypt;
	inst->alg.cra_aead.decrypt = crypto_gcm_decrypt;

out:
779
	crypto_mod_put(ghash_alg);
M
Mikko Herranen 已提交
780
	return inst;
781 782 783

out_put_ctr:
	crypto_drop_skcipher(&ctx->ctr);
784 785
err_drop_ghash:
	crypto_drop_ahash(&ctx->ghash);
M
Mikko Herranen 已提交
786 787
err_free_inst:
	kfree(inst);
788
out_put_ghash:
M
Mikko Herranen 已提交
789 790 791 792
	inst = ERR_PTR(err);
	goto out;
}

793 794 795 796 797 798 799 800
static struct crypto_instance *crypto_gcm_alloc(struct rtattr **tb)
{
	const char *cipher_name;
	char ctr_name[CRYPTO_MAX_ALG_NAME];
	char full_name[CRYPTO_MAX_ALG_NAME];

	cipher_name = crypto_attr_alg_name(tb[1]);
	if (IS_ERR(cipher_name))
J
Julia Lawall 已提交
801
		return ERR_CAST(cipher_name);
802 803 804 805 806 807 808 809 810

	if (snprintf(ctr_name, CRYPTO_MAX_ALG_NAME, "ctr(%s)", cipher_name) >=
	    CRYPTO_MAX_ALG_NAME)
		return ERR_PTR(-ENAMETOOLONG);

	if (snprintf(full_name, CRYPTO_MAX_ALG_NAME, "gcm(%s)", cipher_name) >=
	    CRYPTO_MAX_ALG_NAME)
		return ERR_PTR(-ENAMETOOLONG);

811
	return crypto_gcm_alloc_common(tb, full_name, ctr_name, "ghash");
812 813
}

M
Mikko Herranen 已提交
814 815 816 817
static void crypto_gcm_free(struct crypto_instance *inst)
{
	struct gcm_instance_ctx *ctx = crypto_instance_ctx(inst);

818
	crypto_drop_skcipher(&ctx->ctr);
819
	crypto_drop_ahash(&ctx->ghash);
M
Mikko Herranen 已提交
820 821 822 823 824 825 826 827 828 829
	kfree(inst);
}

static struct crypto_template crypto_gcm_tmpl = {
	.name = "gcm",
	.alloc = crypto_gcm_alloc,
	.free = crypto_gcm_free,
	.module = THIS_MODULE,
};

830 831 832
static struct crypto_instance *crypto_gcm_base_alloc(struct rtattr **tb)
{
	const char *ctr_name;
833
	const char *ghash_name;
834 835 836 837
	char full_name[CRYPTO_MAX_ALG_NAME];

	ctr_name = crypto_attr_alg_name(tb[1]);
	if (IS_ERR(ctr_name))
J
Julia Lawall 已提交
838
		return ERR_CAST(ctr_name);
839

840 841
	ghash_name = crypto_attr_alg_name(tb[2]);
	if (IS_ERR(ghash_name))
J
Julia Lawall 已提交
842
		return ERR_CAST(ghash_name);
843 844 845

	if (snprintf(full_name, CRYPTO_MAX_ALG_NAME, "gcm_base(%s,%s)",
		     ctr_name, ghash_name) >= CRYPTO_MAX_ALG_NAME)
846 847
		return ERR_PTR(-ENAMETOOLONG);

848
	return crypto_gcm_alloc_common(tb, full_name, ctr_name, ghash_name);
849 850 851 852 853 854 855 856 857
}

static struct crypto_template crypto_gcm_base_tmpl = {
	.name = "gcm_base",
	.alloc = crypto_gcm_base_alloc,
	.free = crypto_gcm_free,
	.module = THIS_MODULE,
};

H
Herbert Xu 已提交
858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 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 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974
static int crypto_rfc4106_setkey(struct crypto_aead *parent, const u8 *key,
				 unsigned int keylen)
{
	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(parent);
	struct crypto_aead *child = ctx->child;
	int err;

	if (keylen < 4)
		return -EINVAL;

	keylen -= 4;
	memcpy(ctx->nonce, key + keylen, 4);

	crypto_aead_clear_flags(child, CRYPTO_TFM_REQ_MASK);
	crypto_aead_set_flags(child, crypto_aead_get_flags(parent) &
				     CRYPTO_TFM_REQ_MASK);
	err = crypto_aead_setkey(child, key, keylen);
	crypto_aead_set_flags(parent, crypto_aead_get_flags(child) &
				      CRYPTO_TFM_RES_MASK);

	return err;
}

static int crypto_rfc4106_setauthsize(struct crypto_aead *parent,
				      unsigned int authsize)
{
	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(parent);

	switch (authsize) {
	case 8:
	case 12:
	case 16:
		break;
	default:
		return -EINVAL;
	}

	return crypto_aead_setauthsize(ctx->child, authsize);
}

static struct aead_request *crypto_rfc4106_crypt(struct aead_request *req)
{
	struct aead_request *subreq = aead_request_ctx(req);
	struct crypto_aead *aead = crypto_aead_reqtfm(req);
	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(aead);
	struct crypto_aead *child = ctx->child;
	u8 *iv = PTR_ALIGN((u8 *)(subreq + 1) + crypto_aead_reqsize(child),
			   crypto_aead_alignmask(child) + 1);

	memcpy(iv, ctx->nonce, 4);
	memcpy(iv + 4, req->iv, 8);

	aead_request_set_tfm(subreq, child);
	aead_request_set_callback(subreq, req->base.flags, req->base.complete,
				  req->base.data);
	aead_request_set_crypt(subreq, req->src, req->dst, req->cryptlen, iv);
	aead_request_set_assoc(subreq, req->assoc, req->assoclen);

	return subreq;
}

static int crypto_rfc4106_encrypt(struct aead_request *req)
{
	req = crypto_rfc4106_crypt(req);

	return crypto_aead_encrypt(req);
}

static int crypto_rfc4106_decrypt(struct aead_request *req)
{
	req = crypto_rfc4106_crypt(req);

	return crypto_aead_decrypt(req);
}

static int crypto_rfc4106_init_tfm(struct crypto_tfm *tfm)
{
	struct crypto_instance *inst = (void *)tfm->__crt_alg;
	struct crypto_aead_spawn *spawn = crypto_instance_ctx(inst);
	struct crypto_rfc4106_ctx *ctx = crypto_tfm_ctx(tfm);
	struct crypto_aead *aead;
	unsigned long align;

	aead = crypto_spawn_aead(spawn);
	if (IS_ERR(aead))
		return PTR_ERR(aead);

	ctx->child = aead;

	align = crypto_aead_alignmask(aead);
	align &= ~(crypto_tfm_ctx_alignment() - 1);
	tfm->crt_aead.reqsize = sizeof(struct aead_request) +
				ALIGN(crypto_aead_reqsize(aead),
				      crypto_tfm_ctx_alignment()) +
				align + 16;

	return 0;
}

static void crypto_rfc4106_exit_tfm(struct crypto_tfm *tfm)
{
	struct crypto_rfc4106_ctx *ctx = crypto_tfm_ctx(tfm);

	crypto_free_aead(ctx->child);
}

static struct crypto_instance *crypto_rfc4106_alloc(struct rtattr **tb)
{
	struct crypto_attr_type *algt;
	struct crypto_instance *inst;
	struct crypto_aead_spawn *spawn;
	struct crypto_alg *alg;
	const char *ccm_name;
	int err;

	algt = crypto_get_attr_type(tb);
	if (IS_ERR(algt))
J
Julia Lawall 已提交
975
		return ERR_CAST(algt);
H
Herbert Xu 已提交
976 977 978 979 980 981

	if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
		return ERR_PTR(-EINVAL);

	ccm_name = crypto_attr_alg_name(tb[1]);
	if (IS_ERR(ccm_name))
J
Julia Lawall 已提交
982
		return ERR_CAST(ccm_name);
H
Herbert Xu 已提交
983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 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

	inst = kzalloc(sizeof(*inst) + sizeof(*spawn), GFP_KERNEL);
	if (!inst)
		return ERR_PTR(-ENOMEM);

	spawn = crypto_instance_ctx(inst);
	crypto_set_aead_spawn(spawn, inst);
	err = crypto_grab_aead(spawn, ccm_name, 0,
			       crypto_requires_sync(algt->type, algt->mask));
	if (err)
		goto out_free_inst;

	alg = crypto_aead_spawn_alg(spawn);

	err = -EINVAL;

	/* We only support 16-byte blocks. */
	if (alg->cra_aead.ivsize != 16)
		goto out_drop_alg;

	/* Not a stream cipher? */
	if (alg->cra_blocksize != 1)
		goto out_drop_alg;

	err = -ENAMETOOLONG;
	if (snprintf(inst->alg.cra_name, CRYPTO_MAX_ALG_NAME,
		     "rfc4106(%s)", alg->cra_name) >= CRYPTO_MAX_ALG_NAME ||
	    snprintf(inst->alg.cra_driver_name, CRYPTO_MAX_ALG_NAME,
		     "rfc4106(%s)", alg->cra_driver_name) >=
	    CRYPTO_MAX_ALG_NAME)
		goto out_drop_alg;

	inst->alg.cra_flags = CRYPTO_ALG_TYPE_AEAD;
	inst->alg.cra_flags |= alg->cra_flags & CRYPTO_ALG_ASYNC;
	inst->alg.cra_priority = alg->cra_priority;
	inst->alg.cra_blocksize = 1;
	inst->alg.cra_alignmask = alg->cra_alignmask;
	inst->alg.cra_type = &crypto_nivaead_type;

	inst->alg.cra_aead.ivsize = 8;
	inst->alg.cra_aead.maxauthsize = 16;

	inst->alg.cra_ctxsize = sizeof(struct crypto_rfc4106_ctx);

	inst->alg.cra_init = crypto_rfc4106_init_tfm;
	inst->alg.cra_exit = crypto_rfc4106_exit_tfm;

	inst->alg.cra_aead.setkey = crypto_rfc4106_setkey;
	inst->alg.cra_aead.setauthsize = crypto_rfc4106_setauthsize;
	inst->alg.cra_aead.encrypt = crypto_rfc4106_encrypt;
	inst->alg.cra_aead.decrypt = crypto_rfc4106_decrypt;

	inst->alg.cra_aead.geniv = "seqiv";

out:
	return inst;

out_drop_alg:
	crypto_drop_aead(spawn);
out_free_inst:
	kfree(inst);
	inst = ERR_PTR(err);
	goto out;
}

static void crypto_rfc4106_free(struct crypto_instance *inst)
{
	crypto_drop_spawn(crypto_instance_ctx(inst));
	kfree(inst);
}

static struct crypto_template crypto_rfc4106_tmpl = {
	.name = "rfc4106",
	.alloc = crypto_rfc4106_alloc,
	.free = crypto_rfc4106_free,
	.module = THIS_MODULE,
};

1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102
static inline struct crypto_rfc4543_req_ctx *crypto_rfc4543_reqctx(
	struct aead_request *req)
{
	unsigned long align = crypto_aead_alignmask(crypto_aead_reqtfm(req));

	return (void *)PTR_ALIGN((u8 *)aead_request_ctx(req), align + 1);
}

static int crypto_rfc4543_setkey(struct crypto_aead *parent, const u8 *key,
				 unsigned int keylen)
{
	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(parent);
	struct crypto_aead *child = ctx->child;
	int err;

	if (keylen < 4)
		return -EINVAL;

	keylen -= 4;
	memcpy(ctx->nonce, key + keylen, 4);

	crypto_aead_clear_flags(child, CRYPTO_TFM_REQ_MASK);
	crypto_aead_set_flags(child, crypto_aead_get_flags(parent) &
				     CRYPTO_TFM_REQ_MASK);
	err = crypto_aead_setkey(child, key, keylen);
	crypto_aead_set_flags(parent, crypto_aead_get_flags(child) &
				      CRYPTO_TFM_RES_MASK);

	return err;
}

static int crypto_rfc4543_setauthsize(struct crypto_aead *parent,
				      unsigned int authsize)
{
	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(parent);

	if (authsize != 16)
		return -EINVAL;

	return crypto_aead_setauthsize(ctx->child, authsize);
}

1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117
static void crypto_rfc4543_done(struct crypto_async_request *areq, int err)
{
	struct aead_request *req = areq->data;
	struct crypto_aead *aead = crypto_aead_reqtfm(req);
	struct crypto_rfc4543_req_ctx *rctx = crypto_rfc4543_reqctx(req);

	if (!err) {
		scatterwalk_map_and_copy(rctx->auth_tag, req->dst,
					 req->cryptlen,
					 crypto_aead_authsize(aead), 1);
	}

	aead_request_complete(req, err);
}

1118
static struct aead_request *crypto_rfc4543_crypt(struct aead_request *req,
1119
						 bool enc)
1120 1121 1122 1123 1124
{
	struct crypto_aead *aead = crypto_aead_reqtfm(req);
	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(aead);
	struct crypto_rfc4543_req_ctx *rctx = crypto_rfc4543_reqctx(req);
	struct aead_request *subreq = &rctx->subreq;
1125
	struct scatterlist *src = req->src;
1126 1127 1128 1129 1130
	struct scatterlist *cipher = rctx->cipher;
	struct scatterlist *payload = rctx->payload;
	struct scatterlist *assoc = rctx->assoc;
	unsigned int authsize = crypto_aead_authsize(aead);
	unsigned int assoclen = req->assoclen;
1131 1132
	struct page *srcp;
	u8 *vsrc;
1133 1134 1135 1136 1137 1138 1139 1140 1141 1142
	u8 *iv = PTR_ALIGN((u8 *)(rctx + 1) + crypto_aead_reqsize(ctx->child),
			   crypto_aead_alignmask(ctx->child) + 1);

	memcpy(iv, ctx->nonce, 4);
	memcpy(iv + 4, req->iv, 8);

	/* construct cipher/plaintext */
	if (enc)
		memset(rctx->auth_tag, 0, authsize);
	else
1143
		scatterwalk_map_and_copy(rctx->auth_tag, src,
1144 1145 1146 1147 1148 1149
					 req->cryptlen - authsize,
					 authsize, 0);

	sg_init_one(cipher, rctx->auth_tag, authsize);

	/* construct the aad */
1150 1151
	srcp = sg_page(src);
	vsrc = PageHighMem(srcp) ? NULL : page_address(srcp) + src->offset;
1152 1153 1154

	sg_init_table(payload, 2);
	sg_set_buf(payload, req->iv, 8);
1155
	scatterwalk_crypto_chain(payload, src, vsrc == req->iv + 8, 2);
1156 1157
	assoclen += 8 + req->cryptlen - (enc ? 0 : authsize);

1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170
	if (req->assoc->length == req->assoclen) {
		sg_init_table(assoc, 2);
		sg_set_page(assoc, sg_page(req->assoc), req->assoc->length,
			    req->assoc->offset);
	} else {
		BUG_ON(req->assoclen > sizeof(rctx->assocbuf));

		scatterwalk_map_and_copy(rctx->assocbuf, req->assoc, 0,
					 req->assoclen, 0);

		sg_init_table(assoc, 2);
		sg_set_buf(assoc, rctx->assocbuf, req->assoclen);
	}
1171
	scatterwalk_crypto_chain(assoc, payload, 0, 2);
1172 1173

	aead_request_set_tfm(subreq, ctx->child);
1174 1175
	aead_request_set_callback(subreq, req->base.flags, crypto_rfc4543_done,
				  req);
1176 1177 1178 1179 1180 1181
	aead_request_set_crypt(subreq, cipher, cipher, enc ? 0 : authsize, iv);
	aead_request_set_assoc(subreq, assoc, assoclen);

	return subreq;
}

1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194
static int crypto_rfc4543_copy_src_to_dst(struct aead_request *req, bool enc)
{
	struct crypto_aead *aead = crypto_aead_reqtfm(req);
	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(aead);
	unsigned int authsize = crypto_aead_authsize(aead);
	unsigned int nbytes = req->cryptlen - (enc ? 0 : authsize);
	struct blkcipher_desc desc = {
		.tfm = ctx->null,
	};

	return crypto_blkcipher_encrypt(&desc, req->dst, req->src, nbytes);
}

1195 1196 1197 1198 1199 1200 1201
static int crypto_rfc4543_encrypt(struct aead_request *req)
{
	struct crypto_aead *aead = crypto_aead_reqtfm(req);
	struct crypto_rfc4543_req_ctx *rctx = crypto_rfc4543_reqctx(req);
	struct aead_request *subreq;
	int err;

1202 1203 1204 1205 1206 1207 1208
	if (req->src != req->dst) {
		err = crypto_rfc4543_copy_src_to_dst(req, true);
		if (err)
			return err;
	}

	subreq = crypto_rfc4543_crypt(req, true);
1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220
	err = crypto_aead_encrypt(subreq);
	if (err)
		return err;

	scatterwalk_map_and_copy(rctx->auth_tag, req->dst, req->cryptlen,
				 crypto_aead_authsize(aead), 1);

	return 0;
}

static int crypto_rfc4543_decrypt(struct aead_request *req)
{
1221 1222 1223 1224 1225 1226 1227 1228 1229
	int err;

	if (req->src != req->dst) {
		err = crypto_rfc4543_copy_src_to_dst(req, false);
		if (err)
			return err;
	}

	req = crypto_rfc4543_crypt(req, false);
1230 1231 1232 1233 1234 1235 1236

	return crypto_aead_decrypt(req);
}

static int crypto_rfc4543_init_tfm(struct crypto_tfm *tfm)
{
	struct crypto_instance *inst = (void *)tfm->__crt_alg;
1237 1238
	struct crypto_rfc4543_instance_ctx *ictx = crypto_instance_ctx(inst);
	struct crypto_aead_spawn *spawn = &ictx->aead;
1239 1240
	struct crypto_rfc4543_ctx *ctx = crypto_tfm_ctx(tfm);
	struct crypto_aead *aead;
1241
	struct crypto_blkcipher *null;
1242
	unsigned long align;
1243
	int err = 0;
1244 1245 1246 1247 1248

	aead = crypto_spawn_aead(spawn);
	if (IS_ERR(aead))
		return PTR_ERR(aead);

1249 1250 1251 1252 1253
	null = crypto_spawn_blkcipher(&ictx->null.base);
	err = PTR_ERR(null);
	if (IS_ERR(null))
		goto err_free_aead;

1254
	ctx->child = aead;
1255
	ctx->null = null;
1256 1257 1258 1259 1260 1261 1262 1263 1264

	align = crypto_aead_alignmask(aead);
	align &= ~(crypto_tfm_ctx_alignment() - 1);
	tfm->crt_aead.reqsize = sizeof(struct crypto_rfc4543_req_ctx) +
				ALIGN(crypto_aead_reqsize(aead),
				      crypto_tfm_ctx_alignment()) +
				align + 16;

	return 0;
1265 1266 1267 1268

err_free_aead:
	crypto_free_aead(aead);
	return err;
1269 1270 1271 1272 1273 1274 1275
}

static void crypto_rfc4543_exit_tfm(struct crypto_tfm *tfm)
{
	struct crypto_rfc4543_ctx *ctx = crypto_tfm_ctx(tfm);

	crypto_free_aead(ctx->child);
1276
	crypto_free_blkcipher(ctx->null);
1277 1278 1279 1280 1281 1282 1283 1284
}

static struct crypto_instance *crypto_rfc4543_alloc(struct rtattr **tb)
{
	struct crypto_attr_type *algt;
	struct crypto_instance *inst;
	struct crypto_aead_spawn *spawn;
	struct crypto_alg *alg;
1285
	struct crypto_rfc4543_instance_ctx *ctx;
1286 1287 1288 1289 1290
	const char *ccm_name;
	int err;

	algt = crypto_get_attr_type(tb);
	if (IS_ERR(algt))
J
Julia Lawall 已提交
1291
		return ERR_CAST(algt);
1292 1293 1294 1295 1296 1297

	if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
		return ERR_PTR(-EINVAL);

	ccm_name = crypto_attr_alg_name(tb[1]);
	if (IS_ERR(ccm_name))
J
Julia Lawall 已提交
1298
		return ERR_CAST(ccm_name);
1299

1300
	inst = kzalloc(sizeof(*inst) + sizeof(*ctx), GFP_KERNEL);
1301 1302 1303
	if (!inst)
		return ERR_PTR(-ENOMEM);

1304 1305
	ctx = crypto_instance_ctx(inst);
	spawn = &ctx->aead;
1306 1307 1308 1309 1310 1311 1312 1313
	crypto_set_aead_spawn(spawn, inst);
	err = crypto_grab_aead(spawn, ccm_name, 0,
			       crypto_requires_sync(algt->type, algt->mask));
	if (err)
		goto out_free_inst;

	alg = crypto_aead_spawn_alg(spawn);

1314 1315 1316 1317 1318 1319 1320 1321
	crypto_set_skcipher_spawn(&ctx->null, inst);
	err = crypto_grab_skcipher(&ctx->null, "ecb(cipher_null)", 0,
				   CRYPTO_ALG_ASYNC);
	if (err)
		goto out_drop_alg;

	crypto_skcipher_spawn_alg(&ctx->null);

1322 1323 1324 1325
	err = -EINVAL;

	/* We only support 16-byte blocks. */
	if (alg->cra_aead.ivsize != 16)
1326
		goto out_drop_ecbnull;
1327 1328 1329

	/* Not a stream cipher? */
	if (alg->cra_blocksize != 1)
1330
		goto out_drop_ecbnull;
1331 1332 1333 1334 1335 1336 1337

	err = -ENAMETOOLONG;
	if (snprintf(inst->alg.cra_name, CRYPTO_MAX_ALG_NAME,
		     "rfc4543(%s)", alg->cra_name) >= CRYPTO_MAX_ALG_NAME ||
	    snprintf(inst->alg.cra_driver_name, CRYPTO_MAX_ALG_NAME,
		     "rfc4543(%s)", alg->cra_driver_name) >=
	    CRYPTO_MAX_ALG_NAME)
1338
		goto out_drop_ecbnull;
1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364

	inst->alg.cra_flags = CRYPTO_ALG_TYPE_AEAD;
	inst->alg.cra_flags |= alg->cra_flags & CRYPTO_ALG_ASYNC;
	inst->alg.cra_priority = alg->cra_priority;
	inst->alg.cra_blocksize = 1;
	inst->alg.cra_alignmask = alg->cra_alignmask;
	inst->alg.cra_type = &crypto_nivaead_type;

	inst->alg.cra_aead.ivsize = 8;
	inst->alg.cra_aead.maxauthsize = 16;

	inst->alg.cra_ctxsize = sizeof(struct crypto_rfc4543_ctx);

	inst->alg.cra_init = crypto_rfc4543_init_tfm;
	inst->alg.cra_exit = crypto_rfc4543_exit_tfm;

	inst->alg.cra_aead.setkey = crypto_rfc4543_setkey;
	inst->alg.cra_aead.setauthsize = crypto_rfc4543_setauthsize;
	inst->alg.cra_aead.encrypt = crypto_rfc4543_encrypt;
	inst->alg.cra_aead.decrypt = crypto_rfc4543_decrypt;

	inst->alg.cra_aead.geniv = "seqiv";

out:
	return inst;

1365 1366
out_drop_ecbnull:
	crypto_drop_skcipher(&ctx->null);
1367 1368 1369 1370 1371 1372 1373 1374 1375 1376
out_drop_alg:
	crypto_drop_aead(spawn);
out_free_inst:
	kfree(inst);
	inst = ERR_PTR(err);
	goto out;
}

static void crypto_rfc4543_free(struct crypto_instance *inst)
{
1377 1378 1379 1380 1381
	struct crypto_rfc4543_instance_ctx *ctx = crypto_instance_ctx(inst);

	crypto_drop_aead(&ctx->aead);
	crypto_drop_skcipher(&ctx->null);

1382 1383 1384 1385 1386 1387 1388 1389 1390 1391
	kfree(inst);
}

static struct crypto_template crypto_rfc4543_tmpl = {
	.name = "rfc4543",
	.alloc = crypto_rfc4543_alloc,
	.free = crypto_rfc4543_free,
	.module = THIS_MODULE,
};

M
Mikko Herranen 已提交
1392 1393
static int __init crypto_gcm_module_init(void)
{
1394 1395
	int err;

1396 1397 1398 1399
	gcm_zeroes = kzalloc(16, GFP_KERNEL);
	if (!gcm_zeroes)
		return -ENOMEM;

1400 1401 1402 1403 1404 1405 1406 1407
	err = crypto_register_template(&crypto_gcm_base_tmpl);
	if (err)
		goto out;

	err = crypto_register_template(&crypto_gcm_tmpl);
	if (err)
		goto out_undo_base;

H
Herbert Xu 已提交
1408 1409 1410 1411
	err = crypto_register_template(&crypto_rfc4106_tmpl);
	if (err)
		goto out_undo_gcm;

1412 1413 1414 1415
	err = crypto_register_template(&crypto_rfc4543_tmpl);
	if (err)
		goto out_undo_rfc4106;

1416
	return 0;
1417

1418 1419
out_undo_rfc4106:
	crypto_unregister_template(&crypto_rfc4106_tmpl);
H
Herbert Xu 已提交
1420 1421
out_undo_gcm:
	crypto_unregister_template(&crypto_gcm_tmpl);
1422 1423
out_undo_base:
	crypto_unregister_template(&crypto_gcm_base_tmpl);
1424 1425 1426
out:
	kfree(gcm_zeroes);
	return err;
M
Mikko Herranen 已提交
1427 1428 1429 1430
}

static void __exit crypto_gcm_module_exit(void)
{
1431
	kfree(gcm_zeroes);
1432
	crypto_unregister_template(&crypto_rfc4543_tmpl);
H
Herbert Xu 已提交
1433
	crypto_unregister_template(&crypto_rfc4106_tmpl);
M
Mikko Herranen 已提交
1434
	crypto_unregister_template(&crypto_gcm_tmpl);
1435
	crypto_unregister_template(&crypto_gcm_base_tmpl);
M
Mikko Herranen 已提交
1436 1437 1438 1439 1440 1441 1442 1443
}

module_init(crypto_gcm_module_init);
module_exit(crypto_gcm_module_exit);

MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("Galois/Counter Mode");
MODULE_AUTHOR("Mikko Herranen <mh1@iki.fi>");
1444
MODULE_ALIAS("gcm_base");
H
Herbert Xu 已提交
1445
MODULE_ALIAS("rfc4106");
1446
MODULE_ALIAS("rfc4543");