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     handset->forceConnection();
  33 #endif
  34     return DURATION_IMMEDIATELY;
  35 }
  36
  37 static int timeout()
  38 {
  39     handset->handleInput();
  40     return DURATION_IMMEDIATELY;
  41 }
  42
  43 static int event()
  44 {
  45     // An event should be generated every time the TX power changes
  46     CRSF::LinkStatistics.uplink_TX_Power = powerToCrsfPower(PowerLevelContainer::currPower());
  47     return DURATION_IGNORE;
  48 }
  49
  50 device_t Handset_device = {
  51     .initialize = initialize,
  52     .start = start,
  53     .event = event,
  54     .timeout = timeout};
  55 #endif