--- zzzz-none-000/linux-3.10.107/arch/arm/mach-sunxi/sunxi.c 2017-06-27 09:49:32.000000000 +0000 +++ scorpion-7490-727/linux-3.10.107/arch/arm/mach-sunxi/sunxi.c 2021-02-04 17:41:59.000000000 +0000 @@ -10,114 +10,80 @@ * warranty of any kind, whether express or implied. */ +#include #include -#include -#include #include -#include -#include -#include -#include -#include - -#include +#include #include -#include -#include - -#include "sunxi.h" - -#define SUN4I_WATCHDOG_CTRL_REG 0x00 -#define SUN4I_WATCHDOG_CTRL_RESTART (1 << 0) -#define SUN4I_WATCHDOG_MODE_REG 0x04 -#define SUN4I_WATCHDOG_MODE_ENABLE (1 << 0) -#define SUN4I_WATCHDOG_MODE_RESET_ENABLE (1 << 1) -static void __iomem *wdt_base; - -static void sun4i_restart(char mode, const char *cmd) +static void __init sunxi_dt_cpufreq_init(void) { - if (!wdt_base) - return; - - /* Enable timer and set reset bit in the watchdog */ - writel(SUN4I_WATCHDOG_MODE_ENABLE | SUN4I_WATCHDOG_MODE_RESET_ENABLE, - wdt_base + SUN4I_WATCHDOG_MODE_REG); - - /* - * Restart the watchdog. The default (and lowest) interval - * value for the watchdog is 0.5s. - */ - writel(SUN4I_WATCHDOG_CTRL_RESTART, wdt_base + SUN4I_WATCHDOG_CTRL_REG); - - while (1) { - mdelay(5); - writel(SUN4I_WATCHDOG_MODE_ENABLE | SUN4I_WATCHDOG_MODE_RESET_ENABLE, - wdt_base + SUN4I_WATCHDOG_MODE_REG); - } + platform_device_register_simple("cpufreq-dt", -1, NULL, 0); } -static struct of_device_id sunxi_restart_ids[] = { - { .compatible = "allwinner,sun4i-wdt", .data = sun4i_restart }, - { /*sentinel*/ } +static const char * const sunxi_board_dt_compat[] = { + "allwinner,sun4i-a10", + "allwinner,sun5i-a10s", + "allwinner,sun5i-a13", + "allwinner,sun5i-r8", + NULL, }; -static void sunxi_setup_restart(void) -{ - const struct of_device_id *of_id; - struct device_node *np; - - np = of_find_matching_node(NULL, sunxi_restart_ids); - if (WARN(!np, "unable to setup watchdog restart")) - return; - - wdt_base = of_iomap(np, 0); - WARN(!wdt_base, "failed to map watchdog base address"); - - of_id = of_match_node(sunxi_restart_ids, np); - WARN(!of_id, "restart function not available"); - - arm_pm_restart = of_id->data; -} +DT_MACHINE_START(SUNXI_DT, "Allwinner sun4i/sun5i Families") + .dt_compat = sunxi_board_dt_compat, + .init_late = sunxi_dt_cpufreq_init, +MACHINE_END -static struct map_desc sunxi_io_desc[] __initdata = { - { - .virtual = (unsigned long) SUNXI_REGS_VIRT_BASE, - .pfn = __phys_to_pfn(SUNXI_REGS_PHYS_BASE), - .length = SUNXI_REGS_SIZE, - .type = MT_DEVICE, - }, +static const char * const sun6i_board_dt_compat[] = { + "allwinner,sun6i-a31", + "allwinner,sun6i-a31s", + NULL, }; -void __init sunxi_map_io(void) +extern void __init sun6i_reset_init(void); +static void __init sun6i_timer_init(void) { - iotable_init(sunxi_io_desc, ARRAY_SIZE(sunxi_io_desc)); + of_clk_init(NULL); + if (IS_ENABLED(CONFIG_RESET_CONTROLLER)) + sun6i_reset_init(); + clocksource_probe(); } -static void __init sunxi_timer_init(void) -{ - sunxi_init_clocks(); - clocksource_of_init(); -} +DT_MACHINE_START(SUN6I_DT, "Allwinner sun6i (A31) Family") + .init_time = sun6i_timer_init, + .dt_compat = sun6i_board_dt_compat, + .init_late = sunxi_dt_cpufreq_init, +MACHINE_END -static void __init sunxi_dt_init(void) -{ - sunxi_setup_restart(); +static const char * const sun7i_board_dt_compat[] = { + "allwinner,sun7i-a20", + NULL, +}; - of_platform_populate(NULL, of_default_bus_match_table, NULL, NULL); -} +DT_MACHINE_START(SUN7I_DT, "Allwinner sun7i (A20) Family") + .dt_compat = sun7i_board_dt_compat, + .init_late = sunxi_dt_cpufreq_init, +MACHINE_END -static const char * const sunxi_board_dt_compat[] = { - "allwinner,sun4i-a10", - "allwinner,sun5i-a13", +static const char * const sun8i_board_dt_compat[] = { + "allwinner,sun8i-a23", + "allwinner,sun8i-a33", + "allwinner,sun8i-h3", NULL, }; -DT_MACHINE_START(SUNXI_DT, "Allwinner A1X (Device Tree)") - .init_machine = sunxi_dt_init, - .map_io = sunxi_map_io, - .init_irq = irqchip_init, - .init_time = sunxi_timer_init, - .dt_compat = sunxi_board_dt_compat, +DT_MACHINE_START(SUN8I_DT, "Allwinner sun8i Family") + .init_time = sun6i_timer_init, + .dt_compat = sun8i_board_dt_compat, + .init_late = sunxi_dt_cpufreq_init, +MACHINE_END + +static const char * const sun9i_board_dt_compat[] = { + "allwinner,sun9i-a80", + NULL, +}; + +DT_MACHINE_START(SUN9I_DT, "Allwinner sun9i Family") + .dt_compat = sun9i_board_dt_compat, MACHINE_END