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 <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 
27 struct 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 
54 struct crypto_test_param {
55 	char driver[CRYPTO_MAX_ALG_NAME];
56 	char alg[CRYPTO_MAX_ALG_NAME];
57 	u32 type;
58 };
59 
cryptomgr_probe(void * data)60 static 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 
89 out:
90 	kfree(param);
91 	module_put_and_exit(0);
92 
93 err:
94 	crypto_larval_error(param->larval, param->otype, param->omask);
95 	goto out;
96 }
97 
cryptomgr_schedule_probe(struct crypto_larval * larval)98 static 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] = &param->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] = &param->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 
201 err_free_param:
202 	kfree(param);
203 err_put_module:
204 	module_put(THIS_MODULE);
205 err:
206 	return NOTIFY_OK;
207 }
208 
cryptomgr_test(void * data)209 static int cryptomgr_test(void *data)
210 {
211 	struct crypto_test_param *param = data;
212 	u32 type = param->type;
213 	int err = 0;
214 
215 #ifdef CONFIG_CRYPTO_MANAGER_DISABLE_TESTS
216 	goto skiptest;
217 #endif
218 
219 	if (type & CRYPTO_ALG_TESTED)
220 		goto skiptest;
221 
222 	err = alg_test(param->driver, param->alg, type, CRYPTO_ALG_TESTED);
223 
224 skiptest:
225 	crypto_alg_tested(param->driver, err);
226 
227 	kfree(param);
228 	module_put_and_exit(0);
229 }
230 
cryptomgr_schedule_test(struct crypto_alg * alg)231 static int cryptomgr_schedule_test(struct crypto_alg *alg)
232 {
233 	struct task_struct *thread;
234 	struct crypto_test_param *param;
235 	u32 type;
236 
237 	if (!try_module_get(THIS_MODULE))
238 		goto err;
239 
240 	param = kzalloc(sizeof(*param), GFP_KERNEL);
241 	if (!param)
242 		goto err_put_module;
243 
244 	memcpy(param->driver, alg->cra_driver_name, sizeof(param->driver));
245 	memcpy(param->alg, alg->cra_name, sizeof(param->alg));
246 	type = alg->cra_flags;
247 
248 	/* This piece of crap needs to disappear into per-type test hooks. */
249 	if ((!((type ^ CRYPTO_ALG_TYPE_BLKCIPHER) &
250 	       CRYPTO_ALG_TYPE_BLKCIPHER_MASK) && !(type & CRYPTO_ALG_GENIV) &&
251 	     ((alg->cra_flags & CRYPTO_ALG_TYPE_MASK) ==
252 	      CRYPTO_ALG_TYPE_BLKCIPHER ? alg->cra_blkcipher.ivsize :
253 					  alg->cra_ablkcipher.ivsize)) ||
254 	    (!((type ^ CRYPTO_ALG_TYPE_AEAD) & CRYPTO_ALG_TYPE_MASK) &&
255 	     alg->cra_type == &crypto_nivaead_type && alg->cra_aead.ivsize))
256 		type |= CRYPTO_ALG_TESTED;
257 
258 	param->type = type;
259 
260 	thread = kthread_run(cryptomgr_test, param, "cryptomgr_test");
261 	if (IS_ERR(thread))
262 		goto err_free_param;
263 
264 	return NOTIFY_STOP;
265 
266 err_free_param:
267 	kfree(param);
268 err_put_module:
269 	module_put(THIS_MODULE);
270 err:
271 	return NOTIFY_OK;
272 }
273 
cryptomgr_notify(struct notifier_block * this,unsigned long msg,void * data)274 static int cryptomgr_notify(struct notifier_block *this, unsigned long msg,
275 			    void *data)
276 {
277 	switch (msg) {
278 	case CRYPTO_MSG_ALG_REQUEST:
279 		return cryptomgr_schedule_probe(data);
280 	case CRYPTO_MSG_ALG_REGISTER:
281 		return cryptomgr_schedule_test(data);
282 	}
283 
284 	return NOTIFY_DONE;
285 }
286 
287 static struct notifier_block cryptomgr_notifier = {
288 	.notifier_call = cryptomgr_notify,
289 };
290 
cryptomgr_init(void)291 static int __init cryptomgr_init(void)
292 {
293 	return crypto_register_notifier(&cryptomgr_notifier);
294 }
295 
cryptomgr_exit(void)296 static void __exit cryptomgr_exit(void)
297 {
298 	int err = crypto_unregister_notifier(&cryptomgr_notifier);
299 	BUG_ON(err);
300 }
301 
302 subsys_initcall(cryptomgr_init);
303 module_exit(cryptomgr_exit);
304 
305 MODULE_LICENSE("GPL");
306 MODULE_DESCRIPTION("Crypto Algorithm Manager");
307