1dddba19aSStephan Gerhold /* 2dddba19aSStephan Gerhold * Copyright (c) 2021, Stephan Gerhold <stephan@gerhold.net> 3dddba19aSStephan Gerhold * 4dddba19aSStephan Gerhold * SPDX-License-Identifier: BSD-3-Clause 5dddba19aSStephan Gerhold */ 6dddba19aSStephan Gerhold 7dddba19aSStephan Gerhold #include <arch.h> 8dddba19aSStephan Gerhold #include <common/debug.h> 9*a758c0b6SStephan Gerhold #include <drivers/arm/gicv2.h> 10dddba19aSStephan Gerhold #include <drivers/delay_timer.h> 11dddba19aSStephan Gerhold #include <lib/mmio.h> 12dddba19aSStephan Gerhold #include <lib/psci/psci.h> 13dddba19aSStephan Gerhold #include <plat/common/platform.h> 14dddba19aSStephan Gerhold 15dddba19aSStephan Gerhold #include <msm8916_mmap.h> 16*a758c0b6SStephan Gerhold #include "msm8916_pm.h" 17*a758c0b6SStephan Gerhold 18*a758c0b6SStephan Gerhold static int msm8916_pwr_domain_on(u_register_t mpidr) 19*a758c0b6SStephan Gerhold { 20*a758c0b6SStephan Gerhold unsigned int core = MPIDR_AFFLVL0_VAL(mpidr); 21*a758c0b6SStephan Gerhold 22*a758c0b6SStephan Gerhold VERBOSE("PSCI: Booting CPU %d\n", core); 23*a758c0b6SStephan Gerhold msm8916_cpu_boot(core); 24*a758c0b6SStephan Gerhold 25*a758c0b6SStephan Gerhold return PSCI_E_SUCCESS; 26*a758c0b6SStephan Gerhold } 27*a758c0b6SStephan Gerhold 28*a758c0b6SStephan Gerhold static void msm8916_pwr_domain_on_finish(const psci_power_state_t *target_state) 29*a758c0b6SStephan Gerhold { 30*a758c0b6SStephan Gerhold gicv2_pcpu_distif_init(); 31*a758c0b6SStephan Gerhold gicv2_cpuif_enable(); 32*a758c0b6SStephan Gerhold } 33dddba19aSStephan Gerhold 34dddba19aSStephan Gerhold static void __dead2 msm8916_system_reset(void) 35dddba19aSStephan Gerhold { 36dddba19aSStephan Gerhold mmio_write_32(MPM_PS_HOLD, 0); 37dddba19aSStephan Gerhold mdelay(1000); 38dddba19aSStephan Gerhold 39dddba19aSStephan Gerhold ERROR("PSCI: System reset failed\n"); 40dddba19aSStephan Gerhold panic(); 41dddba19aSStephan Gerhold } 42dddba19aSStephan Gerhold 43dddba19aSStephan Gerhold static const plat_psci_ops_t msm8916_psci_ops = { 44*a758c0b6SStephan Gerhold .pwr_domain_on = msm8916_pwr_domain_on, 45*a758c0b6SStephan Gerhold .pwr_domain_on_finish = msm8916_pwr_domain_on_finish, 46dddba19aSStephan Gerhold .system_off = msm8916_system_reset, 47dddba19aSStephan Gerhold .system_reset = msm8916_system_reset, 48dddba19aSStephan Gerhold }; 49dddba19aSStephan Gerhold 50dddba19aSStephan Gerhold /* Defined and used in msm8916_helpers.S */ 51dddba19aSStephan Gerhold extern uintptr_t msm8916_entry_point; 52dddba19aSStephan Gerhold 53dddba19aSStephan Gerhold int plat_setup_psci_ops(uintptr_t sec_entrypoint, 54dddba19aSStephan Gerhold const plat_psci_ops_t **psci_ops) 55dddba19aSStephan Gerhold { 56dddba19aSStephan Gerhold msm8916_entry_point = sec_entrypoint; 57dddba19aSStephan Gerhold *psci_ops = &msm8916_psci_ops; 58dddba19aSStephan Gerhold return 0; 59dddba19aSStephan Gerhold } 60