sforkowany z mirror/meshtastic-firmware
93 wiersze
3.0 KiB
C++
93 wiersze
3.0 KiB
C++
#include "PowerFSM.h"
|
|
#include "concurrency/OSThread.h"
|
|
#include "configuration.h"
|
|
#include "main.h"
|
|
#include "power.h"
|
|
|
|
#include <Adafruit_LIS3DH.h>
|
|
#include <Adafruit_MPU6050.h>
|
|
|
|
#define ACCELEROMETER_CHECK_INTERVAL_MS 100
|
|
#define ACCELEROMETER_CLICK_THRESHOLD 40
|
|
|
|
namespace concurrency
|
|
{
|
|
class AccelerometerThread : public concurrency::OSThread
|
|
{
|
|
public:
|
|
AccelerometerThread(ScanI2C::DeviceType type = ScanI2C::DeviceType::NONE) : OSThread("AccelerometerThread")
|
|
{
|
|
if (accelerometer_found.port == ScanI2C::I2CPort::NO_I2C) {
|
|
LOG_DEBUG("AccelerometerThread disabling due to no sensors found\n");
|
|
disable();
|
|
return;
|
|
}
|
|
|
|
if (!config.display.wake_on_tap_or_motion && !config.device.double_tap_as_button_press) {
|
|
LOG_DEBUG("AccelerometerThread disabling due to no interested configurations\n");
|
|
disable();
|
|
return;
|
|
}
|
|
|
|
accleremoter_type = type;
|
|
LOG_DEBUG("AccelerometerThread initializing\n");
|
|
|
|
if (accleremoter_type == ScanI2C::DeviceType::MPU6050 && mpu.begin(accelerometer_found.address)) {
|
|
LOG_DEBUG("MPU6050 initializing\n");
|
|
// setup motion detection
|
|
mpu.setHighPassFilter(MPU6050_HIGHPASS_0_63_HZ);
|
|
mpu.setMotionDetectionThreshold(1);
|
|
mpu.setMotionDetectionDuration(20);
|
|
mpu.setInterruptPinLatch(true); // Keep it latched. Will turn off when reinitialized.
|
|
mpu.setInterruptPinPolarity(true);
|
|
} else if (accleremoter_type == ScanI2C::DeviceType::LIS3DH && lis.begin(accelerometer_found.address)) {
|
|
LOG_DEBUG("LIS3DH initializing\n");
|
|
lis.setRange(LIS3DH_RANGE_2_G);
|
|
// Adjust threshhold, higher numbers are less sensitive
|
|
lis.setClick(config.device.double_tap_as_button_press ? 2 : 1, ACCELEROMETER_CLICK_THRESHOLD);
|
|
}
|
|
}
|
|
|
|
protected:
|
|
int32_t runOnce() override
|
|
{
|
|
canSleep = true; // Assume we should not keep the board awake
|
|
|
|
if (accleremoter_type == ScanI2C::DeviceType::MPU6050 && mpu.getMotionInterruptStatus()) {
|
|
wakeScreen();
|
|
} else if (accleremoter_type == ScanI2C::DeviceType::LIS3DH && lis.getClick() > 0) {
|
|
uint8_t click = lis.getClick();
|
|
if (!config.device.double_tap_as_button_press) {
|
|
wakeScreen();
|
|
}
|
|
|
|
if (config.device.double_tap_as_button_press && (click & 0x20)) {
|
|
buttonPress();
|
|
return 500;
|
|
}
|
|
}
|
|
return ACCELEROMETER_CHECK_INTERVAL_MS;
|
|
}
|
|
|
|
private:
|
|
void wakeScreen()
|
|
{
|
|
if (powerFSM.getState() == &stateDARK) {
|
|
LOG_INFO("Tap or motion detected. Turning on screen\n");
|
|
powerFSM.trigger(EVENT_INPUT);
|
|
}
|
|
}
|
|
|
|
void buttonPress()
|
|
{
|
|
LOG_DEBUG("Double-tap detected. Firing button press\n");
|
|
powerFSM.trigger(EVENT_PRESS);
|
|
}
|
|
|
|
ScanI2C::DeviceType accleremoter_type;
|
|
Adafruit_MPU6050 mpu;
|
|
Adafruit_LIS3DH lis;
|
|
};
|
|
|
|
} // namespace concurrency
|