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 7*45c70e68SEtienne Carriere #include <errno.h> 87839a050SYann Gautier #include <limits.h> 909d40e0eSAntonio Nino Diaz 107839a050SYann Gautier #include <platform_def.h> 1109d40e0eSAntonio Nino Diaz 1209d40e0eSAntonio Nino Diaz #include <common/bl_common.h> 1309d40e0eSAntonio Nino Diaz #include <common/debug.h> 145202cb39SYann Gautier #include <drivers/delay_timer.h> 153f9c9784SYann Gautier #include <drivers/st/stm32mp_reset.h> 1609d40e0eSAntonio Nino Diaz #include <lib/mmio.h> 1709d40e0eSAntonio Nino Diaz #include <lib/utils_def.h> 187839a050SYann Gautier 195202cb39SYann Gautier static uint32_t id2reg_offset(unsigned int reset_id) 205202cb39SYann Gautier { 215202cb39SYann Gautier return ((reset_id & GENMASK(31, 5)) >> 5) * sizeof(uint32_t); 225202cb39SYann Gautier } 235202cb39SYann Gautier 245202cb39SYann Gautier static uint8_t id2reg_bit_pos(unsigned int reset_id) 255202cb39SYann Gautier { 265202cb39SYann Gautier return (uint8_t)(reset_id & GENMASK(4, 0)); 275202cb39SYann Gautier } 287839a050SYann Gautier 29*45c70e68SEtienne Carriere int stm32mp_reset_assert(uint32_t id, unsigned int to_us) 307839a050SYann Gautier { 315202cb39SYann Gautier uint32_t offset = id2reg_offset(id); 325202cb39SYann Gautier uint32_t bitmsk = BIT(id2reg_bit_pos(id)); 337ae58c6bSYann Gautier uintptr_t rcc_base = stm32mp_rcc_base(); 347839a050SYann Gautier 355202cb39SYann Gautier mmio_write_32(rcc_base + offset, bitmsk); 365202cb39SYann Gautier 37*45c70e68SEtienne Carriere if (to_us != 0U) { 38*45c70e68SEtienne Carriere uint64_t timeout_ref = timeout_init_us(to_us); 39*45c70e68SEtienne Carriere 405202cb39SYann Gautier while ((mmio_read_32(rcc_base + offset) & bitmsk) == 0U) { 415202cb39SYann Gautier if (timeout_elapsed(timeout_ref)) { 42*45c70e68SEtienne Carriere return -ETIMEDOUT; 435202cb39SYann Gautier } 447839a050SYann Gautier } 457839a050SYann Gautier } 467839a050SYann Gautier 47*45c70e68SEtienne Carriere return 0; 48*45c70e68SEtienne Carriere } 49*45c70e68SEtienne Carriere 50*45c70e68SEtienne Carriere int stm32mp_reset_deassert(uint32_t id, unsigned int to_us) 517839a050SYann Gautier { 525202cb39SYann Gautier uint32_t offset = id2reg_offset(id) + RCC_RSTCLRR_OFFSET; 535202cb39SYann Gautier uint32_t bitmsk = BIT(id2reg_bit_pos(id)); 547ae58c6bSYann Gautier uintptr_t rcc_base = stm32mp_rcc_base(); 557839a050SYann Gautier 565202cb39SYann Gautier mmio_write_32(rcc_base + offset, bitmsk); 575202cb39SYann Gautier 58*45c70e68SEtienne Carriere if (to_us != 0U) { 59*45c70e68SEtienne Carriere uint64_t timeout_ref = timeout_init_us(to_us); 60*45c70e68SEtienne Carriere 615202cb39SYann Gautier while ((mmio_read_32(rcc_base + offset) & bitmsk) != 0U) { 625202cb39SYann Gautier if (timeout_elapsed(timeout_ref)) { 63*45c70e68SEtienne Carriere return -ETIMEDOUT; 645202cb39SYann Gautier } 657839a050SYann Gautier } 667839a050SYann Gautier } 67*45c70e68SEtienne Carriere 68*45c70e68SEtienne Carriere return 0; 69*45c70e68SEtienne Carriere } 70