src/lib/SerialUpdate/devSerialUpdate.cpp

   1 #include "targets.h"
   2
   3 #if defined(PLATFORM_ESP32) && defined(TARGET_RX)
   4 #include "devSerialUpdate.h"
   5 #include "common.h"
   6 #include "hwTimer.h"
   7 #include "POWERMGNT.h"
   8 #include "devVTXSPI.h"
   9 #include "devMSPVTX.h"
  10
  11 extern void start_esp_upload();
  12 extern void stub_handle_rx_byte(char byte);
  13
  14 static bool running = false;
  15
  16 static bool initialize()
  17 {
  18     running = true;
  19     return true;
  20 }
  21
  22 static int event()
  23 {
  24     if (connectionState == serialUpdate && running)
  25     {
  26         running = false;
  27         hwTimer::stop();
  28         disableVTxSpi();
  29         disableMspVtx();
  30         POWERMGNT::setPower(MinPower);
  31         Radio.End();
  32         return DURATION_IMMEDIATELY;
  33     }
  34     return DURATION_NEVER;
  35 }
  36
  37 static int timeout()
  38 {
  39     start_esp_upload();
  40     while (true)
  41     {
  42         uint8_t buf[64];
  43         int count = Serial.read(buf, sizeof(buf));
  44         for (int i=0 ; i<count ; i++)
  45         {
  46             stub_handle_rx_byte(buf[i]);
  47         }
  48     }
  49 }
  50
  51 device_t SerialUpdate_device = {
  52     .initialize = initialize,
  53     .start = nullptr,
  54     .event = event,
  55     .timeout = timeout,
  56     .subscribe = EVENT_CONNECTION_CHANGED
  57 };
  58 #endif