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> 13*5202cb39SYann Gautier #include <drivers/delay_timer.h> 143f9c9784SYann Gautier #include <drivers/st/stm32mp_reset.h> 1509d40e0eSAntonio Nino Diaz #include <lib/mmio.h> 1609d40e0eSAntonio Nino Diaz #include <lib/utils_def.h> 177839a050SYann Gautier 18*5202cb39SYann Gautier #define RESET_TIMEOUT_US_1MS U(1000) 19*5202cb39SYann Gautier 20*5202cb39SYann Gautier static uint32_t id2reg_offset(unsigned int reset_id) 21*5202cb39SYann Gautier { 22*5202cb39SYann Gautier return ((reset_id & GENMASK(31, 5)) >> 5) * sizeof(uint32_t); 23*5202cb39SYann Gautier } 24*5202cb39SYann Gautier 25*5202cb39SYann Gautier static uint8_t id2reg_bit_pos(unsigned int reset_id) 26*5202cb39SYann Gautier { 27*5202cb39SYann Gautier return (uint8_t)(reset_id & GENMASK(4, 0)); 28*5202cb39SYann Gautier } 297839a050SYann Gautier 303f9c9784SYann Gautier void stm32mp_reset_assert(uint32_t id) 317839a050SYann Gautier { 32*5202cb39SYann Gautier uint32_t offset = id2reg_offset(id); 33*5202cb39SYann Gautier uint32_t bitmsk = BIT(id2reg_bit_pos(id)); 34*5202cb39SYann Gautier uint64_t timeout_ref; 357ae58c6bSYann Gautier uintptr_t rcc_base = stm32mp_rcc_base(); 367839a050SYann Gautier 37*5202cb39SYann Gautier mmio_write_32(rcc_base + offset, bitmsk); 38*5202cb39SYann Gautier 39*5202cb39SYann Gautier timeout_ref = timeout_init_us(RESET_TIMEOUT_US_1MS); 40*5202cb39SYann Gautier while ((mmio_read_32(rcc_base + offset) & bitmsk) == 0U) { 41*5202cb39SYann Gautier if (timeout_elapsed(timeout_ref)) { 42*5202cb39SYann Gautier panic(); 43*5202cb39SYann Gautier } 447839a050SYann Gautier } 457839a050SYann Gautier } 467839a050SYann Gautier 473f9c9784SYann Gautier void stm32mp_reset_deassert(uint32_t id) 487839a050SYann Gautier { 49*5202cb39SYann Gautier uint32_t offset = id2reg_offset(id) + RCC_RSTCLRR_OFFSET; 50*5202cb39SYann Gautier uint32_t bitmsk = BIT(id2reg_bit_pos(id)); 51*5202cb39SYann Gautier uint64_t timeout_ref; 527ae58c6bSYann Gautier uintptr_t rcc_base = stm32mp_rcc_base(); 537839a050SYann Gautier 54*5202cb39SYann Gautier mmio_write_32(rcc_base + offset, bitmsk); 55*5202cb39SYann Gautier 56*5202cb39SYann Gautier timeout_ref = timeout_init_us(RESET_TIMEOUT_US_1MS); 57*5202cb39SYann Gautier while ((mmio_read_32(rcc_base + offset) & bitmsk) != 0U) { 58*5202cb39SYann Gautier if (timeout_elapsed(timeout_ref)) { 59*5202cb39SYann Gautier panic(); 60*5202cb39SYann Gautier } 617839a050SYann Gautier } 627839a050SYann Gautier } 63