Files
firmware/src/motion/LSM6DS3Sensor.cpp

32 lines
890 B
C++
Raw Normal View History

#include "LSM6DS3Sensor.h"
2024-10-24 21:58:24 +02:00
#include "NodeDB.h"
#if !defined(ARCH_STM32WL) && !MESHTASTIC_EXCLUDE_I2C && __has_include(<Adafruit_LSM6DS3TRC.h>)
LSM6DS3Sensor::LSM6DS3Sensor(ScanI2C::FoundDevice foundDevice) : MotionSensor::MotionSensor(foundDevice) {}
2026-01-03 21:19:24 +01:00
bool LSM6DS3Sensor::init() {
if (sensor.begin_I2C(deviceAddress())) {
2026-01-03 21:19:24 +01:00
// Default threshold of 2G, less sensitive options are 4, 8 or 16G
sensor.setAccelRange(LSM6DS_ACCEL_RANGE_2_G);
2026-01-03 21:19:24 +01:00
// Duration is number of occurrences needed to trigger, higher threshold is less sensitive
sensor.enableWakeup(config.display.wake_on_tap_or_motion, 1, LSM6DS3_WAKE_THRESH);
2026-01-03 21:19:24 +01:00
LOG_DEBUG("LSM6DS3 init ok");
return true;
}
LOG_DEBUG("LSM6DS3 init failed");
return false;
}
2026-01-03 21:19:24 +01:00
int32_t LSM6DS3Sensor::runOnce() {
if (sensor.shake()) {
wakeScreen();
return 500;
}
return MOTION_SENSOR_CHECK_INTERVAL_MS;
}
#endif