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