2874c5fd28426 (Thomas Gleixner 2019-05-27 08:55:01 +0200 1) // SPDX-License-Identifier: GPL-2.0-or-later
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 2) /*
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 3) * Copyright (C) 1999 ARM Limited
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 4) * Copyright (C) 2000 Deep Blue Solutions Ltd
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 5) * Copyright 2006-2007,2010 Freescale Semiconductor, Inc. All Rights Reserved.
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 6) * Copyright 2008 Juergen Beisert, kernel@pengutronix.de
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 7) * Copyright 2009 Ilya Yanok, Emcraft Systems Ltd, yanok@emcraft.com
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 8) * Copyright (C) 2011 Wolfram Sang, Pengutronix e.K.
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 9) */
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 10)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 11) #include <linux/io.h>
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 12) #include <linux/errno.h>
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 13) #include <linux/delay.h>
b6d4f3221d7fe (Rasmus Villemoes 2015-02-12 15:03:13 -0800 14) #include <linux/compiler.h>
b6d4f3221d7fe (Rasmus Villemoes 2015-02-12 15:03:13 -0800 15) #include <linux/export.h>
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 16) #include <linux/stmp_device.h>
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 17)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 18) #define STMP_MODULE_CLKGATE (1 << 30)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 19) #define STMP_MODULE_SFTRST (1 << 31)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 20)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 21) /*
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 22) * Clear the bit and poll it cleared. This is usually called with
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 23) * a reset address and mask being either SFTRST(bit 31) or CLKGATE
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 24) * (bit 30).
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 25) */
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 26) static int stmp_clear_poll_bit(void __iomem *addr, u32 mask)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 27) {
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 28) int timeout = 0x400;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 29)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 30) writel(mask, addr + STMP_OFFSET_REG_CLR);
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 31) udelay(1);
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 32) while ((readl(addr) & mask) && --timeout)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 33) /* nothing */;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 34)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 35) return !timeout;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 36) }
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 37)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 38) int stmp_reset_block(void __iomem *reset_addr)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 39) {
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 40) int ret;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 41) int timeout = 0x400;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 42)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 43) /* clear and poll SFTRST */
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 44) ret = stmp_clear_poll_bit(reset_addr, STMP_MODULE_SFTRST);
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 45) if (unlikely(ret))
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 46) goto error;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 47)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 48) /* clear CLKGATE */
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 49) writel(STMP_MODULE_CLKGATE, reset_addr + STMP_OFFSET_REG_CLR);
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 50)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 51) /* set SFTRST to reset the block */
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 52) writel(STMP_MODULE_SFTRST, reset_addr + STMP_OFFSET_REG_SET);
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 53) udelay(1);
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 54)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 55) /* poll CLKGATE becoming set */
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 56) while ((!(readl(reset_addr) & STMP_MODULE_CLKGATE)) && --timeout)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 57) /* nothing */;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 58) if (unlikely(!timeout))
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 59) goto error;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 60)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 61) /* clear and poll SFTRST */
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 62) ret = stmp_clear_poll_bit(reset_addr, STMP_MODULE_SFTRST);
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 63) if (unlikely(ret))
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 64) goto error;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 65)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 66) /* clear and poll CLKGATE */
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 67) ret = stmp_clear_poll_bit(reset_addr, STMP_MODULE_CLKGATE);
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 68) if (unlikely(ret))
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 69) goto error;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 70)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 71) return 0;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 72)
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 73) error:
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 74) pr_err("%s(%p): module reset timeout\n", __func__, reset_addr);
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 75) return -ETIMEDOUT;
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 76) }
4ccf4beab8c44 (Wolfram Sang 2011-08-31 20:35:40 +0200 77) EXPORT_SYMBOL(stmp_reset_block);