2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License version 2 as
4 * published by the Free Software Foundation.
6 * This program is distributed in the hope that it will be useful,
7 * but WITHOUT ANY WARRANTY; without even the implied warranty of
8 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
9 * GNU General Public License for more details.
11 * Copyright (C) 2012 ARM Limited
14 #include <linux/basic_mmio_gpio.h>
15 #include <linux/err.h>
17 #include <linux/mfd/core.h>
18 #include <linux/of_address.h>
19 #include <linux/of_platform.h>
20 #include <linux/platform_data/syscon.h>
21 #include <linux/platform_device.h>
22 #include <linux/slab.h>
23 #include <linux/stat.h>
24 #include <linux/vexpress.h>
29 #define SYS_100HZ 0x024
30 #define SYS_FLAGSSET 0x030
31 #define SYS_FLAGSCLR 0x034
32 #define SYS_NVFLAGS 0x038
33 #define SYS_NVFLAGSSET 0x038
34 #define SYS_NVFLAGSCLR 0x03c
36 #define SYS_FLASH 0x04c
37 #define SYS_CFGSW 0x058
38 #define SYS_24MHZ 0x05c
39 #define SYS_MISC 0x060
41 #define SYS_PROCID0 0x084
42 #define SYS_PROCID1 0x088
43 #define SYS_CFGDATA 0x0a0
44 #define SYS_CFGCTRL 0x0a4
45 #define SYS_CFGSTAT 0x0a8
47 #define SYS_HBI_MASK 0xfff
48 #define SYS_PROCIDx_HBI_SHIFT 0
50 #define SYS_MCI_CARDIN (1 << 0)
51 #define SYS_MCI_WPROT (1 << 1)
53 #define SYS_MISC_MASTERSITE (1 << 14)
56 static void __iomem *__vexpress_sysreg_base;
58 static void __iomem *vexpress_sysreg_base(void)
60 if (!__vexpress_sysreg_base) {
61 struct device_node *node = of_find_compatible_node(NULL, NULL,
62 "arm,vexpress-sysreg");
64 __vexpress_sysreg_base = of_iomap(node, 0);
67 WARN_ON(!__vexpress_sysreg_base);
69 return __vexpress_sysreg_base;
73 static int vexpress_sysreg_get_master(void)
75 if (readl(vexpress_sysreg_base() + SYS_MISC) & SYS_MISC_MASTERSITE)
76 return VEXPRESS_SITE_DB2;
78 return VEXPRESS_SITE_DB1;
81 void vexpress_flags_set(u32 data)
83 writel(~0, vexpress_sysreg_base() + SYS_FLAGSCLR);
84 writel(data, vexpress_sysreg_base() + SYS_FLAGSSET);
87 unsigned int vexpress_get_mci_cardin(struct device *dev)
89 return readl(vexpress_sysreg_base() + SYS_MCI) & SYS_MCI_CARDIN;
92 u32 vexpress_get_procid(int site)
94 if (site == VEXPRESS_SITE_MASTER)
95 site = vexpress_sysreg_get_master();
97 return readl(vexpress_sysreg_base() + (site == VEXPRESS_SITE_DB1 ?
98 SYS_PROCID0 : SYS_PROCID1));
101 void __iomem *vexpress_get_24mhz_clock_base(void)
103 return vexpress_sysreg_base() + SYS_24MHZ;
107 void __init vexpress_sysreg_early_init(void __iomem *base)
109 __vexpress_sysreg_base = base;
111 vexpress_config_set_master(vexpress_sysreg_get_master());
115 /* The sysreg block is just a random collection of various functions... */
117 static struct syscon_platform_data vexpress_sysreg_sys_id_pdata = {
121 static struct bgpio_pdata vexpress_sysreg_sys_led_pdata = {
127 static struct bgpio_pdata vexpress_sysreg_sys_mci_pdata = {
133 static struct bgpio_pdata vexpress_sysreg_sys_flash_pdata = {
134 .label = "sys_flash",
139 static struct syscon_platform_data vexpress_sysreg_sys_misc_pdata = {
143 static struct syscon_platform_data vexpress_sysreg_sys_procid_pdata = {
144 .label = "sys_procid",
147 static struct mfd_cell vexpress_sysreg_cells[] = {
151 .resources = (struct resource []) {
152 DEFINE_RES_MEM(SYS_ID, 0x4),
154 .platform_data = &vexpress_sysreg_sys_id_pdata,
155 .pdata_size = sizeof(vexpress_sysreg_sys_id_pdata),
157 .name = "basic-mmio-gpio",
158 .of_compatible = "arm,vexpress-sysreg,sys_led",
160 .resources = (struct resource []) {
161 DEFINE_RES_MEM_NAMED(SYS_LED, 0x4, "dat"),
163 .platform_data = &vexpress_sysreg_sys_led_pdata,
164 .pdata_size = sizeof(vexpress_sysreg_sys_led_pdata),
166 .name = "basic-mmio-gpio",
167 .of_compatible = "arm,vexpress-sysreg,sys_mci",
169 .resources = (struct resource []) {
170 DEFINE_RES_MEM_NAMED(SYS_MCI, 0x4, "dat"),
172 .platform_data = &vexpress_sysreg_sys_mci_pdata,
173 .pdata_size = sizeof(vexpress_sysreg_sys_mci_pdata),
175 .name = "basic-mmio-gpio",
176 .of_compatible = "arm,vexpress-sysreg,sys_flash",
178 .resources = (struct resource []) {
179 DEFINE_RES_MEM_NAMED(SYS_FLASH, 0x4, "dat"),
181 .platform_data = &vexpress_sysreg_sys_flash_pdata,
182 .pdata_size = sizeof(vexpress_sysreg_sys_flash_pdata),
186 .resources = (struct resource []) {
187 DEFINE_RES_MEM(SYS_MISC, 0x4),
189 .platform_data = &vexpress_sysreg_sys_misc_pdata,
190 .pdata_size = sizeof(vexpress_sysreg_sys_misc_pdata),
194 .resources = (struct resource []) {
195 DEFINE_RES_MEM(SYS_PROCID0, 0x8),
197 .platform_data = &vexpress_sysreg_sys_procid_pdata,
198 .pdata_size = sizeof(vexpress_sysreg_sys_procid_pdata),
200 .name = "vexpress-syscfg",
202 .resources = (struct resource []) {
203 DEFINE_RES_MEM(SYS_CFGDATA, 0xc),
208 static int vexpress_sysreg_probe(struct platform_device *pdev)
210 struct resource *mem;
212 struct bgpio_chip *mmc_gpio_chip;
215 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
219 base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem));
223 vexpress_config_set_master(vexpress_sysreg_get_master());
225 /* Confirm board type against DT property, if available */
226 if (of_property_read_u32(of_root, "arm,hbi", &dt_hbi) == 0) {
227 u32 id = vexpress_get_procid(VEXPRESS_SITE_MASTER);
228 u32 hbi = (id >> SYS_PROCIDx_HBI_SHIFT) & SYS_HBI_MASK;
230 if (WARN_ON(dt_hbi != hbi))
231 dev_warn(&pdev->dev, "DT HBI (%x) is not matching hardware (%x)!\n",
236 * Duplicated SYS_MCI pseudo-GPIO controller for compatibility with
237 * older trees using sysreg node for MMC control lines.
239 mmc_gpio_chip = devm_kzalloc(&pdev->dev, sizeof(*mmc_gpio_chip),
243 bgpio_init(mmc_gpio_chip, &pdev->dev, 0x4, base + SYS_MCI,
244 NULL, NULL, NULL, NULL, 0);
245 mmc_gpio_chip->gc.ngpio = 2;
246 gpiochip_add(&mmc_gpio_chip->gc);
248 return mfd_add_devices(&pdev->dev, PLATFORM_DEVID_AUTO,
249 vexpress_sysreg_cells,
250 ARRAY_SIZE(vexpress_sysreg_cells), mem, 0, NULL);
253 static const struct of_device_id vexpress_sysreg_match[] = {
254 { .compatible = "arm,vexpress-sysreg", },
258 static struct platform_driver vexpress_sysreg_driver = {
260 .name = "vexpress-sysreg",
261 .of_match_table = vexpress_sysreg_match,
263 .probe = vexpress_sysreg_probe,
266 static int __init vexpress_sysreg_init(void)
268 struct device_node *node;
270 /* Need the sysreg early, before any other device... */
271 for_each_matching_node(node, vexpress_sysreg_match)
272 of_platform_device_create(node, NULL, NULL);
274 return platform_driver_register(&vexpress_sysreg_driver);
276 core_initcall(vexpress_sysreg_init);