337 lines
11 KiB
C++
337 lines
11 KiB
C++
#define DEBUGLOG_DEFAULT_LOG_LEVEL_DEBUG
|
|
|
|
// Arduino Libraries
|
|
#include <Arduino.h>
|
|
#include <DebugLog.h>
|
|
#include <DebugLogEnable.h>
|
|
#include <SPI.h>
|
|
#include <WiFi.h>
|
|
#include <ArduinoJson.h>
|
|
|
|
// Definitions
|
|
#include <tasks.h>
|
|
#include <devices.h>
|
|
#include <datasave.h>
|
|
#include <webserver.h>
|
|
#include <ui.h>
|
|
|
|
// Defines to enable channel B
|
|
#define CH_B_ENABLE
|
|
#define TEST
|
|
|
|
// Debug Defines
|
|
#define WIFI_SSID "AstroRotaxMonitor"
|
|
#define WIFI_PASSWORD "maledettirotax"
|
|
|
|
void setup()
|
|
{
|
|
Serial.begin(921600);
|
|
delay(250);
|
|
|
|
// Setup Logger
|
|
LOG_ATTACH_SERIAL(Serial);
|
|
LOG_SET_LEVEL(DebugLogLevel::LVL_INFO);
|
|
|
|
// Print Processor Info
|
|
LOG_DEBUG("ESP32 Chip:", ESP.getChipModel());
|
|
if (psramFound())
|
|
{
|
|
LOG_DEBUG("ESP32 PSram Found");
|
|
LOG_DEBUG("ESP32 PSram:", ESP.getPsramSize());
|
|
psramInit();
|
|
}
|
|
LOG_DEBUG("ESP32 Flash:", ESP.getFlashChipSize());
|
|
LOG_DEBUG("ESP32 Heap:", ESP.getHeapSize());
|
|
LOG_DEBUG("ESP32 Sketch:", ESP.getFreeSketchSpace());
|
|
|
|
// Init Wifi station
|
|
LOG_INFO("Initializing WiFi...");
|
|
WiFi.mode(WIFI_AP);
|
|
IPAddress local_IP(10, 11, 12, 1);
|
|
IPAddress gateway(10, 11, 12, 1);
|
|
IPAddress subnet(255, 255, 255, 0);
|
|
WiFi.softAPConfig(local_IP, gateway, subnet);
|
|
if (WiFi.softAP(WIFI_SSID, WIFI_PASSWORD))
|
|
{
|
|
LOG_INFO("WiFi AP Mode Started");
|
|
LOG_INFO("Wifi SSID:", WIFI_SSID);
|
|
LOG_INFO("Wifi Password:", WIFI_PASSWORD);
|
|
LOG_INFO("WiFi IP:" + WiFi.softAPIP().toString());
|
|
}
|
|
else
|
|
{
|
|
LOG_ERROR("Failed to start WiFi AP Mode");
|
|
LOG_ERROR("5 seconds to restart...");
|
|
vTaskDelay(pdMS_TO_TICKS(5000));
|
|
esp_restart();
|
|
}
|
|
|
|
// Initialize Interrupt pins on PICKUP detectors
|
|
initTriggerPinsInputs();
|
|
// Initialize Interrupt pins on SPARK detectors
|
|
initSparkPinInputs();
|
|
}
|
|
|
|
////////////////////// MAIN LOOP //////////////////////
|
|
void loop()
|
|
{
|
|
// global variables
|
|
bool running = true;
|
|
const uint32_t max_queue = 128;
|
|
const uint32_t filter_k = 10;
|
|
|
|
PSRAMVector<ignitionBoxStatus> ignA_history_0(max_history);
|
|
PSRAMVector<ignitionBoxStatus> ignA_history_1(max_history);
|
|
auto *active_history_A = &ignA_history_0;
|
|
auto *writable_history_A = &ignA_history_1;
|
|
|
|
#ifdef CH_B_ENABLE
|
|
PSRAMVector<ignitionBoxStatus> ignB_history_0(max_history);
|
|
PSRAMVector<ignitionBoxStatus> ignB_history_1(max_history);
|
|
auto *active_history_B = &ignB_history_0;
|
|
auto *writable_history_B = &ignB_history_1;
|
|
#endif
|
|
|
|
// Resources Initialization
|
|
Devices dev;
|
|
// Task handle
|
|
TaskHandle_t trigA_TaskHandle = NULL;
|
|
TaskHandle_t trigB_TaskHandle = NULL;
|
|
// Data Queue for real time task to main loop communication
|
|
QueueHandle_t rt_taskA_queue = xQueueCreate(max_queue, sizeof(ignitionBoxStatus));
|
|
QueueHandle_t rt_taskB_queue = xQueueCreate(max_queue, sizeof(ignitionBoxStatus));
|
|
|
|
rtTaskParams taskA_params{
|
|
.rt_running = true,
|
|
.dev = &dev,
|
|
.rt_queue = rt_taskA_queue,
|
|
.rt_int = rtTaskInterrupts{
|
|
.isr_ptr = &trig_isr_A,
|
|
.trig_pin_12p = TRIG_PIN_A12P,
|
|
.trig_pin_12n = TRIG_PIN_A12N,
|
|
.trig_pin_34p = TRIG_PIN_A34P,
|
|
.trig_pin_34n = TRIG_PIN_A34N,
|
|
.spark_pin_12 = SPARK_PIN_A12,
|
|
.spark_pin_34 = SPARK_PIN_A34},
|
|
.rt_resets = rtTaskResets{.rst_io_peak = RST_EXT_PEAK_DETECT_A, .rst_io_sh = RST_EXT_SAMPLE_HOLD_A}};
|
|
|
|
#ifdef CH_B_ENABLE
|
|
rtTaskParams taskB_params{
|
|
.rt_running = true,
|
|
.dev = &dev,
|
|
.rt_queue = rt_taskB_queue,
|
|
.rt_int = rtTaskInterrupts{
|
|
.isr_ptr = &trig_isr_B,
|
|
.trig_pin_12p = TRIG_PIN_B12P,
|
|
.trig_pin_12n = TRIG_PIN_B12N,
|
|
.trig_pin_34p = TRIG_PIN_B34P,
|
|
.trig_pin_34n = TRIG_PIN_B34N,
|
|
.spark_pin_12 = SPARK_PIN_B12,
|
|
.spark_pin_34 = SPARK_PIN_B34},
|
|
.rt_resets = rtTaskResets{.rst_io_peak = RST_EXT_PEAK_DETECT_B, .rst_io_sh = RST_EXT_SAMPLE_HOLD_B}};
|
|
#endif
|
|
|
|
if (!rt_taskA_queue || !rt_taskB_queue)
|
|
{
|
|
LOG_ERROR("Unable To Create task queues");
|
|
LOG_ERROR("5 seconds to restart...");
|
|
vTaskDelay(pdMS_TO_TICKS(5000));
|
|
esp_restart();
|
|
}
|
|
else
|
|
LOG_DEBUG("Task Variables OK");
|
|
|
|
// Spi ok flags
|
|
bool spiA_ok = true;
|
|
bool spiB_ok = true;
|
|
// Init 2 SPI interfaces
|
|
SPIClass SPI_A(FSPI);
|
|
spiA_ok = SPI_A.begin(SPI_A_SCK, SPI_A_MISO, SPI_A_MOSI);
|
|
SPI_A.setDataMode(SPI_MODE1); // ADS1256 requires SPI mode 1
|
|
#ifdef CH_B_ENABLE
|
|
#ifndef TEST
|
|
SPIClass SPI_B(HSPI);
|
|
spiB_ok = SPI_B.begin(SPI_B_SCK, SPI_B_MISO, SPI_B_MOSI);
|
|
SPI_B.setDataMode(SPI_MODE1); // ADS1256 requires SPI mode 1
|
|
#endif
|
|
#endif
|
|
if (!spiA_ok || !spiB_ok)
|
|
{
|
|
LOG_ERROR("Unable to Initialize SPI Busses");
|
|
LOG_ERROR("5 seconds to restart...");
|
|
vTaskDelay(pdMS_TO_TICKS(5000));
|
|
esp_restart();
|
|
}
|
|
LOG_DEBUG("Init SPI OK");
|
|
|
|
#ifndef TEST
|
|
// Init ADC_A
|
|
dev.adc_a = new ADS1256(ADC_A_DRDY, ADS1256::PIN_UNUSED, ADS1256::PIN_UNUSED, ADC_A_CS, 2.5, &SPI_A);
|
|
dev.adc_a->InitializeADC();
|
|
dev.adc_a->setPGA(PGA_1);
|
|
dev.adc_a->setDRATE(DRATE_7500SPS);
|
|
#endif
|
|
#ifdef CH_B_ENABLE
|
|
#ifndef TEST
|
|
// Init ADC_B
|
|
dev.adc_a = new ADS1256(ADC_B_DRDY, ADS1256::PIN_UNUSED, ADS1256::PIN_UNUSED, ADC_B_CS, 2.5, &SPI_B);
|
|
dev.adc_a->InitializeADC();
|
|
dev.adc_a->setPGA(PGA_1);
|
|
dev.adc_a->setDRATE(DRATE_1000SPS);
|
|
#endif
|
|
#endif
|
|
|
|
LOG_DEBUG("Init ADC OK");
|
|
|
|
// Ignition A on Core 0
|
|
auto ignA_task_success = pdPASS;
|
|
ignA_task_success = xTaskCreatePinnedToCore(
|
|
rtIgnitionTask,
|
|
"rtTask_A",
|
|
RT_TASK_STACK,
|
|
(void *)&taskA_params,
|
|
RT_TASK_PRIORITY,
|
|
&trigA_TaskHandle,
|
|
CORE_0);
|
|
delay(100); // give some time to the thread to start
|
|
|
|
// Ignition B on Core 1
|
|
auto ignB_task_success = pdPASS;
|
|
|
|
#ifdef CH_B_ENABLE
|
|
ignB_task_success = xTaskCreatePinnedToCore(
|
|
rtIgnitionTask,
|
|
"rtTask_B",
|
|
RT_TASK_STACK,
|
|
(void *)&taskB_params,
|
|
RT_TASK_PRIORITY, // priorità leggermente più alta
|
|
&trigB_TaskHandle,
|
|
CORE_1);
|
|
delay(100); // give some time to the thread to start
|
|
#endif
|
|
|
|
if (ignA_task_success != pdPASS || ignB_task_success != pdPASS)
|
|
{
|
|
LOG_ERROR("Unable to initialize ISR task");
|
|
LOG_ERROR("5 seconds to restart...");
|
|
vTaskDelay(pdMS_TO_TICKS(5000));
|
|
esp_restart();
|
|
}
|
|
|
|
LOG_DEBUG("Real Time Tasks A & B initialized");
|
|
|
|
bool partial_save = false; // flag to indicate if a partial save has been done after a timeout
|
|
auto last_data = millis();
|
|
auto last_info = millis();
|
|
|
|
uint32_t counter_a = 0;
|
|
uint32_t counter_b = 0;
|
|
uint32_t wait_count = 0;
|
|
|
|
ignitionBoxStatus ign_info_A;
|
|
ignitionBoxStatus ign_info_B;
|
|
|
|
ignitionBoxStatusAverage ign_info_avg_A(filter_k);
|
|
ignitionBoxStatusAverage ign_info_avg_B(filter_k);
|
|
|
|
LITTLEFSGuard fsGuard;
|
|
WebPage webPage(80, LittleFS); // Initialize webserver and Websocket
|
|
|
|
//////////////// INNER LOOP /////////////////////
|
|
while (running)
|
|
{
|
|
auto dataA = pdFALSE;
|
|
auto dataB = pdFALSE;
|
|
|
|
dataA = xQueueReceive(rt_taskA_queue, &ign_info_A, 0);
|
|
if (counter_a >= active_history_A->size()) // not concurrent with write task
|
|
{
|
|
counter_a = 0;
|
|
partial_save = false; // reset partial save flag on new data cycle
|
|
swapHistory(active_history_A, writable_history_A);
|
|
save_history(*writable_history_A, "ignition_historyA.csv"); // directly call the save task function to save without delay
|
|
}
|
|
|
|
#ifdef CH_B_ENABLE
|
|
dataB = xQueueReceive(rt_taskB_queue, &ign_info_B, 0);
|
|
if (counter_b >= active_history_B->size()) // not concurrent with write task
|
|
{
|
|
counter_b = 0;
|
|
partial_save = false; // reset partial save flag on new data cycle
|
|
swapHistory(active_history_B, writable_history_B);
|
|
save_history(*writable_history_B, "ignition_historyB.csv"); // directly call the save task function to save without delay
|
|
}
|
|
#endif
|
|
// Update last data
|
|
if (dataA == pdTRUE || dataB == pdTRUE)
|
|
{
|
|
last_data = millis();
|
|
}
|
|
|
|
if (dataA == pdTRUE)
|
|
{
|
|
(*active_history_A)[counter_a++ % active_history_A->size()] = ign_info_A;
|
|
ign_info_avg_A.update(ign_info_A); // update moving average with latest ignition status
|
|
// Serial.printf("Data Received A: %d/%d\n\r", counter_a, (*active_history_A).size());
|
|
if (counter_a % filter_k == 0) // send data every 10 samples
|
|
{
|
|
ArduinoJson::JsonDocument wsData;
|
|
wsData["box_a"] = ign_info_avg_A.toJson();
|
|
wsData["box_b"] = JsonObject();
|
|
webPage.sendWsData(wsData.as<String>());
|
|
}
|
|
}
|
|
#ifdef CH_B_ENABLE
|
|
if (dataB == pdTRUE)
|
|
{
|
|
(*active_history_B)[counter_b++ % active_history_B->size()] = ign_info_B;
|
|
ign_info_avg_B.update(ign_info_B); // update moving average with latest ignition status
|
|
// Serial.printf("Data Received B: %d/%d\n\r", counter_b, (*active_history_B).size());
|
|
if (counter_b % filter_k == 0) // send data every 10 samples
|
|
{
|
|
ArduinoJson::JsonDocument wsData;
|
|
wsData["box_a"] = JsonObject();
|
|
wsData["box_b"] = ign_info_avg_B.toJson();
|
|
webPage.sendWsData(wsData.as<String>());
|
|
}
|
|
}
|
|
#endif
|
|
if (dataA == pdFALSE && dataB == pdFALSE && (millis() - last_data) > 2000)
|
|
{
|
|
if (!partial_save && counter_a > 0) // if timeout occurs but we have unsaved data, save it before next timeout
|
|
{
|
|
active_history_A->resize(counter_a); // resize active history to actual number of records received to avoid saving empty records
|
|
save_history(*active_history_A, "ignition_history_A.csv");
|
|
active_history_A->resize(max_history); // resize back to max history size for next data cycle
|
|
#ifdef CH_B_ENABLE
|
|
active_history_B->resize(counter_a); // resize active history to actual number of records received to avoid saving empty records
|
|
save_history(*active_history_B, "ignition_history_B.csv");
|
|
active_history_B->resize(max_history); // resize back to max history size for next data cycle
|
|
#endif
|
|
counter_a = 0; // reset counter after saving
|
|
counter_b = 0; // reset counter after saving
|
|
|
|
partial_save = true;
|
|
first_save = true;
|
|
}
|
|
//Serial.printf("[%d] Waiting for data...\r", wait_count++);
|
|
delay(100);
|
|
}
|
|
|
|
if ((millis() - last_info) > 1000)
|
|
{
|
|
clearScreen();
|
|
Serial.println();
|
|
printRunningTasksMod(Serial);
|
|
last_info = millis();
|
|
|
|
}
|
|
} //////////////// INNER LOOP /////////////////////
|
|
|
|
if (trigA_TaskHandle)
|
|
vTaskDelete(trigA_TaskHandle);
|
|
if (trigB_TaskHandle)
|
|
vTaskDelete(trigB_TaskHandle);
|
|
|
|
} ////////////////////// MAIN LOOP //////////////////////
|