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 bool initialize()
  17 {
  18 #if defined(PLATFORM_ESP32)
  19     if (GPIO_PIN_RCSIGNAL_RX == GPIO_PIN_RCSIGNAL_TX)
  20     {
  21         handset = new AutoDetect();
  22         return true;
  23     }
  24 #endif
  25     handset = new CRSFHandset();
  26     return true;
  27 }
  28
  29 static int start()
  30 {
  31     handset->Begin();
  32 #if defined(DEBUG_TX_FREERUN)
  33     handset->forceConnection();
  34 #endif
  35     return DURATION_IMMEDIATELY;
  36 }
  37
  38 static int timeout()
  39 {
  40     handset->handleInput();
  41     return DURATION_IMMEDIATELY;
  42 }
  43
  44 static int event()
  45 {
  46     // An event should be generated every time the TX power changes
  47     CRSF::LinkStatistics.uplink_TX_Power = powerToCrsfPower(PowerLevelContainer::currPower());
  48     return DURATION_IGNORE;
  49 }
  50
  51 device_t Handset_device = {
  52     .initialize = initialize,
  53     .start = start,
  54     .event = event,
  55     .timeout = timeout,
  56     .subscribe = EVENT_POWER_CHANGED
  57 };
  58 #endif