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