Pass the same device type information in DT match table as the one being passed via i2c_device_id Signed-off-by: Andrey Smirnov <andrew.smirnov@xxxxxxxxx> --- drivers/gpio/gpio-sx150x.c | 48 ++++++++++++++++++++++++++++++++-------------- 1 file changed, 34 insertions(+), 14 deletions(-) diff --git a/drivers/gpio/gpio-sx150x.c b/drivers/gpio/gpio-sx150x.c index bfb1ec3..9263d25 100644 --- a/drivers/gpio/gpio-sx150x.c +++ b/drivers/gpio/gpio-sx150x.c @@ -97,8 +97,15 @@ struct sx150x_chip { struct mutex lock; }; +enum sx150x_type { + SX1508Q = 0, + SX1509Q, + SX1506Q, + SX1502Q, +}; + static const struct sx150x_device_data sx150x_devices[] = { - [0] = { /* sx1508q */ + [SX1508Q] = { .model = SX150X_789, .reg_pullup = 0x03, .reg_pulldn = 0x04, @@ -116,7 +123,7 @@ static const struct sx150x_device_data sx150x_devices[] = { }, .ngpios = 8, }, - [1] = { /* sx1509q */ + [SX1509Q] = { .model = SX150X_789, .reg_pullup = 0x07, .reg_pulldn = 0x09, @@ -134,7 +141,7 @@ static const struct sx150x_device_data sx150x_devices[] = { }, .ngpios = 16 }, - [2] = { /* sx1506q */ + [SX1506Q] = { .model = SX150X_456, .reg_pullup = 0x05, .reg_pulldn = 0x07, @@ -154,7 +161,7 @@ static const struct sx150x_device_data sx150x_devices[] = { }, .ngpios = 16 }, - [3] = { /* sx1502q */ + [SX1502Q] = { .model = SX150X_123, .reg_pullup = 0x02, .reg_pulldn = 0x03, @@ -177,19 +184,19 @@ static const struct sx150x_device_data sx150x_devices[] = { }; static const struct i2c_device_id sx150x_id[] = { - {"sx1508q", 0}, - {"sx1509q", 1}, - {"sx1506q", 2}, - {"sx1502q", 3}, + { "sx1508q", SX1508Q }, + { "sx1509q", SX1509Q }, + { "sx1506q", SX1506Q }, + { "sx1502q", SX1502Q }, {} }; MODULE_DEVICE_TABLE(i2c, sx150x_id); static const struct of_device_id sx150x_of_match[] = { - { .compatible = "semtech,sx1508q" }, - { .compatible = "semtech,sx1509q" }, - { .compatible = "semtech,sx1506q" }, - { .compatible = "semtech,sx1502q" }, + { .compatible = "semtech,sx1508q", .data = (void *)SX1508Q }, + { .compatible = "semtech,sx1509q", .data = (void *)SX1509Q }, + { .compatible = "semtech,sx1506q", .data = (void *)SX1506Q }, + { .compatible = "semtech,sx1502q", .data = (void *)SX1502Q }, {}, }; MODULE_DEVICE_TABLE(of, sx150x_of_match); @@ -680,13 +687,14 @@ static int sx150x_install_irq_chip(struct sx150x_chip *chip) } static int sx150x_probe(struct i2c_client *client, - const struct i2c_device_id *id) + const struct i2c_device_id *id) { static const u32 i2c_funcs = I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WRITE_WORD_DATA; struct sx150x_chip *chip; int rc; bool oscio_is_gpo; + kernel_ulong_t driver_data; if (!i2c_check_functionality(client->adapter, i2c_funcs)) return -ENOSYS; @@ -699,7 +707,19 @@ static int sx150x_probe(struct i2c_client *client, oscio_is_gpo = of_property_read_bool(client->dev.of_node, "semtech,oscio-is-gpo"); - sx150x_init_chip(chip, client, id->driver_data); + if (id) { + driver_data = id->driver_data; + } else { + const struct of_device_id *match; + + match = of_match_device(sx150x_of_match, &client->dev); + if (!match) + return -ENODEV; + + driver_data = (kernel_ulong_t)match->data; + } + + sx150x_init_chip(chip, client, driver_data); if (oscio_is_gpo) chip->gpio_chip.ngpio++; -- 2.5.5 -- To unsubscribe from this list: send the line "unsubscribe devicetree" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html