[GitHub/mt8127/android_kernel_alcatel_ttab.git] / crypto / algboss.c

/*
 * Create default crypto algorithm instances.
 *
 * Copyright (c) 2006 Herbert Xu <herbert@gondor.apana.org.au>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by the Free
 * Software Foundation; either version 2 of the License, or (at your option)
 * any later version.
 *
 */

#include <crypto/internal/aead.h>
#include <linux/completion.h>
#include <linux/ctype.h>
#include <linux/err.h>
#include <linux/init.h>
#include <linux/kthread.h>
#include <linux/module.h>
#include <linux/notifier.h>
#include <linux/rtnetlink.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/string.h>

#include "internal.h"

struct cryptomgr_param {
	struct rtattr *tb[CRYPTO_MAX_ATTRS + 2];

	struct {
		struct rtattr attr;
		struct crypto_attr_type data;
	} type;

	union {
		struct rtattr attr;
		struct {
			struct rtattr attr;
			struct crypto_attr_alg data;
		} alg;
		struct {
			struct rtattr attr;
			struct crypto_attr_u32 data;
		} nu32;
	} attrs[CRYPTO_MAX_ATTRS];

	char larval[CRYPTO_MAX_ALG_NAME];
	char template[CRYPTO_MAX_ALG_NAME];

	struct completion *completion;

	u32 otype;
	u32 omask;
};

struct crypto_test_param {
	char driver[CRYPTO_MAX_ALG_NAME];
	char alg[CRYPTO_MAX_ALG_NAME];
	u32 type;
};

static int cryptomgr_probe(void *data)
{
	struct cryptomgr_param *param = data;
	struct crypto_template *tmpl;
	struct crypto_instance *inst;
	int err;

	tmpl = crypto_lookup_template(param->template);
	if (!tmpl)
		goto out;

	do {
		if (tmpl->create) {
			err = tmpl->create(tmpl, param->tb);
			continue;
		}

		inst = tmpl->alloc(param->tb);
		if (IS_ERR(inst))
			err = PTR_ERR(inst);
		else if ((err = crypto_register_instance(tmpl, inst)))
			tmpl->free(inst);
	} while (err == -EAGAIN && !signal_pending(current));

	crypto_tmpl_put(tmpl);

out:
	complete_all(param->completion);
	kfree(param);
	module_put_and_exit(0);
}

static int cryptomgr_schedule_probe(struct crypto_larval *larval)
{
	struct task_struct *thread;
	struct cryptomgr_param *param;
	const char *name = larval->alg.cra_name;
	const char *p;
	unsigned int len;
	int i;

	if (!try_module_get(THIS_MODULE))
		goto err;

	param = kzalloc(sizeof(*param), GFP_KERNEL);
	if (!param)
		goto err_put_module;

	for (p = name; isalnum(*p) || *p == '-' || *p == '_'; p++)
		;

	len = p - name;
	if (!len || *p != '(')
		goto err_free_param;

	memcpy(param->template, name, len);

	i = 0;
	for (;;) {
		int notnum = 0;

		name = ++p;
		len = 0;

		for (; isalnum(*p) || *p == '-' || *p == '_'; p++)
			notnum |= !isdigit(*p);

		if (*p == '(') {
			int recursion = 0;

			for (;;) {
				if (!*++p)
					goto err_free_param;
				if (*p == '(')
					recursion++;
				else if (*p == ')' && !recursion--)
					break;
			}

			notnum = 1;
			p++;
		}

		len = p - name;
		if (!len)
			goto err_free_param;

		if (notnum) {
			param->attrs[i].alg.attr.rta_len =
				sizeof(param->attrs[i].alg);
			param->attrs[i].alg.attr.rta_type = CRYPTOA_ALG;
			memcpy(param->attrs[i].alg.data.name, name, len);
		} else {
			param->attrs[i].nu32.attr.rta_len =
				sizeof(param->attrs[i].nu32);
			param->attrs[i].nu32.attr.rta_type = CRYPTOA_U32;
			param->attrs[i].nu32.data.num =
				simple_strtol(name, NULL, 0);
		}

		param->tb[i + 1] = &param->attrs[i].attr;
		i++;

		if (i >= CRYPTO_MAX_ATTRS)
			goto err_free_param;

		if (*p == ')')
			break;

		if (*p != ',')
			goto err_free_param;
	}

	if (!i)
		goto err_free_param;

	param->tb[i + 1] = NULL;

	param->type.attr.rta_len = sizeof(param->type);
	param->type.attr.rta_type = CRYPTOA_TYPE;
	param->type.data.type = larval->alg.cra_flags & ~CRYPTO_ALG_TESTED;
	param->type.data.mask = larval->mask & ~CRYPTO_ALG_TESTED;
	param->tb[0] = &param->type.attr;

	param->otype = larval->alg.cra_flags;
	param->omask = larval->mask;

	memcpy(param->larval, larval->alg.cra_name, CRYPTO_MAX_ALG_NAME);

	param->completion = &larval->completion;

	thread = kthread_run(cryptomgr_probe, param, "cryptomgr_probe");
	if (IS_ERR(thread))
		goto err_free_param;

	wait_for_completion_interruptible(&larval->completion);

	return NOTIFY_STOP;

err_free_param:
	kfree(param);
err_put_module:
	module_put(THIS_MODULE);
err:
	return NOTIFY_OK;
}

static int cryptomgr_test(void *data)
{
	struct crypto_test_param *param = data;
	u32 type = param->type;
	int err = 0;

#ifdef CONFIG_CRYPTO_MANAGER_DISABLE_TESTS
	goto skiptest;
#endif

	if (type & CRYPTO_ALG_TESTED)
		goto skiptest;

	err = alg_test(param->driver, param->alg, type, CRYPTO_ALG_TESTED);

skiptest:
	crypto_alg_tested(param->driver, err);

	kfree(param);
	module_put_and_exit(0);
}

static int cryptomgr_schedule_test(struct crypto_alg *alg)
{
	struct task_struct *thread;
	struct crypto_test_param *param;
	u32 type;

	if (!try_module_get(THIS_MODULE))
		goto err;

	param = kzalloc(sizeof(*param), GFP_KERNEL);
	if (!param)
		goto err_put_module;

	memcpy(param->driver, alg->cra_driver_name, sizeof(param->driver));
	memcpy(param->alg, alg->cra_name, sizeof(param->alg));
	type = alg->cra_flags;

	/* This piece of crap needs to disappear into per-type test hooks. */
	if ((!((type ^ CRYPTO_ALG_TYPE_BLKCIPHER) &
	       CRYPTO_ALG_TYPE_BLKCIPHER_MASK) && !(type & CRYPTO_ALG_GENIV) &&
	     ((alg->cra_flags & CRYPTO_ALG_TYPE_MASK) ==
	      CRYPTO_ALG_TYPE_BLKCIPHER ? alg->cra_blkcipher.ivsize :
					  alg->cra_ablkcipher.ivsize)) ||
	    (!((type ^ CRYPTO_ALG_TYPE_AEAD) & CRYPTO_ALG_TYPE_MASK) &&
	     alg->cra_type == &crypto_nivaead_type && alg->cra_aead.ivsize))
		type |= CRYPTO_ALG_TESTED;

	param->type = type;

	thread = kthread_run(cryptomgr_test, param, "cryptomgr_test");
	if (IS_ERR(thread))
		goto err_free_param;

	return NOTIFY_STOP;

err_free_param:
	kfree(param);
err_put_module:
	module_put(THIS_MODULE);
err:
	return NOTIFY_OK;
}

static int cryptomgr_notify(struct notifier_block *this, unsigned long msg,
			    void *data)
{
	switch (msg) {
	case CRYPTO_MSG_ALG_REQUEST:
		return cryptomgr_schedule_probe(data);
	case CRYPTO_MSG_ALG_REGISTER:
		return cryptomgr_schedule_test(data);
	}

	return NOTIFY_DONE;
}

static struct notifier_block cryptomgr_notifier = {
	.notifier_call = cryptomgr_notify,
};

static int __init cryptomgr_init(void)
{
	return crypto_register_notifier(&cryptomgr_notifier);
}

static void __exit cryptomgr_exit(void)
{
	int err = crypto_unregister_notifier(&cryptomgr_notifier);
	BUG_ON(err);
}

subsys_initcall(cryptomgr_init);
module_exit(cryptomgr_exit);

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