/* * Copyright (c) 2011 Picochip Ltd., Jamie Iles * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * All enquiries to support@picochip.com */ #include <linux/delay.h> #include <linux/of.h> #include <linux/of_address.h> #include <linux/of_platform.h> #include <linux/reboot.h> #include <asm/mach/arch.h> #include <asm/mach/map.h> #define PHYS_TO_IO(x) (((x) & 0x00ffffff) | 0xfe000000) #define PICOXCELL_PERIPH_BASE 0x80000000 #define PICOXCELL_PERIPH_LENGTH SZ_4M #define WDT_CTRL_REG_EN_MASK (1 << 0) #define WDT_CTRL_REG_OFFS (0x00) #define WDT_TIMEOUT_REG_OFFS (0x04) static void __iomem *wdt_regs; /* * The machine restart method can be called from an atomic context so we won't * be able to ioremap the regs then. */ static void picoxcell_setup_restart(void) { struct device_node *np = of_find_compatible_node(NULL, NULL, "snps,dw-apb-wdg"); if (WARN(!np, "unable to setup watchdog restart")) return; wdt_regs = of_iomap(np, 0); WARN(!wdt_regs, "failed to remap watchdog regs"); } static struct map_desc io_map __initdata = { .virtual = PHYS_TO_IO(PICOXCELL_PERIPH_BASE), .pfn = __phys_to_pfn(PICOXCELL_PERIPH_BASE), .length = PICOXCELL_PERIPH_LENGTH, .type = MT_DEVICE, }; static void __init picoxcell_map_io(void) { iotable_init(&io_map, 1); } static void __init picoxcell_init_machine(void) { of_platform_populate(NULL, of_default_bus_match_table, NULL, NULL); picoxcell_setup_restart(); } static const char *picoxcell_dt_match[] = { "picochip,pc3x2", "picochip,pc3x3", NULL }; static void picoxcell_wdt_restart(enum reboot_mode mode, const char *cmd) { /* * Configure the watchdog to reset with the shortest possible timeout * and give it chance to do the reset. */ if (wdt_regs) { writel_relaxed(WDT_CTRL_REG_EN_MASK, wdt_regs + WDT_CTRL_REG_OFFS); writel_relaxed(0, wdt_regs + WDT_TIMEOUT_REG_OFFS); /* No sleeping, possibly atomic. */ mdelay(500); } } DT_MACHINE_START(PICOXCELL, "Picochip picoXcell") .map_io = picoxcell_map_io, .init_machine = picoxcell_init_machine, .dt_compat = picoxcell_dt_match, .restart = picoxcell_wdt_restart, MACHINE_END