mirror of
https://github.com/meshtastic/firmware.git
synced 2025-06-11 07:32:14 +00:00
3a6fc668d8
* Add __has_include blocks for sensors * Put BMP and BME back in the right sensors * Split environmental_base to environmental_extra, to compile the working sensor libs for Native * Remove hard-coded checks for ARCH_PORTDUINO * Un-clobber bmx160 * Move BusIO to environmental_extra due to Armv7 compile error * Move to forked BusIO for the moment * Switch to Meshtastic ICM-20948 lib for Portduino support * Use 20948 for compass direction * Compass is more than just RAK4631 * Cleanup for 20948 compass * use Meshtastic branch of 20948 lib * Check for HAS_SCREEN for showing calibration screen * No accelerometerThread on STM32
87 lines
2.6 KiB
C++
Executable File
87 lines
2.6 KiB
C++
Executable File
#include "MotionSensor.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)
|
|
{
|
|
// 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::Screen::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);
|
|
screen->drawCompassNorth(display, compassX, compassY, screen->getHeading() * PI / 180);
|
|
}
|
|
#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 |