xref: /rk3399_ARM-atf/plat/amd/versal2/scmi.c (revision b9c20e5d144347ca28e17df080b7ee9bf0dd9377)
1c97857dbSAmit Nagal /*
2c97857dbSAmit Nagal  * Copyright (c) 2023-2024, Advanced Micro Devices, Inc. All rights reserved.
3c97857dbSAmit Nagal  *
4c97857dbSAmit Nagal  * SPDX-License-Identifier: BSD-3-Clause
5c97857dbSAmit Nagal  */
6c97857dbSAmit Nagal 
7c97857dbSAmit Nagal #include <assert.h>
8c97857dbSAmit Nagal #include <errno.h>
9c97857dbSAmit Nagal #include <inttypes.h>
10c97857dbSAmit Nagal 
11c97857dbSAmit Nagal #include <drivers/scmi-msg.h>
12c97857dbSAmit Nagal #include <drivers/scmi.h>
13*b9c20e5dSAmit Nagal #include <lib/mmio.h>
14c97857dbSAmit Nagal #include <lib/utils_def.h>
15c97857dbSAmit Nagal #include <platform_def.h>
16c97857dbSAmit Nagal #include <scmi.h>
17c97857dbSAmit Nagal 
18c97857dbSAmit Nagal #include "plat_private.h"
19c97857dbSAmit Nagal 
20c97857dbSAmit Nagal #define HIGH (1)
21c97857dbSAmit Nagal #define LOW (0)
22c97857dbSAmit Nagal 
23c97857dbSAmit Nagal struct scmi_clk {
24c97857dbSAmit Nagal 	unsigned long clock_id;
25c97857dbSAmit Nagal 	unsigned long rate;
26c97857dbSAmit Nagal 	const char *name;
27c97857dbSAmit Nagal 	bool enabled;
28c97857dbSAmit Nagal };
29c97857dbSAmit Nagal 
30c97857dbSAmit Nagal #define CLOCK_CELL(_scmi_id, _id, _name, _init_enabled, _rate) \
31c97857dbSAmit Nagal 	[_scmi_id] = { \
32c97857dbSAmit Nagal 		.clock_id = (_id), \
33c97857dbSAmit Nagal 		.name = (_name), \
34c97857dbSAmit Nagal 		.enabled = (_init_enabled), \
35c97857dbSAmit Nagal 		.rate = (_rate), \
36c97857dbSAmit Nagal 	}
37c97857dbSAmit Nagal 
38c97857dbSAmit Nagal static struct scmi_clk scmi0_clock[] = {
39c97857dbSAmit Nagal 	CLOCK_CELL(CLK_GEM0_0, CLK_GEM0_0, "gem0_pclk", true, 100000000),
40c97857dbSAmit Nagal 	CLOCK_CELL(CLK_GEM0_1, CLK_GEM0_1, "gem0_hclk", true, 100000000),
41c97857dbSAmit Nagal 	CLOCK_CELL(CLK_GEM0_2, CLK_GEM0_2, "gem0_tx_clk", true, 125000000),
42c97857dbSAmit Nagal 	CLOCK_CELL(CLK_GEM0_3, CLK_GEM0_3, "gem0_rx_clk", true, 100000000),
43c97857dbSAmit Nagal 	CLOCK_CELL(CLK_GEM0_4, CLK_GEM0_4, "gem0_tsu_clk", true, 100000000),
44c97857dbSAmit Nagal 	CLOCK_CELL(CLK_GEM1_0, CLK_GEM1_0, "gem1_pclk", true, 100000000),
45c97857dbSAmit Nagal 	CLOCK_CELL(CLK_GEM1_1, CLK_GEM1_1, "gem1_hclk", true, 100000000),
46c97857dbSAmit Nagal 	CLOCK_CELL(CLK_GEM1_2, CLK_GEM1_2, "gem1_tx_clk", true, 125000000),
47c97857dbSAmit Nagal 	CLOCK_CELL(CLK_GEM1_3, CLK_GEM1_3, "gem1_rx_clk", true, 100000000),
48c97857dbSAmit Nagal 	CLOCK_CELL(CLK_GEM1_4, CLK_GEM1_4, "gem1_tsu_clk", true, 100000000),
49c97857dbSAmit Nagal 	CLOCK_CELL(CLK_SERIAL0_0, CLK_SERIAL0_0, "uart0_uartclk", true, 100000000),
50c97857dbSAmit Nagal 	CLOCK_CELL(CLK_SERIAL0_1, CLK_SERIAL0_1, "uart0_apb_pclk", true, 100000000),
51c97857dbSAmit Nagal 	CLOCK_CELL(CLK_SERIAL1_0, CLK_SERIAL1_0, "uart1_uartclk", true, 100000000),
52c97857dbSAmit Nagal 	CLOCK_CELL(CLK_SERIAL1_1, CLK_SERIAL1_1, "uart1_apb_pclk", true, 100000000),
53c97857dbSAmit Nagal 	CLOCK_CELL(CLK_UFS0_0, CLK_UFS0_0, "ufs_core_clk", true, 100000000),
54c97857dbSAmit Nagal 	CLOCK_CELL(CLK_UFS0_1, CLK_UFS0_1, "ufs_phy_clk", true, 100000000),
55c97857dbSAmit Nagal 	CLOCK_CELL(CLK_UFS0_2, CLK_UFS0_2, "ufs_ref_pclk", true, 100000000),
56c97857dbSAmit Nagal 	CLOCK_CELL(CLK_USB0_0, CLK_USB0_0, "usb0_bus_clk", true, 100000000),
57c97857dbSAmit Nagal 	CLOCK_CELL(CLK_USB0_1, CLK_USB0_1, "usb0_ref_clk", true, 100000000),
58c97857dbSAmit Nagal 	CLOCK_CELL(CLK_USB0_2, CLK_USB0_2, "usb0_dwc_clk", true, 100000000),
59c97857dbSAmit Nagal 	CLOCK_CELL(CLK_USB1_0, CLK_USB1_0, "usb1_bus_clk", true, 100000000),
60c97857dbSAmit Nagal 	CLOCK_CELL(CLK_USB1_1, CLK_USB1_1, "usb1_ref_clk", true, 100000000),
61c97857dbSAmit Nagal 	CLOCK_CELL(CLK_USB1_2, CLK_USB1_2, "usb1_dwc_clk", true, 100000000),
62c97857dbSAmit Nagal 	CLOCK_CELL(CLK_MMC0_0, CLK_MMC0_0, "mmc0_xin_clk", true, 100000000),
63c97857dbSAmit Nagal 	CLOCK_CELL(CLK_MMC0_1, CLK_MMC0_1, "mmc0_ahb_clk", true, 100000000),
64c97857dbSAmit Nagal 	CLOCK_CELL(CLK_MMC0_2, CLK_MMC0_2, "mmc0_gate_clk", true, 100000000),
65c97857dbSAmit Nagal 	CLOCK_CELL(CLK_MMC1_0, CLK_MMC1_0, "mmc1_xin_clk", true, 100000000),
66c97857dbSAmit Nagal 	CLOCK_CELL(CLK_MMC1_1, CLK_MMC1_1, "mmc1_ahb_clk", true, 100000000),
67c97857dbSAmit Nagal 	CLOCK_CELL(CLK_MMC1_2, CLK_MMC1_2, "mmc1_gate_clk", true, 100000000),
68c97857dbSAmit Nagal 	CLOCK_CELL(CLK_TTC0_0, CLK_TTC0_0, "ttc0_clk", true, 100000000),
69c97857dbSAmit Nagal 	CLOCK_CELL(CLK_TTC1_0, CLK_TTC1_0, "ttc1_clk", true, 100000000),
70c97857dbSAmit Nagal 	CLOCK_CELL(CLK_TTC2_0, CLK_TTC2_0, "ttc2_clk", true, 100000000),
71c97857dbSAmit Nagal 	CLOCK_CELL(CLK_TTC3_0, CLK_TTC3_0, "ttc3_clk", true, 100000000),
72c97857dbSAmit Nagal 	CLOCK_CELL(CLK_TTC4_0, CLK_TTC4_0, "ttc4_clk", true, 100000000),
73c97857dbSAmit Nagal 	CLOCK_CELL(CLK_TTC5_0, CLK_TTC5_0, "ttc5_clk", true, 100000000),
74c97857dbSAmit Nagal 	CLOCK_CELL(CLK_TTC6_0, CLK_TTC6_0, "ttc6_clk", true, 100000000),
75c97857dbSAmit Nagal 	CLOCK_CELL(CLK_TTC7_0, CLK_TTC7_0, "ttc7_clk", true, 100000000),
76c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I2C0_0, CLK_I2C0_0, "i2c0_clk", true, 100000000),
77c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I2C1_0, CLK_I2C1_0, "i2c1_clk", true, 100000000),
78c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I2C2_0, CLK_I2C2_0, "i2c2_clk", true, 100000000),
79c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I2C3_0, CLK_I2C3_0, "i2c3_clk", true, 100000000),
80c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I2C4_0, CLK_I2C4_0, "i2c4_clk", true, 100000000),
81c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I2C5_0, CLK_I2C5_0, "i2c5_clk", true, 100000000),
82c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I2C6_0, CLK_I2C6_0, "i2c6_clk", true, 100000000),
83c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I2C7_0, CLK_I2C7_0, "i2c7_clk", true, 100000000),
84c97857dbSAmit Nagal 	CLOCK_CELL(CLK_OSPI0_0, CLK_OSPI0_0, "ospi0_clk", true, 100000000),
85c97857dbSAmit Nagal 	CLOCK_CELL(CLK_QSPI0_0, CLK_QSPI0_0, "qpsi0_ref_clk", true, 100000000),
86c97857dbSAmit Nagal 	CLOCK_CELL(CLK_QSPI0_1, CLK_QSPI0_1, "qspi0_pclk", true, 100000000),
87c97857dbSAmit Nagal 	CLOCK_CELL(CLK_WWDT0_0, CLK_WWDT0_0, "wwdt0_clk", true, 100000000),
88c97857dbSAmit Nagal 	CLOCK_CELL(CLK_WWDT1_0, CLK_WWDT1_0, "wwdt1_clk", true, 100000000),
89c97857dbSAmit Nagal 	CLOCK_CELL(CLK_WWDT2_0, CLK_WWDT2_0, "wwdt2_clk", true, 100000000),
90c97857dbSAmit Nagal 	CLOCK_CELL(CLK_WWDT3_0, CLK_WWDT3_0, "wwdt3_clk", true, 100000000),
91c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA0_0, CLK_ADMA0_0, "adma0_main_clk", true, 100000000),
92c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA0_1, CLK_ADMA0_1, "adma0_apb_clk", true, 100000000),
93c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA1_0, CLK_ADMA1_0, "adma1_main_clk", true, 100000000),
94c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA1_1, CLK_ADMA1_1, "adma1_apb_clk", true, 100000000),
95c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA2_0, CLK_ADMA2_0, "adma2_main_clk", true, 100000000),
96c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA2_1, CLK_ADMA2_1, "adma2_apb_clk", true, 100000000),
97c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA3_0, CLK_ADMA3_0, "adma3_main_clk", true, 100000000),
98c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA3_1, CLK_ADMA3_1, "adma3_apb_clk", true, 100000000),
99c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA4_0, CLK_ADMA4_0, "adma4_main_clk", true, 100000000),
100c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA4_1, CLK_ADMA4_1, "adma4_apb_clk", true, 100000000),
101c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA5_0, CLK_ADMA5_0, "adma5_main_clk", true, 100000000),
102c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA5_1, CLK_ADMA5_1, "adma5_apb_clk", true, 100000000),
103c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA6_0, CLK_ADMA6_0, "adma6_main_clk", true, 100000000),
104c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA6_1, CLK_ADMA6_1, "adma6_apb_clk", true, 100000000),
105c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA7_0, CLK_ADMA7_0, "adma7_main_clk", true, 100000000),
106c97857dbSAmit Nagal 	CLOCK_CELL(CLK_ADMA7_1, CLK_ADMA7_1, "adma7_apb_clk", true, 100000000),
107c97857dbSAmit Nagal 	CLOCK_CELL(CLK_CAN0_0, CLK_CAN0_0, "can0_can_clk", true, 100000000),
108c97857dbSAmit Nagal 	CLOCK_CELL(CLK_CAN0_1, CLK_CAN0_1, "can0_axi_clk", true, 100000000),
109c97857dbSAmit Nagal 	CLOCK_CELL(CLK_CAN1_0, CLK_CAN1_0, "can1_can_clk", true, 100000000),
110c97857dbSAmit Nagal 	CLOCK_CELL(CLK_CAN1_1, CLK_CAN1_1, "can1_axi_clk", true, 100000000),
111c97857dbSAmit Nagal 	CLOCK_CELL(CLK_CAN2_0, CLK_CAN2_0, "can2_can_clk", true, 100000000),
112c97857dbSAmit Nagal 	CLOCK_CELL(CLK_CAN2_1, CLK_CAN2_1, "can2_axi_clk", true, 100000000),
113c97857dbSAmit Nagal 	CLOCK_CELL(CLK_CAN3_0, CLK_CAN3_0, "can3_can_clk", true, 100000000),
114c97857dbSAmit Nagal 	CLOCK_CELL(CLK_CAN3_1, CLK_CAN3_1, "can3_axi_clk", true, 100000000),
115c97857dbSAmit Nagal 	CLOCK_CELL(CLK_PS_GPIO_0, CLK_PS_GPIO_0, "ps_gpio_clk", true, 100000000),
116c97857dbSAmit Nagal 	CLOCK_CELL(CLK_PMC_GPIO_0, CLK_PMC_GPIO_0, "pmc_gpio_clk", true, 100000000),
117c97857dbSAmit Nagal 	CLOCK_CELL(CLK_SPI0_0, CLK_SPI0_0, "spi0_ref_clk", true, 100000000),
118c97857dbSAmit Nagal 	CLOCK_CELL(CLK_SPI0_1, CLK_SPI0_1, "spi0_pclk", true, 100000000),
119c97857dbSAmit Nagal 	CLOCK_CELL(CLK_SPI1_0, CLK_SPI1_0, "spi1_ref_clk", true, 100000000),
120c97857dbSAmit Nagal 	CLOCK_CELL(CLK_SPI1_1, CLK_SPI1_1, "spi1_pclk", true, 100000000),
121c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I3C0_0, CLK_I3C0_0, "i3c0_clk", true, 100000000),
122c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I3C1_0, CLK_I3C1_0, "i3c1_clk", true, 100000000),
123c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I3C2_0, CLK_I3C2_0, "i3c2_clk", true, 100000000),
124c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I3C3_0, CLK_I3C3_0, "i3c3_clk", true, 100000000),
125c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I3C4_0, CLK_I3C4_0, "i3c4_clk", true, 100000000),
126c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I3C5_0, CLK_I3C5_0, "i3c5_clk", true, 100000000),
127c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I3C6_0, CLK_I3C6_0, "i3c6_clk", true, 100000000),
128c97857dbSAmit Nagal 	CLOCK_CELL(CLK_I3C7_0, CLK_I3C7_0, "i3c7_clk", true, 100000000),
129c97857dbSAmit Nagal };
130c97857dbSAmit Nagal 
131c97857dbSAmit Nagal /*
132c97857dbSAmit Nagal  * struct scmi_reset - Data for the exposed reset controller
133c97857dbSAmit Nagal  * @reset_id: Reset identifier in RCC reset driver
134c97857dbSAmit Nagal  * @name: Reset string ID exposed to agent
135c97857dbSAmit Nagal  */
136c97857dbSAmit Nagal struct scmi_reset {
137c97857dbSAmit Nagal 	unsigned long reset_id;
138c97857dbSAmit Nagal 	const char *name;
139c97857dbSAmit Nagal };
140c97857dbSAmit Nagal 
141c97857dbSAmit Nagal #define RESET_CELL(_scmi_id, _id, _name) \
142c97857dbSAmit Nagal 	[_scmi_id] = { \
143c97857dbSAmit Nagal 		.reset_id = (_id), \
144c97857dbSAmit Nagal 		.name = (_name), \
145c97857dbSAmit Nagal 	}
146c97857dbSAmit Nagal 
147c97857dbSAmit Nagal static struct scmi_reset scmi0_reset[] = {
148c97857dbSAmit Nagal 	RESET_CELL(RESET_GEM0_0, RESET_GEM0_0, "gem0"),
149c97857dbSAmit Nagal 	RESET_CELL(RESET_GEM1_0, RESET_GEM1_0, "gem1"),
150c97857dbSAmit Nagal 	RESET_CELL(RESET_SERIAL0_0, RESET_SERIAL0_0, "serial0"),
151c97857dbSAmit Nagal 	RESET_CELL(RESET_SERIAL1_0, RESET_SERIAL1_0, "serial1"),
152c97857dbSAmit Nagal 	RESET_CELL(RESET_UFS0_0, RESET_UFS0_0, "ufs0"),
153c97857dbSAmit Nagal 	RESET_CELL(RESET_I2C0_0, RESET_I2C0_0, "i2c0"),
154c97857dbSAmit Nagal 	RESET_CELL(RESET_I2C1_0, RESET_I2C1_0, "i2c1"),
155c97857dbSAmit Nagal 	RESET_CELL(RESET_I2C2_0, RESET_I2C2_0, "i2c2"),
156c97857dbSAmit Nagal 	RESET_CELL(RESET_I2C3_0, RESET_I2C3_0, "i2c3"),
157c97857dbSAmit Nagal 	RESET_CELL(RESET_I2C4_0, RESET_I2C4_0, "i2c4"),
158c97857dbSAmit Nagal 	RESET_CELL(RESET_I2C5_0, RESET_I2C5_0, "i2c5"),
159c97857dbSAmit Nagal 	RESET_CELL(RESET_I2C6_0, RESET_I2C6_0, "i2c6"),
160c97857dbSAmit Nagal 	RESET_CELL(RESET_I2C7_0, RESET_I2C7_0, "i2c7"),
161c97857dbSAmit Nagal 	RESET_CELL(RESET_I2C8_0, RESET_I2C8_0, "i2c8"),
162c97857dbSAmit Nagal 	RESET_CELL(RESET_OSPI0_0, RESET_OSPI0_0, "ospi"),
163c97857dbSAmit Nagal 	RESET_CELL(RESET_USB0_0, RESET_USB0_0, "usb0_0"),
164c97857dbSAmit Nagal 	RESET_CELL(RESET_USB0_1, RESET_USB0_1, "usb0_1"),
165c97857dbSAmit Nagal 	RESET_CELL(RESET_USB0_2, RESET_USB0_2, "usb0_2"),
166c97857dbSAmit Nagal 	RESET_CELL(RESET_USB1_0, RESET_USB1_0, "usb1_0"),
167c97857dbSAmit Nagal 	RESET_CELL(RESET_USB1_1, RESET_USB1_1, "usb1_1"),
168c97857dbSAmit Nagal 	RESET_CELL(RESET_USB1_2, RESET_USB1_2, "usb1_2"),
169c97857dbSAmit Nagal 	RESET_CELL(RESET_MMC0_0, RESET_MMC0_0, "mmc0"),
170c97857dbSAmit Nagal 	RESET_CELL(RESET_MMC1_0, RESET_MMC1_0, "mmc1"),
171c97857dbSAmit Nagal 	RESET_CELL(RESET_SPI0_0, RESET_SPI0_0, "spi0"),
172c97857dbSAmit Nagal 	RESET_CELL(RESET_SPI1_0, RESET_SPI1_0, "spi1"),
173c97857dbSAmit Nagal 	RESET_CELL(RESET_QSPI0_0, RESET_QSPI0_0, "qspi"),
174c97857dbSAmit Nagal 	RESET_CELL(RESET_I3C0_0, RESET_I3C0_0, "i3c0"),
175c97857dbSAmit Nagal 	RESET_CELL(RESET_I3C1_0, RESET_I3C1_0, "i3c1"),
176c97857dbSAmit Nagal 	RESET_CELL(RESET_I3C2_0, RESET_I3C2_0, "i3c2"),
177c97857dbSAmit Nagal 	RESET_CELL(RESET_I3C3_0, RESET_I3C3_0, "i3c3"),
178c97857dbSAmit Nagal 	RESET_CELL(RESET_I3C4_0, RESET_I3C4_0, "i3c4"),
179c97857dbSAmit Nagal 	RESET_CELL(RESET_I3C5_0, RESET_I3C5_0, "i3c5"),
180c97857dbSAmit Nagal 	RESET_CELL(RESET_I3C6_0, RESET_I3C6_0, "i3c6"),
181c97857dbSAmit Nagal 	RESET_CELL(RESET_I3C7_0, RESET_I3C7_0, "i3c7"),
182c97857dbSAmit Nagal 	RESET_CELL(RESET_I3C8_0, RESET_I3C8_0, "i3c8"),
183*b9c20e5dSAmit Nagal 	RESET_CELL(RESET_UFSPHY_0, RESET_UFSPHY_0, "ufsphy0"),
184c97857dbSAmit Nagal };
185c97857dbSAmit Nagal 
186c97857dbSAmit Nagal struct scmi_resources {
187c97857dbSAmit Nagal 	struct scmi_clk *clock;
188c97857dbSAmit Nagal 	size_t clock_count;
189c97857dbSAmit Nagal 	struct scmi_reset *reset;
190c97857dbSAmit Nagal 	size_t reset_count;
191c97857dbSAmit Nagal 
192c97857dbSAmit Nagal };
193c97857dbSAmit Nagal 
194c97857dbSAmit Nagal static const struct scmi_resources resources[] = {
195c97857dbSAmit Nagal 	[0] = {
196c97857dbSAmit Nagal 		.clock = scmi0_clock,
197c97857dbSAmit Nagal 		.clock_count = ARRAY_SIZE(scmi0_clock),
198c97857dbSAmit Nagal 		.reset = scmi0_reset,
199c97857dbSAmit Nagal 		.reset_count = ARRAY_SIZE(scmi0_reset),
200c97857dbSAmit Nagal 	},
201c97857dbSAmit Nagal };
202c97857dbSAmit Nagal 
203c97857dbSAmit Nagal static const struct scmi_resources *find_resource(unsigned int agent_id)
204c97857dbSAmit Nagal {
205c97857dbSAmit Nagal 	assert(agent_id < ARRAY_SIZE(resources));
206c97857dbSAmit Nagal 
207c97857dbSAmit Nagal 	return &resources[agent_id];
208c97857dbSAmit Nagal }
209c97857dbSAmit Nagal 
210c97857dbSAmit Nagal static struct scmi_clk *clk_find(unsigned int agent_id, unsigned int scmi_id)
211c97857dbSAmit Nagal {
212c97857dbSAmit Nagal 	const struct scmi_resources *resource = find_resource(agent_id);
213c97857dbSAmit Nagal 	size_t n = 0U;
214c97857dbSAmit Nagal 	struct scmi_clk *ret = NULL;
215c97857dbSAmit Nagal 
216c97857dbSAmit Nagal 	if (resource != NULL) {
217c97857dbSAmit Nagal 		for (n = 0U; n < resource->clock_count; n++) {
218c97857dbSAmit Nagal 			if (n == scmi_id) {
219c97857dbSAmit Nagal 				ret = &resource->clock[n];
220c97857dbSAmit Nagal 				break;
221c97857dbSAmit Nagal 			}
222c97857dbSAmit Nagal 		}
223c97857dbSAmit Nagal 	}
224c97857dbSAmit Nagal 
225c97857dbSAmit Nagal 	return ret;
226c97857dbSAmit Nagal }
227c97857dbSAmit Nagal 
228c97857dbSAmit Nagal size_t plat_scmi_clock_count(unsigned int agent_id)
229c97857dbSAmit Nagal {
230c97857dbSAmit Nagal 	const struct scmi_resources *resource = find_resource(agent_id);
231c97857dbSAmit Nagal 	size_t ret;
232c97857dbSAmit Nagal 
233c97857dbSAmit Nagal 	if (resource == NULL) {
234c97857dbSAmit Nagal 		ret = 0U;
235c97857dbSAmit Nagal 	} else {
236c97857dbSAmit Nagal 		VERBOSE("SCMI: CLK: %d clocks\n", (unsigned int)resource->clock_count);
237c97857dbSAmit Nagal 
238c97857dbSAmit Nagal 		ret = resource->clock_count;
239c97857dbSAmit Nagal 	}
240c97857dbSAmit Nagal 	return ret;
241c97857dbSAmit Nagal }
242c97857dbSAmit Nagal 
243c97857dbSAmit Nagal const char *plat_scmi_clock_get_name(unsigned int agent_id, unsigned int scmi_id)
244c97857dbSAmit Nagal {
245c97857dbSAmit Nagal 	struct scmi_clk *clock = clk_find(agent_id, scmi_id);
246c97857dbSAmit Nagal 	const char *ret;
247c97857dbSAmit Nagal 
248c97857dbSAmit Nagal 	if (clock == NULL) {
249c97857dbSAmit Nagal 		ret = NULL;
250c97857dbSAmit Nagal 	} else {
251c97857dbSAmit Nagal 		VERBOSE("SCMI: CLK: id: %d, get_name: %s\n", scmi_id, clock->name);
252c97857dbSAmit Nagal 
253c97857dbSAmit Nagal 		ret = clock->name;
254c97857dbSAmit Nagal 	}
255c97857dbSAmit Nagal 	return ret;
256c97857dbSAmit Nagal };
257c97857dbSAmit Nagal 
258c97857dbSAmit Nagal /* Called by Linux */
259c97857dbSAmit Nagal int32_t plat_scmi_clock_rates_array(unsigned int agent_id, unsigned int scmi_id,
260c97857dbSAmit Nagal 				    unsigned long *array, size_t *nb_elts,
261c97857dbSAmit Nagal 				    uint32_t start_idx)
262c97857dbSAmit Nagal {
263c97857dbSAmit Nagal 	struct scmi_clk *clock = clk_find(agent_id, scmi_id);
264c97857dbSAmit Nagal 
265c97857dbSAmit Nagal 	if (clock == NULL) {
266c97857dbSAmit Nagal 		return SCMI_NOT_FOUND;
267c97857dbSAmit Nagal 	}
268c97857dbSAmit Nagal 
269c97857dbSAmit Nagal 	if (start_idx > 0) {
270c97857dbSAmit Nagal 		return SCMI_OUT_OF_RANGE;
271c97857dbSAmit Nagal 	}
272c97857dbSAmit Nagal 
273c97857dbSAmit Nagal 	if (array == NULL) {
274c97857dbSAmit Nagal 		*nb_elts = 1U;
275c97857dbSAmit Nagal 	} else if (*nb_elts == 1U) {
276c97857dbSAmit Nagal 		*array = clock->rate;
277c97857dbSAmit Nagal 		VERBOSE("SCMI: CLK: id: %d, clk_name: %s, get_rate %lu\n",
278c97857dbSAmit Nagal 		     scmi_id, clock->name, *array);
279c97857dbSAmit Nagal 	} else {
280c97857dbSAmit Nagal 		return SCMI_GENERIC_ERROR;
281c97857dbSAmit Nagal 	}
282c97857dbSAmit Nagal 
283c97857dbSAmit Nagal 	return SCMI_SUCCESS;
284c97857dbSAmit Nagal }
285c97857dbSAmit Nagal 
286c97857dbSAmit Nagal unsigned long plat_scmi_clock_get_rate(unsigned int agent_id, unsigned int scmi_id)
287c97857dbSAmit Nagal {
288c97857dbSAmit Nagal 	struct scmi_clk *clock = clk_find(agent_id, scmi_id);
289c97857dbSAmit Nagal 	unsigned long ret;
290c97857dbSAmit Nagal 
291c97857dbSAmit Nagal 	if ((clock == NULL)) {
292c97857dbSAmit Nagal 		ret = SCMI_NOT_FOUND;
293c97857dbSAmit Nagal 	} else {
294c97857dbSAmit Nagal 		VERBOSE("SCMI: CLK: id: %d, get_rate: %lu\n", scmi_id, clock->rate);
295c97857dbSAmit Nagal 		ret = clock->rate;
296c97857dbSAmit Nagal 	}
297c97857dbSAmit Nagal 	return ret;
298c97857dbSAmit Nagal }
299c97857dbSAmit Nagal 
300c97857dbSAmit Nagal int32_t plat_scmi_clock_set_rate(unsigned int agent_id, unsigned int scmi_id,
301c97857dbSAmit Nagal 				 unsigned long rate)
302c97857dbSAmit Nagal {
303c97857dbSAmit Nagal 	struct scmi_clk *clock = clk_find(agent_id, scmi_id);
304c97857dbSAmit Nagal 	unsigned long ret = UL(SCMI_SUCCESS);
305c97857dbSAmit Nagal 
306c97857dbSAmit Nagal 	if ((clock == NULL)) {
307c97857dbSAmit Nagal 		ret = SCMI_NOT_FOUND;
308c97857dbSAmit Nagal 	} else {
309c97857dbSAmit Nagal 		VERBOSE("SCMI: CLK: id: %d, set_rate: %lu\n", scmi_id, rate);
310c97857dbSAmit Nagal 		clock->rate = rate;
311c97857dbSAmit Nagal 	}
312c97857dbSAmit Nagal 	return ret;
313c97857dbSAmit Nagal }
314c97857dbSAmit Nagal 
315c97857dbSAmit Nagal int32_t plat_scmi_clock_get_state(unsigned int agent_id, unsigned int scmi_id)
316c97857dbSAmit Nagal {
317c97857dbSAmit Nagal 	struct scmi_clk *clock = clk_find(agent_id, scmi_id);
318c97857dbSAmit Nagal 	int32_t ret;
319c97857dbSAmit Nagal 
320c97857dbSAmit Nagal 	if ((clock == NULL)) {
321c97857dbSAmit Nagal 		ret = SCMI_NOT_FOUND;
322c97857dbSAmit Nagal 	} else {
323c97857dbSAmit Nagal 		VERBOSE("SCMI: CLK: id: %d, get_state: %d\n", scmi_id, clock->enabled);
324c97857dbSAmit Nagal 
325c97857dbSAmit Nagal 		if (clock->enabled) {
326c97857dbSAmit Nagal 			ret = HIGH;
327c97857dbSAmit Nagal 		} else {
328c97857dbSAmit Nagal 			ret = LOW;
329c97857dbSAmit Nagal 		}
330c97857dbSAmit Nagal 	}
331c97857dbSAmit Nagal 	return ret;
332c97857dbSAmit Nagal }
333c97857dbSAmit Nagal 
334c97857dbSAmit Nagal int32_t plat_scmi_clock_set_state(unsigned int agent_id, unsigned int scmi_id,
335c97857dbSAmit Nagal 				  bool enable_not_disable)
336c97857dbSAmit Nagal {
337c97857dbSAmit Nagal 	struct scmi_clk *clock = clk_find(agent_id, scmi_id);
338c97857dbSAmit Nagal 	int32_t ret;
339c97857dbSAmit Nagal 
340c97857dbSAmit Nagal 	if (clock == NULL) {
341c97857dbSAmit Nagal 		ret = SCMI_NOT_FOUND;
342c97857dbSAmit Nagal 	} else {
343c97857dbSAmit Nagal 		if (enable_not_disable) {
344c97857dbSAmit Nagal 			if (!clock->enabled) {
345c97857dbSAmit Nagal 				VERBOSE("SCMI: clock: %u enable\n", scmi_id);
346c97857dbSAmit Nagal 				clock->enabled = true;
347c97857dbSAmit Nagal 			}
348c97857dbSAmit Nagal 		} else {
349c97857dbSAmit Nagal 			if (clock->enabled) {
350c97857dbSAmit Nagal 				VERBOSE("SCMI: clock: %u disable\n", scmi_id);
351c97857dbSAmit Nagal 				clock->enabled = false;
352c97857dbSAmit Nagal 			}
353c97857dbSAmit Nagal 		}
354c97857dbSAmit Nagal 
355c97857dbSAmit Nagal 		VERBOSE("SCMI: CLK: id: %d, set_state: %d\n", scmi_id, clock->enabled);
356c97857dbSAmit Nagal 
357c97857dbSAmit Nagal 		ret = SCMI_SUCCESS;
358c97857dbSAmit Nagal 	}
359c97857dbSAmit Nagal 
360c97857dbSAmit Nagal 	return ret;
361c97857dbSAmit Nagal }
362c97857dbSAmit Nagal 
363c97857dbSAmit Nagal 
364c97857dbSAmit Nagal /*
365c97857dbSAmit Nagal  * Platform SCMI reset domains
366c97857dbSAmit Nagal  */
367c97857dbSAmit Nagal static struct scmi_reset *find_reset(unsigned int agent_id,
368c97857dbSAmit Nagal 					 unsigned int scmi_id)
369c97857dbSAmit Nagal {
370c97857dbSAmit Nagal 	const struct scmi_resources *resource = find_resource(agent_id);
371c97857dbSAmit Nagal 	size_t n;
372c97857dbSAmit Nagal 
373c97857dbSAmit Nagal 	if (resource != NULL) {
374c97857dbSAmit Nagal 		for (n = 0U; n < resource->reset_count; n++) {
375c97857dbSAmit Nagal 			if (n == scmi_id) {
376c97857dbSAmit Nagal 				return &resource->reset[n];
377c97857dbSAmit Nagal 			}
378c97857dbSAmit Nagal 		}
379c97857dbSAmit Nagal 	}
380c97857dbSAmit Nagal 
381c97857dbSAmit Nagal 	return NULL;
382c97857dbSAmit Nagal }
383c97857dbSAmit Nagal 
384c97857dbSAmit Nagal const char *plat_scmi_rstd_get_name(unsigned int agent_id, unsigned int scmi_id)
385c97857dbSAmit Nagal {
386c97857dbSAmit Nagal 	const struct scmi_reset *reset = find_reset(agent_id, scmi_id);
387c97857dbSAmit Nagal 
388c97857dbSAmit Nagal 	if (reset == NULL) {
389c97857dbSAmit Nagal 		return NULL;
390c97857dbSAmit Nagal 	}
391c97857dbSAmit Nagal 
392c97857dbSAmit Nagal 	return reset->name;
393c97857dbSAmit Nagal }
394c97857dbSAmit Nagal 
395c97857dbSAmit Nagal size_t plat_scmi_rstd_count(unsigned int agent_id)
396c97857dbSAmit Nagal {
397c97857dbSAmit Nagal 	const struct scmi_resources *resource = find_resource(agent_id);
398c97857dbSAmit Nagal 
399c97857dbSAmit Nagal 	if (resource == NULL) {
400c97857dbSAmit Nagal 		return 0U;
401c97857dbSAmit Nagal 	}
402c97857dbSAmit Nagal 
403c97857dbSAmit Nagal 	return resource->reset_count;
404c97857dbSAmit Nagal }
405c97857dbSAmit Nagal 
406c97857dbSAmit Nagal int32_t plat_scmi_rstd_autonomous(unsigned int agent_id, unsigned int scmi_id,
407c97857dbSAmit Nagal 				uint32_t state)
408c97857dbSAmit Nagal {
409c97857dbSAmit Nagal 	const struct scmi_reset *reset = find_reset(agent_id, scmi_id);
410c97857dbSAmit Nagal 
411c97857dbSAmit Nagal 	if (reset == NULL) {
412c97857dbSAmit Nagal 		return SCMI_NOT_FOUND;
413c97857dbSAmit Nagal 	}
414c97857dbSAmit Nagal 
415c97857dbSAmit Nagal 	/* Supports only reset with context loss */
416c97857dbSAmit Nagal 	if (state != 0U) {
417c97857dbSAmit Nagal 		return SCMI_NOT_SUPPORTED;
418c97857dbSAmit Nagal 	}
419c97857dbSAmit Nagal 
420c97857dbSAmit Nagal 	NOTICE("SCMI reset on ID %lu/%s\n",
421c97857dbSAmit Nagal 	       reset->reset_id, plat_scmi_rstd_get_name(agent_id, scmi_id));
422c97857dbSAmit Nagal 
423c97857dbSAmit Nagal 	return SCMI_SUCCESS;
424c97857dbSAmit Nagal }
425c97857dbSAmit Nagal 
426c97857dbSAmit Nagal int32_t plat_scmi_rstd_set_state(unsigned int agent_id, unsigned int scmi_id,
427c97857dbSAmit Nagal 				 bool assert_not_deassert)
428c97857dbSAmit Nagal {
429c97857dbSAmit Nagal 	const struct scmi_reset *reset = find_reset(agent_id, scmi_id);
430c97857dbSAmit Nagal 
431c97857dbSAmit Nagal 	if (reset == NULL) {
432c97857dbSAmit Nagal 		return SCMI_NOT_FOUND;
433c97857dbSAmit Nagal 	}
434c97857dbSAmit Nagal 
435c97857dbSAmit Nagal 	if (assert_not_deassert) {
436c97857dbSAmit Nagal 		NOTICE("SCMI reset %lu/%s set\n",
437c97857dbSAmit Nagal 		       reset->reset_id, plat_scmi_rstd_get_name(agent_id, scmi_id));
438*b9c20e5dSAmit Nagal 
439*b9c20e5dSAmit Nagal 		switch (scmi_id) {
440*b9c20e5dSAmit Nagal 		case RESET_UFS0_0:
441*b9c20e5dSAmit Nagal 			mmio_write_32(PMXC_CRP_RST_UFS, 1);
442*b9c20e5dSAmit Nagal 			break;
443*b9c20e5dSAmit Nagal 		case RESET_UFSPHY_0:
444*b9c20e5dSAmit Nagal 			mmio_write_32(PMXC_IOU_SLCR_PHY_RESET, 1);
445*b9c20e5dSAmit Nagal 			break;
446*b9c20e5dSAmit Nagal 		default:
447*b9c20e5dSAmit Nagal 			break;
448*b9c20e5dSAmit Nagal 		}
449c97857dbSAmit Nagal 	} else {
450c97857dbSAmit Nagal 		NOTICE("SCMI reset %lu/%s release\n",
451c97857dbSAmit Nagal 		       reset->reset_id, plat_scmi_rstd_get_name(agent_id, scmi_id));
452*b9c20e5dSAmit Nagal 
453*b9c20e5dSAmit Nagal 		switch (scmi_id) {
454*b9c20e5dSAmit Nagal 		case RESET_UFS0_0:
455*b9c20e5dSAmit Nagal 			mmio_write_32(PMXC_CRP_RST_UFS, 0);
456*b9c20e5dSAmit Nagal 			break;
457*b9c20e5dSAmit Nagal 		case RESET_UFSPHY_0:
458*b9c20e5dSAmit Nagal 			mmio_write_32(PMXC_IOU_SLCR_PHY_RESET, 0);
459*b9c20e5dSAmit Nagal 			break;
460*b9c20e5dSAmit Nagal 		default:
461*b9c20e5dSAmit Nagal 			break;
462*b9c20e5dSAmit Nagal 		}
463c97857dbSAmit Nagal 	}
464c97857dbSAmit Nagal 
465c97857dbSAmit Nagal 	return SCMI_SUCCESS;
466c97857dbSAmit Nagal }
467c97857dbSAmit Nagal 
468c97857dbSAmit Nagal /* Currently only one channel is supported. Expectation is that channel 0 is used by NS SW */
469c97857dbSAmit Nagal static struct scmi_msg_channel scmi_channel[] = {
470c97857dbSAmit Nagal 	[0] = {
471c97857dbSAmit Nagal 		.shm_addr = SMT_BUFFER_BASE,
472c97857dbSAmit Nagal 		.shm_size = SMT_BUF_SLOT_SIZE,
473c97857dbSAmit Nagal 	},
474c97857dbSAmit Nagal };
475c97857dbSAmit Nagal 
476c97857dbSAmit Nagal struct scmi_msg_channel *plat_scmi_get_channel(unsigned int agent_id)
477c97857dbSAmit Nagal {
478c97857dbSAmit Nagal 	assert(agent_id < ARRAY_SIZE(scmi_channel));
479c97857dbSAmit Nagal 
480c97857dbSAmit Nagal 	VERBOSE("%d: SCMI asking for channel\n", agent_id);
481c97857dbSAmit Nagal 
482c97857dbSAmit Nagal 	/* Just in case that code is reused */
483c97857dbSAmit Nagal 	return &scmi_channel[agent_id];
484c97857dbSAmit Nagal }
485c97857dbSAmit Nagal 
486c97857dbSAmit Nagal /* Base protocol implementations */
487c97857dbSAmit Nagal const char *plat_scmi_vendor_name(void)
488c97857dbSAmit Nagal {
489c97857dbSAmit Nagal 	return SCMI_VENDOR;
490c97857dbSAmit Nagal }
491c97857dbSAmit Nagal 
492c97857dbSAmit Nagal const char *plat_scmi_sub_vendor_name(void)
493c97857dbSAmit Nagal {
494c97857dbSAmit Nagal 	return SCMI_PRODUCT;
495c97857dbSAmit Nagal }
496c97857dbSAmit Nagal 
497c97857dbSAmit Nagal /* Currently supporting Clocks and Reset Domains */
498c97857dbSAmit Nagal static const uint8_t plat_protocol_list[] = {
499c97857dbSAmit Nagal 	SCMI_PROTOCOL_ID_BASE,
500c97857dbSAmit Nagal 	SCMI_PROTOCOL_ID_CLOCK,
501c97857dbSAmit Nagal 	SCMI_PROTOCOL_ID_RESET_DOMAIN,
502c97857dbSAmit Nagal 	/*
503c97857dbSAmit Nagal 	 *SCMI_PROTOCOL_ID_POWER_DOMAIN,
504c97857dbSAmit Nagal 	 *SCMI_PROTOCOL_ID_SENSOR,
505c97857dbSAmit Nagal 	 */
506c97857dbSAmit Nagal 	0U /* Null termination */
507c97857dbSAmit Nagal };
508c97857dbSAmit Nagal 
509c97857dbSAmit Nagal size_t plat_scmi_protocol_count(void)
510c97857dbSAmit Nagal {
511c97857dbSAmit Nagal 	const size_t count = ARRAY_SIZE(plat_protocol_list) - 1U;
512c97857dbSAmit Nagal 
513c97857dbSAmit Nagal 	VERBOSE("SCMI: Protocol count: %d\n", (int32_t)count);
514c97857dbSAmit Nagal 
515c97857dbSAmit Nagal 	return count;
516c97857dbSAmit Nagal }
517c97857dbSAmit Nagal 
518c97857dbSAmit Nagal const uint8_t *plat_scmi_protocol_list(unsigned int agent_id __unused)
519c97857dbSAmit Nagal {
520c97857dbSAmit Nagal 	return plat_protocol_list;
521c97857dbSAmit Nagal }
522c97857dbSAmit Nagal 
523c97857dbSAmit Nagal void init_scmi_server(void)
524c97857dbSAmit Nagal {
525c97857dbSAmit Nagal 	size_t i;
526c97857dbSAmit Nagal 	int32_t ret;
527c97857dbSAmit Nagal 
528c97857dbSAmit Nagal 	for (i = 0U; i < ARRAY_SIZE(scmi_channel); i++)
529c97857dbSAmit Nagal 		scmi_smt_init_agent_channel(&scmi_channel[i]);
530c97857dbSAmit Nagal 
531c97857dbSAmit Nagal 	INFO("SCMI: Server initialized\n");
532c97857dbSAmit Nagal 
533c97857dbSAmit Nagal 	if (platform_id == QEMU) {
534c97857dbSAmit Nagal 		/* default setting is for QEMU */
535c97857dbSAmit Nagal 	} else if (platform_id == SPP) {
536c97857dbSAmit Nagal 		for (i = 0U; i < ARRAY_SIZE(scmi0_clock); i++) {
537c97857dbSAmit Nagal 
538c97857dbSAmit Nagal 			/* Keep i2c on 100MHz to calculate rates properly */
539c97857dbSAmit Nagal 			if (i >= CLK_I2C0_0 && i <= CLK_I2C7_0)
540c97857dbSAmit Nagal 				continue;
541c97857dbSAmit Nagal 			/*
542c97857dbSAmit Nagal 			 * SPP supports multiple versions.
543c97857dbSAmit Nagal 			 * The cpu_clock value is set to corresponding SPP
544c97857dbSAmit Nagal 			 * version in early platform setup, resuse the same
545c97857dbSAmit Nagal 			 * value here.
546c97857dbSAmit Nagal 			 */
547c97857dbSAmit Nagal 			ret = plat_scmi_clock_set_rate(0, i, cpu_clock);
548c97857dbSAmit Nagal 			if (ret < 0) {
549c97857dbSAmit Nagal 				NOTICE("Failed to set clock rate for SPP scmi_id=%ld\n", i);
550c97857dbSAmit Nagal 			}
551c97857dbSAmit Nagal 		}
552c97857dbSAmit Nagal 	} else {
553c97857dbSAmit Nagal 		 /* Making MISRA C 2012 15.7 compliant */
554c97857dbSAmit Nagal 	}
555c97857dbSAmit Nagal }
556