UbiquitousOS
/
OpenCloudOS-Kernel
mirror of https://gitee.com/OpenCloudOS/OpenCloudOS-Kernel.git
11
0
Fork 0
Code Issues Projects Releases Wiki Activity

pinctrl: mcp23s08: simplify spi pdata handling 

Simplify spi pdata handling, so that it uses pdata when available
and falls back to reading device properties otherwise.

Signed-off-by: Sebastian Reichel <sebastian.reichel@collabora.co.uk>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
This commit is contained in:
Sebastian Reichel 2017-05-15 11:24:34 +02:00 committed by Linus Walleij
parent 5f853acfa9
commit 0d7fcd504c
1 changed files with 32 additions and 35 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

67
drivers/pinctrl/pinctrl-mcp23s08.c
View File

@ -1071,58 +1071,55 @@ static int mcp23s08_probe(struct spi_device *spi)
u32 spi_present_mask = 0; u32 spi_present_mask = 0;
match = of_match_device(of_match_ptr(mcp23s08_spi_of_match), &spi->dev); match = of_match_device(of_match_ptr(mcp23s08_spi_of_match), &spi->dev);
if (match) { if (match)
type = (int)(uintptr_t)match->data; type = (int)(uintptr_t)match->data;
status = of_property_read_u32(spi->dev.of_node, else
"microchip,spi-present-mask", &spi_present_mask); type = spi_get_device_id(spi)->driver_data;
pdata = dev_get_platdata(&spi->dev);
if (!pdata) {
pdata = &local_pdata;
pdata->base = -1;
pdata->irq_controller = device_property_read_bool(&spi->dev,
"interrupt-controller");
pdata->mirror = device_property_read_bool(&spi->dev,
"microchip,irq-mirror");
status = device_property_read_u32(&spi->dev,
"microchip,spi-present-mask", &spi_present_mask);
if (status) { if (status) {
status = of_property_read_u32(spi->dev.of_node, status = device_property_read_u32(&spi->dev,
"mcp,spi-present-mask", &spi_present_mask); "mcp,spi-present-mask", &spi_present_mask);
if (status) { if (status) {
dev_err(&spi->dev, dev_err(&spi->dev, "missing spi-present-mask");
"DT has no spi-present-mask\n");
return -ENODEV; return -ENODEV;
} }
} }
if ((spi_present_mask <= 0) || (spi_present_mask >= 256)) {
dev_err(&spi->dev, "invalid spi-present-mask\n");
return -ENODEV;
}
pdata = &local_pdata;
pdata->base = -1;
for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) {
if (spi_present_mask & (1 << addr))
chips++;
}
pdata->irq_controller = of_property_read_bool(
spi->dev.of_node,
"interrupt-controller");
pdata->mirror = of_property_read_bool(spi->dev.of_node,
"microchip,irq-mirror");
} else { } else {
type = spi_get_device_id(spi)->driver_data;
pdata = dev_get_platdata(&spi->dev);
if (!pdata) {
pdata = devm_kzalloc(&spi->dev,
sizeof(struct mcp23s08_platform_data),
GFP_KERNEL);
pdata->base = -1;
}
for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) { for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) {
if (!pdata->chip[addr].is_present) if (!pdata->chip[addr].is_present)
continue; continue;
chips++;
if ((type == MCP_TYPE_S08) && (addr > 3)) { if ((type == MCP_TYPE_S08) && (addr > 3)) {
dev_err(&spi->dev, dev_err(&spi->dev,
"mcp23s08 only supports address 0..3\n"); "mcp23s08 only supports address 0..3");
return -EINVAL; return -EINVAL;
} }
spi_present_mask |= 1 << addr; spi_present_mask |= BIT(addr);
} }
} }
if (!spi_present_mask || spi_present_mask >= 256) {
dev_err(&spi->dev, "invalid spi-present-mask");
return -ENODEV;
}
for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) {
if (spi_present_mask & BIT(addr))
chips++;
}
if (!chips) if (!chips)
return -ENODEV; return -ENODEV;