Linux-6.18.2/drivers/crypto/loongson/loongson-rng.c

// SPDX-License-Identifier: GPL-2.0
/* Copyright (c) 2019 HiSilicon Limited. */
/* Copyright (c) 2025 Loongson Technology Corporation Limited. */

#include <linux/crypto.h>
#include <linux/err.h>
#include <linux/hw_random.h>
#include <linux/io.h>
#include <linux/iopoll.h>
#include <linux/kernel.h>
#include <linux/list.h>
#include <linux/mfd/loongson-se.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/platform_device.h>
#include <linux/random.h>
#include <crypto/internal/rng.h>

#define SE_SEED_SIZE 32

struct loongson_rng_list {
	struct mutex lock;
	struct list_head list;
	int registered;
};

struct loongson_rng {
	u32 used;
	struct loongson_se_engine *engine;
	struct list_head list;
	struct mutex lock;
};

struct loongson_rng_ctx {
	struct loongson_rng *rng;
};

struct loongson_rng_cmd {
	u32 cmd_id;
	union {
		u32 len;
		u32 ret;
	} u;
	u32 seed_off;
	u32 out_off;
	u32 pad[4];
};

static struct loongson_rng_list rng_devices = {
	.lock = __MUTEX_INITIALIZER(rng_devices.lock),
	.list = LIST_HEAD_INIT(rng_devices.list),
};

static int loongson_rng_generate(struct crypto_rng *tfm, const u8 *src,
			  unsigned int slen, u8 *dstn, unsigned int dlen)
{
	struct loongson_rng_ctx *ctx = crypto_rng_ctx(tfm);
	struct loongson_rng *rng = ctx->rng;
	struct loongson_rng_cmd *cmd = rng->engine->command;
	int err, len;

	mutex_lock(&rng->lock);
	cmd->seed_off = 0;
	do {
		len = min(dlen, rng->engine->buffer_size);
		cmd = rng->engine->command;
		cmd->u.len = len;
		err = loongson_se_send_engine_cmd(rng->engine);
		if (err)
			break;

		cmd = rng->engine->command_ret;
		if (cmd->u.ret) {
			err = -EIO;
			break;
		}

		memcpy(dstn, rng->engine->data_buffer, len);
		dlen -= len;
		dstn += len;
	} while (dlen > 0);
	mutex_unlock(&rng->lock);

	return err;
}

static int loongson_rng_init(struct crypto_tfm *tfm)
{
	struct loongson_rng_ctx *ctx = crypto_tfm_ctx(tfm);
	struct loongson_rng *rng;
	u32 min_used = U32_MAX;

	mutex_lock(&rng_devices.lock);
	list_for_each_entry(rng, &rng_devices.list, list) {
		if (rng->used < min_used) {
			ctx->rng = rng;
			min_used = rng->used;
		}
	}
	ctx->rng->used++;
	mutex_unlock(&rng_devices.lock);

	return 0;
}

static void loongson_rng_exit(struct crypto_tfm *tfm)
{
	struct loongson_rng_ctx *ctx = crypto_tfm_ctx(tfm);

	mutex_lock(&rng_devices.lock);
	ctx->rng->used--;
	mutex_unlock(&rng_devices.lock);
}

static int loongson_rng_seed(struct crypto_rng *tfm, const u8 *seed,
			     unsigned int slen)
{
	struct loongson_rng_ctx *ctx = crypto_rng_ctx(tfm);
	struct loongson_rng *rng = ctx->rng;
	struct loongson_rng_cmd *cmd;
	int err;

	if (slen < SE_SEED_SIZE)
		return -EINVAL;

	slen = min(slen, rng->engine->buffer_size);

	mutex_lock(&rng->lock);
	cmd = rng->engine->command;
	cmd->u.len = slen;
	cmd->seed_off = rng->engine->buffer_off;
	memcpy(rng->engine->data_buffer, seed, slen);
	err = loongson_se_send_engine_cmd(rng->engine);
	if (err)
		goto out;

	cmd = rng->engine->command_ret;
	if (cmd->u.ret)
		err = -EIO;
out:
	mutex_unlock(&rng->lock);

	return err;
}

static struct rng_alg loongson_rng_alg = {
	.generate = loongson_rng_generate,
	.seed =	loongson_rng_seed,
	.seedsize = SE_SEED_SIZE,
	.base = {
		.cra_name = "stdrng",
		.cra_driver_name = "loongson_stdrng",
		.cra_priority = 300,
		.cra_ctxsize = sizeof(struct loongson_rng_ctx),
		.cra_module = THIS_MODULE,
		.cra_init = loongson_rng_init,
		.cra_exit = loongson_rng_exit,
	},
};

static int loongson_rng_probe(struct platform_device *pdev)
{
	struct loongson_rng_cmd *cmd;
	struct loongson_rng *rng;
	int ret = 0;

	rng = devm_kzalloc(&pdev->dev, sizeof(*rng), GFP_KERNEL);
	if (!rng)
		return -ENOMEM;

	rng->engine = loongson_se_init_engine(pdev->dev.parent, SE_ENGINE_RNG);
	if (!rng->engine)
		return -ENODEV;
	cmd = rng->engine->command;
	cmd->cmd_id = SE_CMD_RNG;
	cmd->out_off = rng->engine->buffer_off;
	mutex_init(&rng->lock);

	mutex_lock(&rng_devices.lock);

	if (!rng_devices.registered) {
		ret = crypto_register_rng(&loongson_rng_alg);
		if (ret) {
			dev_err(&pdev->dev, "failed to register crypto(%d)\n", ret);
			goto out;
		}
		rng_devices.registered = 1;
	}

	list_add_tail(&rng->list, &rng_devices.list);
out:
	mutex_unlock(&rng_devices.lock);

	return ret;
}

static struct platform_driver loongson_rng_driver = {
	.probe		= loongson_rng_probe,
	.driver		= {
		.name	= "loongson-rng",
	},
};
module_platform_driver(loongson_rng_driver);

MODULE_ALIAS("platform:loongson-rng");
MODULE_LICENSE("GPL");
MODULE_AUTHOR("Yinggang Gu <guyinggang@loongson.cn>");
MODULE_AUTHOR("Qunqin Zhao <zhaoqunqin@loongson.cn>");
MODULE_DESCRIPTION("Loongson Random Number Generator driver");