17839a050SYann Gautier /* 23f9c9784SYann Gautier * Copyright (c) 2018-2019, STMicroelectronics - All Rights Reserved 37839a050SYann Gautier * 47839a050SYann Gautier * SPDX-License-Identifier: BSD-3-Clause 57839a050SYann Gautier */ 67839a050SYann Gautier 77839a050SYann Gautier #include <limits.h> 809d40e0eSAntonio Nino Diaz 97839a050SYann Gautier #include <platform_def.h> 1009d40e0eSAntonio Nino Diaz 1109d40e0eSAntonio Nino Diaz #include <common/bl_common.h> 1209d40e0eSAntonio Nino Diaz #include <common/debug.h> 133f9c9784SYann Gautier #include <drivers/st/stm32mp_reset.h> 1409d40e0eSAntonio Nino Diaz #include <lib/mmio.h> 1509d40e0eSAntonio Nino Diaz #include <lib/utils_def.h> 167839a050SYann Gautier 177839a050SYann Gautier #define RST_CLR_OFFSET 4U 187839a050SYann Gautier 193f9c9784SYann Gautier void stm32mp_reset_assert(uint32_t id) 207839a050SYann Gautier { 217839a050SYann Gautier uint32_t offset = (id / (uint32_t)__LONG_BIT) * sizeof(uintptr_t); 227839a050SYann Gautier uint32_t bit = id % (uint32_t)__LONG_BIT; 23*7ae58c6bSYann Gautier uintptr_t rcc_base = stm32mp_rcc_base(); 247839a050SYann Gautier 25*7ae58c6bSYann Gautier mmio_write_32(rcc_base + offset, BIT(bit)); 26*7ae58c6bSYann Gautier while ((mmio_read_32(rcc_base + offset) & BIT(bit)) == 0U) { 277839a050SYann Gautier ; 287839a050SYann Gautier } 297839a050SYann Gautier } 307839a050SYann Gautier 313f9c9784SYann Gautier void stm32mp_reset_deassert(uint32_t id) 327839a050SYann Gautier { 337839a050SYann Gautier uint32_t offset = ((id / (uint32_t)__LONG_BIT) * sizeof(uintptr_t)) + 347839a050SYann Gautier RST_CLR_OFFSET; 357839a050SYann Gautier uint32_t bit = id % (uint32_t)__LONG_BIT; 36*7ae58c6bSYann Gautier uintptr_t rcc_base = stm32mp_rcc_base(); 377839a050SYann Gautier 38*7ae58c6bSYann Gautier mmio_write_32(rcc_base + offset, BIT(bit)); 39*7ae58c6bSYann Gautier while ((mmio_read_32(rcc_base + offset) & BIT(bit)) != 0U) { 407839a050SYann Gautier ; 417839a050SYann Gautier } 427839a050SYann Gautier } 43