On Mon, 7 Oct 2019 22:31:49 +0200
Lorenzo Bianconi <lorenzo@xxxxxxxxxx> wrote:
> Introduce odr_len in st_lsm6dsx_odr_table_entry data structure in order
> to explicitly define odr table size and support devices with different
> odr table map
>
> Signed-off-by: Lorenzo Bianconi <lorenzo@xxxxxxxxxx>
Hi Lorenzo,
Patch is fine, but please put it as a precursor in whatever series you have
coming that needs to support a different size.
Thanks,
Jonathan
> ---
> drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h | 2 ++
> drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 26 +++++++++++++++-----
> 2 files changed, 22 insertions(+), 6 deletions(-)
>
> diff --git a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h
> index 30fd274ea8ae..ff7519475478 100644
> --- a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h
> +++ b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h
> @@ -111,7 +111,9 @@ struct st_lsm6dsx_odr {
> #define ST_LSM6DSX_ODR_LIST_SIZE 6
> struct st_lsm6dsx_odr_table_entry {
> struct st_lsm6dsx_reg reg;
> +
> struct st_lsm6dsx_odr odr_avl[ST_LSM6DSX_ODR_LIST_SIZE];
> + int odr_len;
> };
>
> struct st_lsm6dsx_fs {
> diff --git a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c
> index 740912bbf941..98a1fa8d1454 100644
> --- a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c
> +++ b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c
> @@ -131,6 +131,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 238, 0x04 },
> .odr_avl[4] = { 476, 0x05 },
> .odr_avl[5] = { 952, 0x06 },
> + .odr_len = 6,
> },
> [ST_LSM6DSX_ID_GYRO] = {
> .reg = {
> @@ -143,6 +144,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 238, 0x04 },
> .odr_avl[4] = { 476, 0x05 },
> .odr_avl[5] = { 952, 0x06 },
> + .odr_len = 6,
> },
> },
> .fs_table = {
> @@ -230,6 +232,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> [ST_LSM6DSX_ID_GYRO] = {
> .reg = {
> @@ -242,6 +245,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> },
> .fs_table = {
> @@ -394,6 +398,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> [ST_LSM6DSX_ID_GYRO] = {
> .reg = {
> @@ -406,6 +411,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> },
> .fs_table = {
> @@ -567,6 +573,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> [ST_LSM6DSX_ID_GYRO] = {
> .reg = {
> @@ -579,6 +586,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> },
> .fs_table = {
> @@ -738,6 +746,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> [ST_LSM6DSX_ID_GYRO] = {
> .reg = {
> @@ -750,6 +759,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> },
> .fs_table = {
> @@ -928,6 +938,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> [ST_LSM6DSX_ID_GYRO] = {
> .reg = {
> @@ -940,6 +951,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> },
> .fs_table = {
> @@ -1095,6 +1107,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> [ST_LSM6DSX_ID_GYRO] = {
> .reg = {
> @@ -1107,6 +1120,7 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = {
> .odr_avl[3] = { 104, 0x04 },
> .odr_avl[4] = { 208, 0x05 },
> .odr_avl[5] = { 416, 0x06 },
> + .odr_len = 6,
> },
> },
> .fs_table = {
> @@ -1329,7 +1343,7 @@ int st_lsm6dsx_check_odr(struct st_lsm6dsx_sensor *sensor, u16 odr, u8 *val)
> int i;
>
> odr_table = &sensor->hw->settings->odr_table[sensor->id];
> - for (i = 0; i < ST_LSM6DSX_ODR_LIST_SIZE; i++)
> + for (i = 0; i < odr_table->odr_len; i++)
> /*
> * ext devices can run at different odr respect to
> * accel sensor
> @@ -1337,7 +1351,7 @@ int st_lsm6dsx_check_odr(struct st_lsm6dsx_sensor *sensor, u16 odr, u8 *val)
> if (odr_table->odr_avl[i].hz >= odr)
> break;
>
> - if (i == ST_LSM6DSX_ODR_LIST_SIZE)
> + if (i == odr_table->odr_len)
> return -EINVAL;
>
> *val = odr_table->odr_avl[i].val;
> @@ -1688,13 +1702,13 @@ st_lsm6dsx_sysfs_sampling_frequency_avail(struct device *dev,
> char *buf)
> {
> struct st_lsm6dsx_sensor *sensor = iio_priv(dev_get_drvdata(dev));
> - enum st_lsm6dsx_sensor_id id = sensor->id;
> - struct st_lsm6dsx_hw *hw = sensor->hw;
> + const struct st_lsm6dsx_odr_table_entry *odr_table;
> int i, len = 0;
>
> - for (i = 0; i < ST_LSM6DSX_ODR_LIST_SIZE; i++)
> + odr_table = &sensor->hw->settings->odr_table[sensor->id];
> + for (i = 0; i < odr_table->odr_len; i++)
> len += scnprintf(buf + len, PAGE_SIZE - len, "%d ",
> - hw->settings->odr_table[id].odr_avl[i].hz);
> + odr_table->odr_avl[i].hz);
> buf[len - 1] = '\n';
>
> return len;
