1 /* 2 * Copyright (c) 2017-2021, ARM Limited and Contributors. All rights reserved. 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7 #include <arch_helpers.h> 8 #include <common/debug.h> 9 #include <drivers/arm/gicv2.h> 10 #include <drivers/delay_timer.h> 11 #include <lib/mmio.h> 12 #include <lib/psci/psci.h> 13 14 #include <sunxi_mmap.h> 15 #include <sunxi_private.h> 16 17 #define SUNXI_WDOG0_CTRL_REG (SUNXI_R_WDOG_BASE + 0x0010) 18 #define SUNXI_WDOG0_CFG_REG (SUNXI_R_WDOG_BASE + 0x0014) 19 #define SUNXI_WDOG0_MODE_REG (SUNXI_R_WDOG_BASE + 0x0018) 20 21 static int sunxi_pwr_domain_on(u_register_t mpidr) 22 { 23 sunxi_cpu_on(mpidr); 24 25 return PSCI_E_SUCCESS; 26 } 27 28 static void sunxi_pwr_domain_off(const psci_power_state_t *target_state) 29 { 30 gicv2_cpuif_disable(); 31 32 sunxi_cpu_power_off_self(); 33 } 34 35 static void sunxi_pwr_domain_on_finish(const psci_power_state_t *target_state) 36 { 37 gicv2_pcpu_distif_init(); 38 gicv2_cpuif_enable(); 39 } 40 41 static void __dead2 sunxi_system_off(void) 42 { 43 gicv2_cpuif_disable(); 44 45 /* Attempt to power down the board (may not return) */ 46 sunxi_power_down(); 47 48 /* Turn off all CPUs */ 49 sunxi_cpu_power_off_others(); 50 sunxi_cpu_power_off_self(); 51 psci_power_down_wfi(); 52 /* should never reach here */ 53 panic(); 54 } 55 56 static void __dead2 sunxi_system_reset(void) 57 { 58 gicv2_cpuif_disable(); 59 60 /* Reset the whole system when the watchdog times out */ 61 mmio_write_32(SUNXI_WDOG0_CFG_REG, 1); 62 /* Enable the watchdog with the shortest timeout (0.5 seconds) */ 63 mmio_write_32(SUNXI_WDOG0_MODE_REG, (0 << 4) | 1); 64 /* Wait for twice the watchdog timeout before panicking */ 65 mdelay(1000); 66 67 ERROR("PSCI: System reset failed\n"); 68 panic(); 69 } 70 71 static const plat_psci_ops_t sunxi_native_psci_ops = { 72 .pwr_domain_on = sunxi_pwr_domain_on, 73 .pwr_domain_off = sunxi_pwr_domain_off, 74 .pwr_domain_on_finish = sunxi_pwr_domain_on_finish, 75 .system_off = sunxi_system_off, 76 .system_reset = sunxi_system_reset, 77 .validate_ns_entrypoint = sunxi_validate_ns_entrypoint, 78 }; 79 80 void sunxi_set_native_psci_ops(const plat_psci_ops_t **psci_ops) 81 { 82 *psci_ops = &sunxi_native_psci_ops; 83 } 84