1 /* 2 * Copyright (c) 2018-2019, STMicroelectronics - All Rights Reserved 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7 #include <limits.h> 8 9 #include <platform_def.h> 10 11 #include <common/bl_common.h> 12 #include <common/debug.h> 13 #include <drivers/st/stm32mp_reset.h> 14 #include <lib/mmio.h> 15 #include <lib/utils_def.h> 16 17 #define RST_CLR_OFFSET 4U 18 19 void stm32mp_reset_assert(uint32_t id) 20 { 21 uint32_t offset = (id / (uint32_t)__LONG_BIT) * sizeof(uintptr_t); 22 uint32_t bit = id % (uint32_t)__LONG_BIT; 23 uintptr_t rcc_base = stm32mp_rcc_base(); 24 25 mmio_write_32(rcc_base + offset, BIT(bit)); 26 while ((mmio_read_32(rcc_base + offset) & BIT(bit)) == 0U) { 27 ; 28 } 29 } 30 31 void stm32mp_reset_deassert(uint32_t id) 32 { 33 uint32_t offset = ((id / (uint32_t)__LONG_BIT) * sizeof(uintptr_t)) + 34 RST_CLR_OFFSET; 35 uint32_t bit = id % (uint32_t)__LONG_BIT; 36 uintptr_t rcc_base = stm32mp_rcc_base(); 37 38 mmio_write_32(rcc_base + offset, BIT(bit)); 39 while ((mmio_read_32(rcc_base + offset) & BIT(bit)) != 0U) { 40 ; 41 } 42 } 43