forked from Minki/linux
2874c5fd28
Based on 1 normalized pattern(s): this program is free software you can redistribute it and or modify it under the terms of the gnu general public license as published by the free software foundation either version 2 of the license or at your option any later version extracted by the scancode license scanner the SPDX license identifier GPL-2.0-or-later has been chosen to replace the boilerplate/reference in 3029 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Allison Randal <allison@lohutok.net> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190527070032.746973796@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
78 lines
1.9 KiB
C
78 lines
1.9 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* Copyright (C) 1999 ARM Limited
|
|
* Copyright (C) 2000 Deep Blue Solutions Ltd
|
|
* Copyright 2006-2007,2010 Freescale Semiconductor, Inc. All Rights Reserved.
|
|
* Copyright 2008 Juergen Beisert, kernel@pengutronix.de
|
|
* Copyright 2009 Ilya Yanok, Emcraft Systems Ltd, yanok@emcraft.com
|
|
* Copyright (C) 2011 Wolfram Sang, Pengutronix e.K.
|
|
*/
|
|
|
|
#include <linux/io.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/compiler.h>
|
|
#include <linux/export.h>
|
|
#include <linux/stmp_device.h>
|
|
|
|
#define STMP_MODULE_CLKGATE (1 << 30)
|
|
#define STMP_MODULE_SFTRST (1 << 31)
|
|
|
|
/*
|
|
* Clear the bit and poll it cleared. This is usually called with
|
|
* a reset address and mask being either SFTRST(bit 31) or CLKGATE
|
|
* (bit 30).
|
|
*/
|
|
static int stmp_clear_poll_bit(void __iomem *addr, u32 mask)
|
|
{
|
|
int timeout = 0x400;
|
|
|
|
writel(mask, addr + STMP_OFFSET_REG_CLR);
|
|
udelay(1);
|
|
while ((readl(addr) & mask) && --timeout)
|
|
/* nothing */;
|
|
|
|
return !timeout;
|
|
}
|
|
|
|
int stmp_reset_block(void __iomem *reset_addr)
|
|
{
|
|
int ret;
|
|
int timeout = 0x400;
|
|
|
|
/* clear and poll SFTRST */
|
|
ret = stmp_clear_poll_bit(reset_addr, STMP_MODULE_SFTRST);
|
|
if (unlikely(ret))
|
|
goto error;
|
|
|
|
/* clear CLKGATE */
|
|
writel(STMP_MODULE_CLKGATE, reset_addr + STMP_OFFSET_REG_CLR);
|
|
|
|
/* set SFTRST to reset the block */
|
|
writel(STMP_MODULE_SFTRST, reset_addr + STMP_OFFSET_REG_SET);
|
|
udelay(1);
|
|
|
|
/* poll CLKGATE becoming set */
|
|
while ((!(readl(reset_addr) & STMP_MODULE_CLKGATE)) && --timeout)
|
|
/* nothing */;
|
|
if (unlikely(!timeout))
|
|
goto error;
|
|
|
|
/* clear and poll SFTRST */
|
|
ret = stmp_clear_poll_bit(reset_addr, STMP_MODULE_SFTRST);
|
|
if (unlikely(ret))
|
|
goto error;
|
|
|
|
/* clear and poll CLKGATE */
|
|
ret = stmp_clear_poll_bit(reset_addr, STMP_MODULE_CLKGATE);
|
|
if (unlikely(ret))
|
|
goto error;
|
|
|
|
return 0;
|
|
|
|
error:
|
|
pr_err("%s(%p): module reset timeout\n", __func__, reset_addr);
|
|
return -ETIMEDOUT;
|
|
}
|
|
EXPORT_SYMBOL(stmp_reset_block);
|