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