sysmo-bts
/
barebox
9
0
Fork 0
Code Releases Activity

mfd: stmpe: Add devicetree probe support 

Our driver matches stmpe-i2c and stmpe-spi. It seems the device
we really support is the stmpe1601, so use this one for matching
the devicetree compatible.

Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
Sascha Hauer 2013-06-06 13:43:50 +02:00
parent 89825aed29
commit b7ee4acb4a
1 changed files with 30 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

32
drivers/mfd/stmpe-i2c.c
View File

@ -106,6 +106,25 @@ static struct file_operations stmpe_fops = {
.write = stmpe_write,
};
static struct stmpe_platform_data *stmpe_of_probe(struct device_d *dev)
{
struct stmpe_platform_data *pdata;
struct device_node *node;
if (!IS_ENABLED(CONFIG_OFDEVICE) || !dev->device_node)
return NULL;
pdata = xzalloc(sizeof(*pdata));
device_node_for_nach_child(dev->device_node, node) {
if (!strcmp(node->name, "stmpe_gpio")) {
pdata->blocks |= STMPE_BLOCK_GPIO;
}
}
return pdata;
}
static int stmpe_probe(struct device_d *dev)
{
struct stmpe_platform_data *pdata = dev->platform_data;
@ -113,8 +132,11 @@ static int stmpe_probe(struct device_d *dev)
struct stmpe_client_info *i2c_ci;
if (!pdata) {
dev_dbg(dev, "no platform data\n");
return -ENODEV;
pdata = stmpe_of_probe(dev);
if (!pdata) {
dev_dbg(dev, "no platform data\n");
return -ENODEV;
}
}
stmpe_dev = xzalloc(sizeof(struct stmpe));
@ -140,9 +162,15 @@ static int stmpe_probe(struct device_d *dev)
return 0;
}
static struct platform_device_id stmpe_i2c_id[] = {
{ "stmpe1601", 0 },
{ }
};
static struct driver_d stmpe_driver = {
.name = DRIVERNAME,
.probe = stmpe_probe,
.id_table = stmpe_i2c_id,
};
static int stmpe_init(void)