mirror of
https://github.com/meshtastic/firmware.git
synced 2026-01-13 05:17:34 +00:00
92 lines
2.7 KiB
C++
Executable File
92 lines
2.7 KiB
C++
Executable File
#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");
|
|
if (config.display.wake_on_tap_or_motion)
|
|
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
|