1 /* 2 * Copyright (c) 2018-2023, Arm Limited and Contributors. All rights reserved. 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7 #include <assert.h> 8 9 #include <libfdt.h> 10 11 #include <common/bl_common.h> 12 #include <common/debug.h> 13 #include <drivers/arm/css/css_mhu_doorbell.h> 14 #include <drivers/arm/css/scmi.h> 15 #include <plat/arm/common/plat_arm.h> 16 17 #include <plat/common/platform.h> 18 19 #include <plat/arm/css/common/css_pm.h> 20 21 #include <sgi_ras.h> 22 #include <sgi_variant.h> 23 24 sgi_platform_info_t sgi_plat_info; 25 26 static scmi_channel_plat_info_t sgi575_scmi_plat_info = { 27 .scmi_mbx_mem = CSS_SCMI_PAYLOAD_BASE, 28 .db_reg_addr = PLAT_CSS_MHU_BASE + CSS_SCMI_MHU_DB_REG_OFF, 29 .db_preserve_mask = 0xfffffffe, 30 .db_modify_mask = 0x1, 31 .ring_doorbell = &mhu_ring_doorbell, 32 }; 33 34 static scmi_channel_plat_info_t plat_rd_scmi_info[] = { 35 { 36 .scmi_mbx_mem = CSS_SCMI_PAYLOAD_BASE, 37 .db_reg_addr = PLAT_CSS_MHU_BASE + SENDER_REG_SET(0), 38 .db_preserve_mask = 0xfffffffe, 39 .db_modify_mask = 0x1, 40 .ring_doorbell = &mhuv2_ring_doorbell, 41 }, 42 #if (CSS_SGI_CHIP_COUNT > 1) 43 { 44 .scmi_mbx_mem = CSS_SCMI_PAYLOAD_BASE + 45 CSS_SGI_REMOTE_CHIP_MEM_OFFSET(1), 46 .db_reg_addr = PLAT_CSS_MHU_BASE 47 + CSS_SGI_REMOTE_CHIP_MEM_OFFSET(1) + SENDER_REG_SET(0), 48 .db_preserve_mask = 0xfffffffe, 49 .db_modify_mask = 0x1, 50 .ring_doorbell = &mhuv2_ring_doorbell, 51 }, 52 #endif 53 #if (CSS_SGI_CHIP_COUNT > 2) 54 { 55 .scmi_mbx_mem = CSS_SCMI_PAYLOAD_BASE + 56 CSS_SGI_REMOTE_CHIP_MEM_OFFSET(2), 57 .db_reg_addr = PLAT_CSS_MHU_BASE + 58 CSS_SGI_REMOTE_CHIP_MEM_OFFSET(2) + SENDER_REG_SET(0), 59 .db_preserve_mask = 0xfffffffe, 60 .db_modify_mask = 0x1, 61 .ring_doorbell = &mhuv2_ring_doorbell, 62 }, 63 #endif 64 #if (CSS_SGI_CHIP_COUNT > 3) 65 { 66 .scmi_mbx_mem = CSS_SCMI_PAYLOAD_BASE + 67 CSS_SGI_REMOTE_CHIP_MEM_OFFSET(3), 68 .db_reg_addr = PLAT_CSS_MHU_BASE + 69 CSS_SGI_REMOTE_CHIP_MEM_OFFSET(3) + SENDER_REG_SET(0), 70 .db_preserve_mask = 0xfffffffe, 71 .db_modify_mask = 0x1, 72 .ring_doorbell = &mhuv2_ring_doorbell, 73 }, 74 #endif 75 }; 76 77 scmi_channel_plat_info_t *plat_css_get_scmi_info(unsigned int channel_id) 78 { 79 if (sgi_plat_info.platform_id == RD_N1E1_EDGE_SID_VER_PART_NUM || 80 sgi_plat_info.platform_id == RD_V1_SID_VER_PART_NUM || 81 sgi_plat_info.platform_id == RD_N2_SID_VER_PART_NUM || 82 sgi_plat_info.platform_id == RD_V2_SID_VER_PART_NUM || 83 sgi_plat_info.platform_id == RD_N2_CFG1_SID_VER_PART_NUM || 84 sgi_plat_info.platform_id == RD_N2_CFG3_SID_VER_PART_NUM) { 85 if (channel_id >= ARRAY_SIZE(plat_rd_scmi_info)) 86 panic(); 87 return &plat_rd_scmi_info[channel_id]; 88 } 89 else if (sgi_plat_info.platform_id == SGI575_SSC_VER_PART_NUM) 90 return &sgi575_scmi_plat_info; 91 else 92 panic(); 93 } 94 95 void bl31_early_platform_setup2(u_register_t arg0, u_register_t arg1, 96 u_register_t arg2, u_register_t arg3) 97 { 98 sgi_plat_info.platform_id = plat_arm_sgi_get_platform_id(); 99 sgi_plat_info.config_id = plat_arm_sgi_get_config_id(); 100 sgi_plat_info.multi_chip_mode = plat_arm_sgi_get_multi_chip_mode(); 101 102 arm_bl31_early_platform_setup((void *)arg0, arg1, arg2, (void *)arg3); 103 } 104 105 void sgi_bl31_common_platform_setup(void) 106 { 107 arm_bl31_platform_setup(); 108 109 /* Configure the warm reboot SGI for primary core */ 110 css_setup_cpu_pwr_down_intr(); 111 112 #if CSS_SYSTEM_GRACEFUL_RESET 113 /* Register priority level handlers for reboot */ 114 ehf_register_priority_handler(PLAT_REBOOT_PRI, 115 css_reboot_interrupt_handler); 116 #endif 117 } 118 119 const plat_psci_ops_t *plat_arm_psci_override_pm_ops(plat_psci_ops_t *ops) 120 { 121 /* 122 * For RD-E1-Edge, only CPU power ON/OFF, PSCI platform callbacks are 123 * supported. 124 */ 125 if (((sgi_plat_info.platform_id == RD_N1E1_EDGE_SID_VER_PART_NUM) && 126 (sgi_plat_info.config_id == RD_E1_EDGE_CONFIG_ID))) { 127 ops->cpu_standby = NULL; 128 ops->system_off = NULL; 129 ops->system_reset = NULL; 130 ops->get_sys_suspend_power_state = NULL; 131 ops->pwr_domain_suspend = NULL; 132 ops->pwr_domain_suspend_finish = NULL; 133 } 134 135 return css_scmi_override_pm_ops(ops); 136 } 137