xref: /rk3399_rockchip-uboot/drivers/reset/reset-scmi.c (revision 3cdb50e61826b9de0e070cec703df08a030e5624)
1*3cdb50e6SEtienne Carriere // SPDX-License-Identifier: GPL-2.0+
2*3cdb50e6SEtienne Carriere /*
3*3cdb50e6SEtienne Carriere  * Copyright (C) 2019-2020 Linaro Limited
4*3cdb50e6SEtienne Carriere  */
5*3cdb50e6SEtienne Carriere #include <common.h>
6*3cdb50e6SEtienne Carriere #include <dm.h>
7*3cdb50e6SEtienne Carriere #include <errno.h>
8*3cdb50e6SEtienne Carriere #include <reset-uclass.h>
9*3cdb50e6SEtienne Carriere #include <scmi_agent.h>
10*3cdb50e6SEtienne Carriere #include <scmi_protocols.h>
11*3cdb50e6SEtienne Carriere #include <asm/types.h>
12*3cdb50e6SEtienne Carriere 
scmi_reset_set_level(struct reset_ctl * rst,bool assert_not_deassert)13*3cdb50e6SEtienne Carriere static int scmi_reset_set_level(struct reset_ctl *rst, bool assert_not_deassert)
14*3cdb50e6SEtienne Carriere {
15*3cdb50e6SEtienne Carriere 	struct scmi_rd_reset_in in = {
16*3cdb50e6SEtienne Carriere 		.domain_id = rst->id,
17*3cdb50e6SEtienne Carriere 		.flags = assert_not_deassert ? SCMI_RD_RESET_FLAG_ASSERT : 0,
18*3cdb50e6SEtienne Carriere 		.reset_state = 0,
19*3cdb50e6SEtienne Carriere 	};
20*3cdb50e6SEtienne Carriere 	struct scmi_rd_reset_out out;
21*3cdb50e6SEtienne Carriere 	struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_RESET_DOMAIN,
22*3cdb50e6SEtienne Carriere 					  SCMI_RESET_DOMAIN_RESET,
23*3cdb50e6SEtienne Carriere 					  in, out);
24*3cdb50e6SEtienne Carriere 	int ret;
25*3cdb50e6SEtienne Carriere 
26*3cdb50e6SEtienne Carriere 	ret = devm_scmi_process_msg(rst->dev->parent, &msg);
27*3cdb50e6SEtienne Carriere 	if (ret)
28*3cdb50e6SEtienne Carriere 		return ret;
29*3cdb50e6SEtienne Carriere 
30*3cdb50e6SEtienne Carriere 	return scmi_to_linux_errno(out.status);
31*3cdb50e6SEtienne Carriere }
32*3cdb50e6SEtienne Carriere 
scmi_reset_assert(struct reset_ctl * rst)33*3cdb50e6SEtienne Carriere static int scmi_reset_assert(struct reset_ctl *rst)
34*3cdb50e6SEtienne Carriere {
35*3cdb50e6SEtienne Carriere 	return scmi_reset_set_level(rst, true);
36*3cdb50e6SEtienne Carriere }
37*3cdb50e6SEtienne Carriere 
scmi_reset_deassert(struct reset_ctl * rst)38*3cdb50e6SEtienne Carriere static int scmi_reset_deassert(struct reset_ctl *rst)
39*3cdb50e6SEtienne Carriere {
40*3cdb50e6SEtienne Carriere 	return scmi_reset_set_level(rst, false);
41*3cdb50e6SEtienne Carriere }
42*3cdb50e6SEtienne Carriere 
scmi_reset_request(struct reset_ctl * rst)43*3cdb50e6SEtienne Carriere static int scmi_reset_request(struct reset_ctl *rst)
44*3cdb50e6SEtienne Carriere {
45*3cdb50e6SEtienne Carriere 	struct scmi_rd_attr_in in = {
46*3cdb50e6SEtienne Carriere 		.domain_id = rst->id,
47*3cdb50e6SEtienne Carriere 	};
48*3cdb50e6SEtienne Carriere 	struct scmi_rd_attr_out out;
49*3cdb50e6SEtienne Carriere 	struct scmi_msg msg = SCMI_MSG_IN(SCMI_PROTOCOL_ID_RESET_DOMAIN,
50*3cdb50e6SEtienne Carriere 					  SCMI_RESET_DOMAIN_ATTRIBUTES,
51*3cdb50e6SEtienne Carriere 					  in, out);
52*3cdb50e6SEtienne Carriere 	int ret;
53*3cdb50e6SEtienne Carriere 
54*3cdb50e6SEtienne Carriere 	/*
55*3cdb50e6SEtienne Carriere 	 * We don't really care about the attribute, just check
56*3cdb50e6SEtienne Carriere 	 * the reset domain exists.
57*3cdb50e6SEtienne Carriere 	 */
58*3cdb50e6SEtienne Carriere 	ret = devm_scmi_process_msg(rst->dev->parent, &msg);
59*3cdb50e6SEtienne Carriere 	if (ret)
60*3cdb50e6SEtienne Carriere 		return ret;
61*3cdb50e6SEtienne Carriere 
62*3cdb50e6SEtienne Carriere 	return scmi_to_linux_errno(out.status);
63*3cdb50e6SEtienne Carriere }
64*3cdb50e6SEtienne Carriere 
scmi_reset_rfree(struct reset_ctl * rst)65*3cdb50e6SEtienne Carriere static int scmi_reset_rfree(struct reset_ctl *rst)
66*3cdb50e6SEtienne Carriere {
67*3cdb50e6SEtienne Carriere 	return 0;
68*3cdb50e6SEtienne Carriere }
69*3cdb50e6SEtienne Carriere 
70*3cdb50e6SEtienne Carriere static const struct reset_ops scmi_reset_domain_ops = {
71*3cdb50e6SEtienne Carriere 	.request	= scmi_reset_request,
72*3cdb50e6SEtienne Carriere 	.rfree		= scmi_reset_rfree,
73*3cdb50e6SEtienne Carriere 	.rst_assert	= scmi_reset_assert,
74*3cdb50e6SEtienne Carriere 	.rst_deassert	= scmi_reset_deassert,
75*3cdb50e6SEtienne Carriere };
76*3cdb50e6SEtienne Carriere 
77*3cdb50e6SEtienne Carriere U_BOOT_DRIVER(scmi_reset_domain) = {
78*3cdb50e6SEtienne Carriere 	.name = "scmi_reset_domain",
79*3cdb50e6SEtienne Carriere 	.id = UCLASS_RESET,
80*3cdb50e6SEtienne Carriere 	.ops = &scmi_reset_domain_ops,
81*3cdb50e6SEtienne Carriere };
82