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