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