mirror of
https://github.com/meshtastic/firmware.git
synced 2026-01-16 14:57:41 +00:00
40 lines
956 B
C++
40 lines
956 B
C++
|
#include "STK8XXXSensor.h"
|
||
|
|
|
||
|
|
#if !defined(ARCH_PORTDUINO) && !defined(ARCH_STM32WL) && !MESHTASTIC_EXCLUDE_I2C
|
||
|
|
|
||
|
|
STK8XXXSensor::STK8XXXSensor(ScanI2C::FoundDevice foundDevice) : MotionSensor::MotionSensor(foundDevice) {}
|
||
|
|
|
||
|
|
#ifdef STK8XXX_INT
|
||
|
|
|
||
|
|
volatile static bool STK_IRQ;
|
||
|
|
|
||
|
|
bool STK8XXXSensor::init()
|
||
|
|
{
|
||
|
|
if (sensor.STK8xxx_Initialization(STK8xxx_VAL_RANGE_2G)) {
|
||
|
|
STK_IRQ = false;
|
||
|
|
sensor.STK8xxx_Anymotion_init();
|
||
|
|
pinMode(STK8XXX_INT, INPUT_PULLUP);
|
||
|
|
attachInterrupt(
|
||
|
|
digitalPinToInterrupt(STK8XXX_INT), [] { STK_IRQ = true; }, RISING);
|
||
|
|
|
||
|
|
LOG_DEBUG("STK8XXXSensor::init ok\n");
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
LOG_DEBUG("STK8XXXSensor::init failed\n");
|
||
|
|
return false;
|
||
|
|
}
|
||
|
|
|
||
|
|
int32_t STK8XXXSensor::runOnce()
|
||
|
|
{
|
||
|
|
if (STK_IRQ) {
|
||
|
|
STK_IRQ = false;
|
||
|
|
if (config.display.wake_on_tap_or_motion) {
|
||
|
|
wakeScreen();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return MOTION_SENSOR_CHECK_INTERVAL_MS;
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#endif
|