iio: inv_mpu6050: Cleanup hw_info mapping

The hw_info array was indexed by enum inv_devices chip_type despite the
fact that the enumeration had more members than the array and was
ordered differently.

The patch cleans this up and adds explicit chip_types to i2c/spi/acpi
IDs. It also adds some stricter checks inside the driver core.

This happened to work so far because the differences between the
supported models are very minor.

Signed-off-by: Crestez Dan Leonard <leonard.crestez@intel.com>
Acked-by: Ge Gao <ggao@invensense.com>
Signed-off-by: Jonathan Cameron <jic23@kernel.org>

diff --git a/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c b/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
index 482a2490c53aaafba739e622480670ce95a10dc5..ec0ae6f85945a1b2ecc0d0a47c0b5fe4f09ea68f 100644 (file)
--- a/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
+++ b/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
@@ -88,7 +88,14 @@ static const struct inv_mpu6050_chip_config chip_config_6050 = {
        .accl_fs = INV_MPU6050_FS_02G,
 };
 
+/* Indexed by enum inv_devices */
 static const struct inv_mpu6050_hw hw_info[] = {
+       {
+               .num_reg = 117,
+               .name = "MPU6050",
+               .reg = &reg_set_6050,
+               .config = &chip_config_6050,
+       },
        {
                .num_reg = 117,
                .name = "MPU6500",
@@ -97,7 +104,7 @@ static const struct inv_mpu6050_hw hw_info[] = {
        },
        {
                .num_reg = 117,
-               .name = "MPU6050",
+               .name = "MPU6000",
                .reg = &reg_set_6050,
                .config = &chip_config_6050,
        },
@@ -793,6 +800,12 @@ int inv_mpu_core_probe(struct regmap *regmap, int irq, const char *name,
        if (!indio_dev)
                return -ENOMEM;
 
+       BUILD_BUG_ON(ARRAY_SIZE(hw_info) != INV_NUM_PARTS);
+       if (chip_type < 0 || chip_type >= INV_NUM_PARTS) {
+               dev_err(dev, "Bad invensense chip_type=%d name=%s\n",
+                               chip_type, name);
+               return -ENODEV;
+       }
        st = iio_priv(indio_dev);
        st->chip_type = chip_type;
        st->powerup_count = 0;

diff --git a/drivers/iio/imu/inv_mpu6050/inv_mpu_i2c.c b/drivers/iio/imu/inv_mpu6050/inv_mpu_i2c.c
index 5ee4e0dc093e687445cfb3daab47f8a7f0e182fe..bb1a7b1462f51a0c56f13062e0d8e1c6ccbf9224 100644 (file)
--- a/drivers/iio/imu/inv_mpu6050/inv_mpu_i2c.c
+++ b/drivers/iio/imu/inv_mpu6050/inv_mpu_i2c.c
@@ -208,7 +208,7 @@ static const struct i2c_device_id inv_mpu_id[] = {
 MODULE_DEVICE_TABLE(i2c, inv_mpu_id);
 
 static const struct acpi_device_id inv_acpi_match[] = {
-       {"INVN6500", 0},
+       {"INVN6500", INV_MPU6500},
        { },
 };
 

diff --git a/drivers/iio/imu/inv_mpu6050/inv_mpu_spi.c b/drivers/iio/imu/inv_mpu6050/inv_mpu_spi.c
index 7bcb8d839f0549a1a89c6291a78796841cf1db5c..3972a4625127896f8d0b5f1de9c53b6333e81bcb 100644 (file)
--- a/drivers/iio/imu/inv_mpu6050/inv_mpu_spi.c
+++ b/drivers/iio/imu/inv_mpu6050/inv_mpu_spi.c
@@ -44,9 +44,19 @@ static int inv_mpu_i2c_disable(struct iio_dev *indio_dev)
 static int inv_mpu_probe(struct spi_device *spi)
 {
        struct regmap *regmap;
-       const struct spi_device_id *id = spi_get_device_id(spi);
-       const char *name = id ? id->name : NULL;
-       const int chip_type = id ? id->driver_data : 0;
+       const struct spi_device_id *spi_id;
+       const struct acpi_device_id *acpi_id;
+       const char *name = NULL;
+       enum inv_devices chip_type;
+
+       if ((spi_id = spi_get_device_id(spi))) {
+               chip_type = (enum inv_devices)spi_id->driver_data;
+               name = spi_id->name;
+       } else if ((acpi_id = acpi_match_device(spi->dev.driver->acpi_match_table, &spi->dev))) {
+               chip_type = (enum inv_devices)acpi_id->driver_data;
+       } else {
+               return -ENODEV;
+       }
 
        regmap = devm_regmap_init_spi(spi, &inv_mpu_regmap_config);
        if (IS_ERR(regmap)) {
@@ -76,7 +86,7 @@ static const struct spi_device_id inv_mpu_id[] = {
 MODULE_DEVICE_TABLE(spi, inv_mpu_id);
 
 static const struct acpi_device_id inv_acpi_match[] = {
-       {"INVN6000", 0},
+       {"INVN6000", INV_MPU6000},
        { },
 };
 MODULE_DEVICE_TABLE(acpi, inv_acpi_match);