Linux Audio

Check our new training course

Loading...
v4.6
   1/*
   2 * GCM: Galois/Counter Mode.
   3 *
   4 * Copyright (c) 2007 Nokia Siemens Networks - Mikko Herranen <mh1@iki.fi>
   5 *
   6 * This program is free software; you can redistribute it and/or modify it
   7 * under the terms of the GNU General Public License version 2 as published
   8 * by the Free Software Foundation.
   9 */
  10
  11#include <crypto/gf128mul.h>
  12#include <crypto/internal/aead.h>
  13#include <crypto/internal/skcipher.h>
  14#include <crypto/internal/hash.h>
  15#include <crypto/null.h>
  16#include <crypto/scatterwalk.h>
  17#include <crypto/hash.h>
  18#include "internal.h"
  19#include <linux/completion.h>
  20#include <linux/err.h>
  21#include <linux/init.h>
  22#include <linux/kernel.h>
  23#include <linux/module.h>
  24#include <linux/slab.h>
  25
  26struct gcm_instance_ctx {
  27	struct crypto_skcipher_spawn ctr;
  28	struct crypto_ahash_spawn ghash;
  29};
  30
  31struct crypto_gcm_ctx {
  32	struct crypto_ablkcipher *ctr;
  33	struct crypto_ahash *ghash;
  34};
  35
  36struct crypto_rfc4106_ctx {
  37	struct crypto_aead *child;
  38	u8 nonce[4];
  39};
  40
  41struct crypto_rfc4106_req_ctx {
  42	struct scatterlist src[3];
  43	struct scatterlist dst[3];
  44	struct aead_request subreq;
  45};
  46
  47struct crypto_rfc4543_instance_ctx {
  48	struct crypto_aead_spawn aead;
  49};
  50
  51struct crypto_rfc4543_ctx {
  52	struct crypto_aead *child;
  53	struct crypto_blkcipher *null;
  54	u8 nonce[4];
  55};
  56
  57struct crypto_rfc4543_req_ctx {
 
 
 
 
  58	struct aead_request subreq;
  59};
  60
  61struct crypto_gcm_ghash_ctx {
  62	unsigned int cryptlen;
  63	struct scatterlist *src;
  64	int (*complete)(struct aead_request *req, u32 flags);
  65};
  66
  67struct crypto_gcm_req_priv_ctx {
  68	u8 iv[16];
  69	u8 auth_tag[16];
  70	u8 iauth_tag[16];
  71	struct scatterlist src[3];
  72	struct scatterlist dst[3];
  73	struct scatterlist sg;
  74	struct crypto_gcm_ghash_ctx ghash_ctx;
  75	union {
  76		struct ahash_request ahreq;
  77		struct ablkcipher_request abreq;
  78	} u;
  79};
  80
  81struct crypto_gcm_setkey_result {
  82	int err;
  83	struct completion completion;
  84};
  85
  86static struct {
  87	u8 buf[16];
  88	struct scatterlist sg;
  89} *gcm_zeroes;
  90
  91static int crypto_rfc4543_copy_src_to_dst(struct aead_request *req, bool enc);
  92
  93static inline struct crypto_gcm_req_priv_ctx *crypto_gcm_reqctx(
  94	struct aead_request *req)
  95{
  96	unsigned long align = crypto_aead_alignmask(crypto_aead_reqtfm(req));
  97
  98	return (void *)PTR_ALIGN((u8 *)aead_request_ctx(req), align + 1);
  99}
 100
 101static void crypto_gcm_setkey_done(struct crypto_async_request *req, int err)
 102{
 103	struct crypto_gcm_setkey_result *result = req->data;
 104
 105	if (err == -EINPROGRESS)
 106		return;
 107
 108	result->err = err;
 109	complete(&result->completion);
 110}
 111
 112static int crypto_gcm_setkey(struct crypto_aead *aead, const u8 *key,
 113			     unsigned int keylen)
 114{
 115	struct crypto_gcm_ctx *ctx = crypto_aead_ctx(aead);
 116	struct crypto_ahash *ghash = ctx->ghash;
 117	struct crypto_ablkcipher *ctr = ctx->ctr;
 118	struct {
 119		be128 hash;
 120		u8 iv[8];
 121
 122		struct crypto_gcm_setkey_result result;
 123
 124		struct scatterlist sg[1];
 125		struct ablkcipher_request req;
 126	} *data;
 127	int err;
 128
 129	crypto_ablkcipher_clear_flags(ctr, CRYPTO_TFM_REQ_MASK);
 130	crypto_ablkcipher_set_flags(ctr, crypto_aead_get_flags(aead) &
 131					 CRYPTO_TFM_REQ_MASK);
 
 132	err = crypto_ablkcipher_setkey(ctr, key, keylen);
 133	crypto_aead_set_flags(aead, crypto_ablkcipher_get_flags(ctr) &
 134				    CRYPTO_TFM_RES_MASK);
 135	if (err)
 136		return err;
 137
 
 
 
 138	data = kzalloc(sizeof(*data) + crypto_ablkcipher_reqsize(ctr),
 139		       GFP_KERNEL);
 140	if (!data)
 141		return -ENOMEM;
 142
 143	init_completion(&data->result.completion);
 144	sg_init_one(data->sg, &data->hash, sizeof(data->hash));
 145	ablkcipher_request_set_tfm(&data->req, ctr);
 146	ablkcipher_request_set_callback(&data->req, CRYPTO_TFM_REQ_MAY_SLEEP |
 147						    CRYPTO_TFM_REQ_MAY_BACKLOG,
 148					crypto_gcm_setkey_done,
 149					&data->result);
 150	ablkcipher_request_set_crypt(&data->req, data->sg, data->sg,
 151				     sizeof(data->hash), data->iv);
 152
 153	err = crypto_ablkcipher_encrypt(&data->req);
 154	if (err == -EINPROGRESS || err == -EBUSY) {
 155		err = wait_for_completion_interruptible(
 156			&data->result.completion);
 157		if (!err)
 158			err = data->result.err;
 159	}
 160
 161	if (err)
 162		goto out;
 163
 164	crypto_ahash_clear_flags(ghash, CRYPTO_TFM_REQ_MASK);
 165	crypto_ahash_set_flags(ghash, crypto_aead_get_flags(aead) &
 166			       CRYPTO_TFM_REQ_MASK);
 167	err = crypto_ahash_setkey(ghash, (u8 *)&data->hash, sizeof(be128));
 168	crypto_aead_set_flags(aead, crypto_ahash_get_flags(ghash) &
 169			      CRYPTO_TFM_RES_MASK);
 170
 171out:
 172	kzfree(data);
 173	return err;
 174}
 175
 176static int crypto_gcm_setauthsize(struct crypto_aead *tfm,
 177				  unsigned int authsize)
 178{
 179	switch (authsize) {
 180	case 4:
 181	case 8:
 182	case 12:
 183	case 13:
 184	case 14:
 185	case 15:
 186	case 16:
 187		break;
 188	default:
 189		return -EINVAL;
 190	}
 191
 192	return 0;
 193}
 194
 195static void crypto_gcm_init_common(struct aead_request *req)
 
 
 196{
 
 
 197	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 
 198	__be32 counter = cpu_to_be32(1);
 199	struct scatterlist *sg;
 200
 201	memset(pctx->auth_tag, 0, sizeof(pctx->auth_tag));
 202	memcpy(pctx->iv, req->iv, 12);
 203	memcpy(pctx->iv + 12, &counter, 4);
 204
 205	sg_init_table(pctx->src, 3);
 206	sg_set_buf(pctx->src, pctx->auth_tag, sizeof(pctx->auth_tag));
 207	sg = scatterwalk_ffwd(pctx->src + 1, req->src, req->assoclen);
 208	if (sg != pctx->src + 1)
 209		sg_chain(pctx->src, 2, sg);
 210
 
 211	if (req->src != req->dst) {
 212		sg_init_table(pctx->dst, 3);
 213		sg_set_buf(pctx->dst, pctx->auth_tag, sizeof(pctx->auth_tag));
 214		sg = scatterwalk_ffwd(pctx->dst + 1, req->dst, req->assoclen);
 215		if (sg != pctx->dst + 1)
 216			sg_chain(pctx->dst, 2, sg);
 217	}
 218}
 219
 220static void crypto_gcm_init_crypt(struct aead_request *req,
 221				  unsigned int cryptlen)
 222{
 223	struct crypto_aead *aead = crypto_aead_reqtfm(req);
 224	struct crypto_gcm_ctx *ctx = crypto_aead_ctx(aead);
 225	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 226	struct ablkcipher_request *ablk_req = &pctx->u.abreq;
 227	struct scatterlist *dst;
 228
 229	dst = req->src == req->dst ? pctx->src : pctx->dst;
 230
 231	ablkcipher_request_set_tfm(ablk_req, ctx->ctr);
 232	ablkcipher_request_set_crypt(ablk_req, pctx->src, dst,
 233				     cryptlen + sizeof(pctx->auth_tag),
 234				     pctx->iv);
 235}
 236
 237static inline unsigned int gcm_remain(unsigned int len)
 238{
 239	len &= 0xfU;
 240	return len ? 16 - len : 0;
 241}
 242
 243static void gcm_hash_len_done(struct crypto_async_request *areq, int err);
 
 244
 245static int gcm_hash_update(struct aead_request *req,
 246			   crypto_completion_t compl,
 
 247			   struct scatterlist *src,
 248			   unsigned int len, u32 flags)
 249{
 250	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 251	struct ahash_request *ahreq = &pctx->u.ahreq;
 252
 253	ahash_request_set_callback(ahreq, flags, compl, req);
 
 254	ahash_request_set_crypt(ahreq, src, NULL, len);
 255
 256	return crypto_ahash_update(ahreq);
 257}
 258
 259static int gcm_hash_remain(struct aead_request *req,
 
 260			   unsigned int remain,
 261			   crypto_completion_t compl, u32 flags)
 262{
 263	return gcm_hash_update(req, compl, &gcm_zeroes->sg, remain, flags);
 
 
 
 
 
 
 
 264}
 265
 266static int gcm_hash_len(struct aead_request *req, u32 flags)
 
 267{
 268	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 269	struct ahash_request *ahreq = &pctx->u.ahreq;
 270	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 271	u128 lengths;
 272
 273	lengths.a = cpu_to_be64(req->assoclen * 8);
 274	lengths.b = cpu_to_be64(gctx->cryptlen * 8);
 275	memcpy(pctx->iauth_tag, &lengths, 16);
 276	sg_init_one(&pctx->sg, pctx->iauth_tag, 16);
 277	ahash_request_set_callback(ahreq, flags, gcm_hash_len_done, req);
 278	ahash_request_set_crypt(ahreq, &pctx->sg,
 279				pctx->iauth_tag, sizeof(lengths));
 
 
 
 
 
 
 
 
 
 
 
 
 
 280
 281	return crypto_ahash_finup(ahreq);
 282}
 283
 284static int gcm_hash_len_continue(struct aead_request *req, u32 flags)
 285{
 286	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 287	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 288
 289	return gctx->complete(req, flags);
 
 
 
 290}
 291
 292static void gcm_hash_len_done(struct crypto_async_request *areq, int err)
 293{
 294	struct aead_request *req = areq->data;
 295
 296	if (err)
 297		goto out;
 298
 299	err = gcm_hash_len_continue(req, 0);
 300	if (err == -EINPROGRESS)
 301		return;
 302
 303out:
 304	aead_request_complete(req, err);
 
 
 
 
 
 305}
 306
 307static int gcm_hash_crypt_remain_continue(struct aead_request *req, u32 flags)
 308{
 309	return gcm_hash_len(req, flags) ?:
 310	       gcm_hash_len_continue(req, flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 311}
 312
 313static void gcm_hash_crypt_remain_done(struct crypto_async_request *areq,
 314				       int err)
 315{
 316	struct aead_request *req = areq->data;
 317
 318	if (err)
 319		goto out;
 320
 321	err = gcm_hash_crypt_remain_continue(req, 0);
 322	if (err == -EINPROGRESS)
 323		return;
 324
 325out:
 326	aead_request_complete(req, err);
 327}
 328
 329static int gcm_hash_crypt_continue(struct aead_request *req, u32 flags)
 330{
 331	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 332	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 333	unsigned int remain;
 334
 335	remain = gcm_remain(gctx->cryptlen);
 336	if (remain)
 337		return gcm_hash_remain(req, remain,
 338				       gcm_hash_crypt_remain_done, flags) ?:
 339		       gcm_hash_crypt_remain_continue(req, flags);
 
 
 
 340
 341	return gcm_hash_crypt_remain_continue(req, flags);
 342}
 343
 344static void gcm_hash_crypt_done(struct crypto_async_request *areq, int err)
 345{
 346	struct aead_request *req = areq->data;
 347
 348	if (err)
 349		goto out;
 350
 351	err = gcm_hash_crypt_continue(req, 0);
 352	if (err == -EINPROGRESS)
 353		return;
 354
 355out:
 356	aead_request_complete(req, err);
 357}
 358
 359static int gcm_hash_assoc_remain_continue(struct aead_request *req, u32 flags)
 360{
 361	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 362	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 
 
 363
 364	if (gctx->cryptlen)
 365		return gcm_hash_update(req, gcm_hash_crypt_done,
 366				       gctx->src, gctx->cryptlen, flags) ?:
 367		       gcm_hash_crypt_continue(req, flags);
 
 
 
 
 
 368
 369	return gcm_hash_crypt_remain_continue(req, flags);
 
 
 
 370}
 371
 372static void gcm_hash_assoc_remain_done(struct crypto_async_request *areq,
 373				       int err)
 374{
 375	struct aead_request *req = areq->data;
 376
 377	if (err)
 378		goto out;
 379
 380	err = gcm_hash_assoc_remain_continue(req, 0);
 381	if (err == -EINPROGRESS)
 382		return;
 383
 384out:
 385	aead_request_complete(req, err);
 386}
 387
 388static int gcm_hash_assoc_continue(struct aead_request *req, u32 flags)
 389{
 
 390	unsigned int remain;
 391
 392	remain = gcm_remain(req->assoclen);
 393	if (remain)
 394		return gcm_hash_remain(req, remain,
 395				       gcm_hash_assoc_remain_done, flags) ?:
 396		       gcm_hash_assoc_remain_continue(req, flags);
 
 
 
 397
 398	return gcm_hash_assoc_remain_continue(req, flags);
 399}
 400
 401static void gcm_hash_assoc_done(struct crypto_async_request *areq, int err)
 402{
 403	struct aead_request *req = areq->data;
 404
 405	if (err)
 406		goto out;
 407
 408	err = gcm_hash_assoc_continue(req, 0);
 409	if (err == -EINPROGRESS)
 410		return;
 411
 412out:
 413	aead_request_complete(req, err);
 414}
 415
 416static int gcm_hash_init_continue(struct aead_request *req, u32 flags)
 417{
 418	if (req->assoclen)
 419		return gcm_hash_update(req, gcm_hash_assoc_done,
 420				       req->src, req->assoclen, flags) ?:
 421		       gcm_hash_assoc_continue(req, flags);
 
 
 
 
 
 
 
 
 
 422
 423	return gcm_hash_assoc_remain_continue(req, flags);
 
 
 
 424}
 425
 426static void gcm_hash_init_done(struct crypto_async_request *areq, int err)
 427{
 428	struct aead_request *req = areq->data;
 429
 430	if (err)
 431		goto out;
 432
 433	err = gcm_hash_init_continue(req, 0);
 434	if (err == -EINPROGRESS)
 435		return;
 436
 437out:
 438	aead_request_complete(req, err);
 439}
 440
 441static int gcm_hash(struct aead_request *req, u32 flags)
 
 442{
 443	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 444	struct ahash_request *ahreq = &pctx->u.ahreq;
 445	struct crypto_gcm_ctx *ctx = crypto_aead_ctx(crypto_aead_reqtfm(req));
 
 
 
 
 446
 447	ahash_request_set_tfm(ahreq, ctx->ghash);
 448
 449	ahash_request_set_callback(ahreq, flags, gcm_hash_init_done, req);
 450	return crypto_ahash_init(ahreq) ?:
 451	       gcm_hash_init_continue(req, flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 452}
 453
 454static int gcm_enc_copy_hash(struct aead_request *req, u32 flags)
 
 455{
 456	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 457	struct crypto_aead *aead = crypto_aead_reqtfm(req);
 458	u8 *auth_tag = pctx->auth_tag;
 459
 460	crypto_xor(auth_tag, pctx->iauth_tag, 16);
 461	scatterwalk_map_and_copy(auth_tag, req->dst,
 462				 req->assoclen + req->cryptlen,
 463				 crypto_aead_authsize(aead), 1);
 464	return 0;
 465}
 466
 467static int gcm_encrypt_continue(struct aead_request *req, u32 flags)
 468{
 469	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 470	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 471
 472	gctx->src = sg_next(req->src == req->dst ? pctx->src : pctx->dst);
 473	gctx->cryptlen = req->cryptlen;
 474	gctx->complete = gcm_enc_copy_hash;
 475
 476	return gcm_hash(req, flags);
 477}
 478
 479static void gcm_encrypt_done(struct crypto_async_request *areq, int err)
 480{
 481	struct aead_request *req = areq->data;
 
 482
 483	if (err)
 484		goto out;
 485
 486	err = gcm_encrypt_continue(req, 0);
 487	if (err == -EINPROGRESS)
 488		return;
 
 
 
 489
 490out:
 491	aead_request_complete(req, err);
 492}
 493
 494static int crypto_gcm_encrypt(struct aead_request *req)
 495{
 496	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 497	struct ablkcipher_request *abreq = &pctx->u.abreq;
 498	u32 flags = aead_request_flags(req);
 
 
 
 
 
 499
 500	crypto_gcm_init_common(req);
 501	crypto_gcm_init_crypt(req, req->cryptlen);
 502	ablkcipher_request_set_callback(abreq, flags, gcm_encrypt_done, req);
 503
 504	return crypto_ablkcipher_encrypt(abreq) ?:
 505	       gcm_encrypt_continue(req, flags);
 
 
 
 
 
 
 
 
 
 
 506}
 507
 508static int crypto_gcm_verify(struct aead_request *req)
 
 509{
 510	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 511	struct crypto_aead *aead = crypto_aead_reqtfm(req);
 512	u8 *auth_tag = pctx->auth_tag;
 513	u8 *iauth_tag = pctx->iauth_tag;
 514	unsigned int authsize = crypto_aead_authsize(aead);
 515	unsigned int cryptlen = req->cryptlen - authsize;
 516
 517	crypto_xor(auth_tag, iauth_tag, 16);
 518	scatterwalk_map_and_copy(iauth_tag, req->src,
 519				 req->assoclen + cryptlen, authsize, 0);
 520	return crypto_memneq(iauth_tag, auth_tag, authsize) ? -EBADMSG : 0;
 521}
 522
 523static void gcm_decrypt_done(struct crypto_async_request *areq, int err)
 524{
 525	struct aead_request *req = areq->data;
 
 526
 527	if (!err)
 528		err = crypto_gcm_verify(req);
 529
 530	aead_request_complete(req, err);
 531}
 532
 533static int gcm_dec_hash_continue(struct aead_request *req, u32 flags)
 534{
 535	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 536	struct ablkcipher_request *abreq = &pctx->u.abreq;
 537	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 538
 539	crypto_gcm_init_crypt(req, gctx->cryptlen);
 540	ablkcipher_request_set_callback(abreq, flags, gcm_decrypt_done, req);
 541	return crypto_ablkcipher_decrypt(abreq) ?: crypto_gcm_verify(req);
 
 
 
 
 
 
 
 
 
 542}
 543
 544static int crypto_gcm_decrypt(struct aead_request *req)
 545{
 546	struct crypto_aead *aead = crypto_aead_reqtfm(req);
 547	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 
 548	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 549	unsigned int authsize = crypto_aead_authsize(aead);
 550	unsigned int cryptlen = req->cryptlen;
 551	u32 flags = aead_request_flags(req);
 552
 
 
 553	cryptlen -= authsize;
 554
 555	crypto_gcm_init_common(req);
 556
 557	gctx->src = sg_next(pctx->src);
 558	gctx->cryptlen = cryptlen;
 559	gctx->complete = gcm_dec_hash_continue;
 
 
 
 
 560
 561	return gcm_hash(req, flags);
 
 
 
 
 
 
 
 562}
 563
 564static int crypto_gcm_init_tfm(struct crypto_aead *tfm)
 565{
 566	struct aead_instance *inst = aead_alg_instance(tfm);
 567	struct gcm_instance_ctx *ictx = aead_instance_ctx(inst);
 568	struct crypto_gcm_ctx *ctx = crypto_aead_ctx(tfm);
 569	struct crypto_ablkcipher *ctr;
 570	struct crypto_ahash *ghash;
 571	unsigned long align;
 572	int err;
 573
 574	ghash = crypto_spawn_ahash(&ictx->ghash);
 575	if (IS_ERR(ghash))
 576		return PTR_ERR(ghash);
 577
 578	ctr = crypto_spawn_skcipher(&ictx->ctr);
 579	err = PTR_ERR(ctr);
 580	if (IS_ERR(ctr))
 581		goto err_free_hash;
 582
 583	ctx->ctr = ctr;
 584	ctx->ghash = ghash;
 585
 586	align = crypto_aead_alignmask(tfm);
 587	align &= ~(crypto_tfm_ctx_alignment() - 1);
 588	crypto_aead_set_reqsize(tfm,
 589		align + offsetof(struct crypto_gcm_req_priv_ctx, u) +
 590		max(sizeof(struct ablkcipher_request) +
 591		    crypto_ablkcipher_reqsize(ctr),
 592		    sizeof(struct ahash_request) +
 593		    crypto_ahash_reqsize(ghash)));
 594
 595	return 0;
 596
 597err_free_hash:
 598	crypto_free_ahash(ghash);
 599	return err;
 600}
 601
 602static void crypto_gcm_exit_tfm(struct crypto_aead *tfm)
 603{
 604	struct crypto_gcm_ctx *ctx = crypto_aead_ctx(tfm);
 605
 606	crypto_free_ahash(ctx->ghash);
 607	crypto_free_ablkcipher(ctx->ctr);
 608}
 609
 610static void crypto_gcm_free(struct aead_instance *inst)
 611{
 612	struct gcm_instance_ctx *ctx = aead_instance_ctx(inst);
 613
 614	crypto_drop_skcipher(&ctx->ctr);
 615	crypto_drop_ahash(&ctx->ghash);
 616	kfree(inst);
 617}
 618
 619static int crypto_gcm_create_common(struct crypto_template *tmpl,
 620				    struct rtattr **tb,
 621				    const char *full_name,
 622				    const char *ctr_name,
 623				    const char *ghash_name)
 624{
 625	struct crypto_attr_type *algt;
 626	struct aead_instance *inst;
 627	struct crypto_alg *ctr;
 628	struct crypto_alg *ghash_alg;
 629	struct hash_alg_common *ghash;
 630	struct gcm_instance_ctx *ctx;
 631	int err;
 632
 633	algt = crypto_get_attr_type(tb);
 
 634	if (IS_ERR(algt))
 635		return PTR_ERR(algt);
 636
 637	if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
 638		return -EINVAL;
 639
 640	ghash_alg = crypto_find_alg(ghash_name, &crypto_ahash_type,
 641				    CRYPTO_ALG_TYPE_HASH,
 642				    CRYPTO_ALG_TYPE_AHASH_MASK);
 
 643	if (IS_ERR(ghash_alg))
 644		return PTR_ERR(ghash_alg);
 645
 646	ghash = __crypto_hash_alg_common(ghash_alg);
 647
 648	err = -ENOMEM;
 649	inst = kzalloc(sizeof(*inst) + sizeof(*ctx), GFP_KERNEL);
 650	if (!inst)
 651		goto out_put_ghash;
 652
 653	ctx = aead_instance_ctx(inst);
 654	err = crypto_init_ahash_spawn(&ctx->ghash, ghash,
 655				      aead_crypto_instance(inst));
 
 656	if (err)
 657		goto err_free_inst;
 658
 659	err = -EINVAL;
 660	if (ghash->digestsize != 16)
 661		goto err_drop_ghash;
 662
 663	crypto_set_skcipher_spawn(&ctx->ctr, aead_crypto_instance(inst));
 664	err = crypto_grab_skcipher(&ctx->ctr, ctr_name, 0,
 665				   crypto_requires_sync(algt->type,
 666							algt->mask));
 667	if (err)
 668		goto err_drop_ghash;
 669
 670	ctr = crypto_skcipher_spawn_alg(&ctx->ctr);
 671
 672	/* We only support 16-byte blocks. */
 673	if (ctr->cra_ablkcipher.ivsize != 16)
 674		goto out_put_ctr;
 675
 676	/* Not a stream cipher? */
 677	err = -EINVAL;
 678	if (ctr->cra_blocksize != 1)
 679		goto out_put_ctr;
 680
 681	err = -ENAMETOOLONG;
 682	if (snprintf(inst->alg.base.cra_driver_name, CRYPTO_MAX_ALG_NAME,
 683		     "gcm_base(%s,%s)", ctr->cra_driver_name,
 684		     ghash_alg->cra_driver_name) >=
 685	    CRYPTO_MAX_ALG_NAME)
 686		goto out_put_ctr;
 687
 688	memcpy(inst->alg.base.cra_name, full_name, CRYPTO_MAX_ALG_NAME);
 689
 690	inst->alg.base.cra_flags = (ghash->base.cra_flags | ctr->cra_flags) &
 691				   CRYPTO_ALG_ASYNC;
 692	inst->alg.base.cra_priority = (ghash->base.cra_priority +
 693				       ctr->cra_priority) / 2;
 694	inst->alg.base.cra_blocksize = 1;
 695	inst->alg.base.cra_alignmask = ghash->base.cra_alignmask |
 696				       ctr->cra_alignmask;
 697	inst->alg.base.cra_ctxsize = sizeof(struct crypto_gcm_ctx);
 698	inst->alg.ivsize = 12;
 699	inst->alg.maxauthsize = 16;
 700	inst->alg.init = crypto_gcm_init_tfm;
 701	inst->alg.exit = crypto_gcm_exit_tfm;
 702	inst->alg.setkey = crypto_gcm_setkey;
 703	inst->alg.setauthsize = crypto_gcm_setauthsize;
 704	inst->alg.encrypt = crypto_gcm_encrypt;
 705	inst->alg.decrypt = crypto_gcm_decrypt;
 706
 707	inst->free = crypto_gcm_free;
 708
 709	err = aead_register_instance(tmpl, inst);
 710	if (err)
 711		goto out_put_ctr;
 
 
 
 
 
 
 
 
 
 
 
 
 712
 713out_put_ghash:
 714	crypto_mod_put(ghash_alg);
 715	return err;
 716
 717out_put_ctr:
 718	crypto_drop_skcipher(&ctx->ctr);
 719err_drop_ghash:
 720	crypto_drop_ahash(&ctx->ghash);
 721err_free_inst:
 722	kfree(inst);
 723	goto out_put_ghash;
 
 
 724}
 725
 726static int crypto_gcm_create(struct crypto_template *tmpl, struct rtattr **tb)
 727{
 
 728	const char *cipher_name;
 729	char ctr_name[CRYPTO_MAX_ALG_NAME];
 730	char full_name[CRYPTO_MAX_ALG_NAME];
 731
 732	cipher_name = crypto_attr_alg_name(tb[1]);
 
 733	if (IS_ERR(cipher_name))
 734		return PTR_ERR(cipher_name);
 735
 736	if (snprintf(ctr_name, CRYPTO_MAX_ALG_NAME, "ctr(%s)", cipher_name) >=
 737	    CRYPTO_MAX_ALG_NAME)
 738		return -ENAMETOOLONG;
 739
 740	if (snprintf(full_name, CRYPTO_MAX_ALG_NAME, "gcm(%s)", cipher_name) >=
 741	    CRYPTO_MAX_ALG_NAME)
 742		return -ENAMETOOLONG;
 743
 744	return crypto_gcm_create_common(tmpl, tb, full_name,
 745					ctr_name, "ghash");
 
 
 
 
 
 
 
 
 746}
 747
 748static struct crypto_template crypto_gcm_tmpl = {
 749	.name = "gcm",
 750	.create = crypto_gcm_create,
 
 751	.module = THIS_MODULE,
 752};
 753
 754static int crypto_gcm_base_create(struct crypto_template *tmpl,
 755				  struct rtattr **tb)
 756{
 
 757	const char *ctr_name;
 758	const char *ghash_name;
 759	char full_name[CRYPTO_MAX_ALG_NAME];
 760
 761	ctr_name = crypto_attr_alg_name(tb[1]);
 
 762	if (IS_ERR(ctr_name))
 763		return PTR_ERR(ctr_name);
 764
 765	ghash_name = crypto_attr_alg_name(tb[2]);
 
 766	if (IS_ERR(ghash_name))
 767		return PTR_ERR(ghash_name);
 768
 769	if (snprintf(full_name, CRYPTO_MAX_ALG_NAME, "gcm_base(%s,%s)",
 770		     ctr_name, ghash_name) >= CRYPTO_MAX_ALG_NAME)
 771		return -ENAMETOOLONG;
 772
 773	return crypto_gcm_create_common(tmpl, tb, full_name,
 774					ctr_name, ghash_name);
 775}
 776
 777static struct crypto_template crypto_gcm_base_tmpl = {
 778	.name = "gcm_base",
 779	.create = crypto_gcm_base_create,
 
 780	.module = THIS_MODULE,
 781};
 782
 783static int crypto_rfc4106_setkey(struct crypto_aead *parent, const u8 *key,
 784				 unsigned int keylen)
 785{
 786	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(parent);
 787	struct crypto_aead *child = ctx->child;
 788	int err;
 789
 790	if (keylen < 4)
 791		return -EINVAL;
 792
 793	keylen -= 4;
 794	memcpy(ctx->nonce, key + keylen, 4);
 795
 796	crypto_aead_clear_flags(child, CRYPTO_TFM_REQ_MASK);
 797	crypto_aead_set_flags(child, crypto_aead_get_flags(parent) &
 798				     CRYPTO_TFM_REQ_MASK);
 799	err = crypto_aead_setkey(child, key, keylen);
 800	crypto_aead_set_flags(parent, crypto_aead_get_flags(child) &
 801				      CRYPTO_TFM_RES_MASK);
 802
 803	return err;
 804}
 805
 806static int crypto_rfc4106_setauthsize(struct crypto_aead *parent,
 807				      unsigned int authsize)
 808{
 809	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(parent);
 810
 811	switch (authsize) {
 812	case 8:
 813	case 12:
 814	case 16:
 815		break;
 816	default:
 817		return -EINVAL;
 818	}
 819
 820	return crypto_aead_setauthsize(ctx->child, authsize);
 821}
 822
 823static struct aead_request *crypto_rfc4106_crypt(struct aead_request *req)
 824{
 825	struct crypto_rfc4106_req_ctx *rctx = aead_request_ctx(req);
 826	struct crypto_aead *aead = crypto_aead_reqtfm(req);
 827	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(aead);
 828	struct aead_request *subreq = &rctx->subreq;
 829	struct crypto_aead *child = ctx->child;
 830	struct scatterlist *sg;
 831	u8 *iv = PTR_ALIGN((u8 *)(subreq + 1) + crypto_aead_reqsize(child),
 832			   crypto_aead_alignmask(child) + 1);
 833
 834	scatterwalk_map_and_copy(iv + 12, req->src, 0, req->assoclen - 8, 0);
 835
 836	memcpy(iv, ctx->nonce, 4);
 837	memcpy(iv + 4, req->iv, 8);
 838
 839	sg_init_table(rctx->src, 3);
 840	sg_set_buf(rctx->src, iv + 12, req->assoclen - 8);
 841	sg = scatterwalk_ffwd(rctx->src + 1, req->src, req->assoclen);
 842	if (sg != rctx->src + 1)
 843		sg_chain(rctx->src, 2, sg);
 844
 845	if (req->src != req->dst) {
 846		sg_init_table(rctx->dst, 3);
 847		sg_set_buf(rctx->dst, iv + 12, req->assoclen - 8);
 848		sg = scatterwalk_ffwd(rctx->dst + 1, req->dst, req->assoclen);
 849		if (sg != rctx->dst + 1)
 850			sg_chain(rctx->dst, 2, sg);
 851	}
 852
 853	aead_request_set_tfm(subreq, child);
 854	aead_request_set_callback(subreq, req->base.flags, req->base.complete,
 855				  req->base.data);
 856	aead_request_set_crypt(subreq, rctx->src,
 857			       req->src == req->dst ? rctx->src : rctx->dst,
 858			       req->cryptlen, iv);
 859	aead_request_set_ad(subreq, req->assoclen - 8);
 860
 861	return subreq;
 862}
 863
 864static int crypto_rfc4106_encrypt(struct aead_request *req)
 865{
 866	if (req->assoclen != 16 && req->assoclen != 20)
 867		return -EINVAL;
 868
 869	req = crypto_rfc4106_crypt(req);
 870
 871	return crypto_aead_encrypt(req);
 872}
 873
 874static int crypto_rfc4106_decrypt(struct aead_request *req)
 875{
 876	if (req->assoclen != 16 && req->assoclen != 20)
 877		return -EINVAL;
 878
 879	req = crypto_rfc4106_crypt(req);
 880
 881	return crypto_aead_decrypt(req);
 882}
 883
 884static int crypto_rfc4106_init_tfm(struct crypto_aead *tfm)
 885{
 886	struct aead_instance *inst = aead_alg_instance(tfm);
 887	struct crypto_aead_spawn *spawn = aead_instance_ctx(inst);
 888	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(tfm);
 889	struct crypto_aead *aead;
 890	unsigned long align;
 891
 892	aead = crypto_spawn_aead(spawn);
 893	if (IS_ERR(aead))
 894		return PTR_ERR(aead);
 895
 896	ctx->child = aead;
 897
 898	align = crypto_aead_alignmask(aead);
 899	align &= ~(crypto_tfm_ctx_alignment() - 1);
 900	crypto_aead_set_reqsize(
 901		tfm,
 902		sizeof(struct crypto_rfc4106_req_ctx) +
 903		ALIGN(crypto_aead_reqsize(aead), crypto_tfm_ctx_alignment()) +
 904		align + 24);
 905
 906	return 0;
 907}
 908
 909static void crypto_rfc4106_exit_tfm(struct crypto_aead *tfm)
 910{
 911	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(tfm);
 912
 913	crypto_free_aead(ctx->child);
 914}
 915
 916static void crypto_rfc4106_free(struct aead_instance *inst)
 917{
 918	crypto_drop_aead(aead_instance_ctx(inst));
 919	kfree(inst);
 920}
 921
 922static int crypto_rfc4106_create(struct crypto_template *tmpl,
 923				 struct rtattr **tb)
 924{
 925	struct crypto_attr_type *algt;
 926	struct aead_instance *inst;
 927	struct crypto_aead_spawn *spawn;
 928	struct aead_alg *alg;
 929	const char *ccm_name;
 930	int err;
 931
 932	algt = crypto_get_attr_type(tb);
 
 933	if (IS_ERR(algt))
 934		return PTR_ERR(algt);
 935
 936	if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
 937		return -EINVAL;
 938
 939	ccm_name = crypto_attr_alg_name(tb[1]);
 
 940	if (IS_ERR(ccm_name))
 941		return PTR_ERR(ccm_name);
 942
 943	inst = kzalloc(sizeof(*inst) + sizeof(*spawn), GFP_KERNEL);
 944	if (!inst)
 945		return -ENOMEM;
 946
 947	spawn = aead_instance_ctx(inst);
 948	crypto_set_aead_spawn(spawn, aead_crypto_instance(inst));
 949	err = crypto_grab_aead(spawn, ccm_name, 0,
 950			       crypto_requires_sync(algt->type, algt->mask));
 951	if (err)
 952		goto out_free_inst;
 953
 954	alg = crypto_spawn_aead_alg(spawn);
 955
 956	err = -EINVAL;
 957
 958	/* Underlying IV size must be 12. */
 959	if (crypto_aead_alg_ivsize(alg) != 12)
 960		goto out_drop_alg;
 961
 962	/* Not a stream cipher? */
 963	if (alg->base.cra_blocksize != 1)
 964		goto out_drop_alg;
 965
 966	err = -ENAMETOOLONG;
 967	if (snprintf(inst->alg.base.cra_name, CRYPTO_MAX_ALG_NAME,
 968		     "rfc4106(%s)", alg->base.cra_name) >=
 969	    CRYPTO_MAX_ALG_NAME ||
 970	    snprintf(inst->alg.base.cra_driver_name, CRYPTO_MAX_ALG_NAME,
 971		     "rfc4106(%s)", alg->base.cra_driver_name) >=
 972	    CRYPTO_MAX_ALG_NAME)
 973		goto out_drop_alg;
 974
 975	inst->alg.base.cra_flags = alg->base.cra_flags & CRYPTO_ALG_ASYNC;
 976	inst->alg.base.cra_priority = alg->base.cra_priority;
 977	inst->alg.base.cra_blocksize = 1;
 978	inst->alg.base.cra_alignmask = alg->base.cra_alignmask;
 979
 980	inst->alg.base.cra_ctxsize = sizeof(struct crypto_rfc4106_ctx);
 
 
 
 
 
 
 
 
 
 
 
 
 
 981
 982	inst->alg.ivsize = 8;
 983	inst->alg.maxauthsize = crypto_aead_alg_maxauthsize(alg);
 984
 985	inst->alg.init = crypto_rfc4106_init_tfm;
 986	inst->alg.exit = crypto_rfc4106_exit_tfm;
 987
 988	inst->alg.setkey = crypto_rfc4106_setkey;
 989	inst->alg.setauthsize = crypto_rfc4106_setauthsize;
 990	inst->alg.encrypt = crypto_rfc4106_encrypt;
 991	inst->alg.decrypt = crypto_rfc4106_decrypt;
 992
 993	inst->free = crypto_rfc4106_free;
 994
 995	err = aead_register_instance(tmpl, inst);
 996	if (err)
 997		goto out_drop_alg;
 998
 999out:
1000	return err;
1001
1002out_drop_alg:
1003	crypto_drop_aead(spawn);
1004out_free_inst:
1005	kfree(inst);
 
1006	goto out;
1007}
1008
 
 
 
 
 
 
1009static struct crypto_template crypto_rfc4106_tmpl = {
1010	.name = "rfc4106",
1011	.create = crypto_rfc4106_create,
 
1012	.module = THIS_MODULE,
1013};
1014
 
 
 
 
 
 
 
 
1015static int crypto_rfc4543_setkey(struct crypto_aead *parent, const u8 *key,
1016				 unsigned int keylen)
1017{
1018	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(parent);
1019	struct crypto_aead *child = ctx->child;
1020	int err;
1021
1022	if (keylen < 4)
1023		return -EINVAL;
1024
1025	keylen -= 4;
1026	memcpy(ctx->nonce, key + keylen, 4);
1027
1028	crypto_aead_clear_flags(child, CRYPTO_TFM_REQ_MASK);
1029	crypto_aead_set_flags(child, crypto_aead_get_flags(parent) &
1030				     CRYPTO_TFM_REQ_MASK);
1031	err = crypto_aead_setkey(child, key, keylen);
1032	crypto_aead_set_flags(parent, crypto_aead_get_flags(child) &
1033				      CRYPTO_TFM_RES_MASK);
1034
1035	return err;
1036}
1037
1038static int crypto_rfc4543_setauthsize(struct crypto_aead *parent,
1039				      unsigned int authsize)
1040{
1041	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(parent);
1042
1043	if (authsize != 16)
1044		return -EINVAL;
1045
1046	return crypto_aead_setauthsize(ctx->child, authsize);
1047}
1048
1049static int crypto_rfc4543_crypt(struct aead_request *req, bool enc)
 
1050{
1051	struct crypto_aead *aead = crypto_aead_reqtfm(req);
1052	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(aead);
1053	struct crypto_rfc4543_req_ctx *rctx = aead_request_ctx(req);
1054	struct aead_request *subreq = &rctx->subreq;
 
 
 
 
1055	unsigned int authsize = crypto_aead_authsize(aead);
 
 
 
1056	u8 *iv = PTR_ALIGN((u8 *)(rctx + 1) + crypto_aead_reqsize(ctx->child),
1057			   crypto_aead_alignmask(ctx->child) + 1);
1058	int err;
1059
1060	if (req->src != req->dst) {
1061		err = crypto_rfc4543_copy_src_to_dst(req, enc);
1062		if (err)
1063			return err;
1064	}
1065
1066	memcpy(iv, ctx->nonce, 4);
1067	memcpy(iv + 4, req->iv, 8);
1068
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1069	aead_request_set_tfm(subreq, ctx->child);
1070	aead_request_set_callback(subreq, req->base.flags,
1071				  req->base.complete, req->base.data);
1072	aead_request_set_crypt(subreq, req->src, req->dst,
1073			       enc ? 0 : authsize, iv);
1074	aead_request_set_ad(subreq, req->assoclen + req->cryptlen -
1075				    subreq->cryptlen);
1076
1077	return enc ? crypto_aead_encrypt(subreq) : crypto_aead_decrypt(subreq);
1078}
1079
1080static int crypto_rfc4543_copy_src_to_dst(struct aead_request *req, bool enc)
1081{
1082	struct crypto_aead *aead = crypto_aead_reqtfm(req);
1083	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(aead);
1084	unsigned int authsize = crypto_aead_authsize(aead);
1085	unsigned int nbytes = req->assoclen + req->cryptlen -
1086			      (enc ? 0 : authsize);
1087	struct blkcipher_desc desc = {
1088		.tfm = ctx->null,
1089	};
1090
1091	return crypto_blkcipher_encrypt(&desc, req->dst, req->src, nbytes);
1092}
 
 
1093
1094static int crypto_rfc4543_encrypt(struct aead_request *req)
1095{
1096	return crypto_rfc4543_crypt(req, true);
 
1097}
1098
1099static int crypto_rfc4543_decrypt(struct aead_request *req)
1100{
1101	return crypto_rfc4543_crypt(req, false);
 
 
1102}
1103
1104static int crypto_rfc4543_init_tfm(struct crypto_aead *tfm)
1105{
1106	struct aead_instance *inst = aead_alg_instance(tfm);
1107	struct crypto_rfc4543_instance_ctx *ictx = aead_instance_ctx(inst);
1108	struct crypto_aead_spawn *spawn = &ictx->aead;
1109	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(tfm);
1110	struct crypto_aead *aead;
1111	struct crypto_blkcipher *null;
1112	unsigned long align;
1113	int err = 0;
1114
1115	aead = crypto_spawn_aead(spawn);
1116	if (IS_ERR(aead))
1117		return PTR_ERR(aead);
1118
1119	null = crypto_get_default_null_skcipher();
1120	err = PTR_ERR(null);
1121	if (IS_ERR(null))
1122		goto err_free_aead;
1123
1124	ctx->child = aead;
1125	ctx->null = null;
1126
1127	align = crypto_aead_alignmask(aead);
1128	align &= ~(crypto_tfm_ctx_alignment() - 1);
1129	crypto_aead_set_reqsize(
1130		tfm,
1131		sizeof(struct crypto_rfc4543_req_ctx) +
1132		ALIGN(crypto_aead_reqsize(aead), crypto_tfm_ctx_alignment()) +
1133		align + 12);
1134
1135	return 0;
1136
1137err_free_aead:
1138	crypto_free_aead(aead);
1139	return err;
1140}
1141
1142static void crypto_rfc4543_exit_tfm(struct crypto_aead *tfm)
1143{
1144	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(tfm);
1145
1146	crypto_free_aead(ctx->child);
1147	crypto_put_default_null_skcipher();
1148}
1149
1150static void crypto_rfc4543_free(struct aead_instance *inst)
1151{
1152	struct crypto_rfc4543_instance_ctx *ctx = aead_instance_ctx(inst);
1153
1154	crypto_drop_aead(&ctx->aead);
1155
1156	kfree(inst);
1157}
1158
1159static int crypto_rfc4543_create(struct crypto_template *tmpl,
1160				struct rtattr **tb)
1161{
1162	struct crypto_attr_type *algt;
1163	struct aead_instance *inst;
1164	struct crypto_aead_spawn *spawn;
1165	struct aead_alg *alg;
1166	struct crypto_rfc4543_instance_ctx *ctx;
1167	const char *ccm_name;
1168	int err;
1169
1170	algt = crypto_get_attr_type(tb);
 
1171	if (IS_ERR(algt))
1172		return PTR_ERR(algt);
1173
1174	if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
1175		return -EINVAL;
1176
1177	ccm_name = crypto_attr_alg_name(tb[1]);
 
1178	if (IS_ERR(ccm_name))
1179		return PTR_ERR(ccm_name);
1180
1181	inst = kzalloc(sizeof(*inst) + sizeof(*ctx), GFP_KERNEL);
1182	if (!inst)
1183		return -ENOMEM;
1184
1185	ctx = aead_instance_ctx(inst);
1186	spawn = &ctx->aead;
1187	crypto_set_aead_spawn(spawn, aead_crypto_instance(inst));
1188	err = crypto_grab_aead(spawn, ccm_name, 0,
1189			       crypto_requires_sync(algt->type, algt->mask));
1190	if (err)
1191		goto out_free_inst;
1192
1193	alg = crypto_spawn_aead_alg(spawn);
1194
1195	err = -EINVAL;
1196
1197	/* Underlying IV size must be 12. */
1198	if (crypto_aead_alg_ivsize(alg) != 12)
1199		goto out_drop_alg;
1200
1201	/* Not a stream cipher? */
1202	if (alg->base.cra_blocksize != 1)
1203		goto out_drop_alg;
1204
1205	err = -ENAMETOOLONG;
1206	if (snprintf(inst->alg.base.cra_name, CRYPTO_MAX_ALG_NAME,
1207		     "rfc4543(%s)", alg->base.cra_name) >=
1208	    CRYPTO_MAX_ALG_NAME ||
1209	    snprintf(inst->alg.base.cra_driver_name, CRYPTO_MAX_ALG_NAME,
1210		     "rfc4543(%s)", alg->base.cra_driver_name) >=
1211	    CRYPTO_MAX_ALG_NAME)
1212		goto out_drop_alg;
1213
1214	inst->alg.base.cra_flags = alg->base.cra_flags & CRYPTO_ALG_ASYNC;
1215	inst->alg.base.cra_priority = alg->base.cra_priority;
1216	inst->alg.base.cra_blocksize = 1;
1217	inst->alg.base.cra_alignmask = alg->base.cra_alignmask;
1218
1219	inst->alg.base.cra_ctxsize = sizeof(struct crypto_rfc4543_ctx);
1220
1221	inst->alg.ivsize = 8;
1222	inst->alg.maxauthsize = crypto_aead_alg_maxauthsize(alg);
1223
1224	inst->alg.init = crypto_rfc4543_init_tfm;
1225	inst->alg.exit = crypto_rfc4543_exit_tfm;
1226
1227	inst->alg.setkey = crypto_rfc4543_setkey;
1228	inst->alg.setauthsize = crypto_rfc4543_setauthsize;
1229	inst->alg.encrypt = crypto_rfc4543_encrypt;
1230	inst->alg.decrypt = crypto_rfc4543_decrypt;
 
 
1231
1232	inst->free = crypto_rfc4543_free,
1233
1234	err = aead_register_instance(tmpl, inst);
1235	if (err)
1236		goto out_drop_alg;
1237
1238out:
1239	return err;
1240
1241out_drop_alg:
1242	crypto_drop_aead(spawn);
1243out_free_inst:
1244	kfree(inst);
 
1245	goto out;
1246}
1247
 
 
 
 
 
 
1248static struct crypto_template crypto_rfc4543_tmpl = {
1249	.name = "rfc4543",
1250	.create = crypto_rfc4543_create,
 
1251	.module = THIS_MODULE,
1252};
1253
1254static int __init crypto_gcm_module_init(void)
1255{
1256	int err;
1257
1258	gcm_zeroes = kzalloc(sizeof(*gcm_zeroes), GFP_KERNEL);
1259	if (!gcm_zeroes)
1260		return -ENOMEM;
1261
1262	sg_init_one(&gcm_zeroes->sg, gcm_zeroes->buf, sizeof(gcm_zeroes->buf));
1263
1264	err = crypto_register_template(&crypto_gcm_base_tmpl);
1265	if (err)
1266		goto out;
1267
1268	err = crypto_register_template(&crypto_gcm_tmpl);
1269	if (err)
1270		goto out_undo_base;
1271
1272	err = crypto_register_template(&crypto_rfc4106_tmpl);
1273	if (err)
1274		goto out_undo_gcm;
1275
1276	err = crypto_register_template(&crypto_rfc4543_tmpl);
1277	if (err)
1278		goto out_undo_rfc4106;
1279
1280	return 0;
1281
1282out_undo_rfc4106:
1283	crypto_unregister_template(&crypto_rfc4106_tmpl);
1284out_undo_gcm:
1285	crypto_unregister_template(&crypto_gcm_tmpl);
1286out_undo_base:
1287	crypto_unregister_template(&crypto_gcm_base_tmpl);
1288out:
1289	kfree(gcm_zeroes);
1290	return err;
1291}
1292
1293static void __exit crypto_gcm_module_exit(void)
1294{
1295	kfree(gcm_zeroes);
1296	crypto_unregister_template(&crypto_rfc4543_tmpl);
1297	crypto_unregister_template(&crypto_rfc4106_tmpl);
1298	crypto_unregister_template(&crypto_gcm_tmpl);
1299	crypto_unregister_template(&crypto_gcm_base_tmpl);
1300}
1301
1302module_init(crypto_gcm_module_init);
1303module_exit(crypto_gcm_module_exit);
1304
1305MODULE_LICENSE("GPL");
1306MODULE_DESCRIPTION("Galois/Counter Mode");
1307MODULE_AUTHOR("Mikko Herranen <mh1@iki.fi>");
1308MODULE_ALIAS_CRYPTO("gcm_base");
1309MODULE_ALIAS_CRYPTO("rfc4106");
1310MODULE_ALIAS_CRYPTO("rfc4543");
1311MODULE_ALIAS_CRYPTO("gcm");
v3.1
   1/*
   2 * GCM: Galois/Counter Mode.
   3 *
   4 * Copyright (c) 2007 Nokia Siemens Networks - Mikko Herranen <mh1@iki.fi>
   5 *
   6 * This program is free software; you can redistribute it and/or modify it
   7 * under the terms of the GNU General Public License version 2 as published
   8 * by the Free Software Foundation.
   9 */
  10
  11#include <crypto/gf128mul.h>
  12#include <crypto/internal/aead.h>
  13#include <crypto/internal/skcipher.h>
  14#include <crypto/internal/hash.h>
 
  15#include <crypto/scatterwalk.h>
  16#include <crypto/hash.h>
  17#include "internal.h"
  18#include <linux/completion.h>
  19#include <linux/err.h>
  20#include <linux/init.h>
  21#include <linux/kernel.h>
  22#include <linux/module.h>
  23#include <linux/slab.h>
  24
  25struct gcm_instance_ctx {
  26	struct crypto_skcipher_spawn ctr;
  27	struct crypto_ahash_spawn ghash;
  28};
  29
  30struct crypto_gcm_ctx {
  31	struct crypto_ablkcipher *ctr;
  32	struct crypto_ahash *ghash;
  33};
  34
  35struct crypto_rfc4106_ctx {
  36	struct crypto_aead *child;
  37	u8 nonce[4];
  38};
  39
 
 
 
 
 
 
 
 
 
 
  40struct crypto_rfc4543_ctx {
  41	struct crypto_aead *child;
 
  42	u8 nonce[4];
  43};
  44
  45struct crypto_rfc4543_req_ctx {
  46	u8 auth_tag[16];
  47	struct scatterlist cipher[1];
  48	struct scatterlist payload[2];
  49	struct scatterlist assoc[2];
  50	struct aead_request subreq;
  51};
  52
  53struct crypto_gcm_ghash_ctx {
  54	unsigned int cryptlen;
  55	struct scatterlist *src;
  56	void (*complete)(struct aead_request *req, int err);
  57};
  58
  59struct crypto_gcm_req_priv_ctx {
 
  60	u8 auth_tag[16];
  61	u8 iauth_tag[16];
  62	struct scatterlist src[2];
  63	struct scatterlist dst[2];
 
  64	struct crypto_gcm_ghash_ctx ghash_ctx;
  65	union {
  66		struct ahash_request ahreq;
  67		struct ablkcipher_request abreq;
  68	} u;
  69};
  70
  71struct crypto_gcm_setkey_result {
  72	int err;
  73	struct completion completion;
  74};
  75
  76static void *gcm_zeroes;
 
 
 
 
 
  77
  78static inline struct crypto_gcm_req_priv_ctx *crypto_gcm_reqctx(
  79	struct aead_request *req)
  80{
  81	unsigned long align = crypto_aead_alignmask(crypto_aead_reqtfm(req));
  82
  83	return (void *)PTR_ALIGN((u8 *)aead_request_ctx(req), align + 1);
  84}
  85
  86static void crypto_gcm_setkey_done(struct crypto_async_request *req, int err)
  87{
  88	struct crypto_gcm_setkey_result *result = req->data;
  89
  90	if (err == -EINPROGRESS)
  91		return;
  92
  93	result->err = err;
  94	complete(&result->completion);
  95}
  96
  97static int crypto_gcm_setkey(struct crypto_aead *aead, const u8 *key,
  98			     unsigned int keylen)
  99{
 100	struct crypto_gcm_ctx *ctx = crypto_aead_ctx(aead);
 101	struct crypto_ahash *ghash = ctx->ghash;
 102	struct crypto_ablkcipher *ctr = ctx->ctr;
 103	struct {
 104		be128 hash;
 105		u8 iv[8];
 106
 107		struct crypto_gcm_setkey_result result;
 108
 109		struct scatterlist sg[1];
 110		struct ablkcipher_request req;
 111	} *data;
 112	int err;
 113
 114	crypto_ablkcipher_clear_flags(ctr, CRYPTO_TFM_REQ_MASK);
 115	crypto_ablkcipher_set_flags(ctr, crypto_aead_get_flags(aead) &
 116				   CRYPTO_TFM_REQ_MASK);
 117
 118	err = crypto_ablkcipher_setkey(ctr, key, keylen);
 
 
 119	if (err)
 120		return err;
 121
 122	crypto_aead_set_flags(aead, crypto_ablkcipher_get_flags(ctr) &
 123				       CRYPTO_TFM_RES_MASK);
 124
 125	data = kzalloc(sizeof(*data) + crypto_ablkcipher_reqsize(ctr),
 126		       GFP_KERNEL);
 127	if (!data)
 128		return -ENOMEM;
 129
 130	init_completion(&data->result.completion);
 131	sg_init_one(data->sg, &data->hash, sizeof(data->hash));
 132	ablkcipher_request_set_tfm(&data->req, ctr);
 133	ablkcipher_request_set_callback(&data->req, CRYPTO_TFM_REQ_MAY_SLEEP |
 134						    CRYPTO_TFM_REQ_MAY_BACKLOG,
 135					crypto_gcm_setkey_done,
 136					&data->result);
 137	ablkcipher_request_set_crypt(&data->req, data->sg, data->sg,
 138				     sizeof(data->hash), data->iv);
 139
 140	err = crypto_ablkcipher_encrypt(&data->req);
 141	if (err == -EINPROGRESS || err == -EBUSY) {
 142		err = wait_for_completion_interruptible(
 143			&data->result.completion);
 144		if (!err)
 145			err = data->result.err;
 146	}
 147
 148	if (err)
 149		goto out;
 150
 151	crypto_ahash_clear_flags(ghash, CRYPTO_TFM_REQ_MASK);
 152	crypto_ahash_set_flags(ghash, crypto_aead_get_flags(aead) &
 153			       CRYPTO_TFM_REQ_MASK);
 154	err = crypto_ahash_setkey(ghash, (u8 *)&data->hash, sizeof(be128));
 155	crypto_aead_set_flags(aead, crypto_ahash_get_flags(ghash) &
 156			      CRYPTO_TFM_RES_MASK);
 157
 158out:
 159	kfree(data);
 160	return err;
 161}
 162
 163static int crypto_gcm_setauthsize(struct crypto_aead *tfm,
 164				  unsigned int authsize)
 165{
 166	switch (authsize) {
 167	case 4:
 168	case 8:
 169	case 12:
 170	case 13:
 171	case 14:
 172	case 15:
 173	case 16:
 174		break;
 175	default:
 176		return -EINVAL;
 177	}
 178
 179	return 0;
 180}
 181
 182static void crypto_gcm_init_crypt(struct ablkcipher_request *ablk_req,
 183				  struct aead_request *req,
 184				  unsigned int cryptlen)
 185{
 186	struct crypto_aead *aead = crypto_aead_reqtfm(req);
 187	struct crypto_gcm_ctx *ctx = crypto_aead_ctx(aead);
 188	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 189	struct scatterlist *dst;
 190	__be32 counter = cpu_to_be32(1);
 
 191
 192	memset(pctx->auth_tag, 0, sizeof(pctx->auth_tag));
 193	memcpy(req->iv + 12, &counter, 4);
 
 194
 195	sg_init_table(pctx->src, 2);
 196	sg_set_buf(pctx->src, pctx->auth_tag, sizeof(pctx->auth_tag));
 197	scatterwalk_sg_chain(pctx->src, 2, req->src);
 
 
 198
 199	dst = pctx->src;
 200	if (req->src != req->dst) {
 201		sg_init_table(pctx->dst, 2);
 202		sg_set_buf(pctx->dst, pctx->auth_tag, sizeof(pctx->auth_tag));
 203		scatterwalk_sg_chain(pctx->dst, 2, req->dst);
 204		dst = pctx->dst;
 
 205	}
 
 
 
 
 
 
 
 
 
 
 
 
 206
 207	ablkcipher_request_set_tfm(ablk_req, ctx->ctr);
 208	ablkcipher_request_set_crypt(ablk_req, pctx->src, dst,
 209				     cryptlen + sizeof(pctx->auth_tag),
 210				     req->iv);
 211}
 212
 213static inline unsigned int gcm_remain(unsigned int len)
 214{
 215	len &= 0xfU;
 216	return len ? 16 - len : 0;
 217}
 218
 219static void gcm_hash_len_done(struct crypto_async_request *areq, int err);
 220static void gcm_hash_final_done(struct crypto_async_request *areq, int err);
 221
 222static int gcm_hash_update(struct aead_request *req,
 223			   struct crypto_gcm_req_priv_ctx *pctx,
 224			   crypto_completion_t complete,
 225			   struct scatterlist *src,
 226			   unsigned int len)
 227{
 
 228	struct ahash_request *ahreq = &pctx->u.ahreq;
 229
 230	ahash_request_set_callback(ahreq, aead_request_flags(req),
 231				   complete, req);
 232	ahash_request_set_crypt(ahreq, src, NULL, len);
 233
 234	return crypto_ahash_update(ahreq);
 235}
 236
 237static int gcm_hash_remain(struct aead_request *req,
 238			   struct crypto_gcm_req_priv_ctx *pctx,
 239			   unsigned int remain,
 240			   crypto_completion_t complete)
 241{
 242	struct ahash_request *ahreq = &pctx->u.ahreq;
 243
 244	ahash_request_set_callback(ahreq, aead_request_flags(req),
 245				   complete, req);
 246	sg_init_one(pctx->src, gcm_zeroes, remain);
 247	ahash_request_set_crypt(ahreq, pctx->src, NULL, remain);
 248
 249	return crypto_ahash_update(ahreq);
 250}
 251
 252static int gcm_hash_len(struct aead_request *req,
 253			struct crypto_gcm_req_priv_ctx *pctx)
 254{
 
 255	struct ahash_request *ahreq = &pctx->u.ahreq;
 256	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 257	u128 lengths;
 258
 259	lengths.a = cpu_to_be64(req->assoclen * 8);
 260	lengths.b = cpu_to_be64(gctx->cryptlen * 8);
 261	memcpy(pctx->iauth_tag, &lengths, 16);
 262	sg_init_one(pctx->src, pctx->iauth_tag, 16);
 263	ahash_request_set_callback(ahreq, aead_request_flags(req),
 264				   gcm_hash_len_done, req);
 265	ahash_request_set_crypt(ahreq, pctx->src,
 266				NULL, sizeof(lengths));
 267
 268	return crypto_ahash_update(ahreq);
 269}
 270
 271static int gcm_hash_final(struct aead_request *req,
 272			  struct crypto_gcm_req_priv_ctx *pctx)
 273{
 274	struct ahash_request *ahreq = &pctx->u.ahreq;
 275
 276	ahash_request_set_callback(ahreq, aead_request_flags(req),
 277				   gcm_hash_final_done, req);
 278	ahash_request_set_crypt(ahreq, NULL, pctx->iauth_tag, 0);
 279
 280	return crypto_ahash_final(ahreq);
 281}
 282
 283static void __gcm_hash_final_done(struct aead_request *req, int err)
 284{
 285	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 286	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 287
 288	if (!err)
 289		crypto_xor(pctx->auth_tag, pctx->iauth_tag, 16);
 290
 291	gctx->complete(req, err);
 292}
 293
 294static void gcm_hash_final_done(struct crypto_async_request *areq, int err)
 295{
 296	struct aead_request *req = areq->data;
 297
 298	__gcm_hash_final_done(req, err);
 299}
 300
 301static void __gcm_hash_len_done(struct aead_request *req, int err)
 302{
 303	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 304
 305	if (!err) {
 306		err = gcm_hash_final(req, pctx);
 307		if (err == -EINPROGRESS || err == -EBUSY)
 308			return;
 309	}
 310
 311	__gcm_hash_final_done(req, err);
 312}
 313
 314static void gcm_hash_len_done(struct crypto_async_request *areq, int err)
 315{
 316	struct aead_request *req = areq->data;
 317
 318	__gcm_hash_len_done(req, err);
 319}
 320
 321static void __gcm_hash_crypt_remain_done(struct aead_request *req, int err)
 322{
 323	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 324
 325	if (!err) {
 326		err = gcm_hash_len(req, pctx);
 327		if (err == -EINPROGRESS || err == -EBUSY)
 328			return;
 329	}
 330
 331	__gcm_hash_len_done(req, err);
 332}
 333
 334static void gcm_hash_crypt_remain_done(struct crypto_async_request *areq,
 335				       int err)
 336{
 337	struct aead_request *req = areq->data;
 338
 339	__gcm_hash_crypt_remain_done(req, err);
 
 
 
 
 
 
 
 
 340}
 341
 342static void __gcm_hash_crypt_done(struct aead_request *req, int err)
 343{
 344	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 345	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 346	unsigned int remain;
 347
 348	if (!err) {
 349		remain = gcm_remain(gctx->cryptlen);
 350		BUG_ON(!remain);
 351		err = gcm_hash_remain(req, pctx, remain,
 352				      gcm_hash_crypt_remain_done);
 353		if (err == -EINPROGRESS || err == -EBUSY)
 354			return;
 355	}
 356
 357	__gcm_hash_crypt_remain_done(req, err);
 358}
 359
 360static void gcm_hash_crypt_done(struct crypto_async_request *areq, int err)
 361{
 362	struct aead_request *req = areq->data;
 363
 364	__gcm_hash_crypt_done(req, err);
 
 
 
 
 
 
 
 
 365}
 366
 367static void __gcm_hash_assoc_remain_done(struct aead_request *req, int err)
 368{
 369	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 370	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 371	crypto_completion_t complete;
 372	unsigned int remain = 0;
 373
 374	if (!err && gctx->cryptlen) {
 375		remain = gcm_remain(gctx->cryptlen);
 376		complete = remain ? gcm_hash_crypt_done :
 377			gcm_hash_crypt_remain_done;
 378		err = gcm_hash_update(req, pctx, complete,
 379				      gctx->src, gctx->cryptlen);
 380		if (err == -EINPROGRESS || err == -EBUSY)
 381			return;
 382	}
 383
 384	if (remain)
 385		__gcm_hash_crypt_done(req, err);
 386	else
 387		__gcm_hash_crypt_remain_done(req, err);
 388}
 389
 390static void gcm_hash_assoc_remain_done(struct crypto_async_request *areq,
 391				       int err)
 392{
 393	struct aead_request *req = areq->data;
 394
 395	__gcm_hash_assoc_remain_done(req, err);
 
 
 
 
 
 
 
 
 396}
 397
 398static void __gcm_hash_assoc_done(struct aead_request *req, int err)
 399{
 400	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 401	unsigned int remain;
 402
 403	if (!err) {
 404		remain = gcm_remain(req->assoclen);
 405		BUG_ON(!remain);
 406		err = gcm_hash_remain(req, pctx, remain,
 407				      gcm_hash_assoc_remain_done);
 408		if (err == -EINPROGRESS || err == -EBUSY)
 409			return;
 410	}
 411
 412	__gcm_hash_assoc_remain_done(req, err);
 413}
 414
 415static void gcm_hash_assoc_done(struct crypto_async_request *areq, int err)
 416{
 417	struct aead_request *req = areq->data;
 418
 419	__gcm_hash_assoc_done(req, err);
 
 
 
 
 
 
 
 
 420}
 421
 422static void __gcm_hash_init_done(struct aead_request *req, int err)
 423{
 424	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 425	crypto_completion_t complete;
 426	unsigned int remain = 0;
 427
 428	if (!err && req->assoclen) {
 429		remain = gcm_remain(req->assoclen);
 430		complete = remain ? gcm_hash_assoc_done :
 431			gcm_hash_assoc_remain_done;
 432		err = gcm_hash_update(req, pctx, complete,
 433				      req->assoc, req->assoclen);
 434		if (err == -EINPROGRESS || err == -EBUSY)
 435			return;
 436	}
 437
 438	if (remain)
 439		__gcm_hash_assoc_done(req, err);
 440	else
 441		__gcm_hash_assoc_remain_done(req, err);
 442}
 443
 444static void gcm_hash_init_done(struct crypto_async_request *areq, int err)
 445{
 446	struct aead_request *req = areq->data;
 447
 448	__gcm_hash_init_done(req, err);
 
 
 
 
 
 
 
 
 449}
 450
 451static int gcm_hash(struct aead_request *req,
 452		    struct crypto_gcm_req_priv_ctx *pctx)
 453{
 
 454	struct ahash_request *ahreq = &pctx->u.ahreq;
 455	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 456	struct crypto_gcm_ctx *ctx = crypto_tfm_ctx(req->base.tfm);
 457	unsigned int remain;
 458	crypto_completion_t complete;
 459	int err;
 460
 461	ahash_request_set_tfm(ahreq, ctx->ghash);
 462
 463	ahash_request_set_callback(ahreq, aead_request_flags(req),
 464				   gcm_hash_init_done, req);
 465	err = crypto_ahash_init(ahreq);
 466	if (err)
 467		return err;
 468	remain = gcm_remain(req->assoclen);
 469	complete = remain ? gcm_hash_assoc_done : gcm_hash_assoc_remain_done;
 470	err = gcm_hash_update(req, pctx, complete, req->assoc, req->assoclen);
 471	if (err)
 472		return err;
 473	if (remain) {
 474		err = gcm_hash_remain(req, pctx, remain,
 475				      gcm_hash_assoc_remain_done);
 476		if (err)
 477			return err;
 478	}
 479	remain = gcm_remain(gctx->cryptlen);
 480	complete = remain ? gcm_hash_crypt_done : gcm_hash_crypt_remain_done;
 481	err = gcm_hash_update(req, pctx, complete, gctx->src, gctx->cryptlen);
 482	if (err)
 483		return err;
 484	if (remain) {
 485		err = gcm_hash_remain(req, pctx, remain,
 486				      gcm_hash_crypt_remain_done);
 487		if (err)
 488			return err;
 489	}
 490	err = gcm_hash_len(req, pctx);
 491	if (err)
 492		return err;
 493	err = gcm_hash_final(req, pctx);
 494	if (err)
 495		return err;
 496
 497	return 0;
 498}
 499
 500static void gcm_enc_copy_hash(struct aead_request *req,
 501			      struct crypto_gcm_req_priv_ctx *pctx)
 502{
 
 503	struct crypto_aead *aead = crypto_aead_reqtfm(req);
 504	u8 *auth_tag = pctx->auth_tag;
 505
 506	scatterwalk_map_and_copy(auth_tag, req->dst, req->cryptlen,
 
 
 507				 crypto_aead_authsize(aead), 1);
 
 508}
 509
 510static void gcm_enc_hash_done(struct aead_request *req, int err)
 511{
 512	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 
 513
 514	if (!err)
 515		gcm_enc_copy_hash(req, pctx);
 
 516
 517	aead_request_complete(req, err);
 518}
 519
 520static void gcm_encrypt_done(struct crypto_async_request *areq, int err)
 521{
 522	struct aead_request *req = areq->data;
 523	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 524
 525	if (!err) {
 526		err = gcm_hash(req, pctx);
 527		if (err == -EINPROGRESS || err == -EBUSY)
 528			return;
 529		else if (!err) {
 530			crypto_xor(pctx->auth_tag, pctx->iauth_tag, 16);
 531			gcm_enc_copy_hash(req, pctx);
 532		}
 533	}
 534
 
 535	aead_request_complete(req, err);
 536}
 537
 538static int crypto_gcm_encrypt(struct aead_request *req)
 539{
 540	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 541	struct ablkcipher_request *abreq = &pctx->u.abreq;
 542	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 543	int err;
 544
 545	crypto_gcm_init_crypt(abreq, req, req->cryptlen);
 546	ablkcipher_request_set_callback(abreq, aead_request_flags(req),
 547					gcm_encrypt_done, req);
 548
 549	gctx->src = req->dst;
 550	gctx->cryptlen = req->cryptlen;
 551	gctx->complete = gcm_enc_hash_done;
 552
 553	err = crypto_ablkcipher_encrypt(abreq);
 554	if (err)
 555		return err;
 556
 557	err = gcm_hash(req, pctx);
 558	if (err)
 559		return err;
 560
 561	crypto_xor(pctx->auth_tag, pctx->iauth_tag, 16);
 562	gcm_enc_copy_hash(req, pctx);
 563
 564	return 0;
 565}
 566
 567static int crypto_gcm_verify(struct aead_request *req,
 568			     struct crypto_gcm_req_priv_ctx *pctx)
 569{
 
 570	struct crypto_aead *aead = crypto_aead_reqtfm(req);
 571	u8 *auth_tag = pctx->auth_tag;
 572	u8 *iauth_tag = pctx->iauth_tag;
 573	unsigned int authsize = crypto_aead_authsize(aead);
 574	unsigned int cryptlen = req->cryptlen - authsize;
 575
 576	crypto_xor(auth_tag, iauth_tag, 16);
 577	scatterwalk_map_and_copy(iauth_tag, req->src, cryptlen, authsize, 0);
 578	return memcmp(iauth_tag, auth_tag, authsize) ? -EBADMSG : 0;
 
 579}
 580
 581static void gcm_decrypt_done(struct crypto_async_request *areq, int err)
 582{
 583	struct aead_request *req = areq->data;
 584	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 585
 586	if (!err)
 587		err = crypto_gcm_verify(req, pctx);
 588
 589	aead_request_complete(req, err);
 590}
 591
 592static void gcm_dec_hash_done(struct aead_request *req, int err)
 593{
 594	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 595	struct ablkcipher_request *abreq = &pctx->u.abreq;
 596	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 597
 598	if (!err) {
 599		ablkcipher_request_set_callback(abreq, aead_request_flags(req),
 600						gcm_decrypt_done, req);
 601		crypto_gcm_init_crypt(abreq, req, gctx->cryptlen);
 602		err = crypto_ablkcipher_decrypt(abreq);
 603		if (err == -EINPROGRESS || err == -EBUSY)
 604			return;
 605		else if (!err)
 606			err = crypto_gcm_verify(req, pctx);
 607	}
 608
 609	aead_request_complete(req, err);
 610}
 611
 612static int crypto_gcm_decrypt(struct aead_request *req)
 613{
 614	struct crypto_aead *aead = crypto_aead_reqtfm(req);
 615	struct crypto_gcm_req_priv_ctx *pctx = crypto_gcm_reqctx(req);
 616	struct ablkcipher_request *abreq = &pctx->u.abreq;
 617	struct crypto_gcm_ghash_ctx *gctx = &pctx->ghash_ctx;
 618	unsigned int authsize = crypto_aead_authsize(aead);
 619	unsigned int cryptlen = req->cryptlen;
 620	int err;
 621
 622	if (cryptlen < authsize)
 623		return -EINVAL;
 624	cryptlen -= authsize;
 625
 626	gctx->src = req->src;
 
 
 627	gctx->cryptlen = cryptlen;
 628	gctx->complete = gcm_dec_hash_done;
 629
 630	err = gcm_hash(req, pctx);
 631	if (err)
 632		return err;
 633
 634	ablkcipher_request_set_callback(abreq, aead_request_flags(req),
 635					gcm_decrypt_done, req);
 636	crypto_gcm_init_crypt(abreq, req, cryptlen);
 637	err = crypto_ablkcipher_decrypt(abreq);
 638	if (err)
 639		return err;
 640
 641	return crypto_gcm_verify(req, pctx);
 642}
 643
 644static int crypto_gcm_init_tfm(struct crypto_tfm *tfm)
 645{
 646	struct crypto_instance *inst = (void *)tfm->__crt_alg;
 647	struct gcm_instance_ctx *ictx = crypto_instance_ctx(inst);
 648	struct crypto_gcm_ctx *ctx = crypto_tfm_ctx(tfm);
 649	struct crypto_ablkcipher *ctr;
 650	struct crypto_ahash *ghash;
 651	unsigned long align;
 652	int err;
 653
 654	ghash = crypto_spawn_ahash(&ictx->ghash);
 655	if (IS_ERR(ghash))
 656		return PTR_ERR(ghash);
 657
 658	ctr = crypto_spawn_skcipher(&ictx->ctr);
 659	err = PTR_ERR(ctr);
 660	if (IS_ERR(ctr))
 661		goto err_free_hash;
 662
 663	ctx->ctr = ctr;
 664	ctx->ghash = ghash;
 665
 666	align = crypto_tfm_alg_alignmask(tfm);
 667	align &= ~(crypto_tfm_ctx_alignment() - 1);
 668	tfm->crt_aead.reqsize = align +
 669		offsetof(struct crypto_gcm_req_priv_ctx, u) +
 670		max(sizeof(struct ablkcipher_request) +
 671		    crypto_ablkcipher_reqsize(ctr),
 672		    sizeof(struct ahash_request) +
 673		    crypto_ahash_reqsize(ghash));
 674
 675	return 0;
 676
 677err_free_hash:
 678	crypto_free_ahash(ghash);
 679	return err;
 680}
 681
 682static void crypto_gcm_exit_tfm(struct crypto_tfm *tfm)
 683{
 684	struct crypto_gcm_ctx *ctx = crypto_tfm_ctx(tfm);
 685
 686	crypto_free_ahash(ctx->ghash);
 687	crypto_free_ablkcipher(ctx->ctr);
 688}
 689
 690static struct crypto_instance *crypto_gcm_alloc_common(struct rtattr **tb,
 691						       const char *full_name,
 692						       const char *ctr_name,
 693						       const char *ghash_name)
 
 
 
 
 
 
 
 
 
 
 694{
 695	struct crypto_attr_type *algt;
 696	struct crypto_instance *inst;
 697	struct crypto_alg *ctr;
 698	struct crypto_alg *ghash_alg;
 699	struct ahash_alg *ghash_ahash_alg;
 700	struct gcm_instance_ctx *ctx;
 701	int err;
 702
 703	algt = crypto_get_attr_type(tb);
 704	err = PTR_ERR(algt);
 705	if (IS_ERR(algt))
 706		return ERR_PTR(err);
 707
 708	if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
 709		return ERR_PTR(-EINVAL);
 710
 711	ghash_alg = crypto_find_alg(ghash_name, &crypto_ahash_type,
 712				    CRYPTO_ALG_TYPE_HASH,
 713				    CRYPTO_ALG_TYPE_AHASH_MASK);
 714	err = PTR_ERR(ghash_alg);
 715	if (IS_ERR(ghash_alg))
 716		return ERR_PTR(err);
 
 
 717
 718	err = -ENOMEM;
 719	inst = kzalloc(sizeof(*inst) + sizeof(*ctx), GFP_KERNEL);
 720	if (!inst)
 721		goto out_put_ghash;
 722
 723	ctx = crypto_instance_ctx(inst);
 724	ghash_ahash_alg = container_of(ghash_alg, struct ahash_alg, halg.base);
 725	err = crypto_init_ahash_spawn(&ctx->ghash, &ghash_ahash_alg->halg,
 726				      inst);
 727	if (err)
 728		goto err_free_inst;
 729
 730	crypto_set_skcipher_spawn(&ctx->ctr, inst);
 
 
 
 
 731	err = crypto_grab_skcipher(&ctx->ctr, ctr_name, 0,
 732				   crypto_requires_sync(algt->type,
 733							algt->mask));
 734	if (err)
 735		goto err_drop_ghash;
 736
 737	ctr = crypto_skcipher_spawn_alg(&ctx->ctr);
 738
 739	/* We only support 16-byte blocks. */
 740	if (ctr->cra_ablkcipher.ivsize != 16)
 741		goto out_put_ctr;
 742
 743	/* Not a stream cipher? */
 744	err = -EINVAL;
 745	if (ctr->cra_blocksize != 1)
 746		goto out_put_ctr;
 747
 748	err = -ENAMETOOLONG;
 749	if (snprintf(inst->alg.cra_driver_name, CRYPTO_MAX_ALG_NAME,
 750		     "gcm_base(%s,%s)", ctr->cra_driver_name,
 751		     ghash_alg->cra_driver_name) >=
 752	    CRYPTO_MAX_ALG_NAME)
 753		goto out_put_ctr;
 754
 755	memcpy(inst->alg.cra_name, full_name, CRYPTO_MAX_ALG_NAME);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 756
 757	inst->alg.cra_flags = CRYPTO_ALG_TYPE_AEAD;
 758	inst->alg.cra_flags |= ctr->cra_flags & CRYPTO_ALG_ASYNC;
 759	inst->alg.cra_priority = ctr->cra_priority;
 760	inst->alg.cra_blocksize = 1;
 761	inst->alg.cra_alignmask = ctr->cra_alignmask | (__alignof__(u64) - 1);
 762	inst->alg.cra_type = &crypto_aead_type;
 763	inst->alg.cra_aead.ivsize = 16;
 764	inst->alg.cra_aead.maxauthsize = 16;
 765	inst->alg.cra_ctxsize = sizeof(struct crypto_gcm_ctx);
 766	inst->alg.cra_init = crypto_gcm_init_tfm;
 767	inst->alg.cra_exit = crypto_gcm_exit_tfm;
 768	inst->alg.cra_aead.setkey = crypto_gcm_setkey;
 769	inst->alg.cra_aead.setauthsize = crypto_gcm_setauthsize;
 770	inst->alg.cra_aead.encrypt = crypto_gcm_encrypt;
 771	inst->alg.cra_aead.decrypt = crypto_gcm_decrypt;
 772
 773out:
 774	crypto_mod_put(ghash_alg);
 775	return inst;
 776
 777out_put_ctr:
 778	crypto_drop_skcipher(&ctx->ctr);
 779err_drop_ghash:
 780	crypto_drop_ahash(&ctx->ghash);
 781err_free_inst:
 782	kfree(inst);
 783out_put_ghash:
 784	inst = ERR_PTR(err);
 785	goto out;
 786}
 787
 788static struct crypto_instance *crypto_gcm_alloc(struct rtattr **tb)
 789{
 790	int err;
 791	const char *cipher_name;
 792	char ctr_name[CRYPTO_MAX_ALG_NAME];
 793	char full_name[CRYPTO_MAX_ALG_NAME];
 794
 795	cipher_name = crypto_attr_alg_name(tb[1]);
 796	err = PTR_ERR(cipher_name);
 797	if (IS_ERR(cipher_name))
 798		return ERR_PTR(err);
 799
 800	if (snprintf(ctr_name, CRYPTO_MAX_ALG_NAME, "ctr(%s)", cipher_name) >=
 801	    CRYPTO_MAX_ALG_NAME)
 802		return ERR_PTR(-ENAMETOOLONG);
 803
 804	if (snprintf(full_name, CRYPTO_MAX_ALG_NAME, "gcm(%s)", cipher_name) >=
 805	    CRYPTO_MAX_ALG_NAME)
 806		return ERR_PTR(-ENAMETOOLONG);
 807
 808	return crypto_gcm_alloc_common(tb, full_name, ctr_name, "ghash");
 809}
 810
 811static void crypto_gcm_free(struct crypto_instance *inst)
 812{
 813	struct gcm_instance_ctx *ctx = crypto_instance_ctx(inst);
 814
 815	crypto_drop_skcipher(&ctx->ctr);
 816	crypto_drop_ahash(&ctx->ghash);
 817	kfree(inst);
 818}
 819
 820static struct crypto_template crypto_gcm_tmpl = {
 821	.name = "gcm",
 822	.alloc = crypto_gcm_alloc,
 823	.free = crypto_gcm_free,
 824	.module = THIS_MODULE,
 825};
 826
 827static struct crypto_instance *crypto_gcm_base_alloc(struct rtattr **tb)
 
 828{
 829	int err;
 830	const char *ctr_name;
 831	const char *ghash_name;
 832	char full_name[CRYPTO_MAX_ALG_NAME];
 833
 834	ctr_name = crypto_attr_alg_name(tb[1]);
 835	err = PTR_ERR(ctr_name);
 836	if (IS_ERR(ctr_name))
 837		return ERR_PTR(err);
 838
 839	ghash_name = crypto_attr_alg_name(tb[2]);
 840	err = PTR_ERR(ghash_name);
 841	if (IS_ERR(ghash_name))
 842		return ERR_PTR(err);
 843
 844	if (snprintf(full_name, CRYPTO_MAX_ALG_NAME, "gcm_base(%s,%s)",
 845		     ctr_name, ghash_name) >= CRYPTO_MAX_ALG_NAME)
 846		return ERR_PTR(-ENAMETOOLONG);
 847
 848	return crypto_gcm_alloc_common(tb, full_name, ctr_name, ghash_name);
 
 849}
 850
 851static struct crypto_template crypto_gcm_base_tmpl = {
 852	.name = "gcm_base",
 853	.alloc = crypto_gcm_base_alloc,
 854	.free = crypto_gcm_free,
 855	.module = THIS_MODULE,
 856};
 857
 858static int crypto_rfc4106_setkey(struct crypto_aead *parent, const u8 *key,
 859				 unsigned int keylen)
 860{
 861	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(parent);
 862	struct crypto_aead *child = ctx->child;
 863	int err;
 864
 865	if (keylen < 4)
 866		return -EINVAL;
 867
 868	keylen -= 4;
 869	memcpy(ctx->nonce, key + keylen, 4);
 870
 871	crypto_aead_clear_flags(child, CRYPTO_TFM_REQ_MASK);
 872	crypto_aead_set_flags(child, crypto_aead_get_flags(parent) &
 873				     CRYPTO_TFM_REQ_MASK);
 874	err = crypto_aead_setkey(child, key, keylen);
 875	crypto_aead_set_flags(parent, crypto_aead_get_flags(child) &
 876				      CRYPTO_TFM_RES_MASK);
 877
 878	return err;
 879}
 880
 881static int crypto_rfc4106_setauthsize(struct crypto_aead *parent,
 882				      unsigned int authsize)
 883{
 884	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(parent);
 885
 886	switch (authsize) {
 887	case 8:
 888	case 12:
 889	case 16:
 890		break;
 891	default:
 892		return -EINVAL;
 893	}
 894
 895	return crypto_aead_setauthsize(ctx->child, authsize);
 896}
 897
 898static struct aead_request *crypto_rfc4106_crypt(struct aead_request *req)
 899{
 900	struct aead_request *subreq = aead_request_ctx(req);
 901	struct crypto_aead *aead = crypto_aead_reqtfm(req);
 902	struct crypto_rfc4106_ctx *ctx = crypto_aead_ctx(aead);
 
 903	struct crypto_aead *child = ctx->child;
 
 904	u8 *iv = PTR_ALIGN((u8 *)(subreq + 1) + crypto_aead_reqsize(child),
 905			   crypto_aead_alignmask(child) + 1);
 906
 
 
 907	memcpy(iv, ctx->nonce, 4);
 908	memcpy(iv + 4, req->iv, 8);
 909
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 910	aead_request_set_tfm(subreq, child);
 911	aead_request_set_callback(subreq, req->base.flags, req->base.complete,
 912				  req->base.data);
 913	aead_request_set_crypt(subreq, req->src, req->dst, req->cryptlen, iv);
 914	aead_request_set_assoc(subreq, req->assoc, req->assoclen);
 
 
 915
 916	return subreq;
 917}
 918
 919static int crypto_rfc4106_encrypt(struct aead_request *req)
 920{
 
 
 
 921	req = crypto_rfc4106_crypt(req);
 922
 923	return crypto_aead_encrypt(req);
 924}
 925
 926static int crypto_rfc4106_decrypt(struct aead_request *req)
 927{
 
 
 
 928	req = crypto_rfc4106_crypt(req);
 929
 930	return crypto_aead_decrypt(req);
 931}
 932
 933static int crypto_rfc4106_init_tfm(struct crypto_tfm *tfm)
 934{
 935	struct crypto_instance *inst = (void *)tfm->__crt_alg;
 936	struct crypto_aead_spawn *spawn = crypto_instance_ctx(inst);
 937	struct crypto_rfc4106_ctx *ctx = crypto_tfm_ctx(tfm);
 938	struct crypto_aead *aead;
 939	unsigned long align;
 940
 941	aead = crypto_spawn_aead(spawn);
 942	if (IS_ERR(aead))
 943		return PTR_ERR(aead);
 944
 945	ctx->child = aead;
 946
 947	align = crypto_aead_alignmask(aead);
 948	align &= ~(crypto_tfm_ctx_alignment() - 1);
 949	tfm->crt_aead.reqsize = sizeof(struct aead_request) +
 950				ALIGN(crypto_aead_reqsize(aead),
 951				      crypto_tfm_ctx_alignment()) +
 952				align + 16;
 
 953
 954	return 0;
 955}
 956
 957static void crypto_rfc4106_exit_tfm(struct crypto_tfm *tfm)
 958{
 959	struct crypto_rfc4106_ctx *ctx = crypto_tfm_ctx(tfm);
 960
 961	crypto_free_aead(ctx->child);
 962}
 963
 964static struct crypto_instance *crypto_rfc4106_alloc(struct rtattr **tb)
 
 
 
 
 
 
 
 965{
 966	struct crypto_attr_type *algt;
 967	struct crypto_instance *inst;
 968	struct crypto_aead_spawn *spawn;
 969	struct crypto_alg *alg;
 970	const char *ccm_name;
 971	int err;
 972
 973	algt = crypto_get_attr_type(tb);
 974	err = PTR_ERR(algt);
 975	if (IS_ERR(algt))
 976		return ERR_PTR(err);
 977
 978	if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
 979		return ERR_PTR(-EINVAL);
 980
 981	ccm_name = crypto_attr_alg_name(tb[1]);
 982	err = PTR_ERR(ccm_name);
 983	if (IS_ERR(ccm_name))
 984		return ERR_PTR(err);
 985
 986	inst = kzalloc(sizeof(*inst) + sizeof(*spawn), GFP_KERNEL);
 987	if (!inst)
 988		return ERR_PTR(-ENOMEM);
 989
 990	spawn = crypto_instance_ctx(inst);
 991	crypto_set_aead_spawn(spawn, inst);
 992	err = crypto_grab_aead(spawn, ccm_name, 0,
 993			       crypto_requires_sync(algt->type, algt->mask));
 994	if (err)
 995		goto out_free_inst;
 996
 997	alg = crypto_aead_spawn_alg(spawn);
 998
 999	err = -EINVAL;
1000
1001	/* We only support 16-byte blocks. */
1002	if (alg->cra_aead.ivsize != 16)
1003		goto out_drop_alg;
1004
1005	/* Not a stream cipher? */
1006	if (alg->cra_blocksize != 1)
1007		goto out_drop_alg;
1008
1009	err = -ENAMETOOLONG;
1010	if (snprintf(inst->alg.cra_name, CRYPTO_MAX_ALG_NAME,
1011		     "rfc4106(%s)", alg->cra_name) >= CRYPTO_MAX_ALG_NAME ||
1012	    snprintf(inst->alg.cra_driver_name, CRYPTO_MAX_ALG_NAME,
1013		     "rfc4106(%s)", alg->cra_driver_name) >=
 
1014	    CRYPTO_MAX_ALG_NAME)
1015		goto out_drop_alg;
1016
1017	inst->alg.cra_flags = CRYPTO_ALG_TYPE_AEAD;
1018	inst->alg.cra_flags |= alg->cra_flags & CRYPTO_ALG_ASYNC;
1019	inst->alg.cra_priority = alg->cra_priority;
1020	inst->alg.cra_blocksize = 1;
1021	inst->alg.cra_alignmask = alg->cra_alignmask;
1022	inst->alg.cra_type = &crypto_nivaead_type;
1023
1024	inst->alg.cra_aead.ivsize = 8;
1025	inst->alg.cra_aead.maxauthsize = 16;
1026
1027	inst->alg.cra_ctxsize = sizeof(struct crypto_rfc4106_ctx);
1028
1029	inst->alg.cra_init = crypto_rfc4106_init_tfm;
1030	inst->alg.cra_exit = crypto_rfc4106_exit_tfm;
1031
1032	inst->alg.cra_aead.setkey = crypto_rfc4106_setkey;
1033	inst->alg.cra_aead.setauthsize = crypto_rfc4106_setauthsize;
1034	inst->alg.cra_aead.encrypt = crypto_rfc4106_encrypt;
1035	inst->alg.cra_aead.decrypt = crypto_rfc4106_decrypt;
1036
1037	inst->alg.cra_aead.geniv = "seqiv";
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1038
1039out:
1040	return inst;
1041
1042out_drop_alg:
1043	crypto_drop_aead(spawn);
1044out_free_inst:
1045	kfree(inst);
1046	inst = ERR_PTR(err);
1047	goto out;
1048}
1049
1050static void crypto_rfc4106_free(struct crypto_instance *inst)
1051{
1052	crypto_drop_spawn(crypto_instance_ctx(inst));
1053	kfree(inst);
1054}
1055
1056static struct crypto_template crypto_rfc4106_tmpl = {
1057	.name = "rfc4106",
1058	.alloc = crypto_rfc4106_alloc,
1059	.free = crypto_rfc4106_free,
1060	.module = THIS_MODULE,
1061};
1062
1063static inline struct crypto_rfc4543_req_ctx *crypto_rfc4543_reqctx(
1064	struct aead_request *req)
1065{
1066	unsigned long align = crypto_aead_alignmask(crypto_aead_reqtfm(req));
1067
1068	return (void *)PTR_ALIGN((u8 *)aead_request_ctx(req), align + 1);
1069}
1070
1071static int crypto_rfc4543_setkey(struct crypto_aead *parent, const u8 *key,
1072				 unsigned int keylen)
1073{
1074	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(parent);
1075	struct crypto_aead *child = ctx->child;
1076	int err;
1077
1078	if (keylen < 4)
1079		return -EINVAL;
1080
1081	keylen -= 4;
1082	memcpy(ctx->nonce, key + keylen, 4);
1083
1084	crypto_aead_clear_flags(child, CRYPTO_TFM_REQ_MASK);
1085	crypto_aead_set_flags(child, crypto_aead_get_flags(parent) &
1086				     CRYPTO_TFM_REQ_MASK);
1087	err = crypto_aead_setkey(child, key, keylen);
1088	crypto_aead_set_flags(parent, crypto_aead_get_flags(child) &
1089				      CRYPTO_TFM_RES_MASK);
1090
1091	return err;
1092}
1093
1094static int crypto_rfc4543_setauthsize(struct crypto_aead *parent,
1095				      unsigned int authsize)
1096{
1097	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(parent);
1098
1099	if (authsize != 16)
1100		return -EINVAL;
1101
1102	return crypto_aead_setauthsize(ctx->child, authsize);
1103}
1104
1105static struct aead_request *crypto_rfc4543_crypt(struct aead_request *req,
1106						 int enc)
1107{
1108	struct crypto_aead *aead = crypto_aead_reqtfm(req);
1109	struct crypto_rfc4543_ctx *ctx = crypto_aead_ctx(aead);
1110	struct crypto_rfc4543_req_ctx *rctx = crypto_rfc4543_reqctx(req);
1111	struct aead_request *subreq = &rctx->subreq;
1112	struct scatterlist *dst = req->dst;
1113	struct scatterlist *cipher = rctx->cipher;
1114	struct scatterlist *payload = rctx->payload;
1115	struct scatterlist *assoc = rctx->assoc;
1116	unsigned int authsize = crypto_aead_authsize(aead);
1117	unsigned int assoclen = req->assoclen;
1118	struct page *dstp;
1119	u8 *vdst;
1120	u8 *iv = PTR_ALIGN((u8 *)(rctx + 1) + crypto_aead_reqsize(ctx->child),
1121			   crypto_aead_alignmask(ctx->child) + 1);
 
 
 
 
 
 
 
1122
1123	memcpy(iv, ctx->nonce, 4);
1124	memcpy(iv + 4, req->iv, 8);
1125
1126	/* construct cipher/plaintext */
1127	if (enc)
1128		memset(rctx->auth_tag, 0, authsize);
1129	else
1130		scatterwalk_map_and_copy(rctx->auth_tag, dst,
1131					 req->cryptlen - authsize,
1132					 authsize, 0);
1133
1134	sg_init_one(cipher, rctx->auth_tag, authsize);
1135
1136	/* construct the aad */
1137	dstp = sg_page(dst);
1138	vdst = PageHighMem(dstp) ? NULL : page_address(dstp) + dst->offset;
1139
1140	sg_init_table(payload, 2);
1141	sg_set_buf(payload, req->iv, 8);
1142	scatterwalk_crypto_chain(payload, dst, vdst == req->iv + 8, 2);
1143	assoclen += 8 + req->cryptlen - (enc ? 0 : authsize);
1144
1145	sg_init_table(assoc, 2);
1146	sg_set_page(assoc, sg_page(req->assoc), req->assoc->length,
1147		    req->assoc->offset);
1148	scatterwalk_crypto_chain(assoc, payload, 0, 2);
1149
1150	aead_request_set_tfm(subreq, ctx->child);
1151	aead_request_set_callback(subreq, req->base.flags, req->base.complete,
1152				  req->base.data);
1153	aead_request_set_crypt(subreq, cipher, cipher, enc ? 0 : authsize, iv);
1154	aead_request_set_assoc(subreq, assoc, assoclen);
 
 
1155
1156	return subreq;
1157}
1158
1159static int crypto_rfc4543_encrypt(struct aead_request *req)
1160{
1161	struct crypto_aead *aead = crypto_aead_reqtfm(req);
1162	struct crypto_rfc4543_req_ctx *rctx = crypto_rfc4543_reqctx(req);
1163	struct aead_request *subreq;
1164	int err;
 
 
 
 
1165
1166	subreq = crypto_rfc4543_crypt(req, 1);
1167	err = crypto_aead_encrypt(subreq);
1168	if (err)
1169		return err;
1170
1171	scatterwalk_map_and_copy(rctx->auth_tag, req->dst, req->cryptlen,
1172				 crypto_aead_authsize(aead), 1);
1173
1174	return 0;
1175}
1176
1177static int crypto_rfc4543_decrypt(struct aead_request *req)
1178{
1179	req = crypto_rfc4543_crypt(req, 0);
1180
1181	return crypto_aead_decrypt(req);
1182}
1183
1184static int crypto_rfc4543_init_tfm(struct crypto_tfm *tfm)
1185{
1186	struct crypto_instance *inst = (void *)tfm->__crt_alg;
1187	struct crypto_aead_spawn *spawn = crypto_instance_ctx(inst);
1188	struct crypto_rfc4543_ctx *ctx = crypto_tfm_ctx(tfm);
 
1189	struct crypto_aead *aead;
 
1190	unsigned long align;
 
1191
1192	aead = crypto_spawn_aead(spawn);
1193	if (IS_ERR(aead))
1194		return PTR_ERR(aead);
1195
 
 
 
 
 
1196	ctx->child = aead;
 
1197
1198	align = crypto_aead_alignmask(aead);
1199	align &= ~(crypto_tfm_ctx_alignment() - 1);
1200	tfm->crt_aead.reqsize = sizeof(struct crypto_rfc4543_req_ctx) +
1201				ALIGN(crypto_aead_reqsize(aead),
1202				      crypto_tfm_ctx_alignment()) +
1203				align + 16;
 
1204
1205	return 0;
 
 
 
 
1206}
1207
1208static void crypto_rfc4543_exit_tfm(struct crypto_tfm *tfm)
1209{
1210	struct crypto_rfc4543_ctx *ctx = crypto_tfm_ctx(tfm);
1211
1212	crypto_free_aead(ctx->child);
 
 
 
 
 
 
 
 
 
 
1213}
1214
1215static struct crypto_instance *crypto_rfc4543_alloc(struct rtattr **tb)
 
1216{
1217	struct crypto_attr_type *algt;
1218	struct crypto_instance *inst;
1219	struct crypto_aead_spawn *spawn;
1220	struct crypto_alg *alg;
 
1221	const char *ccm_name;
1222	int err;
1223
1224	algt = crypto_get_attr_type(tb);
1225	err = PTR_ERR(algt);
1226	if (IS_ERR(algt))
1227		return ERR_PTR(err);
1228
1229	if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
1230		return ERR_PTR(-EINVAL);
1231
1232	ccm_name = crypto_attr_alg_name(tb[1]);
1233	err = PTR_ERR(ccm_name);
1234	if (IS_ERR(ccm_name))
1235		return ERR_PTR(err);
1236
1237	inst = kzalloc(sizeof(*inst) + sizeof(*spawn), GFP_KERNEL);
1238	if (!inst)
1239		return ERR_PTR(-ENOMEM);
1240
1241	spawn = crypto_instance_ctx(inst);
1242	crypto_set_aead_spawn(spawn, inst);
 
1243	err = crypto_grab_aead(spawn, ccm_name, 0,
1244			       crypto_requires_sync(algt->type, algt->mask));
1245	if (err)
1246		goto out_free_inst;
1247
1248	alg = crypto_aead_spawn_alg(spawn);
1249
1250	err = -EINVAL;
1251
1252	/* We only support 16-byte blocks. */
1253	if (alg->cra_aead.ivsize != 16)
1254		goto out_drop_alg;
1255
1256	/* Not a stream cipher? */
1257	if (alg->cra_blocksize != 1)
1258		goto out_drop_alg;
1259
1260	err = -ENAMETOOLONG;
1261	if (snprintf(inst->alg.cra_name, CRYPTO_MAX_ALG_NAME,
1262		     "rfc4543(%s)", alg->cra_name) >= CRYPTO_MAX_ALG_NAME ||
1263	    snprintf(inst->alg.cra_driver_name, CRYPTO_MAX_ALG_NAME,
1264		     "rfc4543(%s)", alg->cra_driver_name) >=
 
1265	    CRYPTO_MAX_ALG_NAME)
1266		goto out_drop_alg;
1267
1268	inst->alg.cra_flags = CRYPTO_ALG_TYPE_AEAD;
1269	inst->alg.cra_flags |= alg->cra_flags & CRYPTO_ALG_ASYNC;
1270	inst->alg.cra_priority = alg->cra_priority;
1271	inst->alg.cra_blocksize = 1;
1272	inst->alg.cra_alignmask = alg->cra_alignmask;
1273	inst->alg.cra_type = &crypto_nivaead_type;
1274
1275	inst->alg.cra_aead.ivsize = 8;
1276	inst->alg.cra_aead.maxauthsize = 16;
1277
1278	inst->alg.cra_ctxsize = sizeof(struct crypto_rfc4543_ctx);
1279
1280	inst->alg.cra_init = crypto_rfc4543_init_tfm;
1281	inst->alg.cra_exit = crypto_rfc4543_exit_tfm;
1282
1283	inst->alg.cra_aead.setkey = crypto_rfc4543_setkey;
1284	inst->alg.cra_aead.setauthsize = crypto_rfc4543_setauthsize;
1285	inst->alg.cra_aead.encrypt = crypto_rfc4543_encrypt;
1286	inst->alg.cra_aead.decrypt = crypto_rfc4543_decrypt;
1287
1288	inst->alg.cra_aead.geniv = "seqiv";
 
 
 
 
1289
1290out:
1291	return inst;
1292
1293out_drop_alg:
1294	crypto_drop_aead(spawn);
1295out_free_inst:
1296	kfree(inst);
1297	inst = ERR_PTR(err);
1298	goto out;
1299}
1300
1301static void crypto_rfc4543_free(struct crypto_instance *inst)
1302{
1303	crypto_drop_spawn(crypto_instance_ctx(inst));
1304	kfree(inst);
1305}
1306
1307static struct crypto_template crypto_rfc4543_tmpl = {
1308	.name = "rfc4543",
1309	.alloc = crypto_rfc4543_alloc,
1310	.free = crypto_rfc4543_free,
1311	.module = THIS_MODULE,
1312};
1313
1314static int __init crypto_gcm_module_init(void)
1315{
1316	int err;
1317
1318	gcm_zeroes = kzalloc(16, GFP_KERNEL);
1319	if (!gcm_zeroes)
1320		return -ENOMEM;
1321
 
 
1322	err = crypto_register_template(&crypto_gcm_base_tmpl);
1323	if (err)
1324		goto out;
1325
1326	err = crypto_register_template(&crypto_gcm_tmpl);
1327	if (err)
1328		goto out_undo_base;
1329
1330	err = crypto_register_template(&crypto_rfc4106_tmpl);
1331	if (err)
1332		goto out_undo_gcm;
1333
1334	err = crypto_register_template(&crypto_rfc4543_tmpl);
1335	if (err)
1336		goto out_undo_rfc4106;
1337
1338	return 0;
1339
1340out_undo_rfc4106:
1341	crypto_unregister_template(&crypto_rfc4106_tmpl);
1342out_undo_gcm:
1343	crypto_unregister_template(&crypto_gcm_tmpl);
1344out_undo_base:
1345	crypto_unregister_template(&crypto_gcm_base_tmpl);
1346out:
1347	kfree(gcm_zeroes);
1348	return err;
1349}
1350
1351static void __exit crypto_gcm_module_exit(void)
1352{
1353	kfree(gcm_zeroes);
1354	crypto_unregister_template(&crypto_rfc4543_tmpl);
1355	crypto_unregister_template(&crypto_rfc4106_tmpl);
1356	crypto_unregister_template(&crypto_gcm_tmpl);
1357	crypto_unregister_template(&crypto_gcm_base_tmpl);
1358}
1359
1360module_init(crypto_gcm_module_init);
1361module_exit(crypto_gcm_module_exit);
1362
1363MODULE_LICENSE("GPL");
1364MODULE_DESCRIPTION("Galois/Counter Mode");
1365MODULE_AUTHOR("Mikko Herranen <mh1@iki.fi>");
1366MODULE_ALIAS("gcm_base");
1367MODULE_ALIAS("rfc4106");
1368MODULE_ALIAS("rfc4543");