18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Create default crypto algorithm instances.
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (c) 2006 Herbert Xu <herbert@gondor.apana.org.au>
68c2ecf20Sopenharmony_ci */
78c2ecf20Sopenharmony_ci
88c2ecf20Sopenharmony_ci#include <crypto/internal/aead.h>
98c2ecf20Sopenharmony_ci#include <linux/completion.h>
108c2ecf20Sopenharmony_ci#include <linux/ctype.h>
118c2ecf20Sopenharmony_ci#include <linux/err.h>
128c2ecf20Sopenharmony_ci#include <linux/init.h>
138c2ecf20Sopenharmony_ci#include <linux/kthread.h>
148c2ecf20Sopenharmony_ci#include <linux/module.h>
158c2ecf20Sopenharmony_ci#include <linux/notifier.h>
168c2ecf20Sopenharmony_ci#include <linux/rtnetlink.h>
178c2ecf20Sopenharmony_ci#include <linux/sched/signal.h>
188c2ecf20Sopenharmony_ci#include <linux/slab.h>
198c2ecf20Sopenharmony_ci#include <linux/string.h>
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_ci#include "internal.h"
228c2ecf20Sopenharmony_ci
238c2ecf20Sopenharmony_cistruct cryptomgr_param {
248c2ecf20Sopenharmony_ci	struct rtattr *tb[CRYPTO_MAX_ATTRS + 2];
258c2ecf20Sopenharmony_ci
268c2ecf20Sopenharmony_ci	struct {
278c2ecf20Sopenharmony_ci		struct rtattr attr;
288c2ecf20Sopenharmony_ci		struct crypto_attr_type data;
298c2ecf20Sopenharmony_ci	} type;
308c2ecf20Sopenharmony_ci
318c2ecf20Sopenharmony_ci	union {
328c2ecf20Sopenharmony_ci		struct rtattr attr;
338c2ecf20Sopenharmony_ci		struct {
348c2ecf20Sopenharmony_ci			struct rtattr attr;
358c2ecf20Sopenharmony_ci			struct crypto_attr_alg data;
368c2ecf20Sopenharmony_ci		} alg;
378c2ecf20Sopenharmony_ci		struct {
388c2ecf20Sopenharmony_ci			struct rtattr attr;
398c2ecf20Sopenharmony_ci			struct crypto_attr_u32 data;
408c2ecf20Sopenharmony_ci		} nu32;
418c2ecf20Sopenharmony_ci	} attrs[CRYPTO_MAX_ATTRS];
428c2ecf20Sopenharmony_ci
438c2ecf20Sopenharmony_ci	char template[CRYPTO_MAX_ALG_NAME];
448c2ecf20Sopenharmony_ci
458c2ecf20Sopenharmony_ci	struct crypto_larval *larval;
468c2ecf20Sopenharmony_ci
478c2ecf20Sopenharmony_ci	u32 otype;
488c2ecf20Sopenharmony_ci	u32 omask;
498c2ecf20Sopenharmony_ci};
508c2ecf20Sopenharmony_ci
518c2ecf20Sopenharmony_cistruct crypto_test_param {
528c2ecf20Sopenharmony_ci	char driver[CRYPTO_MAX_ALG_NAME];
538c2ecf20Sopenharmony_ci	char alg[CRYPTO_MAX_ALG_NAME];
548c2ecf20Sopenharmony_ci	u32 type;
558c2ecf20Sopenharmony_ci};
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_cistatic int cryptomgr_probe(void *data)
588c2ecf20Sopenharmony_ci{
598c2ecf20Sopenharmony_ci	struct cryptomgr_param *param = data;
608c2ecf20Sopenharmony_ci	struct crypto_template *tmpl;
618c2ecf20Sopenharmony_ci	int err;
628c2ecf20Sopenharmony_ci
638c2ecf20Sopenharmony_ci	tmpl = crypto_lookup_template(param->template);
648c2ecf20Sopenharmony_ci	if (!tmpl)
658c2ecf20Sopenharmony_ci		goto out;
668c2ecf20Sopenharmony_ci
678c2ecf20Sopenharmony_ci	do {
688c2ecf20Sopenharmony_ci		err = tmpl->create(tmpl, param->tb);
698c2ecf20Sopenharmony_ci	} while (err == -EAGAIN && !signal_pending(current));
708c2ecf20Sopenharmony_ci
718c2ecf20Sopenharmony_ci	crypto_tmpl_put(tmpl);
728c2ecf20Sopenharmony_ci
738c2ecf20Sopenharmony_ciout:
748c2ecf20Sopenharmony_ci	complete_all(&param->larval->completion);
758c2ecf20Sopenharmony_ci	crypto_alg_put(&param->larval->alg);
768c2ecf20Sopenharmony_ci	kfree(param);
778c2ecf20Sopenharmony_ci	module_put_and_exit(0);
788c2ecf20Sopenharmony_ci}
798c2ecf20Sopenharmony_ci
808c2ecf20Sopenharmony_cistatic int cryptomgr_schedule_probe(struct crypto_larval *larval)
818c2ecf20Sopenharmony_ci{
828c2ecf20Sopenharmony_ci	struct task_struct *thread;
838c2ecf20Sopenharmony_ci	struct cryptomgr_param *param;
848c2ecf20Sopenharmony_ci	const char *name = larval->alg.cra_name;
858c2ecf20Sopenharmony_ci	const char *p;
868c2ecf20Sopenharmony_ci	unsigned int len;
878c2ecf20Sopenharmony_ci	int i;
888c2ecf20Sopenharmony_ci
898c2ecf20Sopenharmony_ci	if (!try_module_get(THIS_MODULE))
908c2ecf20Sopenharmony_ci		goto err;
918c2ecf20Sopenharmony_ci
928c2ecf20Sopenharmony_ci	param = kzalloc(sizeof(*param), GFP_KERNEL);
938c2ecf20Sopenharmony_ci	if (!param)
948c2ecf20Sopenharmony_ci		goto err_put_module;
958c2ecf20Sopenharmony_ci
968c2ecf20Sopenharmony_ci	for (p = name; isalnum(*p) || *p == '-' || *p == '_'; p++)
978c2ecf20Sopenharmony_ci		;
988c2ecf20Sopenharmony_ci
998c2ecf20Sopenharmony_ci	len = p - name;
1008c2ecf20Sopenharmony_ci	if (!len || *p != '(')
1018c2ecf20Sopenharmony_ci		goto err_free_param;
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_ci	memcpy(param->template, name, len);
1048c2ecf20Sopenharmony_ci
1058c2ecf20Sopenharmony_ci	i = 0;
1068c2ecf20Sopenharmony_ci	for (;;) {
1078c2ecf20Sopenharmony_ci		int notnum = 0;
1088c2ecf20Sopenharmony_ci
1098c2ecf20Sopenharmony_ci		name = ++p;
1108c2ecf20Sopenharmony_ci
1118c2ecf20Sopenharmony_ci		for (; isalnum(*p) || *p == '-' || *p == '_'; p++)
1128c2ecf20Sopenharmony_ci			notnum |= !isdigit(*p);
1138c2ecf20Sopenharmony_ci
1148c2ecf20Sopenharmony_ci		if (*p == '(') {
1158c2ecf20Sopenharmony_ci			int recursion = 0;
1168c2ecf20Sopenharmony_ci
1178c2ecf20Sopenharmony_ci			for (;;) {
1188c2ecf20Sopenharmony_ci				if (!*++p)
1198c2ecf20Sopenharmony_ci					goto err_free_param;
1208c2ecf20Sopenharmony_ci				if (*p == '(')
1218c2ecf20Sopenharmony_ci					recursion++;
1228c2ecf20Sopenharmony_ci				else if (*p == ')' && !recursion--)
1238c2ecf20Sopenharmony_ci					break;
1248c2ecf20Sopenharmony_ci			}
1258c2ecf20Sopenharmony_ci
1268c2ecf20Sopenharmony_ci			notnum = 1;
1278c2ecf20Sopenharmony_ci			p++;
1288c2ecf20Sopenharmony_ci		}
1298c2ecf20Sopenharmony_ci
1308c2ecf20Sopenharmony_ci		len = p - name;
1318c2ecf20Sopenharmony_ci		if (!len)
1328c2ecf20Sopenharmony_ci			goto err_free_param;
1338c2ecf20Sopenharmony_ci
1348c2ecf20Sopenharmony_ci		if (notnum) {
1358c2ecf20Sopenharmony_ci			param->attrs[i].alg.attr.rta_len =
1368c2ecf20Sopenharmony_ci				sizeof(param->attrs[i].alg);
1378c2ecf20Sopenharmony_ci			param->attrs[i].alg.attr.rta_type = CRYPTOA_ALG;
1388c2ecf20Sopenharmony_ci			memcpy(param->attrs[i].alg.data.name, name, len);
1398c2ecf20Sopenharmony_ci		} else {
1408c2ecf20Sopenharmony_ci			param->attrs[i].nu32.attr.rta_len =
1418c2ecf20Sopenharmony_ci				sizeof(param->attrs[i].nu32);
1428c2ecf20Sopenharmony_ci			param->attrs[i].nu32.attr.rta_type = CRYPTOA_U32;
1438c2ecf20Sopenharmony_ci			param->attrs[i].nu32.data.num =
1448c2ecf20Sopenharmony_ci				simple_strtol(name, NULL, 0);
1458c2ecf20Sopenharmony_ci		}
1468c2ecf20Sopenharmony_ci
1478c2ecf20Sopenharmony_ci		param->tb[i + 1] = &param->attrs[i].attr;
1488c2ecf20Sopenharmony_ci		i++;
1498c2ecf20Sopenharmony_ci
1508c2ecf20Sopenharmony_ci		if (i >= CRYPTO_MAX_ATTRS)
1518c2ecf20Sopenharmony_ci			goto err_free_param;
1528c2ecf20Sopenharmony_ci
1538c2ecf20Sopenharmony_ci		if (*p == ')')
1548c2ecf20Sopenharmony_ci			break;
1558c2ecf20Sopenharmony_ci
1568c2ecf20Sopenharmony_ci		if (*p != ',')
1578c2ecf20Sopenharmony_ci			goto err_free_param;
1588c2ecf20Sopenharmony_ci	}
1598c2ecf20Sopenharmony_ci
1608c2ecf20Sopenharmony_ci	if (!i)
1618c2ecf20Sopenharmony_ci		goto err_free_param;
1628c2ecf20Sopenharmony_ci
1638c2ecf20Sopenharmony_ci	param->tb[i + 1] = NULL;
1648c2ecf20Sopenharmony_ci
1658c2ecf20Sopenharmony_ci	param->type.attr.rta_len = sizeof(param->type);
1668c2ecf20Sopenharmony_ci	param->type.attr.rta_type = CRYPTOA_TYPE;
1678c2ecf20Sopenharmony_ci	param->type.data.type = larval->alg.cra_flags & ~CRYPTO_ALG_TESTED;
1688c2ecf20Sopenharmony_ci	param->type.data.mask = larval->mask & ~CRYPTO_ALG_TESTED;
1698c2ecf20Sopenharmony_ci	param->tb[0] = &param->type.attr;
1708c2ecf20Sopenharmony_ci
1718c2ecf20Sopenharmony_ci	param->otype = larval->alg.cra_flags;
1728c2ecf20Sopenharmony_ci	param->omask = larval->mask;
1738c2ecf20Sopenharmony_ci
1748c2ecf20Sopenharmony_ci	crypto_alg_get(&larval->alg);
1758c2ecf20Sopenharmony_ci	param->larval = larval;
1768c2ecf20Sopenharmony_ci
1778c2ecf20Sopenharmony_ci	thread = kthread_run(cryptomgr_probe, param, "cryptomgr_probe");
1788c2ecf20Sopenharmony_ci	if (IS_ERR(thread))
1798c2ecf20Sopenharmony_ci		goto err_put_larval;
1808c2ecf20Sopenharmony_ci
1818c2ecf20Sopenharmony_ci	return NOTIFY_STOP;
1828c2ecf20Sopenharmony_ci
1838c2ecf20Sopenharmony_cierr_put_larval:
1848c2ecf20Sopenharmony_ci	crypto_alg_put(&larval->alg);
1858c2ecf20Sopenharmony_cierr_free_param:
1868c2ecf20Sopenharmony_ci	kfree(param);
1878c2ecf20Sopenharmony_cierr_put_module:
1888c2ecf20Sopenharmony_ci	module_put(THIS_MODULE);
1898c2ecf20Sopenharmony_cierr:
1908c2ecf20Sopenharmony_ci	return NOTIFY_OK;
1918c2ecf20Sopenharmony_ci}
1928c2ecf20Sopenharmony_ci
1938c2ecf20Sopenharmony_cistatic int cryptomgr_test(void *data)
1948c2ecf20Sopenharmony_ci{
1958c2ecf20Sopenharmony_ci	struct crypto_test_param *param = data;
1968c2ecf20Sopenharmony_ci	u32 type = param->type;
1978c2ecf20Sopenharmony_ci	int err = 0;
1988c2ecf20Sopenharmony_ci
1998c2ecf20Sopenharmony_ci#ifdef CONFIG_CRYPTO_MANAGER_DISABLE_TESTS
2008c2ecf20Sopenharmony_ci	goto skiptest;
2018c2ecf20Sopenharmony_ci#endif
2028c2ecf20Sopenharmony_ci
2038c2ecf20Sopenharmony_ci	if (type & CRYPTO_ALG_TESTED)
2048c2ecf20Sopenharmony_ci		goto skiptest;
2058c2ecf20Sopenharmony_ci
2068c2ecf20Sopenharmony_ci	err = alg_test(param->driver, param->alg, type, CRYPTO_ALG_TESTED);
2078c2ecf20Sopenharmony_ci
2088c2ecf20Sopenharmony_ciskiptest:
2098c2ecf20Sopenharmony_ci	crypto_alg_tested(param->driver, err);
2108c2ecf20Sopenharmony_ci
2118c2ecf20Sopenharmony_ci	kfree(param);
2128c2ecf20Sopenharmony_ci	module_put_and_exit(0);
2138c2ecf20Sopenharmony_ci}
2148c2ecf20Sopenharmony_ci
2158c2ecf20Sopenharmony_cistatic int cryptomgr_schedule_test(struct crypto_alg *alg)
2168c2ecf20Sopenharmony_ci{
2178c2ecf20Sopenharmony_ci	struct task_struct *thread;
2188c2ecf20Sopenharmony_ci	struct crypto_test_param *param;
2198c2ecf20Sopenharmony_ci	u32 type;
2208c2ecf20Sopenharmony_ci
2218c2ecf20Sopenharmony_ci	if (!try_module_get(THIS_MODULE))
2228c2ecf20Sopenharmony_ci		goto err;
2238c2ecf20Sopenharmony_ci
2248c2ecf20Sopenharmony_ci	param = kzalloc(sizeof(*param), GFP_KERNEL);
2258c2ecf20Sopenharmony_ci	if (!param)
2268c2ecf20Sopenharmony_ci		goto err_put_module;
2278c2ecf20Sopenharmony_ci
2288c2ecf20Sopenharmony_ci	memcpy(param->driver, alg->cra_driver_name, sizeof(param->driver));
2298c2ecf20Sopenharmony_ci	memcpy(param->alg, alg->cra_name, sizeof(param->alg));
2308c2ecf20Sopenharmony_ci	type = alg->cra_flags;
2318c2ecf20Sopenharmony_ci
2328c2ecf20Sopenharmony_ci	/* Do not test internal algorithms. */
2338c2ecf20Sopenharmony_ci	if (type & CRYPTO_ALG_INTERNAL)
2348c2ecf20Sopenharmony_ci		type |= CRYPTO_ALG_TESTED;
2358c2ecf20Sopenharmony_ci
2368c2ecf20Sopenharmony_ci	param->type = type;
2378c2ecf20Sopenharmony_ci
2388c2ecf20Sopenharmony_ci	thread = kthread_run(cryptomgr_test, param, "cryptomgr_test");
2398c2ecf20Sopenharmony_ci	if (IS_ERR(thread))
2408c2ecf20Sopenharmony_ci		goto err_free_param;
2418c2ecf20Sopenharmony_ci
2428c2ecf20Sopenharmony_ci	return NOTIFY_STOP;
2438c2ecf20Sopenharmony_ci
2448c2ecf20Sopenharmony_cierr_free_param:
2458c2ecf20Sopenharmony_ci	kfree(param);
2468c2ecf20Sopenharmony_cierr_put_module:
2478c2ecf20Sopenharmony_ci	module_put(THIS_MODULE);
2488c2ecf20Sopenharmony_cierr:
2498c2ecf20Sopenharmony_ci	return NOTIFY_OK;
2508c2ecf20Sopenharmony_ci}
2518c2ecf20Sopenharmony_ci
2528c2ecf20Sopenharmony_cistatic int cryptomgr_notify(struct notifier_block *this, unsigned long msg,
2538c2ecf20Sopenharmony_ci			    void *data)
2548c2ecf20Sopenharmony_ci{
2558c2ecf20Sopenharmony_ci	switch (msg) {
2568c2ecf20Sopenharmony_ci	case CRYPTO_MSG_ALG_REQUEST:
2578c2ecf20Sopenharmony_ci		return cryptomgr_schedule_probe(data);
2588c2ecf20Sopenharmony_ci	case CRYPTO_MSG_ALG_REGISTER:
2598c2ecf20Sopenharmony_ci		return cryptomgr_schedule_test(data);
2608c2ecf20Sopenharmony_ci	case CRYPTO_MSG_ALG_LOADED:
2618c2ecf20Sopenharmony_ci		break;
2628c2ecf20Sopenharmony_ci	}
2638c2ecf20Sopenharmony_ci
2648c2ecf20Sopenharmony_ci	return NOTIFY_DONE;
2658c2ecf20Sopenharmony_ci}
2668c2ecf20Sopenharmony_ci
2678c2ecf20Sopenharmony_cistatic struct notifier_block cryptomgr_notifier = {
2688c2ecf20Sopenharmony_ci	.notifier_call = cryptomgr_notify,
2698c2ecf20Sopenharmony_ci};
2708c2ecf20Sopenharmony_ci
2718c2ecf20Sopenharmony_cistatic int __init cryptomgr_init(void)
2728c2ecf20Sopenharmony_ci{
2738c2ecf20Sopenharmony_ci	return crypto_register_notifier(&cryptomgr_notifier);
2748c2ecf20Sopenharmony_ci}
2758c2ecf20Sopenharmony_ci
2768c2ecf20Sopenharmony_cistatic void __exit cryptomgr_exit(void)
2778c2ecf20Sopenharmony_ci{
2788c2ecf20Sopenharmony_ci	int err = crypto_unregister_notifier(&cryptomgr_notifier);
2798c2ecf20Sopenharmony_ci	BUG_ON(err);
2808c2ecf20Sopenharmony_ci}
2818c2ecf20Sopenharmony_ci
2828c2ecf20Sopenharmony_ci/*
2838c2ecf20Sopenharmony_ci * This is arch_initcall() so that the crypto self-tests are run on algorithms
2848c2ecf20Sopenharmony_ci * registered early by subsys_initcall().  subsys_initcall() is needed for
2858c2ecf20Sopenharmony_ci * generic implementations so that they're available for comparison tests when
2868c2ecf20Sopenharmony_ci * other implementations are registered later by module_init().
2878c2ecf20Sopenharmony_ci */
2888c2ecf20Sopenharmony_ciarch_initcall(cryptomgr_init);
2898c2ecf20Sopenharmony_cimodule_exit(cryptomgr_exit);
2908c2ecf20Sopenharmony_ci
2918c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
2928c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Crypto Algorithm Manager");
293