if (ap24_sat_visible > 15) 
{
  if (ap24_sat_visible == 255)
    pt_numsats = 0; // for special case 255 == unknown satellite count
  else
    pt_numsats = 15; // limit to 15 due to only 4 bits available
}
 else 
   pt_numsats = ap24_sat_visible;

[env:esp12e]  ; Node MCU variant
; Remember to set the variant in config.h
platform = espressif8266
board = esp12e
framework = arduino
upload_speed = 115200
monitor_speed = 115200
upload_port = COM(40)

//================================================================================================= 
//================================================================================================= 
//
//                                    C O N F I G U R A T I O N 
// 
//================================================================================================= 
//================================================================================================= 

/*
Complete change log and debugging options are at the bottom of this tab
           
v2.58.4 2020-03-25 RPM fixed (library path).           
*/
//===========================================================================================
//
//                   PLEASE SELECT YOUR DEFAULT OPTIONS BELOW BEFORE COMPILING
//
//===========================================================================================

#define webSupport                      // ESP only. Enable wifi web support, including OTA firmware updating. Browse to IP.
#define webPassword      "changeme!"    // Web password 
//#define Reset_Web_Defaults            // Settings in eeprom. Do this if eeprom settings are corrupt or wrong.

//#define SD_Support                    // Activate if you have an SD card reader attached
#define OLED_Support                  // Activate if you have an OLED display attached

//#define AutoBaud                      // Auto detect Mavlink serial-in baud rate
                                        // NOTE: Set mvBaudFC = 57600 for Dragonlink and RFD900X
#define mvBaudFC               57600    // Mavlink to/from the flight controller - max 921600 - must match FC or long range radio
#define frBaud                 57600    // S.Port baud setting - default 57600 


// Do not enable for FlightDeck
#define PlusVersion  // Added support for 0x5009 Mission WPs, 0x50F1 Servo_Channels, 0x50F2 VFR_Hud

//=================================================================================================
//           D E F A U L T   T R A N S L A T I O N   M O D E   S E T T I N G S   
//=================================================================================================       
// Choose only one of these three translation modes
#define Ground_Mode          // Translator between Taranis et al and LRS transceiver (like Dragonlink, ULRS, RFD900...)
//#define Air_Mode             // Translator between FrSky receiver (like XRS) and Flight Controller (like Pixhawk)
//#define Relay_Mode           // Translator between LRS tranceiver (like Dragonlink) and FrSky receiver (like XRS) in relay box on the ground


//=================================================================================================
//           D E F A U L T   F L I G H T   C O M P U T E R    I / O   S E T T I N G S   
//=================================================================================================
// Choose only one of these default Flight-Controller-side I/O channels 
// How does Mavlink telemetry enter this translator?
#define FC_Mavlink_IO  0    // Serial Port (default)         
//#define FC_Mavlink_IO  1    // BlueTooth Classic - ESP32 only
//#define FC_Mavlink_IO  2    // WiFi - ESP32 or ESP8266 only
//#define FC_Mavlink_IO  3    // SD Card / TF - ESP32 only


//=================================================================================================
//           D E F A U L T   G R O U N D S T A T I O N    I / O   S E T T I N G S   
//=================================================================================================
// Choose only one of these default GCS-side I/O channels
// How does Mavlink telemetry leave this translator?
// These are optional, and in addition to the S.Port telemetry output
//#define GCS_Mavlink_IO  0    // Serial Port  - Only Teensy 3.x and Maple Mini have Serial3     
//#define GCS_Mavlink_IO  1    // BlueTooth Classic - ESP32 only
//#define GCS_Mavlink_IO  2    // WiFi - ESP32 or ESP8266 only
#define GCS_Mavlink_IO  3    // WiFi AND Bluetooth simultaneously - ESP32 only

#ifndef GCS_Mavlink_IO
  #define GCS_Mavlink_IO  9    // NONE (default)
#endif

// NOTE2: The Bluetooth class library uses a lot of application memory. During Compile/Flash
//        You may need to select Tools/Partition Scheme: "Minimal SPIFFS (1.9MB APP ...) or similar

//#define GCS_Mavlink_SD       // SD Card - ESP32 only - mutually inclusive with other GCS I/O

//=================================================================================================                             
//                          S E L E C T   E S P   B O A R D   V A R I A N T   
//=================================================================================================

//#define ESP32_Variant     1    //  ESP32 Dev Module - Use Partition Scheme: "Minimal SPIFFS(1.9MB APP...)"
//#define ESP32_Variant     2    //  Wemos® LOLIN ESP32-WROOM-32_OLED_Dual_26p
//#define ESP32_Variant     3    //  Dragonlink V3 slim with internal ESP32 - contributed by Noircogi
#define ESP32_Variant     4    //  Heltec Wifi Kit 32 - Use Partition Scheme: "Minimal SPIFFS(Large APPS ith OTA)" - contributed by Noircogi

//#define ESP8266_Variant   1   // NodeMCU ESP 12F - choose "NodeMCU 1.0(ESP-12E)" board in the IDE
#define ESP8266_Variant   2   // ESP-F Use me for RFD900X TX-MOD - use generic ESP8266 board on IDE


//=================================================================================================
//                      D E F A U L T   B L U E T O O T H   S E T T I N G S   
//=================================================================================================

//#define BT_Mode  1           // Master Mode - we advertise the "host" name and slave connects to us
#define BT_Mode  2           // Slave Mode - we connect as slave to a master
#define BT_SlaveConnectTo     "Crossfire 0277"  // Example


//=================================================================================================
//                            D E F A U L T   W  I  F  I   S E T T I N G S   
//=================================================================================================

#define HostName             "MavToPass"        // This translator's host name
#define APssid               "MavToPassthru"    // The AP SSID that we advertise   ====>
#define APpw                 "password"         // Change me!
#define APchannel            9                  // The wifi channel to use for our AP
#define STAssid              "OmegaOffice"      // Target AP to connect to         <====
#define STApw                "changeme"        // Target AP password        

#define Start_WiFi                       // Start WiFi at startup, override startWiFi Pin

// Choose one default mode for ESP only - AP means advertise as an access point (hotspot). STA means connect to a known host
//#define WiFi_Mode   1  //AP            
//#define WiFi_Mode   2  // STA
#define WiFi_Mode   3  // STA failover to AP

// Choose one default protocol - for ESP32 only
//#define WiFi_Protocol 1    // TCP/IP
#define WiFi_Protocol 2    // UDP 


//=================================================================================================
//                            O T H E R   U S E R   O P T I O N S  
//=================================================================================================

//#define Battery_mAh_Source  1  // Get battery mAh from the FC - note both rx and tx lines must be connected      
//#define Battery_mAh_Source  2  // Define bat1_capacity and bat2_capacity below and use those 
const uint16_t bat1_capacity = 5200;       
const uint16_t bat2_capacity = 0;
#define Battery_mAh_Source  3         // Define battery mAh in the LUA script on the Taranis/Horus - Recommended

#define SPort_Serial        1         // Teensy port1=pin1, port3=pin8. The default is Serial 1, but 3 is possible 

// RSSI_Source is now automatic. Order of precedence: 
//      First:  #109 SiK style RADIO_STATUS
//      Second: #65 RC_CHANNELS
//      Third:  #35 RC_CHANNELS_RAW

//#define RSSI_Override                // Dummy RSSI - fixed at 70%                                                                                                                    

//#define Rssi_In_Percent             // Un-comment if RSSI is already %, not relative to (254/100)

// Status_Text messages place a huge burden on the meagre 4 byte FrSky telemetry payload bandwith
// The practice has been to send them 3 times to ensure that they arrive unscathed at the receiver
//  but that makes the bandwidth limitation worse and may crowd out other message types. Try without
//  sending 3 times, but if status_text gets distorted, un-comment the next line
//#define Send_status_Text_3_Times

//#define Send_Sensor_Health_Messages

//#define Request_Missions_From_FC    // Un-comment if you need mission waypoint from FC - NOT NECESSARY RIGHT NOW

//#define Data_Streams_Enabled        // Requests data streams from FC. Requires both rx and tx lines to FC. Rather set SRn in Mission Planner
#define Max_Waypoints  256          // Note. This is a global RAM trade-off. If exceeded then Debug message and shut down

//================================== Set your time zone here ======================================
// Only for SD / TF Card adapter option
// Date and time determines the TLog file name only
//const float Time_Zone = 10.5;    // Adelaide, Australia
const float Time_Zone = 2.0;    // Jo'burg
bool daylightSaving = false;

//=================================================================================================
//                        E X P E R I M E N T A L    O P T I O N S  
//    Don't change anything here unless you are confident you know the outcome

//#define ESP32_SoftwareSerial    // otherwise HardwareSerial is used 
//#define ESP_Onewire             // enable half_duplex on single (tx) pin and wire - Air/Relay
//#define ESP_Air_Relay_Blind_Inject_OK  // Blind inject instead of interleaving

//=================================================================================================   
//                              Auto Determine Target Platform
//================================================================================================= 
//
//                Don't change anything here
//
#if defined (__MK20DX128__) || defined(__MK20DX256__)
  #define TEENSY3X   
      
#elif defined ESP32
  #define Target_Board   3      // Espressif ESP32 Dev Module

#elif defined ESP8266
  #define Target_Board   4      // Espressif ESP8266
  
#else
  #error "Unsupported board type!"
#endif

//=================================================================================================   
//                              CHECK #define OPTIONS LOGIC
//================================================================================================= 

#if defined PlusVersion
  #define Request_Mission_Count_From_FC // Needed for yaapu's mission/waypoint script
#endif

#if (not defined ESP32) && (not defined ESP8266)
  #if defined webSupport
    #undef webSupport
    //    #error webSupport only available on ESP32 or ESP8266
  #endif
#endif
  
#if defined ESP32
  #include <iostream> 
  #include <sstream> 
  #include <driver/uart.h>  // In Arduino ESP32 install repo 
  //C:\Users\<YourName>\AppData\Local\Arduino15\packages\esp32\hardware\esp32\1.0.4\tools\sdk\include\driver

#endif
  
  #if (defined ESP32) || (defined ESP8266)  // ESP32 or ESP8266 (UART0, UART1, and UART2)
    #if (SPort_Serial  == 3)    
      #error Board does not have Serial3. This configuration is not possible.
    #endif
  #endif

  #if (defined TEENSY3X) 
    #if (FC_Mavlink_IO == 3) || (defined GCS_Mavlink_SD)  
      #error SD card not currently implemented for Teensy
    #endif
  #endif

  #ifndef Battery_mAh_Source
    #error Please choose at least one Battery_mAh_Source
  #endif

  #if (not defined ESP32) && (not defined ESP8266) 
     #if (FC_Mavlink_IO == 2) || (GCS_Mavlink_IO == 2) || (GCS_Mavlink_IO == 3) || (defined webSupport)
    //   #error WiFi and webSupport only work on an ESP32 or ESP8266 board
       #if defined FC_Mavlink
         #undef FC_Mavlink
       #endif  
       #define FC_Mavlink_IO  0
       #if defined GCS_Mavlink_IO
         #undef GCS_Mavlink_IO
       #endif   
       #define GCS_Mavlink_IO 9
       #if defined webSupport
         #undef  webSupport
       #endif  
     #endif  
  #endif

  #if (defined ESP8266)  && ((GCS_Mavlink_IO == 1) || (GCS_Mavlink_IO == 3))  // Can't do BT on 8266
       #define GCS_Mavlink_IO  2    // WiFi Only
  #endif
       
  #if (not defined ESP32) 
     #if (FC_Mavlink_IO == 1) || (GCS_Mavlink_IO == 1) || (GCS_Mavlink_IO == 3)
       #error Bluetooth works only on an ESP32 board      
     #endif  
  #endif
  
  #ifndef FC_Mavlink_IO
    #error Please choose at least one Mavlink FC IO channel
  #endif

  #if (defined ESP32)
    #ifndef WiFi_Mode 
      #error Please define WiFi_Mode
    #endif
  #endif  

  #if (defined ESP32)
    #ifndef WiFi_Protocol
      #error Please define WiFi_Protocol
    #endif
  #endif

  #if (defined ESP32)         
    #ifndef ESP32_Variant 
      #error Please define an ESP32 board variant
    #endif
  #endif

  #if (defined ESP8266)
    #ifndef ESP8266_Variant
         #error Please define an ESP8266 board variant
    #endif
 
  #endif         
//=================================================================================================   
//                S E T T I N G S   A N D   O P T I O N S   S T R U C T U R E
//=================================================================================================

    typedef enum trmode_set { ground = 1 , air = 2, relay = 3 } trmode_t;                    // translator operation mode
    typedef enum fc_io_set { fc_ser = 0, fc_bt = 1 , fc_wifi = 2, fc_sd = 3 } fc_io_t;
    typedef enum gs_io_set { gs_ser = 0, gs_bt = 1 , gs_wifi = 2, gs_wifi_bt = 3, gs_none = 9} gs_io_t; 
    typedef enum gs_sd_set { gs_off = 0 , gs_on = 1} gs_sd_t; 
    typedef enum wfmode_set { ap = 1 , sta = 2, sta_ap = 3 } wfmode_t;   
    typedef enum wf_proto_set { tcp = 1 , udp = 2, } wf_proto_t; 
    typedef enum btmode_set { master = 1, slave = 2 } btmode_t;

    typedef struct  {
      byte          validity_check;  // 0xdc 
      trmode_t      trmode;         
      fc_io_t       fc_io;
      gs_io_t       gs_io;   
      gs_sd_t       gs_sd;
      wfmode_t      wfmode;
      wf_proto_t    wfproto;
      uint32_t      baud;
      uint8_t       channel;
      char          apSSID[30];
      char          apPw[20];
      char          staSSID[30];
      char          staPw[20];
      char          host[20];     
      uint16_t      tcp_localPort;
      uint16_t      udp_localPort;
      uint16_t      udp_remotePort;
      btmode_t      btmode;
      char          btSlaveConnectTo[20];
      uint8_t       rssi_override;
      bool          web_support;  // this flag is not saved in eeprom
      char*         trmode1;      //ground
      char*         trmode2;      //air
      char*         trmode3;      //relay      
      char*         fc_io0;       //ser
      char*         fc_io1;       //bt
      char*         fc_io2;       //wifi 
      char*         fc_io3;       //sd       
      char*         gs_io0;       //ser
      char*         gs_io1;       //bt
      char*         gs_io2;       // wifi
      char*         gs_io3;       // wifi_bt 
      char*         gs_io9;       // none     
      char*         gs_sd0;       // off 
      char*         gs_sd1;       // on      
      char*         wfmode1;      // ap 
      char*         wfmode2;      // sta
      char*         wfmode3;      // sta_ap     
      char*         wfproto1;     // tcp
      char*         wfproto2;     // udp       
      char*         btmode1;      // master
      char*         btmode2;      // slave 
      char*         rssioverride; //rssi override  
      
      } settings_struct_t;
      
    settings_struct_t set;  


//=================================================================================================   
//                          P L A T F O R M   D E P E N D E N T   S E T U P S
//================================================================================================= 

  
#if defined TEENSY3X               // Teensy3x
  #define MavStatusLed  13
  #define InvertMavLed false   
  #define BufStatusLed  14        
  #define FC_Mav_rxPin  9  
  #define FC_Mav_txPin  10
  #if (SPort_Serial == 1)
    #define Fr_txPin       1      // Not soft configurable. Change wiring 
    #define GC_Mav_rxPin   7    
    #define GC_Mav_txPin   8   
  #elif (SPort_Serial == 3)
    define Fr_txPin        8      // Not soft configurable. Change wiring   
  #endif  
    
  #if (defined SD_Support) || (defined OLED_Support)
  #endif
 
#elif defined ESP32                 // ESP32 Platform

  #if (ESP32_Variant == 1)          // ESP32 Dev Module
    #define MavStatusLed  02        // Onboard LED
    #define InvertMavLed false      
    #define BufStatusLed  27        // untested pin      
    #define FC_Mav_rxPin  16        // Mavlink to FC
    #define FC_Mav_txPin  17        // Mavlink from FC
    #define Fr_rxPin      13        // SPort - Not used in 1-wire mode
    #define Fr_txPin      4         // SPort - Use me  
    #if (defined SD_Support) || (defined OLED_Support)   
      #define SDA           21        // I2C OLED board
      #define SCL           22        // I2C OLED board
      #define i2cAddr      0x3C       // I2C OLED board
    #endif   
    int16_t wifi_rssi;    
    uint8_t startWiFiPin = 15;      // D15
    uint8_t WiFiPinState = 0;
    /*  
      SPI/CS                       Pin 05   For optional TF/SD Card Adapter
      SPI/MOSI                     Pin 23   For optional TF/SD Card Adapter
      SPI/MISO                     Pin 19   For optional TF/SD Card Adapter
      SPI/SCK                      Pin 18   For optional TF/SD Card Adapter  
    */

  #endif

  #if (ESP32_Variant == 2)          // Wemos® LOLIN ESP32-WROOM-32_OLED_Dual_26p
    #define MavStatusLed  15        // No Onboard LED
    #define InvertMavLed false     
    #define BufStatusLed  99        // None    
    #define FC_Mav_rxPin  25        // Mavlink to FC
    #define FC_Mav_txPin  26        // Mavlink from FC
    #define Fr_rxPin      12        // SPort - Not used in single wire mode
    #define Fr_txPin      14        // SPort - Use me
    #if (defined SD_Support) || (defined OLED_Support)
      #define SDA           05        // I2C OLED board
      #define SCL           04        // I2C OLED board
      #define i2cAddr      0x3C       // I2C OLED board
    #endif  
    int16_t wifi_rssi;    
    uint8_t startWiFiPin = 13;     
    uint8_t WiFiPinState = 0;
  #endif

  #if (ESP32_Variant == 3)          // Dragonlink V3 slim with internal ESP32
    #if defined mvBaudFC
      #undef mvBaudFC
      #define mvBaudFC 115200       // Force baud rate to DragonLink rate
    #endif
    #define MavStatusLed  18        // Blue LED
    #define InvertMavLed false    
    #define BufStatusLed  19        // Green LED        
    #define FC_Mav_rxPin  16        // Mavlink to FC
    #define FC_Mav_txPin  17        // Mavlink from FC
    #define Fr_rxPin      12        // SPort - Not used in single wire mode
    #define Fr_txPin      01        // SPort - Use me 
    #if (defined SD_Support) || (defined OLED_Support)
      #define SDA           05        // I2C OLED board
      #define SCL           04        // I2C OLED board 
      #define i2cAddr      0x3C       // I2C OLED board
    #endif  
    int16_t wifi_rssi;    
    uint8_t startWiFiPin = 13;     
    uint8_t WiFiPinState = 0;
  #endif
  
  #if (ESP32_Variant == 4)          // Heltec Wifi Kit 32 (NOTE! 8MB) 
    #define MavStatusLed  25        // Onboard LED
    #define InvertMavLed false     
    #define BufStatusLed  99   
    #define FC_Mav_rxPin  27        // Mavlink to FC
    #define FC_Mav_txPin  17        // Mavlink from FC
    #define Fr_rxPin      12        // SPort - Not used in single wire mode
    #define Fr_txPin      14        // SPort - Use me 
    
    #if !defined OLED_Support    // I2C OLED board is built into Heltec WiFi Kit 32
      #define OLED_Support
    #endif

    #if (defined SD_Support) || (defined OLED_Support)   
      #define SDA           04        // I2C OLED board 
      #define SCL           15        // I2C OLED board
      #define i2cAddr      0x3C       // I2C OLED board
      #define OLED_RESET    16        // RESET here so no rest lower down    
    #endif   


    int16_t wifi_rssi;    
    uint8_t startWiFiPin = 15;      // D15
    uint8_t WiFiPinState = 0;
  #endif
  
#elif defined ESP8266                    // ESP8266 Platform

  #if (ESP8266_Variant == 1)        // NodeMCU 12F board
  
    #define MavStatusLed  D4        // D4 Board LED - Mav Status LED inverted logic - use 99 while debug
    #define InvertMavLed true      
    #define BufStatusLed  99        // None     
   //                     D4        // TXD1 - Serial1 debug log out SHARED WITH BOARD LED                         
    #define FC_Mav_rxPin  D9        // RXD0 default  
    #define FC_Mav_txPin  D10       // TXD0 default    
    #define Fr_rxPin      D5        // GP10 SPort - Not used in single wire mode
    #define Fr_txPin      D6        // GPIO SPort - Use me in single wire mode
    #if (defined SD_Support) || (defined OLED_Support)  
      #define SCL           D1        // I2C OLED board   
      #define SDA           D2        // I2C OLED board
      #define i2cAddr      0x3C       // I2C OLED board
    #endif     
    int16_t wifi_rssi;   
    uint8_t startWiFiPin = D3;      
    uint8_t WiFiPinState = 0;
  #endif
  
  #if (ESP8266_Variant == 2)        // ESP-F RFD900X TX-MOD - use generic esp8266

    //                         GPIO as per node mcu
    static const uint8_t D0   = 16;   // SCL - optional
    static const uint8_t D1   = 5;    // SDA - optional
    static const uint8_t D2   = 4;    // SPort half-duplex
    static const uint8_t D3   = 0;    // Flash
    static const uint8_t D4   = 2;    // BoardLED & TXD1 optional debug out
    static const uint8_t D5   = 14;   // SPort rx (unused in half-duplex)
    static const uint8_t D6   = 12;   // P2-3 exposed dual row of pins
    static const uint8_t D7   = 13;   // CTS
    static const uint8_t D8   = 15;   // RTS
    static const uint8_t D9   = 3;    // RXD0
    static const uint8_t D10  = 1;    // TXD0
    
    #define MavStatusLed  D4        // D4 Board LED - Mav Status LED inverted logic - use 99 while debug
    #define InvertMavLed true    
    #define BufStatusLed  99        // None
    //                    D4        // TXD1 - Serial1 default debug log out SHARED WITH BOARD LED                           
    #define FC_Mav_rxPin  D9        // RXD0 default  
    #define FC_Mav_txPin  D10       // TXD0 default    
    #define Fr_rxPin      D5        // SPort - Not used in single wire mode
    #define Fr_txPin      D2        // SPort half-duplex inverted - Use me in single wire mode
    #if (defined SD_Support) || (defined OLED_Support)
      #define SCL           D0        // I2C OLED board   
      #define SDA           D1        // I2C OLED board
      #define i2cAddr      0x3C       // I2C OLED board
    #endif       
    int16_t wifi_rssi;   
    uint8_t startWiFiPin = D8;      
    uint8_t WiFiPinState = 0;
  #endif  
  
#endif

  //=================================================================================================   
  //                            E E P R O M    S U P P O R T   -   ESP Only - for now
  //================================================================================================= 

  #if (defined ESP32) || (defined ESP8266)
    #include <EEPROM.h>       // To store AP_Failover_Flag and webSupport Settings
    #define EEPROM_SIZE 160   // 1 + 159 bytes, addr range 0 thru 160
  #endif
    
  //=================================================================================================   
  //                             S D   C A R D   S U P P O R T   -   ESP Only - for now
  //================================================================================================= 
  #if (defined ESP32)  || (defined ESP8266)

    #include <FS.h>
    #include <SD.h>
    #include <SPI.h>
    #define SD_Libs_Loaded 

    /*
    // Optional SPI interface pins for SD card adapter or SSD1306 OLED display
    #define CS            5        
    #define MOSI          23 
    #define MISO          19 
    #define SCK           18 
    */  

    // Pins generally   CS=5    MOSI=23   MISO=19   SCK=18    3.3V   GND   Dev Board, LilyGO/TTGO
 
 
     
    // Rememeber to change SPI frequency from 4E6 to 25E6, i.e 4MHz to 25MHz in SD.h otherwise MavRingBuff fills up 
    // C:\Users\YourUserName\AppData\Local\Arduino15\packages\esp32\hardware\esp32\1.0.2\libraries\SD\src  
    // bool begin(uint8_t ssPin=SS, SPIClass &spi=SPI, uint32_t frequency=25000000, const char * mountpoint="/sd", uint8_t max_files=5);  

    char     cPath[40];
    std::string   fnPath[30];
    uint8_t  fnCnt;
    uint16_t sdReadDelay = 10;  // mS   Otherwise the reads run through unnaturally quickly

    File     file;  // Create global object from File class for general use

    static  const uint8_t mthdays[]={31,28,31,30,31,30,31,31,30,31,30,31}; 

    typedef struct  { 
      uint16_t yr;   // relative to 1970;  
      uint8_t mth;
      uint8_t day;
      uint8_t dow;   // sunday is day 1 
      uint8_t hh; 
      uint8_t mm; 
      uint8_t ss; 
    }   DateTime_t;

    static DateTime_t dt_tm; 

  #endif  
  //=================================================================================================   
  //                                 O L E D   S U P P O R T    E S P  O N L Y - for now
  //================================================================================================= 
  #if (defined ESP32 || defined ESP8266)  
  
    #if not defined SD_Libs_Loaded   //  by SD block
      #include <SPI.h>                // for SD card and/or OLED
      #include <Wire.h>
    #endif  

    #include <Adafruit_SSD1306.h> 
    
    #define max_col  22
    #define max_row   8
    // 8 rows of 21 characters

    struct OLED_line {
      char OLx[max_col];
      };
  
     OLED_line OL[max_row]; 

    uint8_t row = 0;
    uint8_t col = 0;
  
    #define SCREEN_WIDTH 128 // OLED display width, in pixels
    #define SCREEN_HEIGHT 64 // OLED display height, in pixels
    // 8 rows of 21 characters

    // Declaration for an SSD1306 I2C display
    #ifndef OLED_RESET
      #define OLED_RESET    -1 // Reset pin # (or -1 if sharing Arduino reset pin)
    #endif  
    Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

  #endif

  //=================================================================================================   
  //                          B L U E T O O T H   S U P P O R T - ESP32 Only
  //================================================================================================= 

  #if (defined ESP32) 

    #include "BluetoothSerial.h"
    #if !defined(CONFIG_BT_ENABLED) || !defined(CONFIG_BLUEDROID_ENABLED)
      #error Bluetooth is not enabled! Please run `make menuconfig in ESP32 IDF` 
    #endif

    BluetoothSerial SerialBT;

  #endif  

  //=================================================================================================   
  //                           W I F I   S U P P O R T - ESP32 and ES8266 Only
  //================================================================================================= 

    uint16_t TCP_localPort = 5760;
    uint16_t UDP_localPort = 14555;     
    uint16_t UDP_remotePort = 14550;      
    bool FtRemIP = true;

  #if (defined ESP32 || defined ESP8266) 

    // Define link variables
    struct linkStatus {
      uint32_t    packets_received;
      uint32_t    packets_lost;
      uint32_t    packets_sent;
    };
    bool          hb_heard_from = false;
    uint8_t       hb_system_id = 0;
    uint8_t       hb_comp_id = 0;
    uint8_t       hb_seq_expected = 0;
    uint32_t      hb_last_heartbeat = 0;
    linkStatus    link_status;
  
    #if defined ESP32 
      #include <WiFi.h>  
      #include <WiFiClient.h>
      #if defined webSupport
        #include <WebServer.h> 
        #include <Update.h> 
        WebServer server(80);          
      #endif      
      #include <WiFiAP.h>  
    #endif

    #if defined ESP8266
      #include <ESP8266WiFi.h>   // Includes AP class
      #include <WiFiClient.h>
      #if defined webSupport
        #include <ESP8266WebServer.h>    
        ESP8266WebServer server(80);
      #endif      
    #endif
    

    #include <WiFiUdp.h>    

    WiFiClient WiFiSTA;   
       
    WiFiServer TCPserver(set.tcp_localPort);

    IPAddress udp_remoteIP(192, 168, 1, 255);    // Declare UDP broadcast on your likely LAN subnet
    WiFiUDP UDP;       // Create UDP object    
         
    IPAddress localIP;   // tcp and udp
    
  #endif  // end of ESP32 and ESP8266
  
//=================================================================================================   
//                                 S E R I A L
//=================================================================================================

#if (defined ESP32)  
  #define Debug               Serial         // USB
  #define mvSerialFC          Serial2        //  RXD0 and TXD0
   
  #if defined ESP32_SoftwareSerial
    #include <SoftwareSerial.h>
    SoftwareSerial frSerial; 
  #else     // default HW Serial
    #define frSerial          Serial1     
  #endif   
    
#elif (defined ESP8266)
  #define Debug               Serial1        //  D4   TXD1 debug out  - no RXD1 !
  #define mvSerialFC          Serial         //  RXD0 and TXD0
  #include <SoftwareSerial.h>
  SoftwareSerial frSerial;  
#endif 

#if (defined TEENSY3X)      //  Teensy 3.1
  #define Debug               Serial         // USB  
  #define mvSerialFC          Serial2   
  #if (SPort_Serial == 1) 
    #define frSerial              Serial1        // S.Port 
  #elif (SPort_Serial == 3)
    #define frSerial              Serial3        // S.Port 
 #else
    #error SPort_Serial can only be 1 or 3. Please correct.
  #endif 
#endif 

#if (defined TEENSY3X) || (defined MAPLE_MINI)  //  only these have 4 uarts at present
  //#define Enable_GCS_Serial  //  OPTION SET HERE   OPTION SET HERE   OPTION SET HERE 
#endif

#if defined Enable_GCS_Serial  // only Teensy and maple mini have 4 uarts at present
  #if (SPort_Serial == 3) 
   #error Mavlink_GCS and SPort both configured for Serial3. Please correct.
  #endif 
  
  #if (defined TEENSY3X)          
    #define mvSerialGCS             Serial3 
    #define mvBaudGCS               57600        // Use 57600
  #else
    #error Mavlink_GCS Serial not available for ESP32 or ESP8266  - no Serial3. Please correct.
  #endif
#endif

//=================================================================================================   
//                                 D E B U G G I N G   O P T I O N S
//=================================================================================================

//#define inhibit_SPort     // Use me to send debug messages only, out of GPIO1/TX0 on ESP32_Variant 3, DL V3 internal ESP32

//#define Mav_Debug_All
//#define Frs_Debug_All
//#define Frs_Debug_Payload
//#define Mav_Debug_RingBuff
//#define Frs_Debug_Period
//#define Debug_Air_Mode
//#define Debug_Relay_Mode
//#define Mav_List_Params      // Use this to test uplink to Flight Controller 
//#define Mav_Debug_Params
//#define Frs_Debug_Params
//#define Debug_BT    
//#define Debug_FC_Down        // traffic down from FC to Ring Buffer
//#define Debug_FC_Up          // traffic up to FC from GCS
//#define Debug_GCS_Down       // traffic from RB to GCS
//#define Debug_GCS_Up         // traffic up from GCS to FC
//#define Mav_Debug_Servo
//#define Frs_Debug_Servo
//#define Debug_Rssi
//#define Mav_Debug_RC
//#define Frs_Debug_RC
//#define Mav_Debug_FC_Heartbeat
//#define Mav_Debug_GCS_Heartbeat
//#define Mav_Debug_MavToPass_Heartbeat
//#define Frs_Debug_APStatus
//#define Mav_Debug_SysStatus
//#define Debug_Batteries
//#define Frs_Debug_Home
//#define Mav_Debug_GPS_Raw     // #24
//#define Mav_Debug_GPS_Int     // #33
//#define Frs_Debug_LatLon
//#define Frs_Debug_YelYaw
//#define Frs_Debug_GPS_status
//#define Mav_Debug_Scaled_IMU
//#define Mav_Debug_Raw_IMU
//#define Mav_Debug_Hud
//#define Frs_Debug_Hud
//#define Mav_Debug_Scaled_Pressure
//#define Mav_Debug_Attitude
//#define Frs_Debug_Attitude
//#define Mav_Debug_StatusText
//#define Frs_Debug_StatusText    
//#define Mav_Debug_Mission
//#define Frs_Debug_Mission   
//#define Debug_SD    
//#define Mav_Debug_System_Time   
//#define Frs_Debug_Scheduler // - this debugger affects the performance of the scheduler when activated
//#define Decode_Non_Essential_Mav 
//#define Debug_Baud 
//#define Debug_Radio_Status  
//#define Debug_GCS_Unknown
//#define Debug_Param_Request_Read
//#define Mav_Show_Unknown_Msgs
//#define Mav_Print_All_Msgid
//#define Debug_Eeprom
//#define Debug_Web_Settings
//#define Debug_SPort
//#define Mav_Debug_RPM


//=================================================================================================   
//                                   C H A N G E   L O G
//=================================================================================================
/*

Change log:
                                    
v2.00 2019-06-07 Plus version firmware ported to ESP32 Dev Module V1 successfully - no improvements  
v2.01 2019-06-09 Added OLED display support
v2.02 2019-05-18 Belatedly include Alex's Rangefinder PR that I missed.
v2.03 2019-05-21 Reduce voltage and current display moving average smoothing
                 Empirical correction of mAh consumed as per Markus Greinwald's measurements 
                 Change mav heartbeat timeout from 3 to 6 seconds
v2.04 2019-05-24 Merge Alex's BT classic PR. Thank you! 
                 Remove Aux port as no longer required
                 Tidy #define options  
v2.05 2019-06-09 Support 3 possible I/O channels on FC side, and 3 on GCS side. UART serial, BT and WiFi.
                 WiFi AP ssid = 'Mav2Passthru', pw = 'password' for now.  
v2.06 2019-06-10 Support added for STA mode and AP mode. Tidied up some lose ends. 
v2.07 2019-06-16 Initiate WiFi session with push button from GPIO15 momentary to ground. 
v2.08 2019-06-16 Add SD/TF card support - wip!!  Added UTP protocol option 
v2.09 2019-06-30 WiFi activation push button momentary but one-time. 
      2019-07-03 Implemented optional TLog input and output via SD card.  
v2.10 2019-07-09 For PX4 flight stack only, send HB to FC every 2 seconds  
      2019-07-10 Radical redesign of S.Port scheduling algorithm. Support SD and WiFi/BT I/O simultaneously 
v2.11 2109-07-11 Auto determine target board. Publish "Universal" version 2.11. One source, four platforms / boards 
v2.12 2019-07-12 Add #define PlusVersion, comment out for FlightDeck   
v2.13 2019-08-13 UDP now working in Access Point mode 
v2.14 2019-07-17 PX4 flight stack only - fixed longitude typo    if (ap_lat24<0) should be if (ap_lon24<0)
v2.15 2019-07-17 Switch to Adafruit_SSD1306 OLED library. 8 lines x 21 chars
v2.16 2019-07-18 Increase time burden for each successive Status Text chunk by 5mS
v2.17 2019-07-19 Auto detect serial telemetry and baud rate    
v2.18 2019-07-21 Tune FrSky packet schduler. Add option. Default is 1x.  //Send_status_Text_3_Times
v2.19 2019-07-22 Implement 2 tier scheduling. Tier1 gets priority, tier2 (0x5000) only when tier1 empty 
v2.20 2019-07-26 Release candidate. Send HB back to FC for APM also, not just PX4. Streamline library #includes.
                 #undef troublesome F function.  
v2.21 2019-07-26 Trap attempt to do GCS I/O on ESP32 or Blue Pill - no Serial3 UART.
      2019-07-29 Implement system health status-text messages as per Alex's request.  
v2.22 2019-08-10 Make sensor health messages optional for now. Fix end-of-sensor message text detection.
v2.23 2019-08-21 Add support for RFD900x long-range telemetry modems, specifically RSSI  
v2.24 2019-08-23 Workaround for Esp32 library "wifi: Set status to INIT" bug
                 Improve responsiveness to baud detect with no telemetry present.    
v2.25 2019-08-28 Version for RFD900x. Bug fixes on rssi. Include #define StartWiFi option to 
                 override startWiFi Pin.  
v2.26 2019-08-31 Improved GCS to FC debugging. Make baud rate sensing optional. 
v2.27 2019-09-13 Small additions to test LILYGO®_TTGO_MINI32_ESP32-WROVER_B
v2.28 2019-09-17 Localise pin definitions in one place to define ESP32 variants more easily
v2.29 2019-09-24 Use #if (TargetBoard == 3) to define soft pins for mvSerialFC
v2.30 2019-09-26 Don't push #5007 into sensor table from #147. Push from #1 only.
v2.31 2019-09-30 Configurable declarations moved to config.h file
v2.32 2019-10-08 Source line corrupted in v2.17 affecting Relay Mode, fixed. Thank you burtgree! 
v2.33 2019-10-09 Don't invert ESP32 SPort in Relay Mode. Use commercial inverter/converter. 
                 Tidy up config.h file.
                 Send #5007 3 times at startup and then every 50th heartbeat.
v2.34 2019-10-15 Move typedef struct DateTime_t to global scope in line with VS Code/Platform IO.  
v2.35 2019-10-18 Add pre-defined ESP32 board variants. TargetBoard >> Target_Board typo Paul Atherton. 
v2.36 2019-10-30 Optimise WiFi amd BT read/send as per excellent mavesp8266 bridge by Tridge.
                 Add support for ESP8266. 
v2.41 2019-11-08 Fix STA mode no-connect loop 
      2019-11-08 Make AutoAP optional    
v2.42 2019-11-09 Add support for GCS-side simultaneous WiFi and BT telemetry option 
v2.43 2019-11-10 Tidy up WiFi Setup for auto AP failover. 
                 Support for 2 new ESP32 board variants, complements of Noircogi.     
      2019-11-11 Implement Auto RSSI selection(Order of precedence #109, then #65 then #35) 
      2019-11-11  Support AutoBaud up to 921600. 
v2.44 2019-11-12  Include Target0815 recommended reset after STA fail to connect.     
v2.45 2019-11-12  Augment mission debugging for athertop.  
      2019-11-13  Move #endif outside } in SetupWiFi         
v2.46 2019-11-16  A few cosmetic improvements     
v2.47 2019-12-23  For ESP32 Dev Module, use pin 27 for S.Port tx, 
                   because boot fails if pin 12 pulled high   

v2.48 2019-12-17 Option for SiK #109, if RSSI is already in %, i.e. not relative to 2.54 
                 Added #define Rssi_In_Percent 
      2019-12-31 Changes for PlatformIO compatibility 
      2020-01-02 ESP32 Dev Board change again for stability - S.Port pins rx=13, tx=14 
v2.49 2020-01-07 Move baud, ssid and BT settings to top of config.h for convenience 
v2.50 2020-01-12 AutoAP: Activate udp broadcast on AP dhcp allocated IP subnet.
                 Eliminate annoying periodic "Stabilized Flight Mode" announcements.
                 Further localise options in to logical groups.     
      2020-01-13 Revert max rssi to 254. 255 is invalid/unknown in ardupilot  
v2.51 2020-01-18 Make default rssi 69% for SiK radios, like RFD900x. PR by Hasi123   
v2.52 2020-01-21 Support web OTA. Rehash STA to AP failover using reboot - now stable. 
v2.53 2020-01-25 ESP8266 (Node MFU 12F) debugged, tested. ESP8266 OTA included. 
v2.54 2020-01-27 ESP8266 inverted single-wire enabled, like Teensy. 
      No hardware invert/convert required.                     
v2.54a 2020-01-28 Setup OTA password in config.h   
v2.54b 2020-01-30 Correct irritating warnings  
v2.55  2020-02-04 Add RFD900X TXMOD ESP8266 variant    
v2.56.1  2020-02-26 Add web interface to allow settings/parameter changes 
v2.56.2  2020-02-27 STM32F103C / Blue Pill / Maple Mini deprecated. Tidy up Teensy3.x warnings. 
v2.56.3 2020-03-03 Minor ESP8266 variants logic check 
v2.56.4 2020-03-04 Remove spurious debugging code affecting S.Port Thanks pascale dragos.     
v2.56.5 2020-03-09 Reduce rssi timing cycle to 350mS from 700mS. 
v2.57   2020-03-15 Fix RFD900/TXMOD status LED. SoftwareSerial for ESP32.  
v2.58   2020-03-17 Option to work around apparent bug in Mavlink V2 Library. Tolerate crc errors.
                   This fixes failure to parse certain mavlink messages, including #226 RPM 
                   Needs more investigation. Use with caution!
v2.58.1 2020-03-18 Improve user options on hw/sw serial 
v2.58.2 2020-03-20 Stable. Lots of nice, small tweaks. Exp. code for inherent 1-wire on ESP
v2.58.3 2020-03-22 Deactivate experimental CRC error tolerance for general use. My bad, sorry!                                           
*/

> Executing task: platformio run <

Processing esp12e (platform: espressif8266; board: esp12e; framework: arduino)
----------------------------------------------------------------------------------------------------------------------------
Verbose mode can be enabled via `-v, --verbose` option
CONFIGURATION: https://docs.platformio.org/page/boards/espressif8266/esp12e.html
PLATFORM: Espressif 8266 2.4.0 > Espressif ESP8266 ESP-12E
HARDWARE: ESP8266 80MHz, 80KB RAM, 4MB Flash
PACKAGES: 
 - framework-arduinoespressif8266 3.20603.200130 (2.6.3) 
 - tool-esptool 1.413.0 (4.13) 
 - tool-esptoolpy 1.20800.0 (2.8.0) 
 - toolchain-xtensa 2.40802.191122 (4.8.2)
LDF: Library Dependency Finder -> http://bit.ly/configure-pio-ldf
LDF Modes: Finder ~ chain, Compatibility ~ soft
Found 38 compatible libraries
Scanning dependencies...
Dependency Graph
|-- <c_library_v2-master>
|-- <ESP8266WebServer> 1.0
|   |-- <ESP8266WiFi> 1.0
|-- <Wire> 1.0
|-- <My_Patched_ESP32_SD_Library>
|   |-- <SPI> 1.0
|-- <CircularBuffer> 1.2.0
|-- <SPI> 1.0
|-- <ESP8266WiFi> 1.0
|-- <EEPROM> 1.0
|-- <Adafruit SSD1306> 2.2.0
|   |-- <Adafruit GFX Library> 1.5.6
|   |   |-- <SPI> 1.0
|   |-- <SPI> 1.0
|   |-- <Wire> 1.0
|-- <EspSoftwareSerial> 6.7.1
|-- <Update> 1.0
Building in release mode
Compiling .pio/build/esp12e/src/main.cpp.o
Generating LD script .pio/build/esp12e/ld/local.eagle.app.v6.common.ld
Archiving .pio/build/esp12e/libb9f/libc_library_v2-master.a
Indexing .pio/build/esp12e/libb9f/libc_library_v2-master.a
Compiling .pio/build/esp12e/libb8b/ESP8266WiFi/BearSSLHelpers.cpp.o
Compiling .pio/build/esp12e/libb8b/ESP8266WiFi/CertStoreBearSSL.cpp.o
Compiling .pio/build/esp12e/libb8b/ESP8266WiFi/ESP8266WiFi.cpp.o
In file included from src/main.cpp:142:0:
include/config.h:246:0: warning: "GCS_Mavlink_IO" redefined [enabled by default]
        #define GCS_Mavlink_IO  2    // WiFi Only
 ^
include/config.h:65:0: note: this is the location of the previous definition
 #define GCS_Mavlink_IO  3    // WiFi AND Bluetooth simultaneously - ESP32 only
 ^
In file included from lib/c_library_v2-master/ardupilotmega/../mavlink_helpers.h:13:0,
                 from lib/c_library_v2-master/ardupilotmega/../protocol.h:75,
                 from lib/c_library_v2-master/ardupilotmega/ardupilotmega.h:30,
                 from lib/c_library_v2-master/ardupilotmega/mavlink.h:32,
                 from src/main.cpp:146:
lib/c_library_v2-master/ardupilotmega/../mavlink_sha256.h:77:0: warning: "F" redefined [enabled by default]
 #define F m->counter[5]
 ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:242:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/WString.h:39:0: note: this is the location of the previous definition
 #define F(string_literal) (FPSTR(PSTR(string_literal)))
 ^
In file included from src/main.cpp:142:0:
include/config.h:485:26: error: redefinition of 'const uint8_t D0'
     static const uint8_t D0   = 16;   // SCL - optional
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:40:22: error: 'const uint8_t D0' previously defined here
 static const uint8_t D0   = 16;
                      ^
In file included from src/main.cpp:142:0:
include/config.h:486:26: error: redefinition of 'const uint8_t D1'
     static const uint8_t D1   = 5;    // SDA - optional
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:41:22: error: 'const uint8_t D1' previously defined here
 static const uint8_t D1   = 5;
                      ^
In file included from src/main.cpp:142:0:
include/config.h:487:26: error: redefinition of 'const uint8_t D2'
     static const uint8_t D2   = 4;    // SPort half-duplex
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:42:22: error: 'const uint8_t D2' previously defined here
 static const uint8_t D2   = 4;
                      ^
In file included from src/main.cpp:142:0:
include/config.h:488:26: error: redefinition of 'const uint8_t D3'
     static const uint8_t D3   = 0;    // Flash
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:43:22: error: 'const uint8_t D3' previously defined here
 static const uint8_t D3   = 0;
                      ^
In file included from src/main.cpp:142:0:
include/config.h:489:26: error: redefinition of 'const uint8_t D4'
     static const uint8_t D4   = 2;    // BoardLED & TXD1 optional debug out
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:44:22: error: 'const uint8_t D4' previously defined here
 static const uint8_t D4   = 2;
                      ^
In file included from src/main.cpp:142:0:
include/config.h:490:26: error: redefinition of 'const uint8_t D5'
     static const uint8_t D5   = 14;   // SPort rx (unused in half-duplex)
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:45:22: error: 'const uint8_t D5' previously defined here
 static const uint8_t D5   = 14;
                      ^
In file included from src/main.cpp:142:0:
include/config.h:491:26: error: redefinition of 'const uint8_t D6'
     static const uint8_t D6   = 12;   // P2-3 exposed dual row of pins
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:46:22: error: 'const uint8_t D6' previously defined here
 static const uint8_t D6   = 12;
                      ^
In file included from src/main.cpp:142:0:
include/config.h:492:26: error: redefinition of 'const uint8_t D7'
     static const uint8_t D7   = 13;   // CTS
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:47:22: error: 'const uint8_t D7' previously defined here
 static const uint8_t D7   = 13;
                      ^
In file included from src/main.cpp:142:0:
include/config.h:493:26: error: redefinition of 'const uint8_t D8'
     static const uint8_t D8   = 15;   // RTS
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:48:22: error: 'const uint8_t D8' previously defined here
 static const uint8_t D8   = 15;
                      ^
In file included from src/main.cpp:142:0:
include/config.h:494:26: error: redefinition of 'const uint8_t D9'
     static const uint8_t D9   = 3;    // RXD0
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:49:22: error: 'const uint8_t D9' previously defined here
 static const uint8_t D9   = 3;
                      ^
In file included from src/main.cpp:142:0:
include/config.h:495:26: error: redefinition of 'const uint8_t D10'
     static const uint8_t D10  = 1;    // TXD0
                          ^
In file included from /Users/giacomo/.platformio/packages/framework-arduinoespressif8266/cores/esp8266/Arduino.h:286:0,
                 from src/main.cpp:1:
/Users/giacomo/.platformio/packages/framework-arduinoespressif8266/variants/nodemcu/pins_arduino.h:50:22: error: 'const uint8_t D10' previously defined here
 static const uint8_t D10  = 1;
                      ^
Compiling .pio/build/esp12e/libb8b/ESP8266WiFi/ESP8266WiFiAP.cpp.o
Compiling .pio/build/esp12e/libb8b/ESP8266WiFi/ESP8266WiFiGeneric.cpp.o
Compiling .pio/build/esp12e/libb8b/ESP8266WiFi/ESP8266WiFiMulti.cpp.o
src/main.cpp: In function 'void Write_To_FC(uint32_t)':
src/main.cpp:1240:17: warning: unused variable 'msgSent' [-Wunused-variable]
            bool msgSent = Send_TCP(&G2Fmsg);  // to FC   
                 ^
src/main.cpp:1247:17: warning: unused variable 'msgRead' [-Wunused-variable]
            bool msgRead = Send_UDP(&G2Fmsg);  // to FC    
                 ^
src/main.cpp: In function 'void Send_From_RingBuf_To_GCS()':
src/main.cpp:1313:16: warning: unused variable 'sentOK' [-Wunused-variable]
           bool sentOK = Send_TCP(&R2Gmsg);  // to GCS
                ^
src/main.cpp: In function 'void RefreshHTMLButtons()':
src/main.cpp:5575:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.trmode1 = "checked";
                 ^
src/main.cpp:5576:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.trmode2 = "";
                 ^
src/main.cpp:5577:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.trmode3 = "";
                 ^
src/main.cpp:5580:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.trmode1 = "";
                 ^
src/main.cpp:5581:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.trmode2 = "checked";
                 ^
src/main.cpp:5582:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.trmode3 = "";  
                 ^
src/main.cpp:5585:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.trmode1 = "";
                 ^
src/main.cpp:5586:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.trmode2 = "";
                 ^
src/main.cpp:5587:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.trmode3 = "checked";
                 ^
src/main.cpp:5591:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io0 = "checked";
                ^
src/main.cpp:5592:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io1 = "";
                ^
src/main.cpp:5593:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io2 = "";
                ^
src/main.cpp:5594:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io3 = "";   
                ^
src/main.cpp:5597:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io0 = "";
                ^
src/main.cpp:5598:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io1 = "checked";
                ^
src/main.cpp:5599:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io2 = "";
                ^
src/main.cpp:5600:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io3 = "";     
                ^
src/main.cpp:5603:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io0 = "";
                ^
src/main.cpp:5604:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io1 = "";
                ^
src/main.cpp:5605:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io2 = "checked";
                ^
src/main.cpp:5606:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io3 = "";      
                ^
src/main.cpp:5609:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io0 = "";
                ^
src/main.cpp:5610:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io1 = "";
                ^
src/main.cpp:5611:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io2 = "";
                ^
src/main.cpp:5612:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.fc_io3 = "checked";  
                ^
src/main.cpp:5625:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io0 = "";
                ^
src/main.cpp:5626:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io1 = "checked";
                ^
src/main.cpp:5627:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io2 = "";
                ^
src/main.cpp:5628:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io3 = ""; 
                ^
src/main.cpp:5629:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io9 = "";           
                ^
src/main.cpp:5632:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io0 = "";
                ^
src/main.cpp:5633:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io1 = "";
                ^
src/main.cpp:5634:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io2 = "checked";
                ^
src/main.cpp:5635:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io3 = "";   
                ^
src/main.cpp:5636:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io9 = "";           
                ^
src/main.cpp:5639:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io0 = "";
                ^
src/main.cpp:5640:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io1 = "";
                ^
src/main.cpp:5641:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io2 = "";
                ^
src/main.cpp:5642:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io3 = "checked";
                ^
src/main.cpp:5643:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_io9 = "";           
                ^
src/main.cpp:5646:18: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
       set.gs_io0 = "";
                  ^
src/main.cpp:5647:18: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
       set.gs_io1 = "";
                  ^
src/main.cpp:5648:18: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
       set.gs_io2 = "";
                  ^
src/main.cpp:5649:18: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
       set.gs_io3 = "";
                  ^
src/main.cpp:5650:18: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
       set.gs_io9 = "checked";            
                  ^
src/main.cpp:5654:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_sd0 = "checked";
                ^
src/main.cpp:5655:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_sd1 = "";
                ^
src/main.cpp:5658:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_sd0 = "";
                ^
src/main.cpp:5659:16: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.gs_sd1 = "checked";
                ^
src/main.cpp:5663:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfmode1 = "checked";
                 ^
src/main.cpp:5664:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfmode2 = "";
                 ^
src/main.cpp:5665:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfmode3 = "";
                 ^
src/main.cpp:5668:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfmode1 = "";
                 ^
src/main.cpp:5669:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfmode2 = "checked";
                 ^
src/main.cpp:5670:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfmode3 = "";
                 ^
src/main.cpp:5673:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfmode1 = "";
                 ^
src/main.cpp:5674:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfmode2 = "";
                 ^
src/main.cpp:5675:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfmode3 = "checked";
                 ^
src/main.cpp:5679:18: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfproto1 = "checked";
                  ^
src/main.cpp:5680:18: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfproto2 = "";
                  ^
src/main.cpp:5683:18: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfproto1 = "";
                  ^
src/main.cpp:5684:18: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.wfproto2 = "checked";
                  ^
src/main.cpp:5688:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.btmode1 = "checked";
                 ^
src/main.cpp:5689:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.btmode2 = "";
                 ^
src/main.cpp:5692:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.btmode1 = "";
                 ^
src/main.cpp:5693:17: warning: deprecated conversion from string constant to 'char*' [-Wwrite-strings]
     set.btmode2 = "checked";
                 ^
Compiling .pio/build/esp12e/libb8b/ESP8266WiFi/ESP8266WiFiSTA-WPS.cpp.o
In file included from src/main.cpp:142:0:
include/config.h: At global scope:
include/config.h:571:23: warning: 'dt_tm' defined but not used [-Wunused-variable]
     static DateTime_t dt_tm; 
                       ^
*** [.pio/build/esp12e/src/main.cpp.o] Error 1
================================================ [FAILED] Took 7.62 seconds

^~~~~

   #error Bluetooth works only on an ESP32 board

    ^~~~~

                            M o s t    R e c e n t   C h a n g e s

                                   // Most of the settings below are saved to EEPROM the first time mav2pt runs

 #if (FC_Mavlink_IO == 2) || (GCS_Mavlink_IO == 2) || (GCS_Mavlink_IO == 3) || (defined webSupport)   // if wifi selected
   #error WiFi and webSupport only work on an ESP32 or ESP8266 board
 #endif  

#if (defined displaySupport)   // Display type defined with board variant
  #define SSD1306_Display         // OLED display type    
  /* Below please choose either Touch pin-pair or Digital pin-pair for display scrolling
   *  Pin == 99 means the pin-pair is not used
   */ 
  #define Pinfo         99        //    Digital pin to toggle information/log page              
  #define Pup           99        // 35 Board Button 1 to scroll the display up
  #define Pdn           99        //  0 Board Button 2 to scroll the display down  
  #define Tinfo         15        // 15 Touch pin to toggle information/log page       
  #define Tup           33        // 33 Touch pin to scroll the display up
  #define Tdn           32        // 32 Touch pin to scroll the display down   
  #define SDA           21        // I2C OLED board
  #define SCL           22        // I2C OLED board
  #define i2cAddr      0x3C       // I2C OLED board
#endif   
/*  
  SPI/CS                       Pin 05   For optional TF/SD Card Adapter
  SPI/MOSI                     Pin 23   For optional TF/SD Card Adapter
  SPI/MISO                     Pin 19   For optional TF/SD Card Adapter
  SPI/SCK                      Pin 18   For optional TF/SD Card Adapter  
*/

#if (defined displaySupport)   // Display type defined with # define displaySupport 
  #define SSD1306_Display         // OLED display type    
  /* Below please choose either Touch pin-pair or Digital pin-pair for display scrolling
   *  Pin == 99 means the pin-pair is not used
   */ 
  #define Pinfo         99        //    Digital pin to trigger information display              
  #define Pup           99        // 35 Board Button 1 to scroll the display up
  #define Pdn           99        //  0 Board Button 2 to scroll the display down   
  #define Tinfo         99        // 02 Touch pin to toggle information/log page       
  #define Tup           99        // 33 Touch pin to scroll the display up
  #define Tdn           99        // 32 Touch pin to scroll the display down   
  #define Tinfo         99        //    Touch pin to toggle information/log page
  #define SDA           05        // I2C OLED board
  #define SCL           04        // I2C OLED board
  #define i2cAddr      0x3C       // I2C OLED board
#endif  

#if (defined displaySupport)   // Display type defined with # define displaySupport   
  #define SSD1306_Display         // OLED display type  
  /* Below please choose either Touch pin-pair or Digital pin-pair for display scrolling
   *  Pin == 99 means the pin-pair is not used
   */ 
  #define Pinfo         99        //    Digital pin to toggle information/log page         
  #define Pup           99        // 35 Board Button 1 to scroll the display up
  #define Pdn           99        //  0 Board Button 2 to scroll the display down 
  #define Tinfo         99        //    Touch pin to toggle information/log page         
  #define Tup           99        // 33 Touch pin to scroll the display up
  #define Tdn           99        // 32 Touch pin to scroll the display down   
  #define SDA           05        // I2C OLED board
  #define SCL           04        // I2C OLED board 
  #define i2cAddr      0x3C       // I2C OLED board
#endif  

/*  
  SPI/CS               05   For optional TF/SD Card Adapter
  SPI/MOSI             23   For optional TF/SD Card Adapter
  SPI/MISO             19   For optional TF/SD Card Adapter
  SPI/SCK              18   For optional TF/SD Card Adapter  
*/

#if !defined displaySupport    // I2C TFT board is built into TTGO T-Display
  #define displaySupport
#endif    
#define ST7789_Display          // TFT display type - if you have a display you must define which type

/* Below please choose either Touch pin-pair or Digital pin-pair for display scrolling
 *  Pin == 99 means the pin-pair is not used
 */ 
#define Pinfo          2        //    Digital pin to toggle information/log page     
#define Pup            0        //  0 Board Button 1 to scroll the display up
#define Pdn           35        // 35 Board Button 2 to scroll the display down 
#define Tinfo         99        //    Touch pin to toggle information/log page       
#define Tup           99        // 33 Touch pin to scroll the display up
#define Tdn           99        // 32 Touch pin to scroll the display down   

//#define screenOrientation 0    // Portrait - Select one orientation only
#define screenOrientation   1    // Landscape

#define SDA           21        // I2C TFT board 
#define SCL           22        // I2C TFT board
#define i2cAddr      0x3C       // I2C TFT board

#if !defined sdBuiltin         // SD reader is built into TTGO T2
  #define sdBuiltin
#endif
#if !defined displaySupport      // I2C OLED board is built into TTGO T2
  #define displaySupport
#endif
#define SSD1331_Display         // colour TFT display type see here https://github.com/emard/ulx3s/issues/8
                                // software graphic display clear very slow
#define SCLK          14          // SPI pins for SSD1331 
#define MOSI          13
#define MISO          12          // apparently not used by Adafruit ?
#define CS            15
#define DC            16
#define RST            4
/*    Below please choose either Touch pin-pair or Digital pin-pair for display scrolling
 *    Pin == 99 means the pin-pair is not used
 */ 
#define Pinfo         25        // Digital pin to toggle information/log page        
#define Pup           99        // Board Button 1 to scroll the display up
#define Pdn           99        // Board Button 2 to scroll the display down    
#define Tinfo         99        // Touch pin to toggle information/log page    
#define Tup           32        // Touch pin to scroll the display up
#define Tdn            2        // Touch pin to scroll the display down      

#define MavStatusLed  D4        // D4/GPIO2 Board LED - Mav Status LED inverted logic - use 99 while debug
#define InvertMavLed true      
#define BufStatusLed  99        // None     

#if (defined displaySupport)   // Display type defined with # define displaySupport   
  /* Below please choose Digital pin-pair for display scrolling
   *  Pin == 99 means the pin-pair is not used
   */ 
  #define Pinfo       99        // Digital pin to toggle information/log page           
  #define Pup         D3        // D3 Board Button 1 to scroll the display up
  #define Pdn         D7        // D7 Board Button 2 to scroll the display down    
  #define SCL         D1        // I2C OLED board   
  #define SDA         D2        // I2C OLED board
  #define i2cAddr    0x3C       // I2C OLED board
#endif

#define MavStatusLed  D4        // D4 Board LED - Mav Status LED inverted logic - use 99 while debug
#define InvertMavLed true    
#define BufStatusLed  99        // None
//                    D4        // TXD1 - Serial1 default debug log out SHARED WITH BOARD LED                           
#define mav_rxPin     D9        // RXD0 default  
#define mav_txPin     D10       // TXD0 default    
#define fr_rxPin      D5        // FPort- Not used in single wire mode
#define fr_txPin      D2        // FPort(half-duplex) inverted - Use me in single wire mode
#define startWiFiPin  D6        // Trigger WiFi startup 
                                // NOTE: There may not be enough pins for wifi pin AND display scrolling  
#if (defined displaySupport)    // Display type defined with # define displaySupport 
  #define SSD1306_Display  
  /* Below please choose Digital pin-pair for display scrolling
   *  Pin == 99 means the pin-pair is not used
   */ 
  #define Pinfo         99        // Digital pin to toggle information/log page          
  #define Pup           99        // D3 Board Button 1 to scroll the display up
  #define Pdn           99        // D7 Board Button 2 to scroll the display down    
  #define SCL           D0        // I2C OLED board   
  #define SDA           D1        // I2C OLED board
  #define i2cAddr      0x3C       // I2C OLED board
#endif 

#define LED_BUILTIN 2

static const uint8_t D0   = 16;  // WiFi trigger
static const uint8_t D1   = 5;   // SCL - optional
static const uint8_t D2   = 4;   // SDA - optional
static const uint8_t D3   = 0;   // Flash - reserved
static const uint8_t D4   = 2;   // LED_BUILTIN & TXD1 optional debug out
static const uint8_t D5   = 14;  // FPortrx (unused in half-duplex)
static const uint8_t D6   = 12;  // FPorttx - Use me in single wire mode
static const uint8_t D7   = 13;  // CTS 
static const uint8_t D8   = 15;  // RTS
static const uint8_t D9   = 3;   // RXD0
static const uint8_t D10  = 1;   // TCD0 

#define MavStatusLed  D4        // D4 Board LED - Mav Status LED inverted logic - use 99 while debug
#define InvertMavLed true    
#define BufStatusLed  99        // None
//                    D4        // TXD1 - Serial1 default debug log out SHARED WITH LED_BUILTIN BOARD LED                           
#define mav_rxPin     D9        // RXD0 - Serial(0) 
#define mav_txPin     D10       // TXD0 - Serial(0) 
#define fr_rxPin      D5        // FPort- Not used in single wire mode
#define fr_txPin      D6        // FPort- inverted - Use me in single wire mode
#define startWiFiPin  D16       // Trigger WiFi startup 
  
#if (defined displaySupport)   // Display type defined with # define displaySupport   
  /* Below please choose Digital pin-pair for display scrolling
   *  Pin == 99 means the pin-pair is not used
   */ 
  #define Pinfo         99        // Digital pin to toggle information/log page           
  #define Pup           99        // D3 Board Button 1 to scroll the display up
  #define Pdn           99        // D7 Board Button 2 to scroll the display down    
  #define SCL           D1        // I2C OLED board   
  #define SDA           D2        // I2C OLED board
  #define i2cAddr      0x3C       // I2C OLED board
#endif 

#include <FS.h>
#include <SD.h>
#include <SPI.h>
#define SD_Libs_Loaded 

/*
// Optional SPI interface pins for SD card adapter or SSD1306 OLED display
#define CS            5        
#define MOSI          23 
#define MISO          19 
#define SCK           18 
*/  

// Pins generally   CS=5    MOSI=23   MISO=19   SCK=18    3.3V   GND   Dev Board, LilyGO/TTGO


 
// Rememeber to change SPI frequency from 4E6 to 25E6, i.e 4MHz to 25MHz in SD.h otherwise MavRingBuff fills up 
// C:\Users\YourUserName\AppData\Local\Arduino15\packages\esp32\hardware\esp32\1.0.2\libraries\SD\src  
// bool begin(uint8_t ssPin=SS, SPIClass &spi=SPI, uint32_t frequency=25000000, const char * mountpoint="/sd", uint8_t max_files=5);  

char              cPath[40];
std::string       fnPath[30];
uint8_t           fnCnt;
uint16_t          sdReadDelay = 10;  // mS   Otherwise the reads run through unnaturally quickly

const uint16_t    sd_buf_sz = 128;
byte              sd_buf [sd_buf_sz];
uint16_t          sd_idx = 0;
 
File     file;  // Create global object from File class for general use

static  const uint8_t mthdays[]={31,28,31,30,31,30,31,31,30,31,30,31}; 

typedef struct  { 
  uint16_t yr;   // relative to 1970;  
  uint8_t mth;
  uint8_t day;
  uint8_t dow;   // sunday is day 1 
  uint8_t hh; 
  uint8_t mm; 
  uint8_t ss; 
}   DateTime_t;

static DateTime_t dt_tm; 

#if not defined SD_Libs_Loaded    //  by SD block
  #include <SPI.h>                // for SD card and/or Display
#endif  

  // Colour definitions for any colour display
  #define BLACK           0x0000
  #define BLUE            0x001F
  #define RED             0xF800
  #define GREEN           0x07E0
  #define CYAN            0x07FF
  #define MAGENTA         0xF81F
  #define YELLOW          0xFFE0
  #define WHITE           0xFFFF 

//==========================================================

#if (defined ST7789_Display)        // TFT display type    
  #include <TFT_eSPI.h>             // Remember to select the T_Display board in User_Setup_Select.h in TFT_eSPI library
                                    // (H 240 x W 135 in portrait) (H 135 x W 240 in landscape) 
  TFT_eSPI display = TFT_eSPI();
  #if (screenOrientation == 0)      // portrait
    #define screen_height  20       // characters not pixels
    #define screen_width   30       // ?
    #define char_height    12       // pixels      
  #elif (screenOrientation == 1)    // landscape
    #define screen_height   8       // characters not pixels 
    #define screen_width   20  
    #define char_height    16       // pixels x 8 = 128  rem 7           
  #endif 

//==========================================================

#elif (defined SSD1306_Display)    // SSD1306 OLED display     (H 128 x W 64 in portrait)
  #include <Adafruit_SSD1306.h> 
  #define SCREEN_WIDTH 128   // OLED display width, in pixels
  #define SCREEN_HEIGHT 64   // OLED display height, in pixels
  #define screen_height  8   // characters not pixels 
  #define screen_width  21   
  #define char_height    8   // 8 x 8 = 64         
  #ifndef OLED_RESET
    #define OLED_RESET    -1 // Reset pin # (or -1 if sharing Arduino reset pin)
  #endif  
  Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);  
      
//==========================================================  
#elif (defined SSD1331_Display)    // SSD1331 colour TFT display (H 96 x W 64 in portrait)
  #include <Adafruit_GFX.h>
  #include <Adafruit_SSD1331.h>
  #define screen_height  8   // characters not pixels 
  #define screen_width  16         
  #define char_height   12   // 8 x 12 = 64   
  Adafruit_SSD1331 display = Adafruit_SSD1331(CS, DC, MOSI, SCLK, RST);      
#endif   
//==========================================================   

static const uint16_t threshold = 40;
volatile bool upButton = false;
volatile bool dnButton = false;
volatile bool infoButton = false;

#if (not defined Tup) 
  #define Tup         99
#endif

#if (not defined Tdn) 
  #define Tdn         99
#endif

#if (not defined Pup) 
  #define Tup         99
#endif

#if (not defined Pdn) 
  #define Tdn         99
#endif

typedef enum scroll_set { non = 0, up = 1, down = 2 } scroll_t;
scroll_t up_down = non; 

typedef enum last_row_set { omit_last_row = 0, show_last_row = 1} last_row_t;
last_row_t last_row_action;   

struct row_t {
  char x[max_col];
  };

 row_t ScreenRow[max_row]; 
 
uint8_t   row = 0;
uint8_t   col = 0;
uint8_t   scroll_row = 0;
uint32_t  scroll_millis =0 ;

#include "BluetoothSerial.h"
#include "esp_bt.h"
#if !defined(CONFIG_BT_ENABLED) || !defined(CONFIG_BLUEDROID_ENABLED)
  #error Bluetooth is not enabled! Please run `idf.py menuconfig` in IDF workspace 
#endif

BluetoothSerial SerialBT;

uint16_t  TCP_localPort = 5760;
uint16_t  TCP_remotePort = 5760;    
uint16_t  UDP_localPort = 14555;     
uint16_t  UDP_remotePort = 14550;      
bool      FtRemIP = true;
bool      wifiDisconnected = false;
int16_t   wifi_rssi;
uint16_t  wifi_status = 0xfe;   // 0xfe = unused yet
uint8_t   AP_sta_count = 0;
uint8_t   AP_prev_sta_count = 0;

// Define link variables
struct linkStatus {
  uint32_t    packets_received;
  uint32_t    packets_lost;
  uint32_t    packets_sent;
};
bool          hb_heard_from = false;
uint8_t       hb_system_id = 0;
uint8_t       hb_comp_id = 0;
uint8_t       hb_seq_expected = 0;
uint32_t      hb_last_heartbeat = 0;
linkStatus    link_status;

#if defined ESP32 
  #include <WiFi.h>  // includes UDP class
  #if defined webSupport
    #include <WebServer.h> 
    #include <Update.h> 
    WebServer server(80);
    
  #endif      
  #include <WiFiAP.h>  
#endif

#if defined ESP8266
  #include <ESP8266WiFi.h>   // Includes AP class
  #if defined webSupport
    #include <ESP8266WebServer.h>    
    ESP8266WebServer server(80);  
    #include <WiFiUdp.h>       
  #endif      
#endif

#define max_clients    5
uint8_t active_client_idx = 0;   

WiFiClient TCPclient; 
 
WiFiClient *clients[max_clients] = {NULL};   // pointers to TCP client objects 

WiFiServer TCPserver(TCP_localPort);         // dummy TCP local port(changes on TCPserver.begin() ).

IPAddress UDP_remoteIP(192, 168, 1, 255);    // default to broadcast unless (not defined UDP_Broadcast)               
uint8_t   UDP_remoteIP_B3[max_clients];      // table of last byte of remote UDP client IPs

WiFiUDP UDP;                                 // create UDP object    
     
IPAddress localIP;                           // tcp and udp
IPAddress TCP_remoteIP(192,168,4,1);         // when we connect to a server in tcp client mode, put the server IP here 

#include <CircularBuffer.h>
#include <GCS_MAVLink.h>

//************************************* Please select your options here before compiling **************************
//#define PX4_Flight_stack // If your flight stack is PX4 and not APM, un-comment this line
// Choose one (only) of these target boards
#define Target_Board 0 // Teensy 3.x Un-comment this line if you are using a Teensy 3.x
//#define Target_Board 1 // Blue Pill STM32F103C OR un-comment this line if you are using a Blue Pill STM32F103C
//#define Target_Board 2 // Maple_Mini STM32F103C OR un-comment this line if you are using a Maple_Mini STM32F103C

// Choose one (only) of these three modes
#define Ground_Mode // Converter between Taranis and LRS tranceiver (like Orange)
//#define Air_Mode // Converter between FrSky receiver (like XRS) and Flight Controller (like Pixhawk)
//#define Relay_Mode // Converter between LRS tranceiver (like Orange) and FrSky receiver (like XRS) in relay box on the ground

//#define Use_Local_Battery_mAh // Un-comment this if you want to define battery mAhs here, no FC tx line needed. Alternatively
// enter battery capacities into yaapu's LUA script menu

const uint16_t bat1_capacity = 5200; // These are ignored if the above #define is commented out
const uint16_t bat2_capacity = 0;

#define SPort_Serial 1 // The default is Serial 1, but 3 is possible if we don't want aux port

//#define Aux_Port_Enabled // For BlueTooth or other auxilliary serial passthrough 

if (((ap26_temp / 100) - 19) < 0)
  pt_imu_temp = 0; // shows +19°C in yaapu, the lowest value possible
else
{
  if (((ap26_temp / 100) - 19) > 63)
    pt_imu_temp = 63; // shows +82°C in yaapu, the highest value possible
  else
    pt_imu_temp = (ap26_temp / 100) - 19; // shows the true value in 1°C resolution
}

Starting .... 
Target Board is Teensy 3.x
Air Mode
Battery_mAh_Source = 3 - Define battery capacities in the LUA script
Using Serial_1 for S.Port
Mavlink in #0 Heartbeat: ap_type=13  ap_autopilot=3  ap_base_mode=81 ap_custom_mode=2  ap_system_status=5  ap_mavlink_version=3
hb_count=1
Mavlink in #0 Heartbeat: ap_type=13  ap_autopilot=3  ap_base_mode=81 ap_custom_mode=2  ap_system_status=5  ap_mavlink_version=3
hb_count=2
Mavlink in #0 Heartbeat: ap_type=13  ap_autopilot=3  ap_base_mode=81 ap_custom_mode=2  ap_system_status=5  ap_mavlink_version=3
hb_count=3
mavgood=true
Mavlink in #27 Raw_IMU: accX=0.02  accY=-0.02  accZ=-1.03
Mavlink in #29 Scaled_Pressure:   press_abs=1002.1hPa  press_diff=0.000hPa  temperature=31.8C
Mavlink in #1 Sys_Status:  Bat volts=0.040  Bat amps=0.0  mAh=0.000000  Total mAh=0.000  Bat1 cell count= 0
Mavlink in #24 GPS_RAW_INT: ap_fixtype=0 No GPS  sats visible=0  latitude=0.0000000  longitude=0.0000000  gps alt amsl=0.0  eph (hdop)=0  epv (vdop)=0  vel=0.000  cog=0.0
Mavlink in #30 Attitude:  ap_roll degs=0.3 ap_pitch degs=0.6 ap_yaw degs=57.3
Mavlink in #74 VFR_HUD: Airspeed= 0.00  Groundspeed= 0.00  Heading= 57  Throttle %= 0  Baro alt= -0  Climb rate= -0.01
Mavlink in #30 Attitude:  ap_roll degs=0.3 ap_pitch degs=0.6 ap_yaw degs=57.3
Mavlink in #74 VFR_HUD: Airspeed= 0.00  Groundspeed= 0.00  Heading= 57  Throttle %= 0  Baro alt= -0  Climb rate= -0.01
Mavlink in #30 Attitude:  ap_roll degs=0.3 ap_pitch degs=0.6 ap_yaw degs=57.3
Mavlink in #74 VFR_HUD: Airspeed= 0.00  Groundspeed= 0.00  Heading= 57  Throttle %= 0  Baro alt= -0  Climb rate= -0.01
Mavlink in #30 Attitude:  ap_roll degs=0.3 ap_pitch degs=0.6 ap_yaw degs=57.3
Mavlink in #74 VFR_HUD: Airspeed= 0.00  Groundspeed= 0.00  Heading= 57  Throttle %= 0  Baro alt= -0  Climb rate= -0.01
Mavlink in #30 Attitude:  ap_roll degs=0.3 ap_pitch degs=0.6 ap_yaw degs=57.3
Mavlink in #74 VFR_HUD: Airspeed= 0.00  Groundspeed= 0.00  Heading= 57  Throttle %= 0  Baro alt= -0  Climb rate= -0.01
Mavlink in #27 Raw_IMU: accX=0.02  accY=-0.01  accZ=-1.03
Mavlink in #29 Scaled_Pressure:   press_abs=1002.1hPa  press_diff=0.000hPa  temperature=31.7C
Mavlink in #1 Sys_Status:  Bat volts=0.040  Bat amps=0.0  mAh=0.000000  Total mAh=0.000  Bat1 cell count= 0
Mavlink in #24 GPS_RAW_INT: ap_fixtype=0 No GPS  sats visible=0  latitude=0.0000000  longitude=0.0000000  gps alt amsl=0.0  eph (hdop)=0  epv (vdop)=0  vel=0.000  cog=0.0
Mavlink in #30 Attitude:  ap_roll degs=0.3 ap_pitch degs=0.6 ap_yaw degs=57.3
Mavlink in #74 VFR_HUD: Airspeed= 0.00  Groundspeed= 0.00  Heading= 57  Throttle %= 0  Baro alt= -0  Climb rate= 0.00
Mavlink in #30 Attitude:  ap_roll degs=0.3 ap_pitch degs=0.6 ap_yaw degs=57.3
Mavlink in #74 VFR_HUD: Airspeed= 0.00  Groundspeed= 0.00  Heading= 57  Throttle %= 0  Baro alt= -0  Climb rate= 0.00
Mavlink in #30 Attitude:  ap_roll degs=0.3 ap_pitch degs=0.6 ap_yaw degs=57.3

Starting .... 
Target Board is Teensy 3.x
Air Mode
Battery_mAh_Source = 3 - Define battery capacities in the LUA script
Using Serial_1 for S.Port
hb_count=1
hb_count=2
hb_count=3
mavgood=true
7E 1B Period ms=5455	 time_slot=1
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=0	 time_slot=2
7E 00 7E A1 7E 7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=330	 time_slot=4
Frsky out AP_Status 0x5001:  fr_flight_mode=3 fr_simple=0 fr_land_complete=0 fr_armed=0 fr_bat_fs=0 fr_ekf_fs=0 px4_flight_stack=0
TX
RX
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=6
Frsky out GPS Status 0x5002:  fr_numsats=0 fr_gps_status=0 fr_gps_adv_status=0 fr_amsl=0 fr_hdop=0 After prep: fr_amsl=0 fr_hdop=0
TX
RX
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=7
Frsky out Bat1 0x5003:  fr_bat1_volts=0 fr_bat1_amps=0 fr_bat1_mAh=0
TX
RX
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=8
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=9
Frsky out VelYaw 0x5005: fr_vy=0.00 fr_vx=0.00 fr_yaw=570.00 After prep: fr_vy=0 fr_vx=0 fr_yaw=285
TX
RX
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=10
Frsky out Attitude 0x5006: fr_roll=901 fr_pitch=452 fr_range=0 Frs_Attitude Payload=926597
TX
RX
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=11
TX
Frsky out Params 0x5007:  fr_param_id=1 fr_frame_type=13
RX
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=12
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=1
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=2
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=3
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=4
Frsky out AP_Status 0x5001:  fr_flight_mode=3 fr_simple=0 fr_land_complete=0 fr_armed=0 fr_bat_fs=0 fr_ekf_fs=0 px4_flight_stack=0
TX
RX
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=6
Frsky out GPS Status 0x5002:  fr_numsats=0 fr_gps_status=0 fr_gps_adv_status=0 fr_amsl=0 fr_hdop=0 After prep: fr_amsl=0 fr_hdop=0
TX
RX
7E 00 7E A1 7E 22 7E 83 7E E4 7E 45 7E C6 7E 67 7E 48 7E E9 7E 6A 7E CB 7E AC 7E 0D 7E 8E 7E 2F 7E D0 7E 71 7E F2 7E 53 7E 34 7E 95 7E 16 7E B7 7E 98 7E 39 7E BA 7E 1B Period ms=336	 time_slot=7
Frsky out Bat1 0x5003:  fr_bat1_volts=0 fr_bat1_amps=0 fr_bat1_mAh=0
TX
RX