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