diff options
Diffstat (limited to 'driver/accelgyro_lsm6dsm.c')
-rw-r--r-- | driver/accelgyro_lsm6dsm.c | 21 |
1 files changed, 3 insertions, 18 deletions
diff --git a/driver/accelgyro_lsm6dsm.c b/driver/accelgyro_lsm6dsm.c index 3383d36741..1a1308c3f5 100644 --- a/driver/accelgyro_lsm6dsm.c +++ b/driver/accelgyro_lsm6dsm.c @@ -514,11 +514,10 @@ __maybe_unused static int irq_handler( * @rnd: Round up/down flag * Note: Range is sensitivity/gain for speed purpose */ -static int set_range(const struct motion_sensor_t *s, int range, int rnd) +static int set_range(struct motion_sensor_t *s, int range, int rnd) { int err; uint8_t ctrl_reg, reg_val; - struct stprivate_data *data = s->drv_data; int newrange = range; switch (s->type) { @@ -551,25 +550,12 @@ static int set_range(const struct motion_sensor_t *s, int range, int rnd) err = st_write_data_with_mask(s, ctrl_reg, LSM6DSM_RANGE_MASK, reg_val); if (err == EC_SUCCESS) /* Save internally gain for speed optimization. */ - data->base.range = newrange; + s->current_range = newrange; mutex_unlock(s->mutex); return err; } /** - * get_range - get full scale range - * @s: Motion sensor pointer - * - * For mag range is fixed to LIS2MDL_RANGE by hardware - */ -static int get_range(const struct motion_sensor_t *s) -{ - struct stprivate_data *data = s->drv_data; - - return data->base.range; -} - -/** * lsm6dsm_set_data_rate * @s: Motion sensor pointer * @range: Rate (mHz) @@ -716,7 +702,7 @@ static int read(const struct motion_sensor_t *s, intv3_t v) return EC_SUCCESS; } -static int init(const struct motion_sensor_t *s) +static int init(struct motion_sensor_t *s) { int ret = 0, tmp; struct stprivate_data *data = s->drv_data; @@ -852,7 +838,6 @@ const struct accelgyro_drv lsm6dsm_drv = { .init = init, .read = read, .set_range = set_range, - .get_range = get_range, .get_resolution = st_get_resolution, .set_data_rate = lsm6dsm_set_data_rate, .get_data_rate = st_get_data_rate, |