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