723 lines · 20.0 KB · C
RawDownload
/* * Authenc: Simple AEAD wrapper for IPsec * * Copyright (c) 2007 Herbert Xu <herbert@gondor.apana.org.au> * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the Free * Software Foundation; either version 2 of the License, or (at your option) * any later version. * */ #include <crypto/aead.h>#include <crypto/internal/hash.h>#include <crypto/internal/skcipher.h>#include <crypto/authenc.h>#include <crypto/scatterwalk.h>#include <linux/err.h>#include <linux/init.h>#include <linux/kernel.h>#include <linux/module.h>#include <linux/rtnetlink.h>#include <linux/slab.h>#include <linux/spinlock.h> typedef u8 *(*authenc_ahash_t)(struct aead_request *req, unsigned int flags); struct authenc_instance_ctx {	struct crypto_ahash_spawn auth;	struct crypto_skcipher_spawn enc;}; struct crypto_authenc_ctx {	unsigned int reqoff;	struct crypto_ahash *auth;	struct crypto_ablkcipher *enc;}; struct authenc_request_ctx {	unsigned int cryptlen;	struct scatterlist *sg;	struct scatterlist asg[2];	struct scatterlist cipher[2];	crypto_completion_t complete;	crypto_completion_t update_complete;	char tail[];}; static void authenc_request_complete(struct aead_request *req, int err){	if (err != -EINPROGRESS)		aead_request_complete(req, err);} int crypto_authenc_extractkeys(struct crypto_authenc_keys *keys, const u8 *key,			       unsigned int keylen){	struct rtattr *rta = (struct rtattr *)key;	struct crypto_authenc_key_param *param; 	if (!RTA_OK(rta, keylen))		return -EINVAL;	if (rta->rta_type != CRYPTO_AUTHENC_KEYA_PARAM)		return -EINVAL;	if (RTA_PAYLOAD(rta) < sizeof(*param))		return -EINVAL; 	param = RTA_DATA(rta);	keys->enckeylen = be32_to_cpu(param->enckeylen); 	key += RTA_ALIGN(rta->rta_len);	keylen -= RTA_ALIGN(rta->rta_len); 	if (keylen < keys->enckeylen)		return -EINVAL; 	keys->authkeylen = keylen - keys->enckeylen;	keys->authkey = key;	keys->enckey = key + keys->authkeylen; 	return 0;}EXPORT_SYMBOL_GPL(crypto_authenc_extractkeys); static int crypto_authenc_setkey(struct crypto_aead *authenc, const u8 *key,				 unsigned int keylen){	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);	struct crypto_ahash *auth = ctx->auth;	struct crypto_ablkcipher *enc = ctx->enc;	struct crypto_authenc_keys keys;	int err = -EINVAL; 	if (crypto_authenc_extractkeys(&keys, key, keylen) != 0)		goto badkey; 	crypto_ahash_clear_flags(auth, CRYPTO_TFM_REQ_MASK);	crypto_ahash_set_flags(auth, crypto_aead_get_flags(authenc) &				    CRYPTO_TFM_REQ_MASK);	err = crypto_ahash_setkey(auth, keys.authkey, keys.authkeylen);	crypto_aead_set_flags(authenc, crypto_ahash_get_flags(auth) &				       CRYPTO_TFM_RES_MASK); 	if (err)		goto out; 	crypto_ablkcipher_clear_flags(enc, CRYPTO_TFM_REQ_MASK);	crypto_ablkcipher_set_flags(enc, crypto_aead_get_flags(authenc) &					 CRYPTO_TFM_REQ_MASK);	err = crypto_ablkcipher_setkey(enc, keys.enckey, keys.enckeylen);	crypto_aead_set_flags(authenc, crypto_ablkcipher_get_flags(enc) &				       CRYPTO_TFM_RES_MASK); out:	return err; badkey:	crypto_aead_set_flags(authenc, CRYPTO_TFM_RES_BAD_KEY_LEN);	goto out;} static void authenc_geniv_ahash_update_done(struct crypto_async_request *areq,					    int err){	struct aead_request *req = areq->data;	struct crypto_aead *authenc = crypto_aead_reqtfm(req);	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff); 	if (err)		goto out; 	ahash_request_set_crypt(ahreq, areq_ctx->sg, ahreq->result,				areq_ctx->cryptlen);	ahash_request_set_callback(ahreq, aead_request_flags(req) &					  CRYPTO_TFM_REQ_MAY_SLEEP,				   areq_ctx->complete, req); 	err = crypto_ahash_finup(ahreq);	if (err)		goto out; 	scatterwalk_map_and_copy(ahreq->result, areq_ctx->sg,				 areq_ctx->cryptlen,				 crypto_aead_authsize(authenc), 1); out:	authenc_request_complete(req, err);} static void authenc_geniv_ahash_done(struct crypto_async_request *areq, int err){	struct aead_request *req = areq->data;	struct crypto_aead *authenc = crypto_aead_reqtfm(req);	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff); 	if (err)		goto out; 	scatterwalk_map_and_copy(ahreq->result, areq_ctx->sg,				 areq_ctx->cryptlen,				 crypto_aead_authsize(authenc), 1); out:	aead_request_complete(req, err);} static void authenc_verify_ahash_update_done(struct crypto_async_request *areq,					     int err){	u8 *ihash;	unsigned int authsize;	struct ablkcipher_request *abreq;	struct aead_request *req = areq->data;	struct crypto_aead *authenc = crypto_aead_reqtfm(req);	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff);	unsigned int cryptlen = req->cryptlen; 	if (err)		goto out; 	ahash_request_set_crypt(ahreq, areq_ctx->sg, ahreq->result,				areq_ctx->cryptlen);	ahash_request_set_callback(ahreq, aead_request_flags(req) &					  CRYPTO_TFM_REQ_MAY_SLEEP,				   areq_ctx->complete, req); 	err = crypto_ahash_finup(ahreq);	if (err)		goto out; 	authsize = crypto_aead_authsize(authenc);	cryptlen -= authsize;	ihash = ahreq->result + authsize;	scatterwalk_map_and_copy(ihash, areq_ctx->sg, areq_ctx->cryptlen,				 authsize, 0); 	err = crypto_memneq(ihash, ahreq->result, authsize) ? -EBADMSG : 0;	if (err)		goto out; 	abreq = aead_request_ctx(req);	ablkcipher_request_set_tfm(abreq, ctx->enc);	ablkcipher_request_set_callback(abreq, aead_request_flags(req),					req->base.complete, req->base.data);	ablkcipher_request_set_crypt(abreq, req->src, req->dst,				     cryptlen, req->iv); 	err = crypto_ablkcipher_decrypt(abreq); out:	authenc_request_complete(req, err);} static void authenc_verify_ahash_done(struct crypto_async_request *areq,				      int err){	u8 *ihash;	unsigned int authsize;	struct ablkcipher_request *abreq;	struct aead_request *req = areq->data;	struct crypto_aead *authenc = crypto_aead_reqtfm(req);	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff);	unsigned int cryptlen = req->cryptlen; 	if (err)		goto out; 	authsize = crypto_aead_authsize(authenc);	cryptlen -= authsize;	ihash = ahreq->result + authsize;	scatterwalk_map_and_copy(ihash, areq_ctx->sg, areq_ctx->cryptlen,				 authsize, 0); 	err = crypto_memneq(ihash, ahreq->result, authsize) ? -EBADMSG : 0;	if (err)		goto out; 	abreq = aead_request_ctx(req);	ablkcipher_request_set_tfm(abreq, ctx->enc);	ablkcipher_request_set_callback(abreq, aead_request_flags(req),					req->base.complete, req->base.data);	ablkcipher_request_set_crypt(abreq, req->src, req->dst,				     cryptlen, req->iv); 	err = crypto_ablkcipher_decrypt(abreq); out:	authenc_request_complete(req, err);} static u8 *crypto_authenc_ahash_fb(struct aead_request *req, unsigned int flags){	struct crypto_aead *authenc = crypto_aead_reqtfm(req);	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);	struct crypto_ahash *auth = ctx->auth;	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff);	u8 *hash = areq_ctx->tail;	int err; 	hash = (u8 *)ALIGN((unsigned long)hash + crypto_ahash_alignmask(auth),			    crypto_ahash_alignmask(auth) + 1); 	ahash_request_set_tfm(ahreq, auth); 	err = crypto_ahash_init(ahreq);	if (err)		return ERR_PTR(err); 	ahash_request_set_crypt(ahreq, req->assoc, hash, req->assoclen);	ahash_request_set_callback(ahreq, aead_request_flags(req) & flags,				   areq_ctx->update_complete, req); 	err = crypto_ahash_update(ahreq);	if (err)		return ERR_PTR(err); 	ahash_request_set_crypt(ahreq, areq_ctx->sg, hash,				areq_ctx->cryptlen);	ahash_request_set_callback(ahreq, aead_request_flags(req) & flags,				   areq_ctx->complete, req); 	err = crypto_ahash_finup(ahreq);	if (err)		return ERR_PTR(err); 	return hash;} static u8 *crypto_authenc_ahash(struct aead_request *req, unsigned int flags){	struct crypto_aead *authenc = crypto_aead_reqtfm(req);	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);	struct crypto_ahash *auth = ctx->auth;	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);	struct ahash_request *ahreq = (void *)(areq_ctx->tail + ctx->reqoff);	u8 *hash = areq_ctx->tail;	int err; 	hash = (u8 *)ALIGN((unsigned long)hash + crypto_ahash_alignmask(auth),			   crypto_ahash_alignmask(auth) + 1); 	ahash_request_set_tfm(ahreq, auth);	ahash_request_set_crypt(ahreq, areq_ctx->sg, hash,				areq_ctx->cryptlen);	ahash_request_set_callback(ahreq, aead_request_flags(req) & flags,				   areq_ctx->complete, req); 	err = crypto_ahash_digest(ahreq);	if (err)		return ERR_PTR(err); 	return hash;} static int crypto_authenc_genicv(struct aead_request *req, u8 *iv,				 unsigned int flags){	struct crypto_aead *authenc = crypto_aead_reqtfm(req);	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);	struct scatterlist *dst = req->dst;	struct scatterlist *assoc = req->assoc;	struct scatterlist *cipher = areq_ctx->cipher;	struct scatterlist *asg = areq_ctx->asg;	unsigned int ivsize = crypto_aead_ivsize(authenc);	unsigned int cryptlen = req->cryptlen;	authenc_ahash_t authenc_ahash_fn = crypto_authenc_ahash_fb;	struct page *dstp;	u8 *vdst;	u8 *hash; 	dstp = sg_page(dst);	vdst = PageHighMem(dstp) ? NULL : page_address(dstp) + dst->offset; 	if (ivsize) {		sg_init_table(cipher, 2);		sg_set_buf(cipher, iv, ivsize);		scatterwalk_crypto_chain(cipher, dst, vdst == iv + ivsize, 2);		dst = cipher;		cryptlen += ivsize;	} 	if (req->assoclen && sg_is_last(assoc)) {		authenc_ahash_fn = crypto_authenc_ahash;		sg_init_table(asg, 2);		sg_set_page(asg, sg_page(assoc), assoc->length, assoc->offset);		scatterwalk_crypto_chain(asg, dst, 0, 2);		dst = asg;		cryptlen += req->assoclen;	} 	areq_ctx->cryptlen = cryptlen;	areq_ctx->sg = dst; 	areq_ctx->complete = authenc_geniv_ahash_done;	areq_ctx->update_complete = authenc_geniv_ahash_update_done; 	hash = authenc_ahash_fn(req, flags);	if (IS_ERR(hash))		return PTR_ERR(hash); 	scatterwalk_map_and_copy(hash, dst, cryptlen,				 crypto_aead_authsize(authenc), 1);	return 0;} static void crypto_authenc_encrypt_done(struct crypto_async_request *req,					int err){	struct aead_request *areq = req->data; 	if (!err) {		struct crypto_aead *authenc = crypto_aead_reqtfm(areq);		struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);		struct authenc_request_ctx *areq_ctx = aead_request_ctx(areq);		struct ablkcipher_request *abreq = (void *)(areq_ctx->tail							    + ctx->reqoff);		u8 *iv = (u8 *)abreq - crypto_ablkcipher_ivsize(ctx->enc); 		err = crypto_authenc_genicv(areq, iv, 0);	} 	authenc_request_complete(areq, err);} static int crypto_authenc_encrypt(struct aead_request *req){	struct crypto_aead *authenc = crypto_aead_reqtfm(req);	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);	struct crypto_ablkcipher *enc = ctx->enc;	struct scatterlist *dst = req->dst;	unsigned int cryptlen = req->cryptlen;	struct ablkcipher_request *abreq = (void *)(areq_ctx->tail						    + ctx->reqoff);	u8 *iv = (u8 *)abreq - crypto_ablkcipher_ivsize(enc);	int err; 	ablkcipher_request_set_tfm(abreq, enc);	ablkcipher_request_set_callback(abreq, aead_request_flags(req),					crypto_authenc_encrypt_done, req);	ablkcipher_request_set_crypt(abreq, req->src, dst, cryptlen, req->iv); 	memcpy(iv, req->iv, crypto_aead_ivsize(authenc)); 	err = crypto_ablkcipher_encrypt(abreq);	if (err)		return err; 	return crypto_authenc_genicv(req, iv, CRYPTO_TFM_REQ_MAY_SLEEP);} static void crypto_authenc_givencrypt_done(struct crypto_async_request *req,					   int err){	struct aead_request *areq = req->data; 	if (!err) {		struct skcipher_givcrypt_request *greq = aead_request_ctx(areq); 		err = crypto_authenc_genicv(areq, greq->giv, 0);	} 	authenc_request_complete(areq, err);} static int crypto_authenc_givencrypt(struct aead_givcrypt_request *req){	struct crypto_aead *authenc = aead_givcrypt_reqtfm(req);	struct crypto_authenc_ctx *ctx = crypto_aead_ctx(authenc);	struct aead_request *areq = &req->areq;	struct skcipher_givcrypt_request *greq = aead_request_ctx(areq);	u8 *iv = req->giv;	int err; 	skcipher_givcrypt_set_tfm(greq, ctx->enc);	skcipher_givcrypt_set_callback(greq, aead_request_flags(areq),				       crypto_authenc_givencrypt_done, areq);	skcipher_givcrypt_set_crypt(greq, areq->src, areq->dst, areq->cryptlen,				    areq->iv);	skcipher_givcrypt_set_giv(greq, iv, req->seq); 	err = crypto_skcipher_givencrypt(greq);	if (err)		return err; 	return crypto_authenc_genicv(areq, iv, CRYPTO_TFM_REQ_MAY_SLEEP);} static int crypto_authenc_verify(struct aead_request *req,				 authenc_ahash_t authenc_ahash_fn){	struct crypto_aead *authenc = crypto_aead_reqtfm(req);	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);	u8 *ohash;	u8 *ihash;	unsigned int authsize; 	areq_ctx->complete = authenc_verify_ahash_done;	areq_ctx->update_complete = authenc_verify_ahash_update_done; 	ohash = authenc_ahash_fn(req, CRYPTO_TFM_REQ_MAY_SLEEP);	if (IS_ERR(ohash))		return PTR_ERR(ohash); 	authsize = crypto_aead_authsize(authenc);	ihash = ohash + authsize;	scatterwalk_map_and_copy(ihash, areq_ctx->sg, areq_ctx->cryptlen,				 authsize, 0);	return crypto_memneq(ihash, ohash, authsize) ? -EBADMSG : 0;} static int crypto_authenc_iverify(struct aead_request *req, u8 *iv,				  unsigned int cryptlen){	struct crypto_aead *authenc = crypto_aead_reqtfm(req);	struct authenc_request_ctx *areq_ctx = aead_request_ctx(req);	struct scatterlist *src = req->src;	struct scatterlist *assoc = req->assoc;	struct scatterlist *cipher = areq_ctx->cipher;	struct scatterlist *asg = areq_ctx->asg;	unsigned int ivsize = crypto_aead_ivsize(authenc);	authenc_ahash_t authenc_ahash_fn = crypto_authenc_ahash_fb;	struct page *srcp;	u8 *vsrc; 	srcp = sg_page(src);	vsrc = PageHighMem(srcp) ? NULL : page_address(srcp) + src->offset; 	if (ivsize) {		sg_init_table(cipher, 2);		sg_set_buf(cipher, iv, ivsize);

Lines 1–500 of 723.