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_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_nth(cpu_index, cpu_online_mask);
191 cipher = crypto_spawn_aead(&ictx->spawn);
192
193 if (IS_ERR(cipher))
194 return PTR_ERR(cipher);
195
196 ctx->child = cipher;
197 crypto_aead_set_reqsize(tfm, sizeof(struct pcrypt_request) +
198 sizeof(struct aead_request) +
199 crypto_aead_reqsize(cipher));
200
201 return 0;
202 }
203
pcrypt_aead_exit_tfm(struct crypto_aead * tfm)204 static void pcrypt_aead_exit_tfm(struct crypto_aead *tfm)
205 {
206 struct pcrypt_aead_ctx *ctx = crypto_aead_ctx(tfm);
207
208 crypto_free_aead(ctx->child);
209 }
210
pcrypt_free(struct aead_instance * inst)211 static void pcrypt_free(struct aead_instance *inst)
212 {
213 struct pcrypt_instance_ctx *ctx = aead_instance_ctx(inst);
214
215 crypto_drop_aead(&ctx->spawn);
216 padata_free_shell(ctx->psdec);
217 padata_free_shell(ctx->psenc);
218 kfree(inst);
219 }
220
pcrypt_init_instance(struct crypto_instance * inst,struct crypto_alg * alg)221 static int pcrypt_init_instance(struct crypto_instance *inst,
222 struct crypto_alg *alg)
223 {
224 if (snprintf(inst->alg.cra_driver_name, CRYPTO_MAX_ALG_NAME,
225 "pcrypt(%s)", alg->cra_driver_name) >= CRYPTO_MAX_ALG_NAME)
226 return -ENAMETOOLONG;
227
228 memcpy(inst->alg.cra_name, alg->cra_name, CRYPTO_MAX_ALG_NAME);
229
230 inst->alg.cra_priority = alg->cra_priority + 100;
231 inst->alg.cra_blocksize = alg->cra_blocksize;
232 inst->alg.cra_alignmask = alg->cra_alignmask;
233
234 return 0;
235 }
236
pcrypt_create_aead(struct crypto_template * tmpl,struct rtattr ** tb,struct crypto_attr_type * algt)237 static int pcrypt_create_aead(struct crypto_template *tmpl, struct rtattr **tb,
238 struct crypto_attr_type *algt)
239 {
240 struct pcrypt_instance_ctx *ctx;
241 struct aead_instance *inst;
242 struct aead_alg *alg;
243 u32 mask = crypto_algt_inherited_mask(algt);
244 int err;
245
246 inst = kzalloc(sizeof(*inst) + sizeof(*ctx), GFP_KERNEL);
247 if (!inst)
248 return -ENOMEM;
249
250 err = -ENOMEM;
251
252 ctx = aead_instance_ctx(inst);
253 ctx->psenc = padata_alloc_shell(pencrypt);
254 if (!ctx->psenc)
255 goto err_free_inst;
256
257 ctx->psdec = padata_alloc_shell(pdecrypt);
258 if (!ctx->psdec)
259 goto err_free_inst;
260
261 err = crypto_grab_aead(&ctx->spawn, aead_crypto_instance(inst),
262 crypto_attr_alg_name(tb[1]), 0, mask);
263 if (err)
264 goto err_free_inst;
265
266 alg = crypto_spawn_aead_alg(&ctx->spawn);
267 err = pcrypt_init_instance(aead_crypto_instance(inst), &alg->base);
268 if (err)
269 goto err_free_inst;
270
271 inst->alg.base.cra_flags |= CRYPTO_ALG_ASYNC;
272
273 inst->alg.ivsize = crypto_aead_alg_ivsize(alg);
274 inst->alg.maxauthsize = crypto_aead_alg_maxauthsize(alg);
275
276 inst->alg.base.cra_ctxsize = sizeof(struct pcrypt_aead_ctx);
277
278 inst->alg.init = pcrypt_aead_init_tfm;
279 inst->alg.exit = pcrypt_aead_exit_tfm;
280
281 inst->alg.setkey = pcrypt_aead_setkey;
282 inst->alg.setauthsize = pcrypt_aead_setauthsize;
283 inst->alg.encrypt = pcrypt_aead_encrypt;
284 inst->alg.decrypt = pcrypt_aead_decrypt;
285
286 inst->free = pcrypt_free;
287
288 err = aead_register_instance(tmpl, inst);
289 if (err) {
290 err_free_inst:
291 pcrypt_free(inst);
292 }
293 return err;
294 }
295
pcrypt_create(struct crypto_template * tmpl,struct rtattr ** tb)296 static int pcrypt_create(struct crypto_template *tmpl, struct rtattr **tb)
297 {
298 struct crypto_attr_type *algt;
299
300 algt = crypto_get_attr_type(tb);
301 if (IS_ERR(algt))
302 return PTR_ERR(algt);
303
304 switch (algt->type & algt->mask & CRYPTO_ALG_TYPE_MASK) {
305 case CRYPTO_ALG_TYPE_AEAD:
306 return pcrypt_create_aead(tmpl, tb, algt);
307 }
308
309 return -EINVAL;
310 }
311
pcrypt_sysfs_add(struct padata_instance * pinst,const char * name)312 static int pcrypt_sysfs_add(struct padata_instance *pinst, const char *name)
313 {
314 int ret;
315
316 pinst->kobj.kset = pcrypt_kset;
317 ret = kobject_add(&pinst->kobj, NULL, "%s", name);
318 if (!ret)
319 kobject_uevent(&pinst->kobj, KOBJ_ADD);
320
321 return ret;
322 }
323
pcrypt_init_padata(struct padata_instance ** pinst,const char * name)324 static int pcrypt_init_padata(struct padata_instance **pinst, const char *name)
325 {
326 int ret = -ENOMEM;
327
328 *pinst = padata_alloc(name);
329 if (!*pinst)
330 return ret;
331
332 ret = pcrypt_sysfs_add(*pinst, name);
333 if (ret)
334 padata_free(*pinst);
335
336 return ret;
337 }
338
339 static struct crypto_template pcrypt_tmpl = {
340 .name = "pcrypt",
341 .create = pcrypt_create,
342 .module = THIS_MODULE,
343 };
344
pcrypt_init(void)345 static int __init pcrypt_init(void)
346 {
347 int err = -ENOMEM;
348
349 pcrypt_kset = kset_create_and_add("pcrypt", NULL, kernel_kobj);
350 if (!pcrypt_kset)
351 goto err;
352
353 err = pcrypt_init_padata(&pencrypt, "pencrypt");
354 if (err)
355 goto err_unreg_kset;
356
357 err = pcrypt_init_padata(&pdecrypt, "pdecrypt");
358 if (err)
359 goto err_deinit_pencrypt;
360
361 return crypto_register_template(&pcrypt_tmpl);
362
363 err_deinit_pencrypt:
364 padata_free(pencrypt);
365 err_unreg_kset:
366 kset_unregister(pcrypt_kset);
367 err:
368 return err;
369 }
370
pcrypt_exit(void)371 static void __exit pcrypt_exit(void)
372 {
373 crypto_unregister_template(&pcrypt_tmpl);
374
375 padata_free(pencrypt);
376 padata_free(pdecrypt);
377
378 kset_unregister(pcrypt_kset);
379 }
380
381 module_init(pcrypt_init);
382 module_exit(pcrypt_exit);
383
384 MODULE_LICENSE("GPL");
385 MODULE_AUTHOR("Steffen Klassert <steffen.klassert@secunet.com>");
386 MODULE_DESCRIPTION("Parallel crypto wrapper");
387 MODULE_ALIAS_CRYPTO("pcrypt");
388