From 155751b7e369fa0f9c71c26d9932c888bbde634f Mon Sep 17 00:00:00 2001 From: Denis Schneider Date: Thu, 3 Jul 2014 11:08:49 +0100 Subject: [PATCH] xen/arm: Implement reset for sunxi. Enable hardware resets on Allwinner sunxi devices. Signed-off-by: Denis Schneider Acked-by: Ian Campbell --- xen/arch/arm/platforms/sunxi.c | 32 ++++++++++++++++++++++++++++++++ 1 file changed, 32 insertions(+) diff --git a/xen/arch/arm/platforms/sunxi.c b/xen/arch/arm/platforms/sunxi.c index fb1280185e..89d8290c5e 100644 --- a/xen/arch/arm/platforms/sunxi.c +++ b/xen/arch/arm/platforms/sunxi.c @@ -16,7 +16,38 @@ * GNU General Public License for more details. */ +#include +#include #include +#include + +/* Watchdog constants: */ +#define SUNXI_WDT_BASE 0x01c20c90 +#define SUNXI_WDT_MODE 0x04 +#define SUNXI_WDT_MODEADDR (SUNXI_WDT_BASE + SUNXI_WDT_MODE) +#define SUNXI_WDT_MODE_EN (1 << 0) +#define SUNXI_WDT_MODE_RST_EN (1 << 1) + + +static void sunxi_reset(void) +{ + void __iomem *wdt; + + wdt = ioremap_nocache(SUNXI_WDT_MODEADDR & PAGE_MASK, PAGE_SIZE); + if ( !wdt ) + { + dprintk(XENLOG_ERR, "Unable to map watchdog register!\n"); + return; + } + + /* Enable watchdog to trigger a reset after 500 ms: */ + writel(SUNXI_WDT_MODE_EN | SUNXI_WDT_MODE_RST_EN, + wdt + (SUNXI_WDT_MODEADDR & ~PAGE_MASK)); + iounmap(wdt); + + for (;;) + wfi(); +} static const char * const sunxi_dt_compat[] __initconst = { @@ -37,6 +68,7 @@ static const struct dt_device_match sunxi_blacklist_dev[] __initconst = PLATFORM_START(sunxi, "Allwinner A20") .compatible = sunxi_dt_compat, .blacklist_dev = sunxi_blacklist_dev, + .reset = sunxi_reset, .dom0_gnttab_start = 0x01d00000, .dom0_gnttab_size = 0x20000, -- 2.39.5