This patch introduces a common probe method for the STA2X11 base platform
drivers. The following steps are performed:
* Registers belonging to the probed device are ioremapped.
* devm_regmap_init_mmio() is invoked on such registers.
* A struct sta2x11_platform_drv_data containing device data is allocated,
filled in, and "linked" to the struct sta2x11_instance_data representing
the instance to which the probed device belongs.
Signed-off-by: Davide Ciminaghi <cimina...@gnudd.com>
Acked-by: Giancarlo Asnaghi <giancarlo.asna...@st.com>
---
arch/x86/include/asm/sta2x11.h | 9 +++++
arch/x86/platform/sta2x11/sta2x11.c | 68 ++++++++++++++++++++++++++++++++++-
2 files changed, 76 insertions(+), 1 deletions(-)
diff --git a/arch/x86/include/asm/sta2x11.h b/arch/x86/include/asm/sta2x11.h
index 6df0c87..31fc648 100644
--- a/arch/x86/include/asm/sta2x11.h
+++ b/arch/x86/include/asm/sta2x11.h
@@ -35,6 +35,15 @@ enum sta2x11_plat_dev {
};
/*
+ * Platform driver data for sta2x11 platform devices
+ */
+struct sta2x11_platform_drv_data {
+ void * __iomem regs;
+ spinlock_t lock;
+ struct regmap *regmap;
+};
+
+/*
* Data structure representing a connext instance.
*/
struct sta2x11_instance_data {
diff --git a/arch/x86/platform/sta2x11/sta2x11.c
b/arch/x86/platform/sta2x11/sta2x11.c
index 861d447..1f1d1af 100644
--- a/arch/x86/platform/sta2x11/sta2x11.c
+++ b/arch/x86/platform/sta2x11/sta2x11.c
@@ -244,10 +244,76 @@ struct sta2x11_instance_data
*sta2x11_node_to_instance(struct device_node *n)
EXPORT_SYMBOL(sta2x11_node_to_instance);
+/* Common probe for the four platform devices */
static int sta2x11_platform_probe(struct platform_device *dev,
enum sta2x11_plat_dev index)
{
- return -EINVAL;
+ struct resource *res;
+ struct regmap_config *regmap_config =
+ sta2x11_platform_regmap_configs[index];
+ struct sta2x11_platform_drv_data *platform_drv_data, **dst;
+ struct sta2x11_instance_data *instance;
+
+ if (!regmap_config)
+ return -ENODEV;
+
+ platform_drv_data = devm_kzalloc(&dev->dev, sizeof(*platform_drv_data),
+ GFP_KERNEL);
+ if (!platform_drv_data)
+ return -ENOMEM;
+
+ res = platform_get_resource(dev, IORESOURCE_MEM, 0);
+ if (!res)
+ return -ENOMEM;
+
+ platform_drv_data->regs = devm_request_and_ioremap(&dev->dev, res);
+ if (!platform_drv_data->regs)
+ return -ENOMEM;
+
+ regmap_config->lock_arg = &platform_drv_data->lock;
+ /*
+ No caching, registers could be reached both via regmap and via
+ void __iomem *
+ */
+ regmap_config->cache_type = REGCACHE_NONE;
+ platform_drv_data->regmap =
+ devm_regmap_init_mmio(&dev->dev, platform_drv_data->regs,
+ regmap_config);
+ WARN_ON(!platform_drv_data->regmap);
+
+ if (!dev->dev.of_node)
+ return -ENODEV;
+
+ /* Find out the connext's instance id */
+ instance = sta2x11_dev_to_instance(&dev->dev);
+ if (!instance)
+ return -ENODEV;
+
+ /*
+ In case the device represents the sysctl or apb soc registers,
+ add clocks related data and maybe create the "virtual"
+ sta2x11-clock-regs platform devices
+ */
+ switch (index) {
+ case sta2x11_sctl:
+ dst = &instance->sctl;
+ break;
+ case sta2x11_apb_soc_regs:
+ dst = &instance->apb_soc_regs;
+ break;
+ case sta2x11_apbreg:
+ dst = &instance->apbreg;
+ break;
+ case sta2x11_scr:
+ dst = &instance->scr;
+ break;
+ default:
+ return -ENODEV;
+ }
+ *dst = platform_drv_data;
+
+ platform_set_drvdata(dev, platform_drv_data);
+ return 0;
}
static int sta2x11_sctl_probe(struct platform_device *dev)
--
1.7.7.2
--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at http://vger.kernel.org/majordomo-info.html
Please read the FAQ at http://www.tux.org/lkml/
