Prepare the bmi270 driver to support similar devices like the bmi260.
Signed-off-by: Justin Weiss <justin@justinweiss.com>
---
drivers/iio/imu/bmi270/bmi270.h | 11 ++++++++++-
drivers/iio/imu/bmi270/bmi270_core.c | 18 ++++++++++++++----
drivers/iio/imu/bmi270/bmi270_i2c.c | 11 ++++++++---
drivers/iio/imu/bmi270/bmi270_spi.c | 11 ++++++++---
4 files changed, 40 insertions(+), 11 deletions(-)
diff --git a/drivers/iio/imu/bmi270/bmi270.h b/drivers/iio/imu/bmi270/bmi270.h
index 8ac20ad7ee94..93e5f387607b 100644
--- a/drivers/iio/imu/bmi270/bmi270.h
+++ b/drivers/iio/imu/bmi270/bmi270.h
@@ -10,10 +10,19 @@ struct device;
struct bmi270_data {
struct device *dev;
struct regmap *regmap;
+ const struct bmi270_chip_info *chip_info;
+};
+
+struct bmi270_chip_info {
+ const char *name;
+ int chip_id;
+ const char *fw_name;
};
extern const struct regmap_config bmi270_regmap_config;
+extern const struct bmi270_chip_info bmi270_chip_info;
-int bmi270_core_probe(struct device *dev, struct regmap *regmap);
+int bmi270_core_probe(struct device *dev, struct regmap *regmap,
+ const struct bmi270_chip_info *chip_info);
#endif /* BMI270_H_ */
diff --git a/drivers/iio/imu/bmi270/bmi270_core.c b/drivers/iio/imu/bmi270/bmi270_core.c
index e598c642178f..5f08d786fa21 100644
--- a/drivers/iio/imu/bmi270/bmi270_core.c
+++ b/drivers/iio/imu/bmi270/bmi270_core.c
@@ -66,6 +66,13 @@ enum bmi270_scan {
BMI270_SCAN_GYRO_Z,
};
+const struct bmi270_chip_info bmi270_chip_info = {
+ .name = "bmi270",
+ .chip_id = BMI270_CHIP_ID_VAL,
+ .fw_name = BMI270_INIT_DATA_FILE,
+};
+EXPORT_SYMBOL_NS_GPL(bmi270_chip_info, IIO_BMI270);
+
static int bmi270_get_data(struct bmi270_data *bmi270_device,
int chan_type, int axis, int *val)
{
@@ -150,7 +157,7 @@ static int bmi270_validate_chip_id(struct bmi270_data *bmi270_device)
if (ret)
return dev_err_probe(dev, ret, "Failed to read chip id");
- if (chip_id != BMI270_CHIP_ID_VAL)
+ if (chip_id != bmi270_device->chip_info->chip_id)
dev_info(dev, "Unknown chip id 0x%x", chip_id);
return 0;
@@ -183,7 +190,8 @@ static int bmi270_write_calibration_data(struct bmi270_data *bmi270_device)
return dev_err_probe(dev, ret,
"Failed to prepare device to load init data");
- ret = request_firmware(&init_data, BMI270_INIT_DATA_FILE, dev);
+ ret = request_firmware(&init_data,
+ bmi270_device->chip_info->fw_name, dev);
if (ret)
return dev_err_probe(dev, ret, "Failed to load init data file");
@@ -270,7 +278,8 @@ static int bmi270_chip_init(struct bmi270_data *bmi270_device)
return bmi270_configure_imu(bmi270_device);
}
-int bmi270_core_probe(struct device *dev, struct regmap *regmap)
+int bmi270_core_probe(struct device *dev, struct regmap *regmap,
+ const struct bmi270_chip_info *chip_info)
{
int ret;
struct bmi270_data *bmi270_device;
@@ -283,6 +292,7 @@ int bmi270_core_probe(struct device *dev, struct regmap *regmap)
bmi270_device = iio_priv(indio_dev);
bmi270_device->dev = dev;
bmi270_device->regmap = regmap;
+ bmi270_device->chip_info = chip_info;
ret = bmi270_chip_init(bmi270_device);
if (ret)
@@ -290,7 +300,7 @@ int bmi270_core_probe(struct device *dev, struct regmap *regmap)
indio_dev->channels = bmi270_channels;
indio_dev->num_channels = ARRAY_SIZE(bmi270_channels);
- indio_dev->name = "bmi270";
+ indio_dev->name = chip_info->name;
indio_dev->modes = INDIO_DIRECT_MODE;
indio_dev->info = &bmi270_info;
diff --git a/drivers/iio/imu/bmi270/bmi270_i2c.c b/drivers/iio/imu/bmi270/bmi270_i2c.c
index d59161f23f9a..394f27996059 100644
--- a/drivers/iio/imu/bmi270/bmi270_i2c.c
+++ b/drivers/iio/imu/bmi270/bmi270_i2c.c
@@ -17,22 +17,27 @@ static int bmi270_i2c_probe(struct i2c_client *client)
{
struct regmap *regmap;
struct device *dev = &client->dev;
+ const struct bmi270_chip_info *chip_info;
+
+ chip_info = i2c_get_match_data(client);
+ if (!chip_info)
+ return -ENODEV;
regmap = devm_regmap_init_i2c(client, &bmi270_i2c_regmap_config);
if (IS_ERR(regmap))
return dev_err_probe(dev, PTR_ERR(regmap),
"Failed to init i2c regmap");
- return bmi270_core_probe(dev, regmap);
+ return bmi270_core_probe(dev, regmap, chip_info);
}
static const struct i2c_device_id bmi270_i2c_id[] = {
- { "bmi270", 0 },
+ { "bmi270", (kernel_ulong_t)&bmi270_chip_info },
{ }
};
static const struct of_device_id bmi270_of_match[] = {
- { .compatible = "bosch,bmi270" },
+ { .compatible = "bosch,bmi270", .data = &bmi270_chip_info },
{ }
};
diff --git a/drivers/iio/imu/bmi270/bmi270_spi.c b/drivers/iio/imu/bmi270/bmi270_spi.c
index b53784d4a1f4..7c2062c660d9 100644
--- a/drivers/iio/imu/bmi270/bmi270_spi.c
+++ b/drivers/iio/imu/bmi270/bmi270_spi.c
@@ -49,6 +49,11 @@ static int bmi270_spi_probe(struct spi_device *spi)
{
struct regmap *regmap;
struct device *dev = &spi->dev;
+ const struct bmi270_chip_info *chip_info;
+
+ chip_info = spi_get_device_match_data(spi);
+ if (!chip_info)
+ return -ENODEV;
regmap = devm_regmap_init(dev, &bmi270_regmap_bus, dev,
&bmi270_spi_regmap_config);
@@ -56,16 +61,16 @@ static int bmi270_spi_probe(struct spi_device *spi)
return dev_err_probe(dev, PTR_ERR(regmap),
"Failed to init i2c regmap");
- return bmi270_core_probe(dev, regmap);
+ return bmi270_core_probe(dev, regmap, chip_info);
}
static const struct spi_device_id bmi270_spi_id[] = {
- { "bmi270" },
+ { "bmi270", (kernel_ulong_t)&bmi270_chip_info },
{ }
};
static const struct of_device_id bmi270_of_match[] = {
- { .compatible = "bosch,bmi270" },
+ { .compatible = "bosch,bmi270", .data = &bmi270_chip_info },
{ }
};
--
2.47.0
On Sun, 20 Oct 2024 15:00:06 -0700 Justin Weiss <justin@justinweiss.com> wrote: > Prepare the bmi270 driver to support similar devices like the bmi260. > > Signed-off-by: Justin Weiss <justin@justinweiss.com> In the interests of reducing how many patches are in flight I'll pick this one as well. Can't go beyond this point though until patch 3 gets a DT RB. > --- > drivers/iio/imu/bmi270/bmi270.h | 11 ++++++++++- > drivers/iio/imu/bmi270/bmi270_core.c | 18 ++++++++++++++---- > drivers/iio/imu/bmi270/bmi270_i2c.c | 11 ++++++++--- > drivers/iio/imu/bmi270/bmi270_spi.c | 11 ++++++++--- > 4 files changed, 40 insertions(+), 11 deletions(-) > > diff --git a/drivers/iio/imu/bmi270/bmi270.h b/drivers/iio/imu/bmi270/bmi270.h > index 8ac20ad7ee94..93e5f387607b 100644 > --- a/drivers/iio/imu/bmi270/bmi270.h > +++ b/drivers/iio/imu/bmi270/bmi270.h > @@ -10,10 +10,19 @@ struct device; > struct bmi270_data { > struct device *dev; > struct regmap *regmap; > + const struct bmi270_chip_info *chip_info; > +}; > + > +struct bmi270_chip_info { > + const char *name; > + int chip_id; > + const char *fw_name; > }; > > extern const struct regmap_config bmi270_regmap_config; > +extern const struct bmi270_chip_info bmi270_chip_info; > > -int bmi270_core_probe(struct device *dev, struct regmap *regmap); > +int bmi270_core_probe(struct device *dev, struct regmap *regmap, > + const struct bmi270_chip_info *chip_info); > > #endif /* BMI270_H_ */ > diff --git a/drivers/iio/imu/bmi270/bmi270_core.c b/drivers/iio/imu/bmi270/bmi270_core.c > index e598c642178f..5f08d786fa21 100644 > --- a/drivers/iio/imu/bmi270/bmi270_core.c > +++ b/drivers/iio/imu/bmi270/bmi270_core.c > @@ -66,6 +66,13 @@ enum bmi270_scan { > BMI270_SCAN_GYRO_Z, > }; > > +const struct bmi270_chip_info bmi270_chip_info = { > + .name = "bmi270", > + .chip_id = BMI270_CHIP_ID_VAL, > + .fw_name = BMI270_INIT_DATA_FILE, > +}; > +EXPORT_SYMBOL_NS_GPL(bmi270_chip_info, IIO_BMI270); > + > static int bmi270_get_data(struct bmi270_data *bmi270_device, > int chan_type, int axis, int *val) > { > @@ -150,7 +157,7 @@ static int bmi270_validate_chip_id(struct bmi270_data *bmi270_device) > if (ret) > return dev_err_probe(dev, ret, "Failed to read chip id"); > > - if (chip_id != BMI270_CHIP_ID_VAL) > + if (chip_id != bmi270_device->chip_info->chip_id) > dev_info(dev, "Unknown chip id 0x%x", chip_id); > > return 0; > @@ -183,7 +190,8 @@ static int bmi270_write_calibration_data(struct bmi270_data *bmi270_device) > return dev_err_probe(dev, ret, > "Failed to prepare device to load init data"); > > - ret = request_firmware(&init_data, BMI270_INIT_DATA_FILE, dev); > + ret = request_firmware(&init_data, > + bmi270_device->chip_info->fw_name, dev); > if (ret) > return dev_err_probe(dev, ret, "Failed to load init data file"); > > @@ -270,7 +278,8 @@ static int bmi270_chip_init(struct bmi270_data *bmi270_device) > return bmi270_configure_imu(bmi270_device); > } > > -int bmi270_core_probe(struct device *dev, struct regmap *regmap) > +int bmi270_core_probe(struct device *dev, struct regmap *regmap, > + const struct bmi270_chip_info *chip_info) > { > int ret; > struct bmi270_data *bmi270_device; > @@ -283,6 +292,7 @@ int bmi270_core_probe(struct device *dev, struct regmap *regmap) > bmi270_device = iio_priv(indio_dev); > bmi270_device->dev = dev; > bmi270_device->regmap = regmap; > + bmi270_device->chip_info = chip_info; > > ret = bmi270_chip_init(bmi270_device); > if (ret) > @@ -290,7 +300,7 @@ int bmi270_core_probe(struct device *dev, struct regmap *regmap) > > indio_dev->channels = bmi270_channels; > indio_dev->num_channels = ARRAY_SIZE(bmi270_channels); > - indio_dev->name = "bmi270"; > + indio_dev->name = chip_info->name; > indio_dev->modes = INDIO_DIRECT_MODE; > indio_dev->info = &bmi270_info; > > diff --git a/drivers/iio/imu/bmi270/bmi270_i2c.c b/drivers/iio/imu/bmi270/bmi270_i2c.c > index d59161f23f9a..394f27996059 100644 > --- a/drivers/iio/imu/bmi270/bmi270_i2c.c > +++ b/drivers/iio/imu/bmi270/bmi270_i2c.c > @@ -17,22 +17,27 @@ static int bmi270_i2c_probe(struct i2c_client *client) > { > struct regmap *regmap; > struct device *dev = &client->dev; > + const struct bmi270_chip_info *chip_info; > + > + chip_info = i2c_get_match_data(client); > + if (!chip_info) > + return -ENODEV; > > regmap = devm_regmap_init_i2c(client, &bmi270_i2c_regmap_config); > if (IS_ERR(regmap)) > return dev_err_probe(dev, PTR_ERR(regmap), > "Failed to init i2c regmap"); > > - return bmi270_core_probe(dev, regmap); > + return bmi270_core_probe(dev, regmap, chip_info); > } > > static const struct i2c_device_id bmi270_i2c_id[] = { > - { "bmi270", 0 }, > + { "bmi270", (kernel_ulong_t)&bmi270_chip_info }, > { } > }; > > static const struct of_device_id bmi270_of_match[] = { > - { .compatible = "bosch,bmi270" }, > + { .compatible = "bosch,bmi270", .data = &bmi270_chip_info }, > { } > }; > > diff --git a/drivers/iio/imu/bmi270/bmi270_spi.c b/drivers/iio/imu/bmi270/bmi270_spi.c > index b53784d4a1f4..7c2062c660d9 100644 > --- a/drivers/iio/imu/bmi270/bmi270_spi.c > +++ b/drivers/iio/imu/bmi270/bmi270_spi.c > @@ -49,6 +49,11 @@ static int bmi270_spi_probe(struct spi_device *spi) > { > struct regmap *regmap; > struct device *dev = &spi->dev; > + const struct bmi270_chip_info *chip_info; > + > + chip_info = spi_get_device_match_data(spi); > + if (!chip_info) > + return -ENODEV; > > regmap = devm_regmap_init(dev, &bmi270_regmap_bus, dev, > &bmi270_spi_regmap_config); > @@ -56,16 +61,16 @@ static int bmi270_spi_probe(struct spi_device *spi) > return dev_err_probe(dev, PTR_ERR(regmap), > "Failed to init i2c regmap"); > > - return bmi270_core_probe(dev, regmap); > + return bmi270_core_probe(dev, regmap, chip_info); > } > > static const struct spi_device_id bmi270_spi_id[] = { > - { "bmi270" }, > + { "bmi270", (kernel_ulong_t)&bmi270_chip_info }, > { } > }; > > static const struct of_device_id bmi270_of_match[] = { > - { .compatible = "bosch,bmi270" }, > + { .compatible = "bosch,bmi270", .data = &bmi270_chip_info }, > { } > }; >
© 2016 - 2024 Red Hat, Inc.