src/lib/DEVICE/device.cpp

   1 #include "targets.h"
   2 #include "common.h"
   3 #include "logging.h"
   4 #include "helpers.h"
   5 #include "device.h"
   6
   7 ///////////////////////////////////////
   8 // Even though we aren't using anything this keeps the PIO dependency analyzer happy!
   9
  10 #if defined(Regulatory_Domain_AU_915) || defined(Regulatory_Domain_EU_868)  || defined(Regulatory_Domain_IN_866) || defined(Regulatory_Domain_FCC_915) || defined(Regulatory_Domain_AU_433) || defined(Regulatory_Domain_EU_433)
  11 #include "SX127xDriver.h"
  12 #endif
  13
  14 #if defined(Regulatory_Domain_ISM_2400)
  15 #include "SX1280Driver.h"
  16 #endif
  17
  18 ///////////////////////////////////////
  19
  20 static device_affinity_t *uiDevices;
  21 static uint8_t deviceCount;
  22
  23 static bool eventFired[2] = {false, false};
  24 static connectionState_e lastConnectionState[2] = {disconnected, disconnected};
  25
  26 static unsigned long deviceTimeout[16] = {0};
  27
  28 #if defined(PLATFORM_ESP32)
  29 static TaskHandle_t xDeviceTask = NULL;
  30 static SemaphoreHandle_t taskSemaphore;
  31 static SemaphoreHandle_t completeSemaphore;
  32 static void deviceTask(void *pvArgs);
  33 #define CURRENT_CORE  xPortGetCoreID()
  34 #else
  35 #define CURRENT_CORE -1
  36 #endif
  37
  38 void devicesRegister(device_affinity_t *devices, uint8_t count)
  39 {
  40     uiDevices = devices;
  41     deviceCount = count;
  42
  43     #if defined(PLATFORM_ESP32)
  44         taskSemaphore = xSemaphoreCreateBinary();
  45         completeSemaphore = xSemaphoreCreateBinary();
  46         disableCore0WDT();
  47         xTaskCreatePinnedToCore(deviceTask, "deviceTask", 3000, NULL, 0, &xDeviceTask, 0);
  48     #endif
  49 }
  50
  51 void devicesInit()
  52 {
  53     int32_t core = CURRENT_CORE;
  54
  55     for(size_t i=0 ; i<deviceCount ; i++) {
  56         if (uiDevices[i].core == core || core == -1) {
  57             if (uiDevices[i].device->initialize) {
  58                 (uiDevices[i].device->initialize)();
  59             }
  60         }
  61     }
  62     #if defined(PLATFORM_ESP32)
  63     if (core == 1)
  64     {
  65         xSemaphoreGive(taskSemaphore);
  66         xSemaphoreTake(completeSemaphore, portMAX_DELAY);
  67     }
  68     #endif
  69 }
  70
  71 void devicesStart()
  72 {
  73     int32_t core = CURRENT_CORE;
  74     unsigned long now = millis();
  75
  76     for(size_t i=0 ; i<deviceCount ; i++)
  77     {
  78         if (uiDevices[i].core == core || core == -1) {
  79             deviceTimeout[i] = 0xFFFFFFFF;
  80             if (uiDevices[i].device->start)
  81             {
  82                 int delay = (uiDevices[i].device->start)();
  83                 deviceTimeout[i] = delay == DURATION_NEVER ? 0xFFFFFFFF : now + delay;
  84             }
  85         }
  86     }
  87     #if defined(PLATFORM_ESP32)
  88     if (core == 1)
  89     {
  90         xSemaphoreGive(taskSemaphore);
  91         xSemaphoreTake(completeSemaphore, portMAX_DELAY);
  92     }
  93     #endif
  94 }
  95
  96 void devicesTriggerEvent()
  97 {
  98     eventFired[0] = true;
  99     eventFired[1] = true;
 100 }
 101
 102 void devicesUpdate(unsigned long now)
 103 {
 104     int32_t core = CURRENT_CORE;
 105
 106     bool handleEvents = eventFired[core==-1?0:core];
 107     eventFired[core==-1?0:core] = false;
 108
 109     for(size_t i=0 ; i<deviceCount ; i++)
 110     {
 111         if (uiDevices[i].core == core || core == -1) {
 112             if ((handleEvents || lastConnectionState[core==-1?0:core] != connectionState) && uiDevices[i].device->event)
 113             {
 114                 int delay = (uiDevices[i].device->event)();
 115                 if (delay != DURATION_IGNORE)
 116                 {
 117                     deviceTimeout[i] = delay == DURATION_NEVER ? 0xFFFFFFFF : now + delay;
 118                 }
 119             }
 120         }
 121     }
 122     lastConnectionState[core==-1?0:core] = connectionState;
 123
 124     for(size_t i=0 ; i<deviceCount ; i++)
 125     {
 126         if (uiDevices[i].core == core || core == -1) {
 127             if (uiDevices[i].device->timeout && now >= deviceTimeout[i])
 128             {
 129                 int delay = (uiDevices[i].device->timeout)();
 130                 deviceTimeout[i] = delay == DURATION_NEVER ? 0xFFFFFFFF : now + delay;
 131             }
 132         }
 133     }
 134 }
 135
 136 #if defined(PLATFORM_ESP32)
 137 static void deviceTask(void *pvArgs)
 138 {
 139     xSemaphoreTake(taskSemaphore, portMAX_DELAY);
 140     devicesInit();
 141     xSemaphoreGive(completeSemaphore);
 142     xSemaphoreTake(taskSemaphore, portMAX_DELAY);
 143     devicesStart();
 144     xSemaphoreGive(completeSemaphore);
 145     for (;;)
 146     {
 147         devicesUpdate(millis());
 148     }
 149 }
 150 #endif