staging: wlan-ng: properly check endpoint types
[linux/fpc-iii.git] / crypto / authenc.c
blob775e7138fd10c4abe5abd24a589ac01ccfc0ca2b
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Authenc: Simple AEAD wrapper for IPsec
5 * Copyright (c) 2007-2015 Herbert Xu <herbert@gondor.apana.org.au>
6 */
8 #include <crypto/internal/aead.h>
9 #include <crypto/internal/hash.h>
10 #include <crypto/internal/skcipher.h>
11 #include <crypto/authenc.h>
12 #include <crypto/null.h>
13 #include <crypto/scatterwalk.h>
14 #include <linux/err.h>
15 #include <linux/init.h>
16 #include <linux/kernel.h>
17 #include <linux/module.h>
18 #include <linux/rtnetlink.h>
19 #include <linux/slab.h>
20 #include <linux/spinlock.h>
22 struct authenc_instance_ctx {
23 struct crypto_ahash_spawn auth;
24 struct crypto_skcipher_spawn enc;
25 unsigned int reqoff;
28 struct crypto_authenc_ctx {
29 struct crypto_ahash *auth;
30 struct crypto_skcipher *enc;
31 struct crypto_sync_skcipher *null;
34 struct authenc_request_ctx {
35 struct scatterlist src[2];
36 struct scatterlist dst[2];
37 char tail[];
40 static void authenc_request_complete(struct aead_request *req, int err)
42 if (err != -EINPROGRESS)
43 aead_request_complete(req, err);
46 int crypto_authenc_extractkeys(struct crypto_authenc_keys *keys, const u8 *key,
47 unsigned int keylen)
49 struct rtattr *rta = (struct rtattr *)key;
50 struct crypto_authenc_key_param *param;
52 if (!RTA_OK(rta, keylen))
53 return -EINVAL;
54 if (rta->rta_type != CRYPTO_AUTHENC_KEYA_PARAM)
55 return -EINVAL;
58 * RTA_OK() didn't align the rtattr's payload when validating that it
59 * fits in the buffer. Yet, the keys should start on the next 4-byte
60 * aligned boundary. To avoid confusion, require that the rtattr
61 * payload be exactly the param struct, which has a 4-byte aligned size.
63 if (RTA_PAYLOAD(rta) != sizeof(*param))
64 return -EINVAL;
65 BUILD_BUG_ON(sizeof(*param) % RTA_ALIGNTO);
67 param = RTA_DATA(rta);
68 keys->enckeylen = be32_to_cpu(param->enckeylen);
70 key += rta->rta_len;
71 keylen -= rta->rta_len;
73 if (keylen < keys->enckeylen)
74 return -EINVAL;
76 keys->authkeylen = keylen - keys->enckeylen;
77 keys->authkey = key;
78 keys->enckey = key + keys->authkeylen;
80 return 0;
82 EXPORT_SYMBOL_GPL(crypto_authenc_extractkeys);
84 static int crypto_authenc_setkey(struct crypto_aead *authenc, const u8 *key,
85 unsigned int keylen)
87 struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
88 struct crypto_ahash *auth = ctx->auth;
89 struct crypto_skcipher *enc = ctx->enc;
90 struct crypto_authenc_keys keys;
91 int err = -EINVAL;
93 if (crypto_authenc_extractkeys(&keys, key, keylen) != 0)
94 goto out;
96 crypto_ahash_clear_flags(auth, CRYPTO_TFM_REQ_MASK);
97 crypto_ahash_set_flags(auth, crypto_aead_get_flags(authenc) &
98 CRYPTO_TFM_REQ_MASK);
99 err = crypto_ahash_setkey(auth, keys.authkey, keys.authkeylen);
100 if (err)
101 goto out;
103 crypto_skcipher_clear_flags(enc, CRYPTO_TFM_REQ_MASK);
104 crypto_skcipher_set_flags(enc, crypto_aead_get_flags(authenc) &
105 CRYPTO_TFM_REQ_MASK);
106 err = crypto_skcipher_setkey(enc, keys.enckey, keys.enckeylen);
107 out:
108 memzero_explicit(&keys, sizeof(keys));
109 return err;
112 static void authenc_geniv_ahash_done(struct crypto_async_request *areq, int err)
114 struct aead_request *req = areq->data;
115 struct crypto_aead *authenc = crypto_aead_reqtfm(req);
116 struct aead_instance *inst = aead_alg_instance(authenc);
117 struct authenc_instance_ctx *ictx = aead_instance_ctx(inst);
118 struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
119 struct ahash_request *ahreq = (void *)(areq_ctx->tail + ictx->reqoff);
121 if (err)
122 goto out;
124 scatterwalk_map_and_copy(ahreq->result, req->dst,
125 req->assoclen + req->cryptlen,
126 crypto_aead_authsize(authenc), 1);
128 out:
129 aead_request_complete(req, err);
132 static int crypto_authenc_genicv(struct aead_request *req, unsigned int flags)
134 struct crypto_aead *authenc = crypto_aead_reqtfm(req);
135 struct aead_instance *inst = aead_alg_instance(authenc);
136 struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
137 struct authenc_instance_ctx *ictx = aead_instance_ctx(inst);
138 struct crypto_ahash *auth = ctx->auth;
139 struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
140 struct ahash_request *ahreq = (void *)(areq_ctx->tail + ictx->reqoff);
141 u8 *hash = areq_ctx->tail;
142 int err;
144 hash = (u8 *)ALIGN((unsigned long)hash + crypto_ahash_alignmask(auth),
145 crypto_ahash_alignmask(auth) + 1);
147 ahash_request_set_tfm(ahreq, auth);
148 ahash_request_set_crypt(ahreq, req->dst, hash,
149 req->assoclen + req->cryptlen);
150 ahash_request_set_callback(ahreq, flags,
151 authenc_geniv_ahash_done, req);
153 err = crypto_ahash_digest(ahreq);
154 if (err)
155 return err;
157 scatterwalk_map_and_copy(hash, req->dst, req->assoclen + req->cryptlen,
158 crypto_aead_authsize(authenc), 1);
160 return 0;
163 static void crypto_authenc_encrypt_done(struct crypto_async_request *req,
164 int err)
166 struct aead_request *areq = req->data;
168 if (err)
169 goto out;
171 err = crypto_authenc_genicv(areq, 0);
173 out:
174 authenc_request_complete(areq, err);
177 static int crypto_authenc_copy_assoc(struct aead_request *req)
179 struct crypto_aead *authenc = crypto_aead_reqtfm(req);
180 struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
181 SYNC_SKCIPHER_REQUEST_ON_STACK(skreq, ctx->null);
183 skcipher_request_set_sync_tfm(skreq, ctx->null);
184 skcipher_request_set_callback(skreq, aead_request_flags(req),
185 NULL, NULL);
186 skcipher_request_set_crypt(skreq, req->src, req->dst, req->assoclen,
187 NULL);
189 return crypto_skcipher_encrypt(skreq);
192 static int crypto_authenc_encrypt(struct aead_request *req)
194 struct crypto_aead *authenc = crypto_aead_reqtfm(req);
195 struct aead_instance *inst = aead_alg_instance(authenc);
196 struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
197 struct authenc_instance_ctx *ictx = aead_instance_ctx(inst);
198 struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
199 struct crypto_skcipher *enc = ctx->enc;
200 unsigned int cryptlen = req->cryptlen;
201 struct skcipher_request *skreq = (void *)(areq_ctx->tail +
202 ictx->reqoff);
203 struct scatterlist *src, *dst;
204 int err;
206 src = scatterwalk_ffwd(areq_ctx->src, req->src, req->assoclen);
207 dst = src;
209 if (req->src != req->dst) {
210 err = crypto_authenc_copy_assoc(req);
211 if (err)
212 return err;
214 dst = scatterwalk_ffwd(areq_ctx->dst, req->dst, req->assoclen);
217 skcipher_request_set_tfm(skreq, enc);
218 skcipher_request_set_callback(skreq, aead_request_flags(req),
219 crypto_authenc_encrypt_done, req);
220 skcipher_request_set_crypt(skreq, src, dst, cryptlen, req->iv);
222 err = crypto_skcipher_encrypt(skreq);
223 if (err)
224 return err;
226 return crypto_authenc_genicv(req, aead_request_flags(req));
229 static int crypto_authenc_decrypt_tail(struct aead_request *req,
230 unsigned int flags)
232 struct crypto_aead *authenc = crypto_aead_reqtfm(req);
233 struct aead_instance *inst = aead_alg_instance(authenc);
234 struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
235 struct authenc_instance_ctx *ictx = aead_instance_ctx(inst);
236 struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
237 struct ahash_request *ahreq = (void *)(areq_ctx->tail + ictx->reqoff);
238 struct skcipher_request *skreq = (void *)(areq_ctx->tail +
239 ictx->reqoff);
240 unsigned int authsize = crypto_aead_authsize(authenc);
241 u8 *ihash = ahreq->result + authsize;
242 struct scatterlist *src, *dst;
244 scatterwalk_map_and_copy(ihash, req->src, ahreq->nbytes, authsize, 0);
246 if (crypto_memneq(ihash, ahreq->result, authsize))
247 return -EBADMSG;
249 src = scatterwalk_ffwd(areq_ctx->src, req->src, req->assoclen);
250 dst = src;
252 if (req->src != req->dst)
253 dst = scatterwalk_ffwd(areq_ctx->dst, req->dst, req->assoclen);
255 skcipher_request_set_tfm(skreq, ctx->enc);
256 skcipher_request_set_callback(skreq, aead_request_flags(req),
257 req->base.complete, req->base.data);
258 skcipher_request_set_crypt(skreq, src, dst,
259 req->cryptlen - authsize, req->iv);
261 return crypto_skcipher_decrypt(skreq);
264 static void authenc_verify_ahash_done(struct crypto_async_request *areq,
265 int err)
267 struct aead_request *req = areq->data;
269 if (err)
270 goto out;
272 err = crypto_authenc_decrypt_tail(req, 0);
274 out:
275 authenc_request_complete(req, err);
278 static int crypto_authenc_decrypt(struct aead_request *req)
280 struct crypto_aead *authenc = crypto_aead_reqtfm(req);
281 unsigned int authsize = crypto_aead_authsize(authenc);
282 struct aead_instance *inst = aead_alg_instance(authenc);
283 struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);
284 struct authenc_instance_ctx *ictx = aead_instance_ctx(inst);
285 struct crypto_ahash *auth = ctx->auth;
286 struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);
287 struct ahash_request *ahreq = (void *)(areq_ctx->tail + ictx->reqoff);
288 u8 *hash = areq_ctx->tail;
289 int err;
291 hash = (u8 *)ALIGN((unsigned long)hash + crypto_ahash_alignmask(auth),
292 crypto_ahash_alignmask(auth) + 1);
294 ahash_request_set_tfm(ahreq, auth);
295 ahash_request_set_crypt(ahreq, req->src, hash,
296 req->assoclen + req->cryptlen - authsize);
297 ahash_request_set_callback(ahreq, aead_request_flags(req),
298 authenc_verify_ahash_done, req);
300 err = crypto_ahash_digest(ahreq);
301 if (err)
302 return err;
304 return crypto_authenc_decrypt_tail(req, aead_request_flags(req));
307 static int crypto_authenc_init_tfm(struct crypto_aead *tfm)
309 struct aead_instance *inst = aead_alg_instance(tfm);
310 struct authenc_instance_ctx *ictx = aead_instance_ctx(inst);
311 struct crypto_authenc_ctx *ctx = crypto_aead_ctx(tfm);
312 struct crypto_ahash *auth;
313 struct crypto_skcipher *enc;
314 struct crypto_sync_skcipher *null;
315 int err;
317 auth = crypto_spawn_ahash(&ictx->auth);
318 if (IS_ERR(auth))
319 return PTR_ERR(auth);
321 enc = crypto_spawn_skcipher(&ictx->enc);
322 err = PTR_ERR(enc);
323 if (IS_ERR(enc))
324 goto err_free_ahash;
326 null = crypto_get_default_null_skcipher();
327 err = PTR_ERR(null);
328 if (IS_ERR(null))
329 goto err_free_skcipher;
331 ctx->auth = auth;
332 ctx->enc = enc;
333 ctx->null = null;
335 crypto_aead_set_reqsize(
336 tfm,
337 sizeof(struct authenc_request_ctx) +
338 ictx->reqoff +
339 max_t(unsigned int,
340 crypto_ahash_reqsize(auth) +
341 sizeof(struct ahash_request),
342 sizeof(struct skcipher_request) +
343 crypto_skcipher_reqsize(enc)));
345 return 0;
347 err_free_skcipher:
348 crypto_free_skcipher(enc);
349 err_free_ahash:
350 crypto_free_ahash(auth);
351 return err;
354 static void crypto_authenc_exit_tfm(struct crypto_aead *tfm)
356 struct crypto_authenc_ctx *ctx = crypto_aead_ctx(tfm);
358 crypto_free_ahash(ctx->auth);
359 crypto_free_skcipher(ctx->enc);
360 crypto_put_default_null_skcipher();
363 static void crypto_authenc_free(struct aead_instance *inst)
365 struct authenc_instance_ctx *ctx = aead_instance_ctx(inst);
367 crypto_drop_skcipher(&ctx->enc);
368 crypto_drop_ahash(&ctx->auth);
369 kfree(inst);
372 static int crypto_authenc_create(struct crypto_template *tmpl,
373 struct rtattr **tb)
375 struct crypto_attr_type *algt;
376 u32 mask;
377 struct aead_instance *inst;
378 struct authenc_instance_ctx *ctx;
379 struct hash_alg_common *auth;
380 struct crypto_alg *auth_base;
381 struct skcipher_alg *enc;
382 int err;
384 algt = crypto_get_attr_type(tb);
385 if (IS_ERR(algt))
386 return PTR_ERR(algt);
388 if ((algt->type ^ CRYPTO_ALG_TYPE_AEAD) & algt->mask)
389 return -EINVAL;
391 mask = crypto_requires_sync(algt->type, algt->mask);
393 inst = kzalloc(sizeof(*inst) + sizeof(*ctx), GFP_KERNEL);
394 if (!inst)
395 return -ENOMEM;
396 ctx = aead_instance_ctx(inst);
398 err = crypto_grab_ahash(&ctx->auth, aead_crypto_instance(inst),
399 crypto_attr_alg_name(tb[1]), 0, mask);
400 if (err)
401 goto err_free_inst;
402 auth = crypto_spawn_ahash_alg(&ctx->auth);
403 auth_base = &auth->base;
405 err = crypto_grab_skcipher(&ctx->enc, aead_crypto_instance(inst),
406 crypto_attr_alg_name(tb[2]), 0, mask);
407 if (err)
408 goto err_free_inst;
409 enc = crypto_spawn_skcipher_alg(&ctx->enc);
411 ctx->reqoff = ALIGN(2 * auth->digestsize + auth_base->cra_alignmask,
412 auth_base->cra_alignmask + 1);
414 err = -ENAMETOOLONG;
415 if (snprintf(inst->alg.base.cra_name, CRYPTO_MAX_ALG_NAME,
416 "authenc(%s,%s)", auth_base->cra_name,
417 enc->base.cra_name) >=
418 CRYPTO_MAX_ALG_NAME)
419 goto err_free_inst;
421 if (snprintf(inst->alg.base.cra_driver_name, CRYPTO_MAX_ALG_NAME,
422 "authenc(%s,%s)", auth_base->cra_driver_name,
423 enc->base.cra_driver_name) >= CRYPTO_MAX_ALG_NAME)
424 goto err_free_inst;
426 inst->alg.base.cra_flags = (auth_base->cra_flags |
427 enc->base.cra_flags) & CRYPTO_ALG_ASYNC;
428 inst->alg.base.cra_priority = enc->base.cra_priority * 10 +
429 auth_base->cra_priority;
430 inst->alg.base.cra_blocksize = enc->base.cra_blocksize;
431 inst->alg.base.cra_alignmask = auth_base->cra_alignmask |
432 enc->base.cra_alignmask;
433 inst->alg.base.cra_ctxsize = sizeof(struct crypto_authenc_ctx);
435 inst->alg.ivsize = crypto_skcipher_alg_ivsize(enc);
436 inst->alg.chunksize = crypto_skcipher_alg_chunksize(enc);
437 inst->alg.maxauthsize = auth->digestsize;
439 inst->alg.init = crypto_authenc_init_tfm;
440 inst->alg.exit = crypto_authenc_exit_tfm;
442 inst->alg.setkey = crypto_authenc_setkey;
443 inst->alg.encrypt = crypto_authenc_encrypt;
444 inst->alg.decrypt = crypto_authenc_decrypt;
446 inst->free = crypto_authenc_free;
448 err = aead_register_instance(tmpl, inst);
449 if (err) {
450 err_free_inst:
451 crypto_authenc_free(inst);
453 return err;
456 static struct crypto_template crypto_authenc_tmpl = {
457 .name = "authenc",
458 .create = crypto_authenc_create,
459 .module = THIS_MODULE,
462 static int __init crypto_authenc_module_init(void)
464 return crypto_register_template(&crypto_authenc_tmpl);
467 static void __exit crypto_authenc_module_exit(void)
469 crypto_unregister_template(&crypto_authenc_tmpl);
472 subsys_initcall(crypto_authenc_module_init);
473 module_exit(crypto_authenc_module_exit);
475 MODULE_LICENSE("GPL");
476 MODULE_DESCRIPTION("Simple AEAD wrapper for IPsec");
477 MODULE_ALIAS_CRYPTO("authenc");