2024-09-25 21:25:31 +10:00
|
|
|
#include "MPU6050Sensor.h"
|
|
|
|
|
|
2025-04-28 18:35:13 -05:00
|
|
|
#if !defined(ARCH_STM32WL) && !MESHTASTIC_EXCLUDE_I2C && __has_include(<Adafruit_MPU6050.h>)
|
2024-09-25 21:25:31 +10:00
|
|
|
|
|
|
|
|
MPU6050Sensor::MPU6050Sensor(ScanI2C::FoundDevice foundDevice) : MotionSensor::MotionSensor(foundDevice) {}
|
|
|
|
|
|
|
|
|
|
bool MPU6050Sensor::init()
|
|
|
|
|
{
|
|
|
|
|
if (sensor.begin(deviceAddress())) {
|
|
|
|
|
// setup motion detection
|
|
|
|
|
sensor.setHighPassFilter(MPU6050_HIGHPASS_0_63_HZ);
|
|
|
|
|
sensor.setMotionDetectionThreshold(1);
|
|
|
|
|
sensor.setMotionDetectionDuration(20);
|
|
|
|
|
sensor.setInterruptPinLatch(true); // Keep it latched. Will turn off when reinitialized.
|
|
|
|
|
sensor.setInterruptPinPolarity(true);
|
2024-11-04 19:15:59 -06:00
|
|
|
LOG_DEBUG("MPU6050 init ok");
|
2024-09-25 21:25:31 +10:00
|
|
|
return true;
|
|
|
|
|
}
|
2024-11-04 19:15:59 -06:00
|
|
|
LOG_DEBUG("MPU6050 init failed");
|
2024-09-25 21:25:31 +10:00
|
|
|
return false;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int32_t MPU6050Sensor::runOnce()
|
|
|
|
|
{
|
|
|
|
|
if (sensor.getMotionInterruptStatus()) {
|
|
|
|
|
wakeScreen();
|
|
|
|
|
}
|
|
|
|
|
return MOTION_SENSOR_CHECK_INTERVAL_MS;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#endif
|