[thirdparty/u-boot.git] / drivers / reset / reset-zynqmp.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2021 Xilinx, Inc. - Michal Simek
 */

#define LOG_CATEGORY UCLASS_RESET

#include <common.h>
#include <dm.h>
#include <dm/device_compat.h>
#include <reset-uclass.h>
#include <zynqmp_firmware.h>

#define ZYNQMP_NR_RESETS	(ZYNQMP_PM_RESET_END - ZYNQMP_PM_RESET_START)
#define ZYNQMP_RESET_ID		ZYNQMP_PM_RESET_START

struct zynqmp_reset_priv {
	u32 reset_id;
	u32 nr_reset;
};

static int zynqmp_pm_reset_assert(const u32 reset,
				  const enum zynqmp_pm_reset_action assert_flag)
{
	return xilinx_pm_request(PM_RESET_ASSERT, reset, assert_flag, 0, 0,
				 NULL);
}

static int zynqmp_reset_assert(struct reset_ctl *rst)
{
	struct zynqmp_reset_priv *priv = dev_get_priv(rst->dev);

	dev_dbg(rst->dev, "%s(rst=%p) (id=%lu)\n", __func__, rst, rst->id);

	return zynqmp_pm_reset_assert(priv->reset_id + rst->id,
				      PM_RESET_ACTION_ASSERT);
}

static int zynqmp_reset_deassert(struct reset_ctl *rst)
{
	struct zynqmp_reset_priv *priv = dev_get_priv(rst->dev);

	dev_dbg(rst->dev, "%s(rst=%p) (id=%lu)\n", __func__, rst, rst->id);

	return zynqmp_pm_reset_assert(priv->reset_id + rst->id,
				      PM_RESET_ACTION_RELEASE);
}

static int zynqmp_reset_request(struct reset_ctl *rst)
{
	struct zynqmp_reset_priv *priv = dev_get_priv(rst->dev);

	dev_dbg(rst->dev, "%s(rst=%p) (id=%lu) (nr_reset=%d)\n", __func__,
		rst, rst->id, priv->nr_reset);

	if (priv->nr_reset && rst->id > priv->nr_reset)
		return -EINVAL;

	return 0;
}

static int zynqmp_reset_probe(struct udevice *dev)
{
	struct zynqmp_reset_priv *priv = dev_get_priv(dev);

	if (device_is_compatible(dev, "xlnx,zynqmp-reset")) {
		priv->reset_id = ZYNQMP_RESET_ID;
		priv->nr_reset = ZYNQMP_NR_RESETS;
	}

	return 0;
}

const struct reset_ops zynqmp_reset_ops = {
	.request = zynqmp_reset_request,
	.rst_assert = zynqmp_reset_assert,
	.rst_deassert = zynqmp_reset_deassert,
};

static const struct udevice_id zynqmp_reset_ids[] = {
	{ .compatible = "xlnx,zynqmp-reset" },
	{ .compatible = "xlnx,versal-reset" },
	{ .compatible = "xlnx,versal-net-reset" },
	{ }
};

U_BOOT_DRIVER(zynqmp_reset) = {
	.name		= "zynqmp_reset",
	.id		= UCLASS_RESET,
	.of_match	= zynqmp_reset_ids,
	.ops		= &zynqmp_reset_ops,
	.probe		= zynqmp_reset_probe,
	.priv_auto	= sizeof(struct zynqmp_reset_priv),
};
Commit	Line	Data
3f123b74 MS	1	// SPDX-License-Identifier: GPL-2.0
	2	/*
	3	* Copyright (C) 2021 Xilinx, Inc. - Michal Simek
	4	*/
	5
	6	#define LOG_CATEGORY UCLASS_RESET
	7
d678a59d	8	#include <common.h>
3f123b74 MS	9	#include <dm.h>
	10	#include <dm/device_compat.h>
	11	#include <reset-uclass.h>
	12	#include <zynqmp_firmware.h>
	13
	14	#define ZYNQMP_NR_RESETS (ZYNQMP_PM_RESET_END - ZYNQMP_PM_RESET_START)
	15	#define ZYNQMP_RESET_ID ZYNQMP_PM_RESET_START
	16
	17	struct zynqmp_reset_priv {
	18	u32 reset_id;
	19	u32 nr_reset;
	20	};
	21
	22	static int zynqmp_pm_reset_assert(const u32 reset,
	23	const enum zynqmp_pm_reset_action assert_flag)
	24	{
	25	return xilinx_pm_request(PM_RESET_ASSERT, reset, assert_flag, 0, 0,
	26	NULL);
	27	}
	28
	29	static int zynqmp_reset_assert(struct reset_ctl *rst)
	30	{
	31	struct zynqmp_reset_priv *priv = dev_get_priv(rst->dev);
	32
	33	dev_dbg(rst->dev, "%s(rst=%p) (id=%lu)\n", __func__, rst, rst->id);
	34
	35	return zynqmp_pm_reset_assert(priv->reset_id + rst->id,
	36	PM_RESET_ACTION_ASSERT);
	37	}
	38
	39	static int zynqmp_reset_deassert(struct reset_ctl *rst)
	40	{
	41	struct zynqmp_reset_priv *priv = dev_get_priv(rst->dev);
	42
	43	dev_dbg(rst->dev, "%s(rst=%p) (id=%lu)\n", __func__, rst, rst->id);
	44
	45	return zynqmp_pm_reset_assert(priv->reset_id + rst->id,
	46	PM_RESET_ACTION_RELEASE);
	47	}
	48
	49	static int zynqmp_reset_request(struct reset_ctl *rst)
	50	{
	51	struct zynqmp_reset_priv *priv = dev_get_priv(rst->dev);
	52
	53	dev_dbg(rst->dev, "%s(rst=%p) (id=%lu) (nr_reset=%d)\n", __func__,
	54	rst, rst->id, priv->nr_reset);
	55
9df50817	56	if (priv->nr_reset && rst->id > priv->nr_reset)
3f123b74 MS	57	return -EINVAL;
	58
	59	return 0;
	60	}
	61
3f123b74 MS	62	static int zynqmp_reset_probe(struct udevice *dev)
	63	{
	64	struct zynqmp_reset_priv *priv = dev_get_priv(dev);
	65
9df50817 KR	66	if (device_is_compatible(dev, "xlnx,zynqmp-reset")) {
	67	priv->reset_id = ZYNQMP_RESET_ID;
	68	priv->nr_reset = ZYNQMP_NR_RESETS;
	69	}
	70
3f123b74 MS	71	return 0;
	72	}
	73
	74	const struct reset_ops zynqmp_reset_ops = {
	75	.request = zynqmp_reset_request,
3f123b74 MS	76	.rst_assert = zynqmp_reset_assert,
	77	.rst_deassert = zynqmp_reset_deassert,
	78	};
	79
	80	static const struct udevice_id zynqmp_reset_ids[] = {
	81	{ .compatible = "xlnx,zynqmp-reset" },
9df50817	82	{ .compatible = "xlnx,versal-reset" },
a41c3399	83	{ .compatible = "xlnx,versal-net-reset" },
3f123b74 MS	84	{ }
	85	};
	86
	87	U_BOOT_DRIVER(zynqmp_reset) = {
	88	.name = "zynqmp_reset",
	89	.id = UCLASS_RESET,
	90	.of_match = zynqmp_reset_ids,
	91	.ops = &zynqmp_reset_ops,
	92	.probe = zynqmp_reset_probe,
	93	.priv_auto = sizeof(struct zynqmp_reset_priv),
	94	};