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))
|
if (!this->read_register(0x1E, &status, 1))
|
||||||
return;
|
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];
|
uint8_t data[6];
|
||||||
if (this->read_register(0x22, data, 6)) {
|
if (this->read_register(0x22, data, 6)) {
|
||||||
int16_t gx = encode_uint16(data[1], data[0]);
|
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];
|
uint8_t data[6];
|
||||||
if (this->read_register(0x28, data, 6)) {
|
if (this->read_register(0x28, data, 6)) {
|
||||||
int16_t ax = encode_uint16(data[1], data[0]);
|
int16_t ax = encode_uint16(data[1], data[0]);
|
||||||
|
|||||||
Reference in new issue
Block a user