1 /*
2 * Author: Alexander Shiyan <shc_work@mail.ru>, 2016
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
8 */
9
10 #include <linux/io.h>
11 #include <linux/of_fdt.h>
12 #include <linux/platform_device.h>
13 #include <linux/random.h>
14 #include <linux/sizes.h>
15
16 #include <linux/mfd/syscon/clps711x.h>
17
18 #include <asm/system_info.h>
19 #include <asm/system_misc.h>
20 #include <asm/mach/arch.h>
21 #include <asm/mach/map.h>
22
23 #define CLPS711X_VIRT_BASE IOMEM(0xfeff4000)
24 #define CLPS711X_PHYS_BASE (0x80000000)
25 # define SYSFLG1 (0x0140)
26 # define HALT (0x0800)
27 # define UNIQID (0x2440)
28 # define RANDID0 (0x2700)
29 # define RANDID1 (0x2704)
30 # define RANDID2 (0x2708)
31 # define RANDID3 (0x270c)
32
33 static struct map_desc clps711x_io_desc __initdata = {
34 .virtual = (unsigned long)CLPS711X_VIRT_BASE,
35 .pfn = __phys_to_pfn(CLPS711X_PHYS_BASE),
36 .length = 48 * SZ_1K,
37 .type = MT_DEVICE,
38 };
39
clps711x_map_io(void)40 static void __init clps711x_map_io(void)
41 {
42 iotable_init(&clps711x_io_desc, 1);
43 }
44
45 static const struct resource clps711x_cpuidle_res =
46 DEFINE_RES_MEM(CLPS711X_PHYS_BASE + HALT, SZ_128);
47
clps711x_init(void)48 static void __init clps711x_init(void)
49 {
50 u32 id[5];
51
52 id[0] = readl(CLPS711X_VIRT_BASE + UNIQID);
53 id[1] = readl(CLPS711X_VIRT_BASE + RANDID0);
54 id[2] = readl(CLPS711X_VIRT_BASE + RANDID1);
55 id[3] = readl(CLPS711X_VIRT_BASE + RANDID2);
56 id[4] = readl(CLPS711X_VIRT_BASE + RANDID3);
57 system_rev = SYSFLG1_VERID(readl(CLPS711X_VIRT_BASE + SYSFLG1));
58
59 add_device_randomness(id, sizeof(id));
60
61 system_serial_low = id[0];
62
63 platform_device_register_simple("clps711x-cpuidle", PLATFORM_DEVID_NONE,
64 &clps711x_cpuidle_res, 1);
65 }
66
clps711x_restart(enum reboot_mode mode,const char * cmd)67 static void clps711x_restart(enum reboot_mode mode, const char *cmd)
68 {
69 soft_restart(0);
70 }
71
72 static const char *const clps711x_compat[] __initconst = {
73 "cirrus,ep7209",
74 NULL
75 };
76
77 DT_MACHINE_START(CLPS711X_DT, "Cirrus Logic CLPS711X (Device Tree Support)")
78 .dt_compat = clps711x_compat,
79 .map_io = clps711x_map_io,
80 .init_late = clps711x_init,
81 .restart = clps711x_restart,
82 MACHINE_END
83