Commit | Line | Data |
---|---|---|
e328b880 AS |
1 | /* |
2 | * CLPS711X common devices definitions | |
3 | * | |
e4e3a37d | 4 | * Author: Alexander Shiyan <shc_work@mail.ru>, 2013-2014 |
e328b880 AS |
5 | * |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License as published by | |
8 | * the Free Software Foundation; either version 2 of the License, or | |
9 | * (at your option) any later version. | |
10 | */ | |
11 | ||
e4e3a37d AS |
12 | #include <linux/io.h> |
13 | #include <linux/of_fdt.h> | |
e328b880 | 14 | #include <linux/platform_device.h> |
e4e3a37d | 15 | #include <linux/random.h> |
6597619f | 16 | #include <linux/sizes.h> |
e4e3a37d AS |
17 | #include <linux/slab.h> |
18 | #include <linux/sys_soc.h> | |
19 | ||
20 | #include <asm/system_info.h> | |
e328b880 AS |
21 | |
22 | #include <mach/hardware.h> | |
23 | ||
2d57f248 AS |
24 | static const struct resource clps711x_cpuidle_res __initconst = |
25 | DEFINE_RES_MEM(CLPS711X_PHYS_BASE + HALT, SZ_128); | |
26 | ||
27 | static void __init clps711x_add_cpuidle(void) | |
28 | { | |
29 | platform_device_register_simple("clps711x-cpuidle", PLATFORM_DEVID_NONE, | |
30 | &clps711x_cpuidle_res, 1); | |
31 | } | |
32 | ||
e328b880 AS |
33 | static const phys_addr_t clps711x_gpios[][2] __initconst = { |
34 | { PADR, PADDR }, | |
35 | { PBDR, PBDDR }, | |
36 | { PCDR, PCDDR }, | |
37 | { PDDR, PDDDR }, | |
38 | { PEDR, PEDDR }, | |
39 | }; | |
40 | ||
41 | static void __init clps711x_add_gpio(void) | |
42 | { | |
43 | unsigned i; | |
44 | struct resource gpio_res[2]; | |
45 | ||
46 | memset(gpio_res, 0, sizeof(gpio_res)); | |
47 | ||
48 | gpio_res[0].flags = IORESOURCE_MEM; | |
49 | gpio_res[1].flags = IORESOURCE_MEM; | |
50 | ||
51 | for (i = 0; i < ARRAY_SIZE(clps711x_gpios); i++) { | |
52 | gpio_res[0].start = CLPS711X_PHYS_BASE + clps711x_gpios[i][0]; | |
53 | gpio_res[0].end = gpio_res[0].start; | |
54 | gpio_res[1].start = CLPS711X_PHYS_BASE + clps711x_gpios[i][1]; | |
55 | gpio_res[1].end = gpio_res[1].start; | |
56 | ||
57 | platform_device_register_simple("clps711x-gpio", i, | |
58 | gpio_res, ARRAY_SIZE(gpio_res)); | |
59 | } | |
60 | } | |
61 | ||
6597619f AS |
62 | const struct resource clps711x_syscon_res[] __initconst = { |
63 | /* SYSCON1, SYSFLG1 */ | |
64 | DEFINE_RES_MEM(CLPS711X_PHYS_BASE + SYSCON1, SZ_128), | |
65 | /* SYSCON2, SYSFLG2 */ | |
66 | DEFINE_RES_MEM(CLPS711X_PHYS_BASE + SYSCON2, SZ_128), | |
67 | /* SYSCON3 */ | |
68 | DEFINE_RES_MEM(CLPS711X_PHYS_BASE + SYSCON3, SZ_64), | |
69 | }; | |
70 | ||
71 | static void __init clps711x_add_syscon(void) | |
72 | { | |
73 | unsigned i; | |
74 | ||
75 | for (i = 0; i < ARRAY_SIZE(clps711x_syscon_res); i++) | |
5104d265 | 76 | platform_device_register_simple("syscon", i + 1, |
6597619f AS |
77 | &clps711x_syscon_res[i], 1); |
78 | } | |
79 | ||
bc000245 AS |
80 | static const struct resource clps711x_uart1_res[] __initconst = { |
81 | DEFINE_RES_MEM(CLPS711X_PHYS_BASE + UARTDR1, SZ_128), | |
82 | DEFINE_RES_IRQ(IRQ_UTXINT1), | |
83 | DEFINE_RES_IRQ(IRQ_URXINT1), | |
84 | }; | |
85 | ||
86 | static const struct resource clps711x_uart2_res[] __initconst = { | |
87 | DEFINE_RES_MEM(CLPS711X_PHYS_BASE + UARTDR2, SZ_128), | |
88 | DEFINE_RES_IRQ(IRQ_UTXINT2), | |
89 | DEFINE_RES_IRQ(IRQ_URXINT2), | |
90 | }; | |
91 | ||
92 | static void __init clps711x_add_uart(void) | |
93 | { | |
94 | platform_device_register_simple("clps711x-uart", 0, clps711x_uart1_res, | |
95 | ARRAY_SIZE(clps711x_uart1_res)); | |
96 | platform_device_register_simple("clps711x-uart", 1, clps711x_uart2_res, | |
97 | ARRAY_SIZE(clps711x_uart2_res)); | |
98 | }; | |
99 | ||
e4e3a37d AS |
100 | static void __init clps711x_soc_init(void) |
101 | { | |
102 | struct soc_device_attribute *soc_dev_attr; | |
103 | struct soc_device *soc_dev; | |
104 | void __iomem *base; | |
105 | u32 id[5]; | |
106 | ||
107 | base = ioremap(CLPS711X_PHYS_BASE, SZ_32K); | |
108 | if (!base) | |
109 | return; | |
110 | ||
111 | id[0] = readl(base + UNIQID); | |
112 | id[1] = readl(base + RANDID0); | |
113 | id[2] = readl(base + RANDID1); | |
114 | id[3] = readl(base + RANDID2); | |
115 | id[4] = readl(base + RANDID3); | |
116 | system_rev = SYSFLG1_VERID(readl(base + SYSFLG1)); | |
117 | ||
118 | add_device_randomness(id, sizeof(id)); | |
119 | ||
120 | system_serial_low = id[0]; | |
121 | ||
122 | soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL); | |
123 | if (!soc_dev_attr) | |
124 | goto out_unmap; | |
125 | ||
126 | soc_dev_attr->machine = of_flat_dt_get_machine_name(); | |
127 | soc_dev_attr->family = "Cirrus Logic CLPS711X"; | |
128 | soc_dev_attr->revision = kasprintf(GFP_KERNEL, "%u", system_rev); | |
129 | soc_dev_attr->soc_id = kasprintf(GFP_KERNEL, "%08x", id[0]); | |
130 | ||
131 | soc_dev = soc_device_register(soc_dev_attr); | |
132 | if (IS_ERR(soc_dev)) { | |
133 | kfree(soc_dev_attr->revision); | |
134 | kfree(soc_dev_attr->soc_id); | |
135 | kfree(soc_dev_attr); | |
136 | } | |
137 | ||
138 | out_unmap: | |
139 | iounmap(base); | |
140 | } | |
141 | ||
e328b880 AS |
142 | void __init clps711x_devices_init(void) |
143 | { | |
2d57f248 | 144 | clps711x_add_cpuidle(); |
e328b880 | 145 | clps711x_add_gpio(); |
6597619f | 146 | clps711x_add_syscon(); |
bc000245 | 147 | clps711x_add_uart(); |
e4e3a37d | 148 | clps711x_soc_init(); |
e328b880 | 149 | } |