Commit | Line | Data |
---|---|---|
88e0abcd PM |
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/err.h> | |
15 | #include <linux/gpio.h> | |
16 | #include <linux/io.h> | |
17 | #include <linux/leds.h> | |
18 | #include <linux/of_address.h> | |
19 | #include <linux/platform_device.h> | |
20 | #include <linux/regulator/driver.h> | |
21 | #include <linux/slab.h> | |
22 | #include <linux/stat.h> | |
23 | #include <linux/timer.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_FLAGS 0x030 | |
31 | #define SYS_FLAGSSET 0x030 | |
32 | #define SYS_FLAGSCLR 0x034 | |
33 | #define SYS_NVFLAGS 0x038 | |
34 | #define SYS_NVFLAGSSET 0x038 | |
35 | #define SYS_NVFLAGSCLR 0x03c | |
36 | #define SYS_MCI 0x048 | |
37 | #define SYS_FLASH 0x04c | |
38 | #define SYS_CFGSW 0x058 | |
39 | #define SYS_24MHZ 0x05c | |
40 | #define SYS_MISC 0x060 | |
41 | #define SYS_DMA 0x064 | |
42 | #define SYS_PROCID0 0x084 | |
43 | #define SYS_PROCID1 0x088 | |
44 | #define SYS_CFGDATA 0x0a0 | |
45 | #define SYS_CFGCTRL 0x0a4 | |
46 | #define SYS_CFGSTAT 0x0a8 | |
47 | ||
48 | #define SYS_HBI_MASK 0xfff | |
49 | #define SYS_ID_HBI_SHIFT 16 | |
50 | #define SYS_PROCIDx_HBI_SHIFT 0 | |
51 | ||
8ea402f5 PM |
52 | #define SYS_LED_LED(n) (1 << (n)) |
53 | ||
88e0abcd PM |
54 | #define SYS_MCI_CARDIN (1 << 0) |
55 | #define SYS_MCI_WPROT (1 << 1) | |
56 | ||
57 | #define SYS_FLASH_WPn (1 << 0) | |
58 | ||
59 | #define SYS_MISC_MASTERSITE (1 << 14) | |
60 | ||
61 | #define SYS_CFGCTRL_START (1 << 31) | |
62 | #define SYS_CFGCTRL_WRITE (1 << 30) | |
63 | #define SYS_CFGCTRL_DCC(n) (((n) & 0xf) << 26) | |
64 | #define SYS_CFGCTRL_FUNC(n) (((n) & 0x3f) << 20) | |
65 | #define SYS_CFGCTRL_SITE(n) (((n) & 0x3) << 16) | |
66 | #define SYS_CFGCTRL_POSITION(n) (((n) & 0xf) << 12) | |
67 | #define SYS_CFGCTRL_DEVICE(n) (((n) & 0xfff) << 0) | |
68 | ||
69 | #define SYS_CFGSTAT_ERR (1 << 1) | |
70 | #define SYS_CFGSTAT_COMPLETE (1 << 0) | |
71 | ||
72 | ||
73 | static void __iomem *vexpress_sysreg_base; | |
74 | static struct device *vexpress_sysreg_dev; | |
75 | static int vexpress_master_site; | |
76 | ||
77 | ||
78 | void vexpress_flags_set(u32 data) | |
79 | { | |
80 | writel(~0, vexpress_sysreg_base + SYS_FLAGSCLR); | |
81 | writel(data, vexpress_sysreg_base + SYS_FLAGSSET); | |
82 | } | |
83 | ||
84 | u32 vexpress_get_procid(int site) | |
85 | { | |
86 | if (site == VEXPRESS_SITE_MASTER) | |
87 | site = vexpress_master_site; | |
88 | ||
89 | return readl(vexpress_sysreg_base + (site == VEXPRESS_SITE_DB1 ? | |
90 | SYS_PROCID0 : SYS_PROCID1)); | |
91 | } | |
92 | ||
93 | u32 vexpress_get_hbi(int site) | |
94 | { | |
95 | u32 id; | |
96 | ||
97 | switch (site) { | |
98 | case VEXPRESS_SITE_MB: | |
99 | id = readl(vexpress_sysreg_base + SYS_ID); | |
100 | return (id >> SYS_ID_HBI_SHIFT) & SYS_HBI_MASK; | |
101 | case VEXPRESS_SITE_MASTER: | |
102 | case VEXPRESS_SITE_DB1: | |
103 | case VEXPRESS_SITE_DB2: | |
104 | id = vexpress_get_procid(site); | |
105 | return (id >> SYS_PROCIDx_HBI_SHIFT) & SYS_HBI_MASK; | |
106 | } | |
107 | ||
108 | return ~0; | |
109 | } | |
110 | ||
111 | void __iomem *vexpress_get_24mhz_clock_base(void) | |
112 | { | |
113 | return vexpress_sysreg_base + SYS_24MHZ; | |
114 | } | |
115 | ||
116 | ||
117 | static void vexpress_sysreg_find_prop(struct device_node *node, | |
118 | const char *name, u32 *val) | |
119 | { | |
120 | of_node_get(node); | |
121 | while (node) { | |
122 | if (of_property_read_u32(node, name, val) == 0) { | |
123 | of_node_put(node); | |
124 | return; | |
125 | } | |
126 | node = of_get_next_parent(node); | |
127 | } | |
128 | } | |
129 | ||
130 | unsigned __vexpress_get_site(struct device *dev, struct device_node *node) | |
131 | { | |
132 | u32 site = 0; | |
133 | ||
134 | WARN_ON(dev && node && dev->of_node != node); | |
135 | if (dev && !node) | |
136 | node = dev->of_node; | |
137 | ||
138 | if (node) { | |
139 | vexpress_sysreg_find_prop(node, "arm,vexpress,site", &site); | |
140 | } else if (dev && dev->bus == &platform_bus_type) { | |
141 | struct platform_device *pdev = to_platform_device(dev); | |
142 | ||
143 | if (pdev->num_resources == 1 && | |
144 | pdev->resource[0].flags == IORESOURCE_BUS) | |
145 | site = pdev->resource[0].start; | |
146 | } else if (dev && strncmp(dev_name(dev), "ct:", 3) == 0) { | |
147 | site = VEXPRESS_SITE_MASTER; | |
148 | } | |
149 | ||
150 | if (site == VEXPRESS_SITE_MASTER) | |
151 | site = vexpress_master_site; | |
152 | ||
153 | return site; | |
154 | } | |
155 | ||
156 | ||
157 | struct vexpress_sysreg_config_func { | |
158 | u32 template; | |
159 | u32 device; | |
160 | }; | |
161 | ||
162 | static struct vexpress_config_bridge *vexpress_sysreg_config_bridge; | |
163 | static struct timer_list vexpress_sysreg_config_timer; | |
164 | static u32 *vexpress_sysreg_config_data; | |
165 | static int vexpress_sysreg_config_tries; | |
166 | ||
167 | static void *vexpress_sysreg_config_func_get(struct device *dev, | |
168 | struct device_node *node) | |
169 | { | |
170 | struct vexpress_sysreg_config_func *config_func; | |
63f5d2e8 | 171 | u32 site = 0; |
88e0abcd PM |
172 | u32 position = 0; |
173 | u32 dcc = 0; | |
174 | u32 func_device[2]; | |
175 | int err = -EFAULT; | |
176 | ||
177 | if (node) { | |
178 | of_node_get(node); | |
179 | vexpress_sysreg_find_prop(node, "arm,vexpress,site", &site); | |
180 | vexpress_sysreg_find_prop(node, "arm,vexpress,position", | |
181 | &position); | |
182 | vexpress_sysreg_find_prop(node, "arm,vexpress,dcc", &dcc); | |
183 | err = of_property_read_u32_array(node, | |
184 | "arm,vexpress-sysreg,func", func_device, | |
185 | ARRAY_SIZE(func_device)); | |
186 | of_node_put(node); | |
187 | } else if (dev && dev->bus == &platform_bus_type) { | |
188 | struct platform_device *pdev = to_platform_device(dev); | |
189 | ||
190 | if (pdev->num_resources == 1 && | |
191 | pdev->resource[0].flags == IORESOURCE_BUS) { | |
192 | site = pdev->resource[0].start; | |
193 | func_device[0] = pdev->resource[0].end; | |
194 | func_device[1] = pdev->id; | |
195 | err = 0; | |
196 | } | |
197 | } | |
198 | if (err) | |
199 | return NULL; | |
200 | ||
201 | config_func = kzalloc(sizeof(*config_func), GFP_KERNEL); | |
202 | if (!config_func) | |
203 | return NULL; | |
204 | ||
205 | config_func->template = SYS_CFGCTRL_DCC(dcc); | |
206 | config_func->template |= SYS_CFGCTRL_FUNC(func_device[0]); | |
207 | config_func->template |= SYS_CFGCTRL_SITE(site == VEXPRESS_SITE_MASTER ? | |
208 | vexpress_master_site : site); | |
209 | config_func->template |= SYS_CFGCTRL_POSITION(position); | |
210 | config_func->device |= func_device[1]; | |
211 | ||
212 | dev_dbg(vexpress_sysreg_dev, "func 0x%p = 0x%x, %d\n", config_func, | |
213 | config_func->template, config_func->device); | |
214 | ||
215 | return config_func; | |
216 | } | |
217 | ||
218 | static void vexpress_sysreg_config_func_put(void *func) | |
219 | { | |
220 | kfree(func); | |
221 | } | |
222 | ||
223 | static int vexpress_sysreg_config_func_exec(void *func, int offset, | |
224 | bool write, u32 *data) | |
225 | { | |
226 | int status; | |
227 | struct vexpress_sysreg_config_func *config_func = func; | |
228 | u32 command; | |
229 | ||
230 | if (WARN_ON(!vexpress_sysreg_base)) | |
231 | return -ENOENT; | |
232 | ||
233 | command = readl(vexpress_sysreg_base + SYS_CFGCTRL); | |
234 | if (WARN_ON(command & SYS_CFGCTRL_START)) | |
235 | return -EBUSY; | |
236 | ||
237 | command = SYS_CFGCTRL_START; | |
238 | command |= write ? SYS_CFGCTRL_WRITE : 0; | |
239 | command |= config_func->template; | |
240 | command |= SYS_CFGCTRL_DEVICE(config_func->device + offset); | |
241 | ||
242 | /* Use a canary for reads */ | |
243 | if (!write) | |
244 | *data = 0xdeadbeef; | |
245 | ||
246 | dev_dbg(vexpress_sysreg_dev, "command %x, data %x\n", | |
247 | command, *data); | |
248 | writel(*data, vexpress_sysreg_base + SYS_CFGDATA); | |
249 | writel(0, vexpress_sysreg_base + SYS_CFGSTAT); | |
250 | writel(command, vexpress_sysreg_base + SYS_CFGCTRL); | |
251 | mb(); | |
252 | ||
253 | if (vexpress_sysreg_dev) { | |
254 | /* Schedule completion check */ | |
255 | if (!write) | |
256 | vexpress_sysreg_config_data = data; | |
257 | vexpress_sysreg_config_tries = 100; | |
258 | mod_timer(&vexpress_sysreg_config_timer, | |
259 | jiffies + usecs_to_jiffies(100)); | |
260 | status = VEXPRESS_CONFIG_STATUS_WAIT; | |
261 | } else { | |
262 | /* Early execution, no timer available, have to spin */ | |
263 | u32 cfgstat; | |
264 | ||
265 | do { | |
266 | cpu_relax(); | |
267 | cfgstat = readl(vexpress_sysreg_base + SYS_CFGSTAT); | |
268 | } while (!cfgstat); | |
269 | ||
270 | if (!write && (cfgstat & SYS_CFGSTAT_COMPLETE)) | |
271 | *data = readl(vexpress_sysreg_base + SYS_CFGDATA); | |
272 | status = VEXPRESS_CONFIG_STATUS_DONE; | |
273 | ||
274 | if (cfgstat & SYS_CFGSTAT_ERR) | |
275 | status = -EINVAL; | |
276 | } | |
277 | ||
278 | return status; | |
279 | } | |
280 | ||
281 | struct vexpress_config_bridge_info vexpress_sysreg_config_bridge_info = { | |
282 | .name = "vexpress-sysreg", | |
283 | .func_get = vexpress_sysreg_config_func_get, | |
284 | .func_put = vexpress_sysreg_config_func_put, | |
285 | .func_exec = vexpress_sysreg_config_func_exec, | |
286 | }; | |
287 | ||
288 | static void vexpress_sysreg_config_complete(unsigned long data) | |
289 | { | |
290 | int status = VEXPRESS_CONFIG_STATUS_DONE; | |
291 | u32 cfgstat = readl(vexpress_sysreg_base + SYS_CFGSTAT); | |
292 | ||
293 | if (cfgstat & SYS_CFGSTAT_ERR) | |
294 | status = -EINVAL; | |
295 | if (!vexpress_sysreg_config_tries--) | |
296 | status = -ETIMEDOUT; | |
297 | ||
298 | if (status < 0) { | |
299 | dev_err(vexpress_sysreg_dev, "error %d\n", status); | |
300 | } else if (!(cfgstat & SYS_CFGSTAT_COMPLETE)) { | |
301 | mod_timer(&vexpress_sysreg_config_timer, | |
302 | jiffies + usecs_to_jiffies(50)); | |
303 | return; | |
304 | } | |
305 | ||
306 | if (vexpress_sysreg_config_data) { | |
307 | *vexpress_sysreg_config_data = readl(vexpress_sysreg_base + | |
308 | SYS_CFGDATA); | |
309 | dev_dbg(vexpress_sysreg_dev, "read data %x\n", | |
310 | *vexpress_sysreg_config_data); | |
311 | vexpress_sysreg_config_data = NULL; | |
312 | } | |
313 | ||
314 | vexpress_config_complete(vexpress_sysreg_config_bridge, status); | |
315 | } | |
316 | ||
317 | ||
e065d3d4 | 318 | void vexpress_sysreg_setup(struct device_node *node) |
88e0abcd | 319 | { |
52666298 | 320 | if (WARN_ON(!vexpress_sysreg_base)) |
88e0abcd PM |
321 | return; |
322 | ||
88e0abcd PM |
323 | if (readl(vexpress_sysreg_base + SYS_MISC) & SYS_MISC_MASTERSITE) |
324 | vexpress_master_site = VEXPRESS_SITE_DB2; | |
325 | else | |
326 | vexpress_master_site = VEXPRESS_SITE_DB1; | |
327 | ||
328 | vexpress_sysreg_config_bridge = vexpress_config_bridge_register( | |
329 | node, &vexpress_sysreg_config_bridge_info); | |
330 | WARN_ON(!vexpress_sysreg_config_bridge); | |
331 | } | |
332 | ||
52666298 PM |
333 | void __init vexpress_sysreg_early_init(void __iomem *base) |
334 | { | |
335 | vexpress_sysreg_base = base; | |
336 | vexpress_sysreg_setup(NULL); | |
337 | } | |
338 | ||
88e0abcd PM |
339 | void __init vexpress_sysreg_of_early_init(void) |
340 | { | |
dcd560c8 | 341 | struct device_node *node; |
52666298 | 342 | |
dcd560c8 CM |
343 | if (vexpress_sysreg_base) |
344 | return; | |
52666298 | 345 | |
dcd560c8 | 346 | node = of_find_compatible_node(NULL, NULL, "arm,vexpress-sysreg"); |
52666298 PM |
347 | if (node) { |
348 | vexpress_sysreg_base = of_iomap(node, 0); | |
349 | vexpress_sysreg_setup(node); | |
52666298 | 350 | } |
88e0abcd PM |
351 | } |
352 | ||
353 | ||
8eb12b98 PM |
354 | #ifdef CONFIG_GPIOLIB |
355 | ||
8ea402f5 PM |
356 | #define VEXPRESS_SYSREG_GPIO(_name, _reg, _value) \ |
357 | [VEXPRESS_GPIO_##_name] = { \ | |
358 | .reg = _reg, \ | |
359 | .value = _reg##_##_value, \ | |
360 | } | |
361 | ||
88e0abcd PM |
362 | static struct vexpress_sysreg_gpio { |
363 | unsigned long reg; | |
364 | u32 value; | |
365 | } vexpress_sysreg_gpios[] = { | |
8ea402f5 PM |
366 | VEXPRESS_SYSREG_GPIO(MMC_CARDIN, SYS_MCI, CARDIN), |
367 | VEXPRESS_SYSREG_GPIO(MMC_WPROT, SYS_MCI, WPROT), | |
368 | VEXPRESS_SYSREG_GPIO(FLASH_WPn, SYS_FLASH, WPn), | |
369 | VEXPRESS_SYSREG_GPIO(LED0, SYS_LED, LED(0)), | |
370 | VEXPRESS_SYSREG_GPIO(LED1, SYS_LED, LED(1)), | |
371 | VEXPRESS_SYSREG_GPIO(LED2, SYS_LED, LED(2)), | |
372 | VEXPRESS_SYSREG_GPIO(LED3, SYS_LED, LED(3)), | |
373 | VEXPRESS_SYSREG_GPIO(LED4, SYS_LED, LED(4)), | |
374 | VEXPRESS_SYSREG_GPIO(LED5, SYS_LED, LED(5)), | |
375 | VEXPRESS_SYSREG_GPIO(LED6, SYS_LED, LED(6)), | |
376 | VEXPRESS_SYSREG_GPIO(LED7, SYS_LED, LED(7)), | |
88e0abcd PM |
377 | }; |
378 | ||
379 | static int vexpress_sysreg_gpio_direction_input(struct gpio_chip *chip, | |
380 | unsigned offset) | |
381 | { | |
382 | return 0; | |
383 | } | |
384 | ||
88e0abcd PM |
385 | static int vexpress_sysreg_gpio_get(struct gpio_chip *chip, |
386 | unsigned offset) | |
387 | { | |
388 | struct vexpress_sysreg_gpio *gpio = &vexpress_sysreg_gpios[offset]; | |
389 | u32 reg_value = readl(vexpress_sysreg_base + gpio->reg); | |
390 | ||
391 | return !!(reg_value & gpio->value); | |
392 | } | |
393 | ||
394 | static void vexpress_sysreg_gpio_set(struct gpio_chip *chip, | |
395 | unsigned offset, int value) | |
396 | { | |
397 | struct vexpress_sysreg_gpio *gpio = &vexpress_sysreg_gpios[offset]; | |
398 | u32 reg_value = readl(vexpress_sysreg_base + gpio->reg); | |
399 | ||
400 | if (value) | |
401 | reg_value |= gpio->value; | |
402 | else | |
403 | reg_value &= ~gpio->value; | |
404 | ||
405 | writel(reg_value, vexpress_sysreg_base + gpio->reg); | |
406 | } | |
407 | ||
8ea402f5 PM |
408 | static int vexpress_sysreg_gpio_direction_output(struct gpio_chip *chip, |
409 | unsigned offset, int value) | |
410 | { | |
411 | vexpress_sysreg_gpio_set(chip, offset, value); | |
412 | ||
413 | return 0; | |
414 | } | |
415 | ||
88e0abcd PM |
416 | static struct gpio_chip vexpress_sysreg_gpio_chip = { |
417 | .label = "vexpress-sysreg", | |
418 | .direction_input = vexpress_sysreg_gpio_direction_input, | |
419 | .direction_output = vexpress_sysreg_gpio_direction_output, | |
420 | .get = vexpress_sysreg_gpio_get, | |
421 | .set = vexpress_sysreg_gpio_set, | |
422 | .ngpio = ARRAY_SIZE(vexpress_sysreg_gpios), | |
423 | .base = 0, | |
424 | }; | |
425 | ||
426 | ||
8ea402f5 PM |
427 | #define VEXPRESS_SYSREG_GREEN_LED(_name, _default_trigger, _gpio) \ |
428 | { \ | |
429 | .name = "v2m:green:"_name, \ | |
430 | .default_trigger = _default_trigger, \ | |
431 | .gpio = VEXPRESS_GPIO_##_gpio, \ | |
432 | } | |
433 | ||
434 | struct gpio_led vexpress_sysreg_leds[] = { | |
435 | VEXPRESS_SYSREG_GREEN_LED("user1", "heartbeat", LED0), | |
436 | VEXPRESS_SYSREG_GREEN_LED("user2", "mmc0", LED1), | |
437 | VEXPRESS_SYSREG_GREEN_LED("user3", "cpu0", LED2), | |
438 | VEXPRESS_SYSREG_GREEN_LED("user4", "cpu1", LED3), | |
439 | VEXPRESS_SYSREG_GREEN_LED("user5", "cpu2", LED4), | |
440 | VEXPRESS_SYSREG_GREEN_LED("user6", "cpu3", LED5), | |
441 | VEXPRESS_SYSREG_GREEN_LED("user7", "cpu4", LED6), | |
442 | VEXPRESS_SYSREG_GREEN_LED("user8", "cpu5", LED7), | |
443 | }; | |
444 | ||
445 | struct gpio_led_platform_data vexpress_sysreg_leds_pdata = { | |
446 | .num_leds = ARRAY_SIZE(vexpress_sysreg_leds), | |
447 | .leds = vexpress_sysreg_leds, | |
448 | }; | |
449 | ||
8eb12b98 PM |
450 | #endif |
451 | ||
8ea402f5 | 452 | |
88e0abcd PM |
453 | static ssize_t vexpress_sysreg_sys_id_show(struct device *dev, |
454 | struct device_attribute *attr, char *buf) | |
455 | { | |
456 | return sprintf(buf, "0x%08x\n", readl(vexpress_sysreg_base + SYS_ID)); | |
457 | } | |
458 | ||
459 | DEVICE_ATTR(sys_id, S_IRUGO, vexpress_sysreg_sys_id_show, NULL); | |
460 | ||
612b95cd | 461 | static int vexpress_sysreg_probe(struct platform_device *pdev) |
88e0abcd PM |
462 | { |
463 | int err; | |
464 | struct resource *res = platform_get_resource(pdev, | |
465 | IORESOURCE_MEM, 0); | |
466 | ||
467 | if (!devm_request_mem_region(&pdev->dev, res->start, | |
468 | resource_size(res), pdev->name)) { | |
469 | dev_err(&pdev->dev, "Failed to request memory region!\n"); | |
470 | return -EBUSY; | |
471 | } | |
472 | ||
52666298 | 473 | if (!vexpress_sysreg_base) { |
88e0abcd PM |
474 | vexpress_sysreg_base = devm_ioremap(&pdev->dev, res->start, |
475 | resource_size(res)); | |
52666298 PM |
476 | vexpress_sysreg_setup(pdev->dev.of_node); |
477 | } | |
88e0abcd PM |
478 | |
479 | if (!vexpress_sysreg_base) { | |
480 | dev_err(&pdev->dev, "Failed to obtain base address!\n"); | |
481 | return -EFAULT; | |
482 | } | |
483 | ||
484 | setup_timer(&vexpress_sysreg_config_timer, | |
485 | vexpress_sysreg_config_complete, 0); | |
486 | ||
8eb12b98 PM |
487 | vexpress_sysreg_dev = &pdev->dev; |
488 | ||
489 | #ifdef CONFIG_GPIOLIB | |
88e0abcd PM |
490 | vexpress_sysreg_gpio_chip.dev = &pdev->dev; |
491 | err = gpiochip_add(&vexpress_sysreg_gpio_chip); | |
492 | if (err) { | |
493 | vexpress_config_bridge_unregister( | |
494 | vexpress_sysreg_config_bridge); | |
495 | dev_err(&pdev->dev, "Failed to register GPIO chip! (%d)\n", | |
496 | err); | |
497 | return err; | |
498 | } | |
499 | ||
8ea402f5 PM |
500 | platform_device_register_data(vexpress_sysreg_dev, "leds-gpio", |
501 | PLATFORM_DEVID_AUTO, &vexpress_sysreg_leds_pdata, | |
502 | sizeof(vexpress_sysreg_leds_pdata)); | |
8eb12b98 | 503 | #endif |
8ea402f5 | 504 | |
88e0abcd PM |
505 | device_create_file(vexpress_sysreg_dev, &dev_attr_sys_id); |
506 | ||
507 | return 0; | |
508 | } | |
509 | ||
510 | static const struct of_device_id vexpress_sysreg_match[] = { | |
511 | { .compatible = "arm,vexpress-sysreg", }, | |
512 | {}, | |
513 | }; | |
514 | ||
515 | static struct platform_driver vexpress_sysreg_driver = { | |
516 | .driver = { | |
517 | .name = "vexpress-sysreg", | |
518 | .of_match_table = vexpress_sysreg_match, | |
519 | }, | |
520 | .probe = vexpress_sysreg_probe, | |
521 | }; | |
522 | ||
523 | static int __init vexpress_sysreg_init(void) | |
524 | { | |
dcd560c8 | 525 | vexpress_sysreg_of_early_init(); |
88e0abcd PM |
526 | return platform_driver_register(&vexpress_sysreg_driver); |
527 | } | |
528 | core_initcall(vexpress_sysreg_init); |