diff options
Diffstat (limited to 'driver')
-rw-r--r-- | driver/accelgyro_lsm6dso.c | 5 | ||||
-rw-r--r-- | driver/accelgyro_lsm6dso.h | 4 |
2 files changed, 4 insertions, 5 deletions
diff --git a/driver/accelgyro_lsm6dso.c b/driver/accelgyro_lsm6dso.c index a23ea2c393..ca4d85edb8 100644 --- a/driver/accelgyro_lsm6dso.c +++ b/driver/accelgyro_lsm6dso.c @@ -208,7 +208,7 @@ static int accelgyro_config_fifo(const struct motion_sensor_t *s) */ samples_to_discard[s->type] = LSM6DSO_DISCARD_SAMPLES; - fifo_odr_mask = LSM6DSO_FIFO_ODR_TO_REG(s); + fifo_odr_mask = LSM6DSO_FIFO_ODR_MASK(s); reg_val = LSM6DSO_ODR_TO_REG(data->base.odr); err = st_write_data_with_mask(s, LSM6DSO_FIFO_CTRL3_ADDR, fifo_odr_mask, reg_val); @@ -333,8 +333,7 @@ static int set_data_rate(const struct motion_sensor_t *s, int rate, int rnd) } if (normalized_rate < LSM6DSO_ODR_MIN_VAL || - normalized_rate > MIN(LSM6DSO_ODR_MAX_VAL, - CONFIG_EC_MAX_SENSOR_FREQ_MILLIHZ)) + normalized_rate > LSM6DSO_ODR_MAX_VAL) return EC_RES_INVALID_PARAM; } diff --git a/driver/accelgyro_lsm6dso.h b/driver/accelgyro_lsm6dso.h index a823fe7e61..a786f5adf0 100644 --- a/driver/accelgyro_lsm6dso.h +++ b/driver/accelgyro_lsm6dso.h @@ -128,7 +128,7 @@ struct lsm6dso_fstatus { /* ODR reg value from selected data rate in mHz */ #define LSM6DSO_ODR_TO_REG(_odr) (__fls(_odr / LSM6DSO_ODR_MIN_VAL) + 1) -#define LSM6DSO_FIFO_ODR_TO_REG(_s) \ +#define LSM6DSO_FIFO_ODR_MASK(_s) \ (_s->type == MOTIONSENSE_TYPE_ACCEL ? LSM6DSO_FIFO_ODR_XL_MASK : \ LSM6DSO_FIFO_ODR_G_MASK) @@ -221,7 +221,7 @@ struct lsm6dso_data { #define LSM6DSO_GET_DATA(_s) ((struct stprivate_data *)((_s)->drv_data)) /* Macro to initialize motion_sensors structure */ -#define LSM6DSO_ST_DATA(g, type) (&(&(g))->st_data[(type)]) +#define LSM6DSO_ST_DATA(g, type) (&((g).st_data[type])) #define LSM6DSO_MAIN_SENSOR(_s) ((_s) - (_s)->type) extern const struct accelgyro_drv lsm6dso_drv; |