315 lines
7.9 KiB
C++
315 lines
7.9 KiB
C++
constexpr const char * const TAG = "BOBBY";
|
|
|
|
#ifndef OTA_USERNAME
|
|
#error No OTA username!
|
|
#endif
|
|
|
|
// system includes
|
|
#include <cstdio>
|
|
|
|
// esp-idf includes
|
|
#include <esp_log.h>
|
|
|
|
// Arduino includes
|
|
#include <Arduino.h>
|
|
|
|
// 3rdparty lib includes
|
|
#include <espchrono.h>
|
|
using namespace std::chrono_literals;
|
|
#include <espwifistack.h>
|
|
#include <schedulertask.h>
|
|
|
|
// local includes
|
|
#include "bobbycar-common.h"
|
|
#include "bobbycar-serial.h"
|
|
#include "macros_bobbycar.h"
|
|
#include "globals.h"
|
|
#include "screens.h"
|
|
#ifdef FEATURE_OTA
|
|
#include "ota.h"
|
|
#include "displays/menus/selectbuildservermenu.h"
|
|
#endif
|
|
#include "presets.h"
|
|
#include "statistics.h"
|
|
#ifdef FEATURE_BLE
|
|
#include "ble_bobby.h"
|
|
#endif
|
|
#ifdef FEATURE_WEBSERVER
|
|
#include "webserver.h"
|
|
#endif
|
|
#ifdef FEATURE_CLOUD
|
|
#include "cloud.h"
|
|
#include "udpcloud.h"
|
|
#endif
|
|
#include "wifi_bobbycar.h"
|
|
#ifdef FEATURE_LEDSTRIP
|
|
#include "ledstrip.h"
|
|
#endif
|
|
#include "modes/defaultmode.h"
|
|
#include "displays/statusdisplay.h"
|
|
#include "displays/lockscreen.h"
|
|
#include "displays/calibratedisplay.h"
|
|
#ifdef FEATURE_DNS_NS
|
|
#include "dnsannounce.h"
|
|
#endif
|
|
#include "drivingstatistics.h"
|
|
#include "newsettings.h"
|
|
#ifdef FEATURE_ESPNOW
|
|
#include "espnowfunctions.h"
|
|
#endif
|
|
#include "taskmanager.h"
|
|
|
|
namespace {
|
|
std::optional<espchrono::millis_clock::time_point> lastModeUpdate;
|
|
std::optional<espchrono::millis_clock::time_point> lastStatsUpdate;
|
|
std::optional<espchrono::millis_clock::time_point> lastDisplayUpdate;
|
|
std::optional<espchrono::millis_clock::time_point> lastDisplayRedraw;
|
|
#ifdef FEATURE_BLE
|
|
std::optional<espchrono::millis_clock::time_point> lastBleUpdate;
|
|
#endif
|
|
#ifdef FEATURE_CLOUD
|
|
std::optional<espchrono::millis_clock::time_point> lastCloudCollect;
|
|
std::optional<espchrono::millis_clock::time_point> lastCloudSend;
|
|
#endif
|
|
#ifdef FEATURE_LEDSTRIP
|
|
std::optional<espchrono::millis_clock::time_point> lastLedstripUpdate;
|
|
#endif
|
|
}
|
|
|
|
extern "C" void app_main()
|
|
{
|
|
#ifdef FEATURE_LEDBACKLIGHT
|
|
pinMode(PINS_LEDBACKLIGHT, OUTPUT);
|
|
digitalWrite(PINS_LEDBACKLIGHT, ledBacklightInverted ? LOW : HIGH);
|
|
#endif
|
|
|
|
pinMode(3, INPUT_PULLUP);
|
|
|
|
currentlyReverseBeeping = false;
|
|
|
|
initScreen();
|
|
|
|
bootLabel.redraw("settings");
|
|
|
|
if (const auto result = configs.init("bobbycar"); result != ESP_OK)
|
|
ESP_LOGE(TAG, "config_init_settings() failed with %s", esp_err_to_name(result));
|
|
|
|
settings = presets::defaultSettings;
|
|
stringSettings = presets::makeDefaultStringSettings();
|
|
|
|
if (settingsPersister.init())
|
|
{
|
|
if (!settingsPersister.openCommon())
|
|
ESP_LOGE("BOBBY", "openCommon() failed");
|
|
|
|
if (!settingsPersister.openProfile(0))
|
|
ESP_LOGE("BOBBY", "openProfile(0) failed");
|
|
|
|
loadSettings();
|
|
}
|
|
else
|
|
ESP_LOGE("BOBBY", "init() failed");
|
|
|
|
bootLabel.redraw("deviceName");
|
|
if (const auto result = wifi_stack::get_default_mac_addr())
|
|
std::sprintf(deviceName, STRING(DEVICE_PREFIX) "_%02hhx%02hhx%02hhx", result->at(3), result->at(4), result->at(5));
|
|
else
|
|
ESP_LOGE("MAIN", "get_default_mac_addr() failed: %.*s", result.error().size(), result.error().data());
|
|
|
|
for (const auto &task : schedulerTasks)
|
|
{
|
|
bootLabel.redraw(task.name());
|
|
task.setup();
|
|
}
|
|
|
|
#ifdef FEATURE_LEDSTRIP
|
|
bootLabel.redraw("LED strip");
|
|
initLedStrip();
|
|
#endif
|
|
|
|
for (Controller &controller : controllers)
|
|
controller.command.buzzer = {};
|
|
|
|
currentMode = &modes::defaultMode;
|
|
|
|
#ifdef FEATURE_OTA
|
|
bootLabel.redraw("ota");
|
|
initOta();
|
|
#endif
|
|
|
|
#ifdef FEATURE_BLE
|
|
bootLabel.redraw("ble");
|
|
initBle();
|
|
#endif
|
|
|
|
#ifdef FEATURE_WEBSERVER
|
|
bootLabel.redraw("webserver");
|
|
initWebserver();
|
|
#endif
|
|
|
|
bootLabel.redraw("potis");
|
|
readPotis();
|
|
|
|
#ifdef FEATURE_CLOUD
|
|
bootLabel.redraw("cloud");
|
|
initCloud();
|
|
#endif
|
|
|
|
bootLabel.redraw("switchScreen");
|
|
|
|
#if defined(FEATURE_DPAD_5WIRESW) && defined(DPAD_5WIRESW_DEBUG)
|
|
switchScreen<DPad5WireDebugDisplay>();
|
|
#elif defined(FEATURE_DPAD_5WIRESW_2OUT) && defined(DPAD_5WIRESW_DEBUG)
|
|
switchScreen<DPad5Wire2OutDebugDisplay>();
|
|
#elif defined(FEATURE_DPAD_6WIRESW) && defined(DPAD_6WIRESW_DEBUG)
|
|
switchScreen<DPad6WireDebugDisplay>();
|
|
#else
|
|
|
|
if (settings.lockscreen.keepLockedAfterReboot && settings.lockscreen.locked)
|
|
{
|
|
espgui::switchScreen<Lockscreen>();
|
|
}
|
|
else
|
|
{
|
|
if (!gas || !brems || *gas > 200.f || *brems > 200.f)
|
|
espgui::switchScreen<CalibrateDisplay>(true);
|
|
else
|
|
{
|
|
espgui::switchScreen<StatusDisplay>();
|
|
}
|
|
}
|
|
#endif
|
|
#ifdef FEATURE_ESPNOW
|
|
espnow::initESPNow();
|
|
#endif
|
|
|
|
while (true)
|
|
{
|
|
const auto now = espchrono::millis_clock::now();
|
|
|
|
for (auto &schedulerTask : schedulerTasks)
|
|
{
|
|
schedulerTask.loop();
|
|
}
|
|
|
|
if (!lastModeUpdate || now - *lastModeUpdate >= 1000ms/settings.boardcomputerHardware.timersSettings.modeUpdateRate)
|
|
{
|
|
if (lastMode != currentMode)
|
|
{
|
|
if (lastMode)
|
|
lastMode->stop();
|
|
lastMode = currentMode;
|
|
if (currentMode)
|
|
currentMode->start();
|
|
}
|
|
|
|
if (currentMode)
|
|
currentMode->update();
|
|
|
|
lastModeUpdate = now;
|
|
|
|
performance.current++;
|
|
}
|
|
|
|
if (!lastStatsUpdate || now - *lastStatsUpdate >= 1000ms/settings.boardcomputerHardware.timersSettings.statsUpdateRate)
|
|
{
|
|
updateAccumulators();
|
|
pushStats();
|
|
lastStatsUpdate = now;
|
|
}
|
|
|
|
if (!lastDisplayUpdate || now - *lastDisplayUpdate >= 1000ms/settings.boardcomputerHardware.timersSettings.displayUpdateRate)
|
|
{
|
|
updateDisplay();
|
|
|
|
lastDisplayUpdate = now;
|
|
}
|
|
|
|
if (!lastDisplayRedraw || now - *lastDisplayRedraw >= 1000ms/settings.boardcomputerHardware.timersSettings.displayRedrawRate)
|
|
{
|
|
redrawDisplay();
|
|
|
|
lastDisplayRedraw = now;
|
|
}
|
|
|
|
if (now - performance.lastTime >= 1000ms)
|
|
{
|
|
performance.last = performance.current;
|
|
performance.current = 0;
|
|
performance.lastTime = now;
|
|
}
|
|
|
|
#ifdef FEATURE_OTA
|
|
handleOta();
|
|
#endif
|
|
|
|
#ifdef FEATURE_BLE
|
|
if (!lastBleUpdate || now - *lastBleUpdate >= 250ms)
|
|
{
|
|
handleBle();
|
|
|
|
lastBleUpdate = now;
|
|
}
|
|
#endif
|
|
|
|
#ifdef FEATURE_ESPNOW
|
|
espnow::handle();
|
|
#endif
|
|
|
|
#ifdef FEATURE_CLOUD
|
|
if (!lastCloudCollect || now - *lastCloudCollect >= std::chrono::milliseconds{settings.boardcomputerHardware.timersSettings.cloudCollectRate})
|
|
{
|
|
cloudCollect();
|
|
|
|
lastCloudCollect = now;
|
|
}
|
|
|
|
if (!lastCloudSend || now - *lastCloudSend >= 1000ms/settings.boardcomputerHardware.timersSettings.cloudSendRate)
|
|
{
|
|
cloudSend();
|
|
|
|
lastCloudSend = now;
|
|
}
|
|
#endif
|
|
|
|
#ifdef FEATURE_WEBSERVER
|
|
handleWebserver();
|
|
#endif
|
|
|
|
#ifdef FEATURE_BMS
|
|
bms::update();
|
|
#endif
|
|
|
|
#ifdef FEATURE_LEDSTRIP
|
|
if (!lastLedstripUpdate || now - *lastLedstripUpdate >= 1000ms / 60)
|
|
{
|
|
updateLedStrip();
|
|
|
|
lastLedstripUpdate = now;
|
|
}
|
|
#endif
|
|
#ifdef FEATURE_DNS_NS
|
|
handle_dns_announce();
|
|
#endif
|
|
calculateStatistics();
|
|
#ifdef FEATURE_CLOUD
|
|
if (settings.cloudSettings.udpCloudEnabled)
|
|
sendUdpCloudPacket();
|
|
#endif
|
|
if (battery::bootBatPercentage == -1)
|
|
{
|
|
if(controllers.front.feedbackValid && controllers.back.feedbackValid)
|
|
{
|
|
float avgVoltage = 0;
|
|
for (auto &controller : controllers)
|
|
{
|
|
avgVoltage += controller.getCalibratedVoltage();
|
|
}
|
|
avgVoltage = avgVoltage / controllers.size();
|
|
if (avgVoltage > 30)
|
|
battery::bootBatPercentage = getBatteryPercentage(avgVoltage, BatteryCellType(settings.battery.cellType));
|
|
}
|
|
}
|
|
}
|
|
}
|