Commit aadd3076 authored by Crestez Dan Leonard's avatar Crestez Dan Leonard Committed by Jonathan Cameron

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: default avatarCrestez Dan Leonard <leonard.crestez@intel.com>
Acked-by: default avatarGe Gao <ggao@invensense.com>
Signed-off-by: default avatarJonathan Cameron <jic23@kernel.org>
parent 62979904
...@@ -88,7 +88,14 @@ static const struct inv_mpu6050_chip_config chip_config_6050 = { ...@@ -88,7 +88,14 @@ static const struct inv_mpu6050_chip_config chip_config_6050 = {
.accl_fs = INV_MPU6050_FS_02G, .accl_fs = INV_MPU6050_FS_02G,
}; };
/* Indexed by enum inv_devices */
static const struct inv_mpu6050_hw hw_info[] = { static const struct inv_mpu6050_hw hw_info[] = {
{
.num_reg = 117,
.name = "MPU6050",
.reg = &reg_set_6050,
.config = &chip_config_6050,
},
{ {
.num_reg = 117, .num_reg = 117,
.name = "MPU6500", .name = "MPU6500",
...@@ -97,7 +104,7 @@ static const struct inv_mpu6050_hw hw_info[] = { ...@@ -97,7 +104,7 @@ static const struct inv_mpu6050_hw hw_info[] = {
}, },
{ {
.num_reg = 117, .num_reg = 117,
.name = "MPU6050", .name = "MPU6000",
.reg = &reg_set_6050, .reg = &reg_set_6050,
.config = &chip_config_6050, .config = &chip_config_6050,
}, },
...@@ -793,6 +800,12 @@ int inv_mpu_core_probe(struct regmap *regmap, int irq, const char *name, ...@@ -793,6 +800,12 @@ int inv_mpu_core_probe(struct regmap *regmap, int irq, const char *name,
if (!indio_dev) if (!indio_dev)
return -ENOMEM; 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 = iio_priv(indio_dev);
st->chip_type = chip_type; st->chip_type = chip_type;
st->powerup_count = 0; st->powerup_count = 0;
......
...@@ -208,7 +208,7 @@ static const struct i2c_device_id inv_mpu_id[] = { ...@@ -208,7 +208,7 @@ static const struct i2c_device_id inv_mpu_id[] = {
MODULE_DEVICE_TABLE(i2c, inv_mpu_id); MODULE_DEVICE_TABLE(i2c, inv_mpu_id);
static const struct acpi_device_id inv_acpi_match[] = { static const struct acpi_device_id inv_acpi_match[] = {
{"INVN6500", 0}, {"INVN6500", INV_MPU6500},
{ }, { },
}; };
......
...@@ -44,9 +44,19 @@ static int inv_mpu_i2c_disable(struct iio_dev *indio_dev) ...@@ -44,9 +44,19 @@ static int inv_mpu_i2c_disable(struct iio_dev *indio_dev)
static int inv_mpu_probe(struct spi_device *spi) static int inv_mpu_probe(struct spi_device *spi)
{ {
struct regmap *regmap; struct regmap *regmap;
const struct spi_device_id *id = spi_get_device_id(spi); const struct spi_device_id *spi_id;
const char *name = id ? id->name : NULL; const struct acpi_device_id *acpi_id;
const int chip_type = id ? id->driver_data : 0; 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); regmap = devm_regmap_init_spi(spi, &inv_mpu_regmap_config);
if (IS_ERR(regmap)) { if (IS_ERR(regmap)) {
...@@ -76,7 +86,7 @@ static const struct spi_device_id inv_mpu_id[] = { ...@@ -76,7 +86,7 @@ static const struct spi_device_id inv_mpu_id[] = {
MODULE_DEVICE_TABLE(spi, inv_mpu_id); MODULE_DEVICE_TABLE(spi, inv_mpu_id);
static const struct acpi_device_id inv_acpi_match[] = { static const struct acpi_device_id inv_acpi_match[] = {
{"INVN6000", 0}, {"INVN6000", INV_MPU6000},
{ }, { },
}; };
MODULE_DEVICE_TABLE(acpi, inv_acpi_match); MODULE_DEVICE_TABLE(acpi, inv_acpi_match);
......
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