xref: /openbmc/linux/crypto/algboss.c (revision 9ac8d3fb) 
1 /*
2  * Create default crypto algorithm instances.
3  *
4  * Copyright (c) 2006 Herbert Xu <herbert@gondor.apana.org.au>
5  *
6  * This program is free software; you can redistribute it and/or modify it
7  * under the terms of the GNU General Public License as published by the Free
8  * Software Foundation; either version 2 of the License, or (at your option)
9  * any later version.
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 
26 struct 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 
53 struct crypto_test_param {
54 	char driver[CRYPTO_MAX_ALG_NAME];
55 	char alg[CRYPTO_MAX_ALG_NAME];
56 	u32 type;
57 };
58 
59 static 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 
83 out:
84 	kfree(param);
85 	module_put_and_exit(0);
86 
87 err:
88 	crypto_larval_error(param->larval, param->otype, param->omask);
89 	goto out;
90 }
91 
92 static 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] = &param->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] = &param->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 
195 err_free_param:
196 	kfree(param);
197 err_put_module:
198 	module_put(THIS_MODULE);
199 err:
200 	return NOTIFY_OK;
201 }
202 
203 static 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 
215 skiptest:
216 	crypto_alg_tested(param->driver, err);
217 
218 	kfree(param);
219 	module_put_and_exit(0);
220 }
221 
222 static 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 
244 err_free_param:
245 	kfree(param);
246 err_put_module:
247 	module_put(THIS_MODULE);
248 err:
249 	return NOTIFY_OK;
250 }
251 
252 static 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 
265 static struct notifier_block cryptomgr_notifier = {
266 	.notifier_call = cryptomgr_notify,
267 };
268 
269 static 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 
283 free_testmgr:
284 	testmgr_exit();
285 	return err;
286 }
287 
288 static void __exit cryptomgr_exit(void)
289 {
290 	int err = crypto_unregister_notifier(&cryptomgr_notifier);
291 	BUG_ON(err);
292 
293 	testmgr_exit();
294 }
295 
296 subsys_initcall(cryptomgr_init);
297 module_exit(cryptomgr_exit);
298 
299 MODULE_LICENSE("GPL");
300 MODULE_DESCRIPTION("Crypto Algorithm Manager");
301