Commit ce9bd0a0 authored by Sebastian Reichel's avatar Sebastian Reichel Committed by Linus Walleij

pinctrl: mcp23s08: simplify spi_present_mask handling

Signed-off-by: default avatarSebastian Reichel <sebastian.reichel@collabora.co.uk>
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
parent 5b1a7e80
...@@ -351,11 +351,11 @@ static struct platform_device bfin_i2s = { ...@@ -351,11 +351,11 @@ static struct platform_device bfin_i2s = {
#if IS_ENABLED(CONFIG_PINCTRL_MCP23S08) #if IS_ENABLED(CONFIG_PINCTRL_MCP23S08)
#include <linux/spi/mcp23s08.h> #include <linux/spi/mcp23s08.h>
static const struct mcp23s08_platform_data bfin_mcp23s08_sys_gpio_info = { static const struct mcp23s08_platform_data bfin_mcp23s08_sys_gpio_info = {
.chip[0].is_present = true, .spi_present_mask = BIT(0),
.base = 0x30, .base = 0x30,
}; };
static const struct mcp23s08_platform_data bfin_mcp23s08_usr_gpio_info = { static const struct mcp23s08_platform_data bfin_mcp23s08_usr_gpio_info = {
.chip[2].is_present = true, .spi_present_mask = BIT(2),
.base = 0x38, .base = 0x38,
}; };
#endif #endif
......
...@@ -36,6 +36,8 @@ ...@@ -36,6 +36,8 @@
#define MCP_TYPE_017 3 #define MCP_TYPE_017 3
#define MCP_TYPE_S18 4 #define MCP_TYPE_S18 4
#define MCP_MAX_DEV_PER_CS 8
/* Registers are all 8 bits wide. /* Registers are all 8 bits wide.
* *
* The mcp23s17 has twice as many bits, and can be configured to work * The mcp23s17 has twice as many bits, and can be configured to work
...@@ -1064,7 +1066,6 @@ static int mcp23s08_probe(struct spi_device *spi) ...@@ -1064,7 +1066,6 @@ static int mcp23s08_probe(struct spi_device *spi)
int status, type; int status, type;
unsigned ngpio = 0; unsigned ngpio = 0;
const struct of_device_id *match; const struct of_device_id *match;
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)
...@@ -1078,36 +1079,26 @@ static int mcp23s08_probe(struct spi_device *spi) ...@@ -1078,36 +1079,26 @@ static int mcp23s08_probe(struct spi_device *spi)
pdata->base = -1; pdata->base = -1;
status = device_property_read_u32(&spi->dev, status = device_property_read_u32(&spi->dev,
"microchip,spi-present-mask", &spi_present_mask); "microchip,spi-present-mask", &pdata->spi_present_mask);
if (status) { if (status) {
status = device_property_read_u32(&spi->dev, status = device_property_read_u32(&spi->dev,
"mcp,spi-present-mask", &spi_present_mask); "mcp,spi-present-mask",
&pdata->spi_present_mask);
if (status) { if (status) {
dev_err(&spi->dev, "missing spi-present-mask"); dev_err(&spi->dev, "missing spi-present-mask");
return -ENODEV; return -ENODEV;
} }
} }
} else {
for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) {
if (!pdata->chip[addr].is_present)
continue;
if ((type == MCP_TYPE_S08) && (addr > 3)) {
dev_err(&spi->dev,
"mcp23s08 only supports address 0..3");
return -EINVAL;
}
spi_present_mask |= BIT(addr);
}
} }
if (!spi_present_mask || spi_present_mask >= 256) { if (!pdata->spi_present_mask || pdata->spi_present_mask > 0xff) {
dev_err(&spi->dev, "invalid spi-present-mask"); dev_err(&spi->dev, "invalid spi-present-mask");
return -ENODEV; return -ENODEV;
} }
for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) { for (addr = 0; addr < MCP_MAX_DEV_PER_CS; addr++) {
if (spi_present_mask & BIT(addr)) if (pdata->spi_present_mask & BIT(addr))
chips++; chips++;
} }
...@@ -1122,8 +1113,8 @@ static int mcp23s08_probe(struct spi_device *spi) ...@@ -1122,8 +1113,8 @@ static int mcp23s08_probe(struct spi_device *spi)
spi_set_drvdata(spi, data); spi_set_drvdata(spi, data);
for (addr = 0; addr < ARRAY_SIZE(pdata->chip); addr++) { for (addr = 0; addr < MCP_MAX_DEV_PER_CS; addr++) {
if (!(spi_present_mask & (1 << addr))) if (!(pdata->spi_present_mask & BIT(addr)))
continue; continue;
chips--; chips--;
data->mcp[addr] = &data->chip[chips]; data->mcp[addr] = &data->chip[chips];
......
/* FIXME driver should be able to handle IRQs... */ /* FIXME driver should be able to handle IRQs... */
struct mcp23s08_chip_info {
bool is_present; /* true if populated */
};
struct mcp23s08_platform_data { struct mcp23s08_platform_data {
/* For mcp23s08, up to 4 slaves (numbered 0..3) can share one SPI /* For mcp23s08, up to 4 slaves (numbered 0..3) can share one SPI
* chipselect, each providing 1 gpio_chip instance with 8 gpios. * chipselect, each providing 1 gpio_chip instance with 8 gpios.
...@@ -12,7 +8,7 @@ struct mcp23s08_platform_data { ...@@ -12,7 +8,7 @@ struct mcp23s08_platform_data {
* chipselect, each providing 1 gpio_chip (port A + port B) with * chipselect, each providing 1 gpio_chip (port A + port B) with
* 16 gpios. * 16 gpios.
*/ */
struct mcp23s08_chip_info chip[8]; u32 spi_present_mask;
/* "base" is the number of the first GPIO. Dynamic assignment is /* "base" is the number of the first GPIO. Dynamic assignment is
* not currently supported, and even if there are gaps in chip * not currently supported, and even if there are gaps in chip
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment