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