From: Heiko Schocher Date: Mon, 4 Nov 2013 07:40:45 +0100 Subject: [U-Boot] [PATCH v2 2/4] arm, at91: add function for waiting if reset ends In-Reply-To: <1383547247-7017-1-git-send-email-hs@denx.de> References: <1383547247-7017-1-git-send-email-hs@denx.de> Message-ID: <1383547247-7017-3-git-send-email-hs@denx.de> List-Id: MIME-Version: 1.0 Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit To: u-boot@lists.denx.de add function for waiting if reset ends. If reset never ends, timeout and print an error message. Signed-off-by: Heiko Schocher Cc: Bo Shen Cc: Andreas Bie?mann --- - changes for v2: - new in v2 --- arch/arm/cpu/arm926ejs/at91/reset.c | 15 +++++++++++++++ arch/arm/include/asm/arch-at91/at91_rstc.h | 1 + 2 files changed, 16 insertions(+) diff --git a/arch/arm/cpu/arm926ejs/at91/reset.c b/arch/arm/cpu/arm926ejs/at91/reset.c index e67f47b..03b661c 100644 --- a/arch/arm/cpu/arm926ejs/at91/reset.c +++ b/arch/arm/cpu/arm926ejs/at91/reset.c @@ -27,3 +27,18 @@ void reset_cpu(ulong ignored) while (1) ; } + +void at91_wait_for_reset(int timeout) +{ + struct at91_rstc *rstc = (struct at91_rstc *)ATMEL_BASE_RSTC; + int count = 0; + + while (!(readl(&rstc->sr) & AT91_RSTC_SR_NRSTL)) { + if (count >= timeout) { + printf("reset timeout.\n"); + return; + } + udelay(10); + timeout++; + } +} diff --git a/arch/arm/include/asm/arch-at91/at91_rstc.h b/arch/arm/include/asm/arch-at91/at91_rstc.h index a942342..7f4e59f 100644 --- a/arch/arm/include/asm/arch-at91/at91_rstc.h +++ b/arch/arm/include/asm/arch-at91/at91_rstc.h @@ -23,6 +23,7 @@ typedef struct at91_rstc { u32 mr; /* Reset Controller Mode Register */ } at91_rstc_t; +void at91_wait_for_reset(int timeout); #endif /* __ASSEMBLY__ */ #define AT91_RSTC_KEY 0xA5000000 -- 1.8.3.1