1
2
3
4
5
6
7
8
9
10
11
12
13#include <crypto/internal/aead.h>
14#include <linux/ctype.h>
15#include <linux/err.h>
16#include <linux/init.h>
17#include <linux/kthread.h>
18#include <linux/module.h>
19#include <linux/notifier.h>
20#include <linux/rtnetlink.h>
21#include <linux/sched.h>
22#include <linux/slab.h>
23#include <linux/string.h>
24
25#include "internal.h"
26
27struct cryptomgr_param {
28 struct rtattr *tb[CRYPTO_MAX_ATTRS + 2];
29
30 struct {
31 struct rtattr attr;
32 struct crypto_attr_type data;
33 } type;
34
35 union {
36 struct rtattr attr;
37 struct {
38 struct rtattr attr;
39 struct crypto_attr_alg data;
40 } alg;
41 struct {
42 struct rtattr attr;
43 struct crypto_attr_u32 data;
44 } nu32;
45 } attrs[CRYPTO_MAX_ATTRS];
46
47 char larval[CRYPTO_MAX_ALG_NAME];
48 char template[CRYPTO_MAX_ALG_NAME];
49
50 u32 otype;
51 u32 omask;
52};
53
54struct crypto_test_param {
55 char driver[CRYPTO_MAX_ALG_NAME];
56 char alg[CRYPTO_MAX_ALG_NAME];
57 u32 type;
58};
59
60static int cryptomgr_probe(void *data)
61{
62 struct cryptomgr_param *param = data;
63 struct crypto_template *tmpl;
64 struct crypto_instance *inst;
65 int err;
66
67 tmpl = crypto_lookup_template(param->template);
68 if (!tmpl)
69 goto err;
70
71 do {
72 if (tmpl->create) {
73 err = tmpl->create(tmpl, param->tb);
74 continue;
75 }
76
77 inst = tmpl->alloc(param->tb);
78 if (IS_ERR(inst))
79 err = PTR_ERR(inst);
80 else if ((err = crypto_register_instance(tmpl, inst)))
81 tmpl->free(inst);
82 } while (err == -EAGAIN && !signal_pending(current));
83
84 crypto_tmpl_put(tmpl);
85
86 if (err)
87 goto err;
88
89out:
90 kfree(param);
91 module_put_and_exit(0);
92
93err:
94 crypto_larval_error(param->larval, param->otype, param->omask);
95 goto out;
96}
97
98static int cryptomgr_schedule_probe(struct crypto_larval *larval)
99{
100 struct task_struct *thread;
101 struct cryptomgr_param *param;
102 const char *name = larval->alg.cra_name;
103 const char *p;
104 unsigned int len;
105 int i;
106
107 if (!try_module_get(THIS_MODULE))
108 goto err;
109
110 param = kzalloc(sizeof(*param), GFP_KERNEL);
111 if (!param)
112 goto err_put_module;
113
114 for (p = name; isalnum(*p) || *p == '-' || *p == '_'; p++)
115 ;
116
117 len = p - name;
118 if (!len || *p != '(')
119 goto err_free_param;
120
121 memcpy(param->template, name, len);
122
123 i = 0;
124 for (;;) {
125 int notnum = 0;
126
127 name = ++p;
128 len = 0;
129
130 for (; isalnum(*p) || *p == '-' || *p == '_'; p++)
131 notnum |= !isdigit(*p);
132
133 if (*p == '(') {
134 int recursion = 0;
135
136 for (;;) {
137 if (!*++p)
138 goto err_free_param;
139 if (*p == '(')
140 recursion++;
141 else if (*p == ')' && !recursion--)
142 break;
143 }
144
145 notnum = 1;
146 p++;
147 }
148
149 len = p - name;
150 if (!len)
151 goto err_free_param;
152
153 if (notnum) {
154 param->attrs[i].alg.attr.rta_len =
155 sizeof(param->attrs[i].alg);
156 param->attrs[i].alg.attr.rta_type = CRYPTOA_ALG;
157 memcpy(param->attrs[i].alg.data.name, name, len);
158 } else {
159 param->attrs[i].nu32.attr.rta_len =
160 sizeof(param->attrs[i].nu32);
161 param->attrs[i].nu32.attr.rta_type = CRYPTOA_U32;
162 param->attrs[i].nu32.data.num =
163 simple_strtol(name, NULL, 0);
164 }
165
166 param->tb[i + 1] = ¶m->attrs[i].attr;
167 i++;
168
169 if (i >= CRYPTO_MAX_ATTRS)
170 goto err_free_param;
171
172 if (*p == ')')
173 break;
174
175 if (*p != ',')
176 goto err_free_param;
177 }
178
179 if (!i)
180 goto err_free_param;
181
182 param->tb[i + 1] = NULL;
183
184 param->type.attr.rta_len = sizeof(param->type);
185 param->type.attr.rta_type = CRYPTOA_TYPE;
186 param->type.data.type = larval->alg.cra_flags & ~CRYPTO_ALG_TESTED;
187 param->type.data.mask = larval->mask & ~CRYPTO_ALG_TESTED;
188 param->tb[0] = ¶m->type.attr;
189
190 param->otype = larval->alg.cra_flags;
191 param->omask = larval->mask;
192
193 memcpy(param->larval, larval->alg.cra_name, CRYPTO_MAX_ALG_NAME);
194
195 thread = kthread_run(cryptomgr_probe, param, "cryptomgr_probe");
196 if (IS_ERR(thread))
197 goto err_free_param;
198
199 return NOTIFY_STOP;
200
201err_free_param:
202 kfree(param);
203err_put_module:
204 module_put(THIS_MODULE);
205err:
206 return NOTIFY_OK;
207}
208
209static int cryptomgr_test(void *data)
210{
211 struct crypto_test_param *param = data;
212 u32 type = param->type;
213 int err = 0;
214
215 if (type & CRYPTO_ALG_TESTED)
216 goto skiptest;
217
218 err = alg_test(param->driver, param->alg, type, CRYPTO_ALG_TESTED);
219
220skiptest:
221 crypto_alg_tested(param->driver, err);
222
223 kfree(param);
224 module_put_and_exit(0);
225}
226
227static int cryptomgr_schedule_test(struct crypto_alg *alg)
228{
229 struct task_struct *thread;
230 struct crypto_test_param *param;
231 u32 type;
232
233 if (!try_module_get(THIS_MODULE))
234 goto err;
235
236 param = kzalloc(sizeof(*param), GFP_KERNEL);
237 if (!param)
238 goto err_put_module;
239
240 memcpy(param->driver, alg->cra_driver_name, sizeof(param->driver));
241 memcpy(param->alg, alg->cra_name, sizeof(param->alg));
242 type = alg->cra_flags;
243
244
245 if ((!((type ^ CRYPTO_ALG_TYPE_BLKCIPHER) &
246 CRYPTO_ALG_TYPE_BLKCIPHER_MASK) && !(type & CRYPTO_ALG_GENIV) &&
247 ((alg->cra_flags & CRYPTO_ALG_TYPE_MASK) ==
248 CRYPTO_ALG_TYPE_BLKCIPHER ? alg->cra_blkcipher.ivsize :
249 alg->cra_ablkcipher.ivsize)) ||
250 (!((type ^ CRYPTO_ALG_TYPE_AEAD) & CRYPTO_ALG_TYPE_MASK) &&
251 alg->cra_type == &crypto_nivaead_type && alg->cra_aead.ivsize))
252 type |= CRYPTO_ALG_TESTED;
253
254 param->type = type;
255
256 thread = kthread_run(cryptomgr_test, param, "cryptomgr_test");
257 if (IS_ERR(thread))
258 goto err_free_param;
259
260 return NOTIFY_STOP;
261
262err_free_param:
263 kfree(param);
264err_put_module:
265 module_put(THIS_MODULE);
266err:
267 return NOTIFY_OK;
268}
269
270static int cryptomgr_notify(struct notifier_block *this, unsigned long msg,
271 void *data)
272{
273 switch (msg) {
274 case CRYPTO_MSG_ALG_REQUEST:
275 return cryptomgr_schedule_probe(data);
276 case CRYPTO_MSG_ALG_REGISTER:
277 return cryptomgr_schedule_test(data);
278 }
279
280 return NOTIFY_DONE;
281}
282
283static struct notifier_block cryptomgr_notifier = {
284 .notifier_call = cryptomgr_notify,
285};
286
287static int __init cryptomgr_init(void)
288{
289 return crypto_register_notifier(&cryptomgr_notifier);
290}
291
292static void __exit cryptomgr_exit(void)
293{
294 int err = crypto_unregister_notifier(&cryptomgr_notifier);
295 BUG_ON(err);
296}
297
298subsys_initcall(cryptomgr_init);
299module_exit(cryptomgr_exit);
300
301MODULE_LICENSE("GPL");
302MODULE_DESCRIPTION("Crypto Algorithm Manager");
303
