Commit | Line | Data |
---|---|---|
1802d0be | 1 | // SPDX-License-Identifier: GPL-2.0-only |
88e0abcd | 2 | /* |
88e0abcd PM |
3 | * |
4 | * Copyright (C) 2012 ARM Limited | |
5 | */ | |
6 | ||
0f4630f3 | 7 | #include <linux/gpio/driver.h> |
88e0abcd | 8 | #include <linux/err.h> |
88e0abcd | 9 | #include <linux/io.h> |
974cc7b9 | 10 | #include <linux/mfd/core.h> |
88e0abcd | 11 | #include <linux/of_address.h> |
3b9334ac | 12 | #include <linux/of_platform.h> |
974cc7b9 | 13 | #include <linux/platform_data/syscon.h> |
88e0abcd | 14 | #include <linux/platform_device.h> |
88e0abcd PM |
15 | #include <linux/slab.h> |
16 | #include <linux/stat.h> | |
88e0abcd PM |
17 | #include <linux/vexpress.h> |
18 | ||
19 | #define SYS_ID 0x000 | |
20 | #define SYS_SW 0x004 | |
21 | #define SYS_LED 0x008 | |
22 | #define SYS_100HZ 0x024 | |
88e0abcd PM |
23 | #define SYS_FLAGSSET 0x030 |
24 | #define SYS_FLAGSCLR 0x034 | |
25 | #define SYS_NVFLAGS 0x038 | |
26 | #define SYS_NVFLAGSSET 0x038 | |
27 | #define SYS_NVFLAGSCLR 0x03c | |
28 | #define SYS_MCI 0x048 | |
29 | #define SYS_FLASH 0x04c | |
30 | #define SYS_CFGSW 0x058 | |
31 | #define SYS_24MHZ 0x05c | |
32 | #define SYS_MISC 0x060 | |
33 | #define SYS_DMA 0x064 | |
34 | #define SYS_PROCID0 0x084 | |
35 | #define SYS_PROCID1 0x088 | |
36 | #define SYS_CFGDATA 0x0a0 | |
37 | #define SYS_CFGCTRL 0x0a4 | |
38 | #define SYS_CFGSTAT 0x0a8 | |
39 | ||
40 | #define SYS_HBI_MASK 0xfff | |
88e0abcd PM |
41 | #define SYS_PROCIDx_HBI_SHIFT 0 |
42 | ||
88e0abcd PM |
43 | #define SYS_MISC_MASTERSITE (1 << 14) |
44 | ||
f0bd7ccc | 45 | void vexpress_flags_set(u32 data) |
974cc7b9 | 46 | { |
f0bd7ccc PM |
47 | static void __iomem *base; |
48 | ||
49 | if (!base) { | |
974cc7b9 PM |
50 | struct device_node *node = of_find_compatible_node(NULL, NULL, |
51 | "arm,vexpress-sysreg"); | |
88e0abcd | 52 | |
f0bd7ccc | 53 | base = of_iomap(node, 0); |
974cc7b9 PM |
54 | } |
55 | ||
f0bd7ccc PM |
56 | if (WARN_ON(!base)) |
57 | return; | |
88e0abcd | 58 | |
f0bd7ccc PM |
59 | writel(~0, base + SYS_FLAGSCLR); |
60 | writel(data, base + SYS_FLAGSSET); | |
88e0abcd PM |
61 | } |
62 | ||
974cc7b9 | 63 | /* The sysreg block is just a random collection of various functions... */ |
8ea402f5 | 64 | |
974cc7b9 PM |
65 | static struct syscon_platform_data vexpress_sysreg_sys_id_pdata = { |
66 | .label = "sys_id", | |
88e0abcd PM |
67 | }; |
68 | ||
974cc7b9 PM |
69 | static struct bgpio_pdata vexpress_sysreg_sys_led_pdata = { |
70 | .label = "sys_led", | |
71 | .base = -1, | |
72 | .ngpio = 8, | |
88e0abcd PM |
73 | }; |
74 | ||
974cc7b9 PM |
75 | static struct bgpio_pdata vexpress_sysreg_sys_mci_pdata = { |
76 | .label = "sys_mci", | |
77 | .base = -1, | |
78 | .ngpio = 2, | |
8ea402f5 PM |
79 | }; |
80 | ||
974cc7b9 PM |
81 | static struct bgpio_pdata vexpress_sysreg_sys_flash_pdata = { |
82 | .label = "sys_flash", | |
83 | .base = -1, | |
84 | .ngpio = 1, | |
8ea402f5 PM |
85 | }; |
86 | ||
974cc7b9 PM |
87 | static struct syscon_platform_data vexpress_sysreg_sys_misc_pdata = { |
88 | .label = "sys_misc", | |
89 | }; | |
8ea402f5 | 90 | |
974cc7b9 PM |
91 | static struct syscon_platform_data vexpress_sysreg_sys_procid_pdata = { |
92 | .label = "sys_procid", | |
93 | }; | |
88e0abcd | 94 | |
974cc7b9 PM |
95 | static struct mfd_cell vexpress_sysreg_cells[] = { |
96 | { | |
97 | .name = "syscon", | |
98 | .num_resources = 1, | |
99 | .resources = (struct resource []) { | |
100 | DEFINE_RES_MEM(SYS_ID, 0x4), | |
101 | }, | |
102 | .platform_data = &vexpress_sysreg_sys_id_pdata, | |
103 | .pdata_size = sizeof(vexpress_sysreg_sys_id_pdata), | |
104 | }, { | |
105 | .name = "basic-mmio-gpio", | |
106 | .of_compatible = "arm,vexpress-sysreg,sys_led", | |
107 | .num_resources = 1, | |
108 | .resources = (struct resource []) { | |
109 | DEFINE_RES_MEM_NAMED(SYS_LED, 0x4, "dat"), | |
110 | }, | |
111 | .platform_data = &vexpress_sysreg_sys_led_pdata, | |
112 | .pdata_size = sizeof(vexpress_sysreg_sys_led_pdata), | |
113 | }, { | |
114 | .name = "basic-mmio-gpio", | |
115 | .of_compatible = "arm,vexpress-sysreg,sys_mci", | |
116 | .num_resources = 1, | |
117 | .resources = (struct resource []) { | |
118 | DEFINE_RES_MEM_NAMED(SYS_MCI, 0x4, "dat"), | |
119 | }, | |
120 | .platform_data = &vexpress_sysreg_sys_mci_pdata, | |
121 | .pdata_size = sizeof(vexpress_sysreg_sys_mci_pdata), | |
122 | }, { | |
123 | .name = "basic-mmio-gpio", | |
124 | .of_compatible = "arm,vexpress-sysreg,sys_flash", | |
125 | .num_resources = 1, | |
126 | .resources = (struct resource []) { | |
127 | DEFINE_RES_MEM_NAMED(SYS_FLASH, 0x4, "dat"), | |
128 | }, | |
129 | .platform_data = &vexpress_sysreg_sys_flash_pdata, | |
130 | .pdata_size = sizeof(vexpress_sysreg_sys_flash_pdata), | |
131 | }, { | |
132 | .name = "syscon", | |
133 | .num_resources = 1, | |
134 | .resources = (struct resource []) { | |
135 | DEFINE_RES_MEM(SYS_MISC, 0x4), | |
136 | }, | |
137 | .platform_data = &vexpress_sysreg_sys_misc_pdata, | |
138 | .pdata_size = sizeof(vexpress_sysreg_sys_misc_pdata), | |
139 | }, { | |
140 | .name = "syscon", | |
141 | .num_resources = 1, | |
142 | .resources = (struct resource []) { | |
143 | DEFINE_RES_MEM(SYS_PROCID0, 0x8), | |
144 | }, | |
145 | .platform_data = &vexpress_sysreg_sys_procid_pdata, | |
146 | .pdata_size = sizeof(vexpress_sysreg_sys_procid_pdata), | |
147 | }, { | |
148 | .name = "vexpress-syscfg", | |
149 | .num_resources = 1, | |
150 | .resources = (struct resource []) { | |
151 | DEFINE_RES_MEM(SYS_CFGDATA, 0xc), | |
152 | }, | |
153 | } | |
154 | }; | |
88e0abcd | 155 | |
612b95cd | 156 | static int vexpress_sysreg_probe(struct platform_device *pdev) |
88e0abcd | 157 | { |
974cc7b9 PM |
158 | struct resource *mem; |
159 | void __iomem *base; | |
0f4630f3 | 160 | struct gpio_chip *mmc_gpio_chip; |
f0bd7ccc | 161 | int master; |
6b2c31c7 | 162 | u32 dt_hbi; |
88e0abcd | 163 | |
974cc7b9 PM |
164 | mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
165 | if (!mem) | |
166 | return -EINVAL; | |
88e0abcd | 167 | |
974cc7b9 PM |
168 | base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem)); |
169 | if (!base) | |
170 | return -ENOMEM; | |
88e0abcd | 171 | |
f0bd7ccc PM |
172 | master = readl(base + SYS_MISC) & SYS_MISC_MASTERSITE ? |
173 | VEXPRESS_SITE_DB2 : VEXPRESS_SITE_DB1; | |
174 | vexpress_config_set_master(master); | |
88e0abcd | 175 | |
6b2c31c7 | 176 | /* Confirm board type against DT property, if available */ |
5063e25a | 177 | if (of_property_read_u32(of_root, "arm,hbi", &dt_hbi) == 0) { |
f0bd7ccc PM |
178 | u32 id = readl(base + (master == VEXPRESS_SITE_DB1 ? |
179 | SYS_PROCID0 : SYS_PROCID1)); | |
6b2c31c7 PM |
180 | u32 hbi = (id >> SYS_PROCIDx_HBI_SHIFT) & SYS_HBI_MASK; |
181 | ||
182 | if (WARN_ON(dt_hbi != hbi)) | |
183 | dev_warn(&pdev->dev, "DT HBI (%x) is not matching hardware (%x)!\n", | |
184 | dt_hbi, hbi); | |
185 | } | |
186 | ||
974cc7b9 PM |
187 | /* |
188 | * Duplicated SYS_MCI pseudo-GPIO controller for compatibility with | |
189 | * older trees using sysreg node for MMC control lines. | |
190 | */ | |
191 | mmc_gpio_chip = devm_kzalloc(&pdev->dev, sizeof(*mmc_gpio_chip), | |
192 | GFP_KERNEL); | |
193 | if (!mmc_gpio_chip) | |
194 | return -ENOMEM; | |
195 | bgpio_init(mmc_gpio_chip, &pdev->dev, 0x4, base + SYS_MCI, | |
196 | NULL, NULL, NULL, NULL, 0); | |
0f4630f3 | 197 | mmc_gpio_chip->ngpio = 2; |
7ad07369 | 198 | gpiochip_add_data(mmc_gpio_chip, NULL); |
974cc7b9 PM |
199 | |
200 | return mfd_add_devices(&pdev->dev, PLATFORM_DEVID_AUTO, | |
201 | vexpress_sysreg_cells, | |
202 | ARRAY_SIZE(vexpress_sysreg_cells), mem, 0, NULL); | |
88e0abcd PM |
203 | } |
204 | ||
205 | static const struct of_device_id vexpress_sysreg_match[] = { | |
206 | { .compatible = "arm,vexpress-sysreg", }, | |
207 | {}, | |
208 | }; | |
209 | ||
210 | static struct platform_driver vexpress_sysreg_driver = { | |
211 | .driver = { | |
212 | .name = "vexpress-sysreg", | |
213 | .of_match_table = vexpress_sysreg_match, | |
214 | }, | |
215 | .probe = vexpress_sysreg_probe, | |
216 | }; | |
217 | ||
218 | static int __init vexpress_sysreg_init(void) | |
219 | { | |
3b9334ac PM |
220 | struct device_node *node; |
221 | ||
222 | /* Need the sysreg early, before any other device... */ | |
223 | for_each_matching_node(node, vexpress_sysreg_match) | |
224 | of_platform_device_create(node, NULL, NULL); | |
225 | ||
88e0abcd PM |
226 | return platform_driver_register(&vexpress_sysreg_driver); |
227 | } | |
228 | core_initcall(vexpress_sysreg_init); |