// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Create default crypto algorithm instances.
 *
 * Copyright (c) 2006 Herbert Xu <herbert@gondor.apana.org.au>
 */

#include <crypto_algapi.h>
#include <linux_completion.h>
#include <linux_ctype.h>
#include <linux_err.h>
#include <linux_module.h>
#include <notifier.h>
#include <linux_rtnetlink.h>
#include "crypto_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 template[CRYPTO_MAX_ALG_NAME];

	struct crypto_larval *larval;

	u32 otype;
	u32 omask;
};

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

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

	UMAC_CRYPTO_OUTMSG("cryptomgr_probe: param->template:%s\n",
				param->template);

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

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

		UMAC_CRYPTO_OUTMSG("cryptomgr_probe:"
					" calling alloc param->template:%s\n",
					param->template);
		inst = tmpl->alloc(param->tb);
		if (IS_ERR(inst)){
			UMAC_CRYPTO_OUTMSG("cryptomgr_probe: alloc failed"
						" param->template:%s\n",
						param->template);
			err = PTR_ERR(inst);
		}
		else if ((err = crypto_register_instance(tmpl, inst))) {
			UMAC_CRYPTO_OUTMSG("cryptomgr_probe:"
						" crypto_register_instance"
						" failed param->template:%s\n",
						param->template);
			tmpl->free(inst);
		}
		UMAC_CRYPTO_OUTMSG("cryptomgr_probe: param->template:%s %d\n",
					param->template, err);
	} while (err == -EAGAIN && !signal_pending(current));

	crypto_tmpl_put(tmpl);

out:
	complete_all(&param->larval->completion);
	crypto_alg_put(&param->larval->alg);
	kfree(param);
	module_put_and_exit(0);
}

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;

	UMAC_CRYPTO_OUTMSG("cryptomgr_schedule_probe:"
				" larval->alg.cra_name:%s\n",
				larval->alg.cra_name);

	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;

	crypto_alg_get(&larval->alg);
	param->larval = larval;

	thread = (struct task_struct *)kthread_run(cryptomgr_probe,
							param,
							"cryptomgr_probe");
	if (IS_ERR(thread))
		goto err_put_larval;

	wait_for_completion_interruptible(&larval->completion);

	UMAC_CRYPTO_OUTMSG("cryptomgr_schedule_probe:"
				" larval->alg.cra_name:%s"
				" returning NOTIFY_STOP\n",
				larval->alg.cra_name);

	return NOTIFY_STOP;

err_put_larval:
	crypto_alg_put(&larval->alg);
err_free_param:
	kfree(param);
err_put_module:
	module_put(THIS_MODULE);
err:
	UMAC_CRYPTO_OUTMSG("cryptomgr_schedule_probe:"
				" larval->alg.cra_name:%s"
				" returning NOTIFY_OK\n",
				larval->alg.cra_name);
	return NOTIFY_OK;
}

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);
}

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)) || 0 )
		type |= CRYPTO_ALG_TESTED;

	param->type = type;

	thread = (struct task_struct *)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;
}

int cryptomgr_notify(struct notifier_block *this, unsigned long msg,
			    void *data)
{
	(void)this;
	int ret;
	UMAC_CRYPTO_OUTMSG("cryptomgr_notify called msg:%d\n", msg);
	switch (msg) {
	case CRYPTO_MSG_ALG_REQUEST:
		ret = cryptomgr_schedule_probe(data);
		UMAC_CRYPTO_OUTMSG("cryptomgr_notify called msg:%d"
					" return ret %d\n", msg, ret);
		return ret;
	case CRYPTO_MSG_ALG_REGISTER:
		ret = cryptomgr_schedule_test(data);
		UMAC_CRYPTO_OUTMSG("cryptomgr_notify called msg:%d"
					" return ret %d\n", msg, ret);
		return ret;
	case CRYPTO_MSG_ALG_LOADED:
		break;
	}
	UMAC_CRYPTO_OUTMSG("cryptomgr_notify called msg:%d return ret %d"
					"(NOTIFY_DONE)\n", msg, NOTIFY_DONE);

	return NOTIFY_DONE;
}

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

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

subsys_initcall(cryptomgr_init);

MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("Crypto Algorithm Manager");