lsm6ds: skip reads for disabled sensors
This commit is contained in:
1 parent
41cb715d63
commit
3b86faa445
1 file changed
+2
-2
@@ -101,7 +101,7 @@ void LSM6DSComponent::update() {
|
||||
if (!this->read_register(0x1E, &status, 1))
|
||||
return;
|
||||
|
||||
if (status & 0x01) { // GDA - Gyroscope data available
|
||||
if (this->gyro_odr_ != LSM6DS_ODR_OFF && (status & 0x01)) { // GDA - Gyroscope data available
|
||||
uint8_t data[6];
|
||||
if (this->read_register(0x22, data, 6)) {
|
||||
int16_t gx = encode_uint16(data[1], data[0]);
|
||||
@@ -116,7 +116,7 @@ void LSM6DSComponent::update() {
|
||||
}
|
||||
}
|
||||
|
||||
if (status & 0x02) { // XLDA - Accelerometer data available
|
||||
if (this->accel_odr_ != LSM6DS_ODR_OFF && (status & 0x02)) { // XLDA - Accelerometer data available
|
||||
uint8_t data[6];
|
||||
if (this->read_register(0x28, data, 6)) {
|
||||
int16_t ax = encode_uint16(data[1], data[0]);
|
||||
|
||||
Reference in new issue
Block a user