1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 *
4 * Copyright (C) 2012 John Crispin <john@phrozen.org>
5 */
6
7 #include <linux/err.h>
8 #include <linux/export.h>
9 #include <linux/gpio/consumer.h>
10 #include <linux/mod_devicetable.h>
11 #include <linux/platform_device.h>
12 #include <linux/dma-mapping.h>
13
14 #include <lantiq_soc.h>
15
16 static unsigned int *cp1_base;
17
ltq_get_cp1_base(void)18 unsigned int *ltq_get_cp1_base(void)
19 {
20 if (!cp1_base)
21 panic("no cp1 base was set\n");
22
23 return cp1_base;
24 }
25 EXPORT_SYMBOL(ltq_get_cp1_base);
26
vmmc_probe(struct platform_device * pdev)27 static int vmmc_probe(struct platform_device *pdev)
28 {
29 #define CP1_SIZE (1 << 20)
30 struct gpio_desc *gpio;
31 int gpio_count;
32 dma_addr_t dma;
33 int error;
34
35 cp1_base =
36 (void *) CPHYSADDR(dma_alloc_coherent(&pdev->dev, CP1_SIZE,
37 &dma, GFP_KERNEL));
38
39 gpio_count = gpiod_count(&pdev->dev, NULL);
40 while (gpio_count > 0) {
41 gpio = devm_gpiod_get_index(&pdev->dev,
42 NULL, --gpio_count, GPIOD_OUT_HIGH);
43 error = PTR_ERR_OR_ZERO(gpio);
44 if (error) {
45 dev_err(&pdev->dev,
46 "failed to request GPIO idx %d: %d\n",
47 gpio_count, error);
48 continue;
49 }
50
51 gpiod_set_consumer_name(gpio, "vmmc-relay");
52 }
53
54 dev_info(&pdev->dev, "reserved %dMB at 0x%p", CP1_SIZE >> 20, cp1_base);
55
56 return 0;
57 }
58
59 static const struct of_device_id vmmc_match[] = {
60 { .compatible = "lantiq,vmmc-xway" },
61 {},
62 };
63
64 static struct platform_driver vmmc_driver = {
65 .probe = vmmc_probe,
66 .driver = {
67 .name = "lantiq,vmmc",
68 .of_match_table = vmmc_match,
69 },
70 };
71 builtin_platform_driver(vmmc_driver);
72