387 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * pcrypt - Parallel crypto wrapper.4 *5 * Copyright (C) 2009 secunet Security Networks AG6 * Copyright (C) 2009 Steffen Klassert <steffen.klassert@secunet.com>7 */8 9#include <crypto/algapi.h>10#include <crypto/internal/aead.h>11#include <linux/atomic.h>12#include <linux/err.h>13#include <linux/init.h>14#include <linux/module.h>15#include <linux/slab.h>16#include <linux/kobject.h>17#include <linux/cpu.h>18#include <crypto/pcrypt.h>19 20static struct padata_instance *pencrypt;21static struct padata_instance *pdecrypt;22static struct kset *pcrypt_kset;23 24struct pcrypt_instance_ctx {25 struct crypto_aead_spawn spawn;26 struct padata_shell *psenc;27 struct padata_shell *psdec;28 atomic_t tfm_count;29};30 31struct pcrypt_aead_ctx {32 struct crypto_aead *child;33 unsigned int cb_cpu;34};35 36static inline struct pcrypt_instance_ctx *pcrypt_tfm_ictx(37 struct crypto_aead *tfm)38{39 return aead_instance_ctx(aead_alg_instance(tfm));40}41 42static int pcrypt_aead_setkey(struct crypto_aead *parent,43 const u8 *key, unsigned int keylen)44{45 struct pcrypt_aead_ctx *ctx = crypto_aead_ctx(parent);46 47 return crypto_aead_setkey(ctx->child, key, keylen);48}49 50static int pcrypt_aead_setauthsize(struct crypto_aead *parent,51 unsigned int authsize)52{53 struct pcrypt_aead_ctx *ctx = crypto_aead_ctx(parent);54 55 return crypto_aead_setauthsize(ctx->child, authsize);56}57 58static void pcrypt_aead_serial(struct padata_priv *padata)59{60 struct pcrypt_request *preq = pcrypt_padata_request(padata);61 struct aead_request *req = pcrypt_request_ctx(preq);62 63 aead_request_complete(req->base.data, padata->info);64}65 66static void pcrypt_aead_done(void *data, int err)67{68 struct aead_request *req = data;69 struct pcrypt_request *preq = aead_request_ctx(req);70 struct padata_priv *padata = pcrypt_request_padata(preq);71 72 padata->info = err;73 74 padata_do_serial(padata);75}76 77static void pcrypt_aead_enc(struct padata_priv *padata)78{79 struct pcrypt_request *preq = pcrypt_padata_request(padata);80 struct aead_request *req = pcrypt_request_ctx(preq);81 int ret;82 83 ret = crypto_aead_encrypt(req);84 85 if (ret == -EINPROGRESS)86 return;87 88 padata->info = ret;89 padata_do_serial(padata);90}91 92static int pcrypt_aead_encrypt(struct aead_request *req)93{94 int err;95 struct pcrypt_request *preq = aead_request_ctx(req);96 struct aead_request *creq = pcrypt_request_ctx(preq);97 struct padata_priv *padata = pcrypt_request_padata(preq);98 struct crypto_aead *aead = crypto_aead_reqtfm(req);99 struct pcrypt_aead_ctx *ctx = crypto_aead_ctx(aead);100 u32 flags = aead_request_flags(req);101 struct pcrypt_instance_ctx *ictx;102 103 ictx = pcrypt_tfm_ictx(aead);104 105 memset(padata, 0, sizeof(struct padata_priv));106 107 padata->parallel = pcrypt_aead_enc;108 padata->serial = pcrypt_aead_serial;109 110 aead_request_set_tfm(creq, ctx->child);111 aead_request_set_callback(creq, flags & ~CRYPTO_TFM_REQ_MAY_SLEEP,112 pcrypt_aead_done, req);113 aead_request_set_crypt(creq, req->src, req->dst,114 req->cryptlen, req->iv);115 aead_request_set_ad(creq, req->assoclen);116 117 err = padata_do_parallel(ictx->psenc, padata, &ctx->cb_cpu);118 if (!err)119 return -EINPROGRESS;120 if (err == -EBUSY)121 return -EAGAIN;122 123 return err;124}125 126static void pcrypt_aead_dec(struct padata_priv *padata)127{128 struct pcrypt_request *preq = pcrypt_padata_request(padata);129 struct aead_request *req = pcrypt_request_ctx(preq);130 int ret;131 132 ret = crypto_aead_decrypt(req);133 134 if (ret == -EINPROGRESS)135 return;136 137 padata->info = ret;138 padata_do_serial(padata);139}140 141static int pcrypt_aead_decrypt(struct aead_request *req)142{143 int err;144 struct pcrypt_request *preq = aead_request_ctx(req);145 struct aead_request *creq = pcrypt_request_ctx(preq);146 struct padata_priv *padata = pcrypt_request_padata(preq);147 struct crypto_aead *aead = crypto_aead_reqtfm(req);148 struct pcrypt_aead_ctx *ctx = crypto_aead_ctx(aead);149 u32 flags = aead_request_flags(req);150 struct pcrypt_instance_ctx *ictx;151 152 ictx = pcrypt_tfm_ictx(aead);153 154 memset(padata, 0, sizeof(struct padata_priv));155 156 padata->parallel = pcrypt_aead_dec;157 padata->serial = pcrypt_aead_serial;158 159 aead_request_set_tfm(creq, ctx->child);160 aead_request_set_callback(creq, flags & ~CRYPTO_TFM_REQ_MAY_SLEEP,161 pcrypt_aead_done, req);162 aead_request_set_crypt(creq, req->src, req->dst,163 req->cryptlen, req->iv);164 aead_request_set_ad(creq, req->assoclen);165 166 err = padata_do_parallel(ictx->psdec, padata, &ctx->cb_cpu);167 if (!err)168 return -EINPROGRESS;169 if (err == -EBUSY)170 return -EAGAIN;171 172 return err;173}174 175static int pcrypt_aead_init_tfm(struct crypto_aead *tfm)176{177 int cpu, cpu_index;178 struct aead_instance *inst = aead_alg_instance(tfm);179 struct pcrypt_instance_ctx *ictx = aead_instance_ctx(inst);180 struct pcrypt_aead_ctx *ctx = crypto_aead_ctx(tfm);181 struct crypto_aead *cipher;182 183 cpu_index = (unsigned int)atomic_inc_return(&ictx->tfm_count) %184 cpumask_weight(cpu_online_mask);185 186 ctx->cb_cpu = cpumask_first(cpu_online_mask);187 for (cpu = 0; cpu < cpu_index; cpu++)188 ctx->cb_cpu = cpumask_next(ctx->cb_cpu, cpu_online_mask);189 190 cipher = crypto_spawn_aead(&ictx->spawn);191 192 if (IS_ERR(cipher))193 return PTR_ERR(cipher);194 195 ctx->child = cipher;196 crypto_aead_set_reqsize(tfm, sizeof(struct pcrypt_request) +197 sizeof(struct aead_request) +198 crypto_aead_reqsize(cipher));199 200 return 0;201}202 203static void pcrypt_aead_exit_tfm(struct crypto_aead *tfm)204{205 struct pcrypt_aead_ctx *ctx = crypto_aead_ctx(tfm);206 207 crypto_free_aead(ctx->child);208}209 210static void pcrypt_free(struct aead_instance *inst)211{212 struct pcrypt_instance_ctx *ctx = aead_instance_ctx(inst);213 214 crypto_drop_aead(&ctx->spawn);215 padata_free_shell(ctx->psdec);216 padata_free_shell(ctx->psenc);217 kfree(inst);218}219 220static int pcrypt_init_instance(struct crypto_instance *inst,221 struct crypto_alg *alg)222{223 if (snprintf(inst->alg.cra_driver_name, CRYPTO_MAX_ALG_NAME,224 "pcrypt(%s)", alg->cra_driver_name) >= CRYPTO_MAX_ALG_NAME)225 return -ENAMETOOLONG;226 227 memcpy(inst->alg.cra_name, alg->cra_name, CRYPTO_MAX_ALG_NAME);228 229 inst->alg.cra_priority = alg->cra_priority + 100;230 inst->alg.cra_blocksize = alg->cra_blocksize;231 inst->alg.cra_alignmask = alg->cra_alignmask;232 233 return 0;234}235 236static int pcrypt_create_aead(struct crypto_template *tmpl, struct rtattr **tb,237 struct crypto_attr_type *algt)238{239 struct pcrypt_instance_ctx *ctx;240 struct aead_instance *inst;241 struct aead_alg *alg;242 u32 mask = crypto_algt_inherited_mask(algt);243 int err;244 245 inst = kzalloc(sizeof(*inst) + sizeof(*ctx), GFP_KERNEL);246 if (!inst)247 return -ENOMEM;248 249 err = -ENOMEM;250 251 ctx = aead_instance_ctx(inst);252 ctx->psenc = padata_alloc_shell(pencrypt);253 if (!ctx->psenc)254 goto err_free_inst;255 256 ctx->psdec = padata_alloc_shell(pdecrypt);257 if (!ctx->psdec)258 goto err_free_inst;259 260 err = crypto_grab_aead(&ctx->spawn, aead_crypto_instance(inst),261 crypto_attr_alg_name(tb[1]), 0, mask);262 if (err)263 goto err_free_inst;264 265 alg = crypto_spawn_aead_alg(&ctx->spawn);266 err = pcrypt_init_instance(aead_crypto_instance(inst), &alg->base);267 if (err)268 goto err_free_inst;269 270 inst->alg.base.cra_flags |= CRYPTO_ALG_ASYNC;271 272 inst->alg.ivsize = crypto_aead_alg_ivsize(alg);273 inst->alg.maxauthsize = crypto_aead_alg_maxauthsize(alg);274 275 inst->alg.base.cra_ctxsize = sizeof(struct pcrypt_aead_ctx);276 277 inst->alg.init = pcrypt_aead_init_tfm;278 inst->alg.exit = pcrypt_aead_exit_tfm;279 280 inst->alg.setkey = pcrypt_aead_setkey;281 inst->alg.setauthsize = pcrypt_aead_setauthsize;282 inst->alg.encrypt = pcrypt_aead_encrypt;283 inst->alg.decrypt = pcrypt_aead_decrypt;284 285 inst->free = pcrypt_free;286 287 err = aead_register_instance(tmpl, inst);288 if (err) {289err_free_inst:290 pcrypt_free(inst);291 }292 return err;293}294 295static int pcrypt_create(struct crypto_template *tmpl, struct rtattr **tb)296{297 struct crypto_attr_type *algt;298 299 algt = crypto_get_attr_type(tb);300 if (IS_ERR(algt))301 return PTR_ERR(algt);302 303 switch (algt->type & algt->mask & CRYPTO_ALG_TYPE_MASK) {304 case CRYPTO_ALG_TYPE_AEAD:305 return pcrypt_create_aead(tmpl, tb, algt);306 }307 308 return -EINVAL;309}310 311static int pcrypt_sysfs_add(struct padata_instance *pinst, const char *name)312{313 int ret;314 315 pinst->kobj.kset = pcrypt_kset;316 ret = kobject_add(&pinst->kobj, NULL, "%s", name);317 if (!ret)318 kobject_uevent(&pinst->kobj, KOBJ_ADD);319 320 return ret;321}322 323static int pcrypt_init_padata(struct padata_instance **pinst, const char *name)324{325 int ret = -ENOMEM;326 327 *pinst = padata_alloc(name);328 if (!*pinst)329 return ret;330 331 ret = pcrypt_sysfs_add(*pinst, name);332 if (ret)333 padata_free(*pinst);334 335 return ret;336}337 338static struct crypto_template pcrypt_tmpl = {339 .name = "pcrypt",340 .create = pcrypt_create,341 .module = THIS_MODULE,342};343 344static int __init pcrypt_init(void)345{346 int err = -ENOMEM;347 348 pcrypt_kset = kset_create_and_add("pcrypt", NULL, kernel_kobj);349 if (!pcrypt_kset)350 goto err;351 352 err = pcrypt_init_padata(&pencrypt, "pencrypt");353 if (err)354 goto err_unreg_kset;355 356 err = pcrypt_init_padata(&pdecrypt, "pdecrypt");357 if (err)358 goto err_deinit_pencrypt;359 360 return crypto_register_template(&pcrypt_tmpl);361 362err_deinit_pencrypt:363 padata_free(pencrypt);364err_unreg_kset:365 kset_unregister(pcrypt_kset);366err:367 return err;368}369 370static void __exit pcrypt_exit(void)371{372 crypto_unregister_template(&pcrypt_tmpl);373 374 padata_free(pencrypt);375 padata_free(pdecrypt);376 377 kset_unregister(pcrypt_kset);378}379 380subsys_initcall(pcrypt_init);381module_exit(pcrypt_exit);382 383MODULE_LICENSE("GPL");384MODULE_AUTHOR("Steffen Klassert <steffen.klassert@secunet.com>");385MODULE_DESCRIPTION("Parallel crypto wrapper");386MODULE_ALIAS_CRYPTO("pcrypt");387