diff --git a/input_devices/imu/LSM6DSV16X/hello.LSM6DSV16X.fusion.ino b/input_devices/imu/LSM6DSV16X/hello.LSM6DSV16X.fusion.ino index 35c585f2b5f4ff607ba1ab19513309d6149b007a..77de5cec5d291808a3bf48eb89c3a5bb3f07dffb 100644 --- a/input_devices/imu/LSM6DSV16X/hello.LSM6DSV16X.fusion.ino +++ b/input_devices/imu/LSM6DSV16X/hello.LSM6DSV16X.fusion.ino @@ -157,9 +157,9 @@ void setup() { I2C_write_reg(address,0x12,0x44); // CTRL3: block data update, auto inc addresses I2C_write_reg(address,0x13,0x00); // CTRL4: for interrupts I2C_write_reg(address,0x14,0x00); // CTRL5: for interrupts - I2C_write_reg(address,0x15,0x04); // CTRL6: gyro 2000 dps + I2C_write_reg(address,0x15,0x03); // CTRL6: gyro 1000 dps I2C_write_reg(address,0x16,0x00); // CTRL7: analog hub - I2C_write_reg(address,0x17,0x01); // CTRL8: accel 4g + I2C_write_reg(address,0x17,0x00); // CTRL8: accel 2g I2C_write_reg(address,0x18,0x00); // CTRL9: accel filter I2C_write_reg(address,0x19,0x00); // CTRL10: self test // @@ -172,7 +172,7 @@ void setup() { I2C_write_reg(address,0x05,0); // EMB_FUNC_EN_B: embedded functions I2C_write_reg(address,0x07,0); // FIFO_CTRL1: watermark I2C_write_reg(address,0x08,0); // FIFO_CTRL2: modes - I2C_write_reg(address,0x09,0b01100110); // FIFO_CTRL3: 0 accel gyro not batched 0b01100110 120 Hz gyro and accel batch + I2C_write_reg(address,0x09,0b01100110); // FIFO_CTRL3: 0 accel gyro not batched 0b01100110 120 Hz gyro and accel batch I2C_write_reg(address,0x0A,0b00000110); // FIFO_CTRL4: continuous mode I2C_write_reg(address,0x5E,0b01011011); // SFLP_ODR: 120 Hz sensor fusion output data rate }