Signed-off-by: 吴文峰 <kevin@lmve.net>

2026-03-06 16:14:00 +08:00
parent 47d5814325
commit 1ad2934389
1451 changed files with 242614 additions and 0 deletions
@@ -0,0 +1,90 @@
+#include "MotionSensor.h"
+#include "graphics/draw/CompassRenderer.h"
+
+#if !defined(ARCH_STM32WL) && !MESHTASTIC_EXCLUDE_I2C
+
+char timeRemainingBuffer[12];
+
+// screen is defined in main.cpp
+extern graphics::Screen *screen;
+
+MotionSensor::MotionSensor(ScanI2C::FoundDevice foundDevice)
+{
+    device.address.address = foundDevice.address.address;
+    device.address.port = foundDevice.address.port;
+    device.type = foundDevice.type;
+    LOG_DEBUG("Motion MotionSensor port: %s address: 0x%x type: %d", devicePort() == ScanI2C::I2CPort::WIRE1 ? "Wire1" : "Wire",
+              (uint8_t)deviceAddress(), deviceType());
+}
+
+ScanI2C::DeviceType MotionSensor::deviceType()
+{
+    return device.type;
+}
+
+uint8_t MotionSensor::deviceAddress()
+{
+    return device.address.address;
+}
+
+ScanI2C::I2CPort MotionSensor::devicePort()
+{
+    return device.address.port;
+}
+
+#if !defined(MESHTASTIC_EXCLUDE_SCREEN) && HAS_SCREEN
+void MotionSensor::drawFrameCalibration(OLEDDisplay *display, OLEDDisplayUiState *state, int16_t x, int16_t y)
+{
+    if (screen == nullptr)
+        return;
+    // int x_offset = display->width() / 2;
+    // int y_offset = display->height() <= 80 ? 0 : 32;
+    display->setTextAlignment(TEXT_ALIGN_LEFT);
+    display->setFont(FONT_MEDIUM);
+    display->drawString(x, y, "Calibrating\nCompass");
+
+    uint8_t timeRemaining = (screen->getEndCalibration() - millis()) / 1000;
+    sprintf(timeRemainingBuffer, "( %02d )", timeRemaining);
+    display->setFont(FONT_SMALL);
+    display->drawString(x, y + 40, timeRemainingBuffer);
+
+    int16_t compassX = 0, compassY = 0;
+    uint16_t compassDiam = graphics::CompassRenderer::getCompassDiam(display->getWidth(), display->getHeight());
+
+    // coordinates for the center of the compass/circle
+    if (config.display.displaymode == meshtastic_Config_DisplayConfig_DisplayMode_DEFAULT) {
+        compassX = x + display->getWidth() - compassDiam / 2 - 5;
+        compassY = y + display->getHeight() / 2;
+    } else {
+        compassX = x + display->getWidth() - compassDiam / 2 - 5;
+        compassY = y + FONT_HEIGHT_SMALL + (display->getHeight() - FONT_HEIGHT_SMALL) / 2;
+    }
+    display->drawCircle(compassX, compassY, compassDiam / 2);
+    graphics::CompassRenderer::drawCompassNorth(display, compassX, compassY, screen->getHeading() * PI / 180, (compassDiam / 2));
+}
+#endif
+
+#if !MESHTASTIC_EXCLUDE_POWER_FSM
+void MotionSensor::wakeScreen()
+{
+    if (powerFSM.getState() == &stateDARK) {
+        LOG_DEBUG("Motion wakeScreen detected");
+        powerFSM.trigger(EVENT_INPUT);
+    }
+}
+
+void MotionSensor::buttonPress()
+{
+    LOG_DEBUG("Motion buttonPress detected");
+    powerFSM.trigger(EVENT_PRESS);
+}
+
+#else
+
+void MotionSensor::wakeScreen() {}
+
+void MotionSensor::buttonPress() {}
+
+#endif
+
+#endif