src/lib/Handset/devHandset.cpp

   1 #include "targets.h"
   2
   3 #ifdef TARGET_TX
   4
   5 #include "CRSF.h"
   6 #include "CRSFHandset.h"
   7 #include "POWERMGNT.h"
   8 #include "devHandset.h"
   9
  10 #if defined(PLATFORM_ESP32)
  11 #include "AutoDetect.h"
  12 #endif
  13
  14 Handset *handset;
  15
  16 static void initialize()
  17 {
  18 #if defined(PLATFORM_ESP32)
  19     if (GPIO_PIN_RCSIGNAL_RX == GPIO_PIN_RCSIGNAL_TX)
  20     {
  21         handset = new AutoDetect();
  22         return;
  23     }
  24 #endif
  25     handset = new CRSFHandset();
  26 }
  27
  28 static int start()
  29 {
  30     handset->Begin();
  31 #if defined(DEBUG_TX_FREERUN)
  32     if (!handset->connect())
  33     {
  34         ERRLN("CRSF::connected has not been initialised");
  35     }
  36 #endif
  37     return DURATION_IMMEDIATELY;
  38 }
  39
  40 static int timeout()
  41 {
  42     handset->handleInput();
  43     return DURATION_IMMEDIATELY;
  44 }
  45
  46 static int event()
  47 {
  48     // An event should be generated every time the TX power changes
  49     CRSF::LinkStatistics.uplink_TX_Power = powerToCrsfPower(PowerLevelContainer::currPower());
  50     return DURATION_IGNORE;
  51 }
  52
  53 device_t Handset_device = {
  54     .initialize = initialize,
  55     .start = start,
  56     .event = event,
  57     .timeout = timeout};
  58 #endif