Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 | // SPDX-License-Identifier: GPL-2.0-only /* * ARM Integrator Logical Module bus driver * Copyright (C) 2020 Linaro Ltd. * Author: Linus Walleij <linus.walleij@linaro.org> * * See the device tree bindings for this block for more details on the * hardware. */ #include <linux/module.h> #include <linux/err.h> #include <linux/io.h> #include <linux/of.h> #include <linux/of_address.h> #include <linux/of_platform.h> #include <linux/init.h> #include <linux/slab.h> #include <linux/platform_device.h> #include <linux/bitops.h> #include <linux/mfd/syscon.h> #include <linux/regmap.h> /* All information about the connected logic modules are in here */ #define INTEGRATOR_SC_DEC_OFFSET 0x10 /* Base address for the expansion modules */ #define INTEGRATOR_AP_EXP_BASE 0xc0000000 #define INTEGRATOR_AP_EXP_STRIDE 0x10000000 static int integrator_lm_populate(int num, struct device *dev) { struct device_node *np = dev->of_node; struct device_node *child; u32 base; int ret; base = INTEGRATOR_AP_EXP_BASE + (num * INTEGRATOR_AP_EXP_STRIDE); /* Walk over the child nodes and see what chipselects we use */ for_each_available_child_of_node(np, child) { struct resource res; ret = of_address_to_resource(child, 0, &res); if (ret) { dev_info(dev, "no valid address on child\n"); continue; } /* First populate the syscon then any devices */ if (res.start == base) { dev_info(dev, "populate module @0x%08x from DT\n", base); ret = of_platform_default_populate(child, NULL, dev); if (ret) { dev_err(dev, "failed to populate module\n"); return ret; } } } return 0; } static const struct of_device_id integrator_ap_syscon_match[] = { { .compatible = "arm,integrator-ap-syscon"}, { }, }; static int integrator_ap_lm_probe(struct platform_device *pdev) { struct device *dev = &pdev->dev; struct device_node *syscon; static struct regmap *map; u32 val; int ret; int i; /* Look up the system controller */ syscon = of_find_matching_node(NULL, integrator_ap_syscon_match); if (!syscon) { dev_err(dev, "could not find Integrator/AP system controller\n"); return -ENODEV; } map = syscon_node_to_regmap(syscon); if (IS_ERR(map)) { dev_err(dev, "could not find Integrator/AP system controller\n"); return PTR_ERR(map); } ret = regmap_read(map, INTEGRATOR_SC_DEC_OFFSET, &val); if (ret) { dev_err(dev, "could not read from Integrator/AP syscon\n"); return ret; } /* Loop over the connected modules */ for (i = 0; i < 4; i++) { if (!(val & BIT(4 + i))) continue; dev_info(dev, "detected module in slot %d\n", i); ret = integrator_lm_populate(i, dev); if (ret) return ret; } return 0; } static const struct of_device_id integrator_ap_lm_match[] = { { .compatible = "arm,integrator-ap-lm"}, { }, }; static struct platform_driver integrator_ap_lm_driver = { .probe = integrator_ap_lm_probe, .driver = { .name = "integratorap-lm", .of_match_table = integrator_ap_lm_match, }, }; module_platform_driver(integrator_ap_lm_driver); MODULE_AUTHOR("Linus Walleij <linus.walleij@linaro.org>"); MODULE_DESCRIPTION("Integrator AP Logical Module driver"); MODULE_LICENSE("GPL v2"); |