diff options
Diffstat (limited to 'driver/accelgyro_lsm6ds0.c')
-rw-r--r-- | driver/accelgyro_lsm6ds0.c | 17 |
1 files changed, 4 insertions, 13 deletions
diff --git a/driver/accelgyro_lsm6ds0.c b/driver/accelgyro_lsm6ds0.c index dee3e7d622..62996825ac 100644 --- a/driver/accelgyro_lsm6ds0.c +++ b/driver/accelgyro_lsm6ds0.c @@ -426,29 +426,20 @@ static int init(const struct motion_sensor_t *s) if (ret) return EC_ERROR_UNKNOWN; - ret = set_range(s, s->runtime_config.range, 1); - if (ret) - return EC_ERROR_UNKNOWN; - - ret = set_data_rate(s, s->runtime_config.odr, 1); + ret = set_range(s, s->default_range, 1); if (ret) return EC_ERROR_UNKNOWN; } if (MOTIONSENSE_TYPE_GYRO == s->type) { /* Config GYRO Range */ - ret = set_range(s, s->runtime_config.range, 1); - if (ret) - return EC_ERROR_UNKNOWN; - - /* Config ACCEL & GYRO ODR */ - ret = set_data_rate(s, s->runtime_config.odr, 1); + ret = set_range(s, s->default_range, 1); if (ret) return EC_ERROR_UNKNOWN; } - CPRINTF("[%T %s: MS Done Init type:0x%X range:%d odr:%d]\n", - s->name, s->type, get_range(s), get_data_rate(s)); + CPRINTF("[%T %s: MS Done Init type:0x%X range:%d]\n", + s->name, s->type, get_range(s)); return ret; } |