#include <stdio.h>

#include <sys/types.h>
#include <dirent.h>
#include <sys/stat.h>
#include <unistd.h>

// #include "esp_system.h"
// #include "esp_sleep.h"

#include "hal.h"

#include "sens.h"
#include "rf.h"
#include "ctrl.h"
#include "proc.h"

#ifdef WITH_STRATUX
#include "stratux.h"
#endif

#ifdef WITH_WIFI
#include "wifi.h"
#endif

#ifdef WITH_AP
#include "wifi.h"
#endif

#ifdef WITH_BT_SPP
#include "bt.h"
#endif

#include "gps.h"
// #include "ubx.h"
// #include "timesync.h"
#include "format.h"

#include "config.h"

#define QUOTE(name) #name
#define STR(macro) QUOTE(macro)

#ifndef VERSION
#define VERSION 0.1.6
#endif

static char Line[128];

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

#ifdef WITH_OLED

#include "disp_oled.h"

int OLED_DisplayStatus(uint32_t Time, uint8_t LineIdx)
{ Format_String(Line   , "OGN Tx/Rx      ");
  Format_HHMMSS(Line+10, Time);
  OLED_PutLine(LineIdx++, Line);
  Parameters.Print(Line);
  OLED_PutLine(LineIdx++, Line);
  return 0; }

int OLED_DisplayPosition(GPS_Position *GPS=0, uint8_t LineIdx=2)
{ if(GPS && GPS->isValid())
  { Line[0]=' ';
    Format_SignDec(Line+1,  GPS->Latitude /60, 6, 4); Line[9]=' ';
    Format_UnsDec (Line+10, GPS->Altitude /10, 5, 0); Line[15]='m';
    OLED_PutLine(LineIdx  , Line);
    Format_SignDec(Line,    GPS->Longitude/60, 7, 4);
    Format_SignDec(Line+10, GPS->ClimbRate,    4, 1);
    OLED_PutLine(LineIdx+1, Line);
    Format_UnsDec (Line   , GPS->Speed, 4, 1); Format_String(Line+5, "m/s  ");
    Format_UnsDec (Line+10, GPS->Heading, 4, 1); Line[15]='^';
    OLED_PutLine(LineIdx+2, Line);
    Format_String(Line, "0D/00sat DOP00.0");
    Line[0]+=GPS->FixMode; Format_UnsDec(Line+3, GPS->Satellites, 2);
    Format_UnsDec(Line+12, (uint16_t)GPS->HDOP, 3, 1);
    OLED_PutLine(LineIdx+3, Line);
  }
  else { OLED_PutLine(LineIdx, 0); OLED_PutLine(LineIdx+1, 0); OLED_PutLine(LineIdx+2, 0); OLED_PutLine(LineIdx+3, 0); }
  if(GPS && GPS->isDateValid())
  { Format_UnsDec (Line   , (uint16_t)GPS->Day,   2, 0); Line[2]='.';
    Format_UnsDec (Line+ 3, (uint16_t)GPS->Month, 2, 0); Line[5]='.';
    Format_UnsDec (Line+ 6, (uint16_t)GPS->Year , 2, 0); Line[8]=' '; Line[9]=' '; }
  else Format_String(Line, "          ");
  if(GPS && GPS->isTimeValid())
  { Format_UnsDec (Line+10, (uint16_t)GPS->Hour,  2, 0);
    Format_UnsDec (Line+12, (uint16_t)GPS->Min,   2, 0);
    Format_UnsDec (Line+14, (uint16_t)GPS->Sec,   2, 0);
  } else Line[10]=0;
  OLED_PutLine(LineIdx+4, Line);
  Line[0]=0;
  if(GPS && GPS->hasBaro)
  { Format_String(Line   , "0000.0hPa 00000m");
    Format_UnsDec(Line   , GPS->Pressure/40, 5, 1);
    Format_UnsDec(Line+10, GPS->StdAltitude/10, 5, 0); }
  OLED_PutLine(LineIdx+5, Line);
  return 0; }
#endif

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

#ifdef WITH_U8G2_OLED

void OLED_DrawLogo(u8g2_t *OLED, GPS_Position *GPS)  // draw logo and hardware options in software
{
  u8g2_DrawCircle(OLED, 96, 32, 30, U8G2_DRAW_ALL);
  u8g2_DrawCircle(OLED, 96, 32, 34, U8G2_DRAW_UPPER_RIGHT);
  u8g2_DrawCircle(OLED, 96, 32, 38, U8G2_DRAW_UPPER_RIGHT);
  // u8g2_SetFont(OLED, u8g2_font_open_iconic_all_4x_t);
  // u8g2_DrawGlyph(OLED, 64, 32, 0xF0);
  u8g2_SetFont(OLED, u8g2_font_ncenB14_tr);
  u8g2_DrawStr(OLED, 74, 31, "OGN");
  u8g2_SetFont(OLED, u8g2_font_8x13_tr);
  u8g2_DrawStr(OLED, 69, 43, "Tracker");

#ifdef WITH_FollowMe
  u8g2_DrawStr(OLED, 0, 16 ,"FollowMe");
#endif
#ifdef WITH_TTGO
  u8g2_DrawStr(OLED, 0, 16 ,"TTGO");
#endif
#if defined(WITH_HELTEC) || defined(WITH_HELTEC_V2)
  u8g2_DrawStr(OLED, 0, 16 ,"HELTEC");
#endif
#if defined(WITH_TBEAM) || defined(WITH_TBEAM_V10)
  u8g2_DrawStr(OLED, 0, 16 ,"T-BEAM");
#endif

#ifdef WITH_GPS_MTK
  u8g2_DrawStr(OLED, 0, 28 ,"MTK GPS");
#endif
#ifdef WITH_GPS_UBX
  u8g2_DrawStr(OLED, 0, 28 ,"UBX GPS");
#endif
#ifdef WITH_GPS_SRF
  u8g2_DrawStr(OLED, 0, 28 ,"SRF GPS");
#endif

#ifdef WITH_RFM95
  u8g2_DrawStr(OLED, 0, 40 ,"RFM95");
#endif
#ifdef WITH_RFM69
  u8g2_DrawStr(OLED, 0, 40 ,"RFM69");
#endif

#ifdef WITH_BMP180
  u8g2_DrawStr(OLED, 0, 52 ,"BMP180");
#endif
#ifdef WITH_BMP280
  u8g2_DrawStr(OLED, 0, 52 ,"BMP280");
#endif
#ifdef WITH_BME280
  u8g2_DrawStr(OLED, 0, 52 ,"BME280");
#endif
#ifdef WITH_MS5607
  u8g2_DrawStr(OLED, 0, 52 ,"MS5607");
#endif
#ifdef WITH_MS5611
  u8g2_DrawStr(OLED, 0, 52 ,"MS5611");
#endif

#ifdef WITH_BT_SPP
  u8g2_DrawStr(OLED, 0, 64 ,"BT SPP");
#endif
}

void OLED_PutLine(u8g2_t *OLED, uint8_t LineIdx, const char *Line)
{ if(Line==0) return;
#ifdef DEBUG_PRINT
  xSemaphoreTake(CONS_Mutex, portMAX_DELAY);
  Format_String(CONS_UART_Write, "OLED_PutLine( ,");
  Format_UnsDec(CONS_UART_Write, (uint16_t)LineIdx);
  CONS_UART_Write(',');
  Format_String(CONS_UART_Write, Line);
  Format_String(CONS_UART_Write, ")\n");
  xSemaphoreGive(CONS_Mutex);
#endif
  // u8g2_SetFont(OLED, u8g2_font_5x8_tr);
  u8g2_SetFont(OLED, u8g2_font_amstrad_cpc_extended_8r);
  u8g2_DrawStr(OLED, 0, (LineIdx+1)*8, Line);
}

void OLED_DrawStatus(u8g2_t *OLED, uint32_t Time, uint8_t LineIdx=0)
{ Format_String(Line   , "OGN Tx/Rx      ");
  Format_HHMMSS(Line+10, Time); Line[16]=0;
  OLED_PutLine(OLED, LineIdx++, Line);
  Parameters.Print(Line); Line[16]=0;
  OLED_PutLine(OLED, LineIdx++, Line); }

void OLED_DrawPosition(u8g2_t *OLED, GPS_Position *GPS=0, uint8_t LineIdx=2)
{ if(GPS && GPS->isValid())
  { Line[0]=' ';
    Format_SignDec(Line+1,  GPS->Latitude /60, 6, 4); Line[9]=' ';
    Format_UnsDec (Line+10, GPS->Altitude /10, 5, 0); Line[15]='m';
    OLED_PutLine(OLED, LineIdx  , Line);
    Format_SignDec(Line,    GPS->Longitude/60, 7, 4);
    Format_SignDec(Line+10, GPS->ClimbRate,    4, 1);
    OLED_PutLine(OLED, LineIdx+1, Line);
    Format_UnsDec (Line   , GPS->Speed, 4, 1); Format_String(Line+5, "m/s  ");
    Format_UnsDec (Line+10, GPS->Heading, 4, 1); Line[15]='^';
    OLED_PutLine(OLED, LineIdx+2, Line);
    Format_String(Line, "0D/00sat DOP00.0");
    Line[0]+=GPS->FixMode; Format_UnsDec(Line+3, GPS->Satellites, 2);
    Format_UnsDec(Line+12, (uint16_t)GPS->HDOP, 3, 1);
    OLED_PutLine(OLED, LineIdx+3, Line);
  }
  // else { OLED_PutLine(OLED, LineIdx, 0); OLED_PutLine(OLED, LineIdx+1, 0); OLED_PutLine(LineIdx+2, 0); OLED_PutLine(LineIdx+3, 0); }
  if(GPS && GPS->isDateValid())
  { Format_UnsDec (Line   , (uint16_t)GPS->Day,   2, 0); Line[2]='.';
    Format_UnsDec (Line+ 3, (uint16_t)GPS->Month, 2, 0); Line[5]='.';
    Format_UnsDec (Line+ 6, (uint16_t)GPS->Year , 2, 0); Line[8]=' '; Line[9]=' '; }
  else Format_String(Line, "          ");
  if(GPS && GPS->isTimeValid())
  { Format_UnsDec (Line+10, (uint16_t)GPS->Hour,  2, 0);
    Format_UnsDec (Line+12, (uint16_t)GPS->Min,   2, 0);
    Format_UnsDec (Line+14, (uint16_t)GPS->Sec,   2, 0);
  } else Line[10]=0;
  OLED_PutLine(OLED, LineIdx+4, Line);
  Line[0]=0;
  if(GPS && GPS->hasBaro)
  { Format_String(Line   , "0000.0hPa 00000m");
    Format_UnsDec(Line   , GPS->Pressure/40, 5, 1);
    Format_UnsDec(Line+10, GPS->StdAltitude/10, 5, 0); }
  OLED_PutLine(OLED, LineIdx+5, Line);
}

void OLED_DrawGPS(u8g2_t *OLED, GPS_Position *GPS)  // GPS time, position, altitude
{ bool isAltitudeUnitMeter = Parameters.AltitudeUnit == 0;  // display altitude in meters
  bool isAltitudeUnitFeet  = Parameters.AltitudeUnit == 1;  // display altitude in feet
  // u8g2_SetFont(OLED, u8g2_font_ncenB14_tr);
  u8g2_SetFont(OLED, u8g2_font_7x13_tf);              // 5 lines, 12 pixels/line
  uint8_t Len=0;
/*
  Len+=Format_String(Line+Len, "GPS ");
  if(GPS && GPS->isValid())
  { Line[Len++]='0'+GPS->FixMode; Line[Len++]='D'; Line[Len++]='/';
    Len+=Format_UnsDec(Line+Len, GPS->Satellites, 1);
    Len+=Format_String(Line+Len, "sat DOP");
    Len+=Format_UnsDec(Line+Len, (uint16_t)GPS->HDOP, 2, 1); }
  else
  { Len+=Format_String(Line+Len, "(no lock)"); }
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 12, Line);
*/
  if(GPS && GPS->isDateValid())
  { Format_UnsDec (Line   , (uint16_t)GPS->Day,   2, 0); Line[2]='.';
    Format_UnsDec (Line+ 3, (uint16_t)GPS->Month, 2, 0); Line[5]='.';
    Format_UnsDec (Line+ 6, (uint16_t)GPS->Year , 2, 0); Line[8]=' ';
  } else Format_String(Line, "  .  .   ");
  if(GPS && GPS->isTimeValid())
  { Format_UnsDec (Line+ 9, (uint16_t)GPS->Hour,  2, 0); Line[11]=':';
    Format_UnsDec (Line+12, (uint16_t)GPS->Min,   2, 0); Line[14]=':';
    Format_UnsDec (Line+15, (uint16_t)GPS->Sec,   2, 0);
  } else Format_String(Line+9, "  :  :  ");
  Line[17]=0;
  u8g2_DrawStr(OLED, 0, 24, Line);

  Len=0;
  Len+=Format_String(Line+Len, "Lat:  ");
  if(GPS && GPS->isValid())
  { Len+=Format_SignDec(Line+Len,  GPS->Latitude /6, 7, 5);
    Line[Len++]=0xB0; }
  else Len+=Format_String(Line+Len, "---.-----");
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 36, Line);
  Len=0;
  Len+=Format_String(Line+Len, "Lon: ");
  if(GPS && GPS->isValid())
  { Len+=Format_SignDec(Line+Len,  GPS->Longitude /6, 8, 5);
    Line[Len++]=0xB0; }
  else Len+=Format_String(Line+Len, "----.-----");
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 48, Line);
  Len=0;
  Len+=Format_String(Line+Len, "Alt: ");
  if(GPS && GPS->isValid())
  { int32_t Alt = GPS->Altitude;
    if(Alt>=0) Line[Len++]=' ';
    if(isAltitudeUnitMeter)                                       // display altitude in meters
    { Len+=Format_SignDec(Line+Len,  Alt, 1, 1, 1);               // [0.1m]
      Line[Len++]='m'; }
    else if(isAltitudeUnitFeet)                                   // display altitude in feet
    { Alt = (Alt*336+512)>>10;                                    // [0.1m] => [feet]
      Len+=Format_SignDec(Line+Len,  Alt, 1, 0, 1);               // [feet]
      Line[Len++]='f'; Line[Len++]='t'; }
    // for( ; Len<14; ) Line[Len++]=' ';                          // tail of spaces to cover older printouts
  }
  else Len+=Format_String(Line+Len, "-----.-  ");
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 60, Line);
}

void OLED_DrawRF(u8g2_t *OLED, GPS_Position *GPS) // RF
{ u8g2_SetFont(OLED, u8g2_font_7x13_tf);            // 5 lines. 12 pixels/line
  uint8_t Len=0;
#ifdef WITH_RFM69
  Len+=Format_String(Line+Len, "RFM69");            // Type of RF chip used
  if(Parameters.RFchipTypeHW) Line[Len++]='H';
  Line[Len++]='W';
#endif
#ifdef WITH_RFM95
  Len+=Format_String(Line+Len, "RFM95");
#endif
#ifdef WITH_SX1262
  Len+=Format_String(Line+Len, "SX1262");
#endif
#ifdef WITH_SX1272
  Len+=Format_String(Line+Len, "SX1272");
#endif
  Line[Len++]=':';
  Len+=Format_SignDec(Line+Len, (int16_t)Parameters.TxPower);              // Tx power
  Len+=Format_String(Line+Len, "dBm");
  Line[Len++]=' ';
  Len+=Format_SignDec(Line+Len, (int32_t)Parameters.RFchipFreqCorr, 2, 1); // frequency correction
  Len+=Format_String(Line+Len, "ppm");
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 24, Line);
  Len=0;
  Len+=Format_String(Line+Len, "Rx:");                                     //
  Len+=Format_SignDec(Line+Len, -5*TRX.averRSSI, 2, 1);                    // noise level seen by the receiver
  Len+=Format_String(Line+Len, "dBm ");
  Len+=Format_UnsDec(Line+Len, RX_OGN_Count64);                            // received packet/min
  Len+=Format_String(Line+Len, "/min");
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 36, Line);
  Len=0;
  Len+=Format_SignDec(Line+Len, (int16_t)TRX.chipTemp);                    // RF chip internal temperature (not calibrated)
  // Line[Len++]=0xB0;
  // Line[Len++]='C';
  Len+=Format_String(Line+Len, "\260C    RxFIFO:");
  Len+=Format_UnsDec(Line+Len, RF_RxFIFO.Full());                          // how many packets wait in the RX queue
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 48, Line);
  // u8g2_DrawStr(OLED, 0, 48, RF_FreqPlan.getPlanName());
  Len=0;
  Len+=Format_String(Line+Len, RF_FreqPlan.getPlanName());                 // name of the frequency plan
  Line[Len++]=' ';
  Len+=Format_UnsDec(Line+Len, (uint16_t)(RF_FreqPlan.getCenterFreq()/100000), 3, 1); // center frequency
  Len+=Format_String(Line+Len, "MHz");
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 60, Line);
}

void OLED_DrawRelay(u8g2_t *OLED, GPS_Position *GPS)
{ 
  const char *AcftTypeName[16] = { "----", "Glid", "Tow ", "Heli",
                                   "SkyD", "Drop", "Hang", "Para",
                                   "Pwrd", "Jet ", "UFO ", "Ball",
                                   "Zepp", "UAV ", "Car ", "Fix " } ;

  // u8g2_SetFont(OLED, u8g2_font_amstrad_cpc_extended_8r);
  // uint8_t Len=Format_String(Line, "Relay:");
  // if(GPS && GPS->Sec>=0) { Len+=Format_UnsDec(Line+Len, (uint16_t)(GPS->Sec), 2); Line[Len++]='s'; }
  // Line[Len]=0;
  // u8g2_DrawStr(OLED, 0, 24, Line);
  uint8_t LineIdx=1;
  for( uint8_t Idx=0; Idx<RelayQueueSize; Idx++)
  { OGN_RxPacket<OGN_Packet> *Packet = RelayQueue.Packet+Idx; if(Packet->Alloc==0) continue;
    if(Packet->Packet.Header.NonPos) continue;
    uint32_t Dist= IntDistance(Packet->LatDist, Packet->LonDist);      // [m]
    uint32_t Dir = IntAtan2(Packet->LonDist, Packet->LatDist);         // [16-bit cyclic]
    Dir &= 0xFFFF; Dir = (Dir*360)>>16;                                // [deg]
    uint8_t Len=0;
    Len+=Format_String(Line+Len, AcftTypeName[Packet->Packet.Position.AcftType]);
    Line[Len++]=' ';
    Len+=Format_UnsDec(Line+Len, Packet->Packet.DecodeAltitude(), 4); // [m] altitude
    Line[Len++]='m'; Line[Len++]=' ';
    Len+=Format_UnsDec(Line+Len, Dir, 3);                             // [deg] direction to target
    Line[Len++]=' ';
    Len+=Format_UnsDec(Line+Len, (Dist+50)/100, 3, 1);                // [km] distance to target
    Len+=Format_String(Line+Len, "km");
/*
    Line[Len++]='0'+Packet->Packet.Header.AddrType;
    Line[Len++]=':';
    Len+=Format_Hex(Line+Len, Packet->Packet.Header.Address, 6);
    Line[Len++]=' ';
    Len+=Format_Hex(Line+Len, Packet->Rank);
    Line[Len++]=' ';
    Line[Len++]=':';
    Len+=Format_UnsDec(Line+Len, Packet->Packet.Position.Time, 2);
*/
    Line[Len]=0;
    u8g2_DrawStr(OLED, 0, (LineIdx+3)*8, Line);
    LineIdx++; if(LineIdx>=8) break;
  }
}

#ifdef WITH_LOOKOUT
void OLED_DrawLookout(u8g2_t *OLED, GPS_Position *GPS)
{ u8g2_SetFont(OLED, u8g2_font_amstrad_cpc_extended_8r);
  uint8_t Len=Format_String(Line, "=> ");
  if(Look.WarnLevel)
  { const LookOut_Target *Tgt = Look.Target+Look.WorstTgtIdx;
    Len+=Format_Hex(Line+Len, Tgt->ID, 7);
    Line[Len++]='/';
    Line[Len++]='0'+Tgt->WarnLevel;
    Line[Len++]=' ';
    Len+=Format_UnsDec(Line+Len, Tgt->TimeMargin>>1);
    Line[Len++]='s';
  }
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 24, Line);
  uint8_t LineIdx=1;
  for( uint8_t Idx=0; Idx<Look.MaxTargets; Idx++)
  { const LookOut_Target *Tgt = Look.Target+Idx; if(!Tgt->Alloc) continue;
    uint8_t Len=0;
    Len+=Format_Hex(Line+Len, Tgt->ID, 7);
    Line[Len++]=' ';
    if(Tgt->DistMargin)
    { Len+=Format_UnsDec(Line+Len, Tgt->HorDist>>1);
      Line[Len++]='m'; }
    else
    { Len+=Format_UnsDec(Line+Len, Tgt->TimeMargin>>1);
      Line[Len++]='s';
      Line[Len++]=' ';
      Len+=Format_UnsDec(Line+Len, Tgt->MissDist>>1);
      Line[Len++]='m'; }
    Line[Len]=0;
    u8g2_DrawStr(OLED, 0, (LineIdx+3)*8, Line);
    LineIdx++; if(LineIdx>=8) break;
  }
}

void OLED_DrawTrafWarn(u8g2_t *OLED, GPS_Position *GPS)
{ u8g2_SetFont(OLED, u8g2_font_9x15_tr);
  if(Look.WarnLevel==0) return;
  const LookOut_Target *Tgt = Look.Target+Look.WorstTgtIdx;
  uint8_t Len=0;
  Len+=Format_Hex(Line+Len, Tgt->ID, 7);                      // ID of the target
  Line[Len++]='/';
  Line[Len++]='0'+Tgt->WarnLevel;                             // warning level
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 30, Line);
  Len=0;
  Len+=Format_UnsDec(Line+Len, Tgt->TimeMargin*5, 2, 1);      // time-to-impact
  Line[Len++]='s';
  Line[Len++]=' ';
  Len+=Format_UnsDec(Line+Len, Tgt->MissDist*5, 2, 1);        // miss-distance
  Line[Len++]='m';
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 45, Line);
  Len=0;
  Len+=Format_UnsDec(Line+Len, Tgt->getRelHorSpeed()*5, 2, 1); // horizontal speed
  Line[Len++]='m';
  Line[Len++]='/';
  Line[Len++]='s';
  Line[Len++]=' ';
  Len+=Format_UnsDec(Line+Len, Tgt->HorDist*5, 2, 1);          // horizontal distance
  Line[Len++]='m';
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 60, Line);
}
#endif // WITH_LOOKOUT

void OLED_DrawBaro(u8g2_t *OLED, GPS_Position *GPS)
{ bool isAltitudeUnitMeter = Parameters.AltitudeUnit == 0;  // display altitude in meters
  bool isAltitudeUnitFeet  = Parameters.AltitudeUnit == 1;  // display altitude in feet

  bool isVarioUnitMPS = Parameters.VarioUnit == 0;  // display Vario in m/s
  bool isVarioUnitFPM = Parameters.VarioUnit == 1;  // display Vario in fpm

  u8g2_SetFont(OLED, u8g2_font_7x13_tf);              // 5 lines, 12 pixels/line
  uint8_t Len=0;
#ifdef WITH_BMP180
  Len+=Format_String(Line+Len, "BMP180 ");
#endif
#ifdef WITH_BMP280
  Len+=Format_String(Line+Len, "BMP280 ");
#endif
#ifdef WITH_BME280
  Len+=Format_String(Line+Len, "BME280 ");
#endif
#ifdef WITH_MS5607
  Len+=Format_String(Line+Len, "MS5607 ");
#endif
#ifdef WITH_MS5611
  Len+=Format_String(Line+Len, "MS5611 ");
#endif
  if(GPS && GPS->hasBaro)
  { Len+=Format_UnsDec(Line+Len, GPS->Pressure/4, 5, 2);
    Len+=Format_String(Line+Len, "hPa "); }
  else Len+=Format_String(Line+Len, "----.--hPa ");
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 24, Line);
  Len=0;
  if(GPS && GPS->hasBaro)
  { if(isAltitudeUnitMeter)
    { Len+=Format_SignDec(Line+Len, GPS->StdAltitude, 5, 1);
      Len+=Format_String(Line+Len, "m "); }
    else if(isAltitudeUnitFeet)
    { Len+=Format_SignDec(Line+Len, (GPS->StdAltitude*336+512)>>10, 5, 0);
      Len+=Format_String(Line+Len, "ft "); }
    if(isVarioUnitMPS)
    { Len+=Format_SignDec(Line+Len, GPS->ClimbRate, 2, 1);
      Len+=Format_String(Line+Len, "m/s "); }
    else if(isVarioUnitFPM)
    { Len+=Format_SignDec(Line+Len, (GPS->ClimbRate*5039+128)>>8, 2, 0);
      Len+=Format_String(Line+Len, "fpm "); } }
  else
  { if(isAltitudeUnitMeter) Len+=Format_String(Line+Len, "-----.-m");
    else if(isAltitudeUnitFeet) Len+=Format_String(Line+Len, "-----ft  ");
    Len+=Format_String(Line+Len, " --.-m/s "); }
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 36, Line);
  Len=0;
  if(GPS && GPS->hasBaro)
  { Len+=Format_SignDec(Line+Len, GPS->Temperature, 2, 1);
    Line[Len++]=0xB0;
    Line[Len++]='C';
    Line[Len++]=' ';
    Len+=Format_SignDec(Line+Len, GPS->Humidity, 2, 1);
    Line[Len++]='%'; }
  else Len+=Format_String(Line+Len, "---.- C --.-% ");
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 48, Line);
}

static int8_t BattCapacity(uint16_t mVolt) // deduce battery capacity from its voltage
{ if(mVolt>=4100) return 100;              // if 4.1V or more then full
  if(mVolt<=1000) return  -1;              // if below 1.0V then no-battery
  if(mVolt<=3600) return   0;              // if below 3.6V then empty
  return (mVolt-3600+2)/5; }               // otherwise a linear function from 3.6V to 4.1V

void OLED_DrawBattery(u8g2_t *OLED, GPS_Position *GPS) // draw battery status page
{
#ifdef WITH_MAVLINK
   int8_t Cap=MAVLINK_BattCap;                         // [%] from the drone's telemetry
#else
   int8_t Cap=BattCapacity(BatteryVoltage>>8);         // [%] est. battery capacity based on the voltage readout
#endif
  // u8g2_SetFont(OLED, u8g2_font_battery19_tn);
  // u8g2_DrawGlyph(OLED, 120, 60, '0'+(Cap+10)/20);

  // u8g2_SetFont(OLED, u8g2_font_6x10_tr);
  // u8g2_DrawStr(OLED, 0, 24, Line);

  // u8g2_DrawStr(OLED, 0, 24, "Battery");

  u8g2_SetFont(OLED, u8g2_font_9x15_tr);

  if(Cap>=0)
  { strcpy(Line, "   %");
    if(Cap>=100) Format_UnsDec(Line, (uint8_t)Cap, 3);
    else if(Cap>=10) Format_UnsDec(Line+1, (uint8_t)Cap, 2);
    else Line[2]='0'+Cap;
    u8g2_DrawStr  (OLED, 16, 32, Line);                  // print battery est. capacity
    u8g2_DrawFrame(OLED, 12, 20, 42, 14);                // draw battery empty box around it
    u8g2_DrawBox  (OLED,  8, 23,  4,  8); }              // and the battery tip

  strcpy(Line, " .   V");
#ifdef WITH_MAVLINK
  Format_UnsDec(Line, MAVLINK_BattVolt, 4, 3);
#else
  Format_UnsDec(Line, BatteryVoltage>>8, 4, 3);        // print the battery voltage readout
#endif
  u8g2_DrawStr(OLED, 0, 48, Line);

#ifdef WITH_MAVLINK
  strcpy(Line, "  .  A");
  Format_UnsDec(Line, MAVLINK_BattCurr, 4, 2);
#else
  strcpy(Line, "   . mV/min ");                        // print the battery voltage rate
  Format_SignDec(Line, (600*BatteryVoltageRate+128)>>8, 3, 1);
#endif
  u8g2_DrawStr(OLED, 0, 60, Line);

#ifdef WITH_BQ
  uint8_t Fault  = BQ.readFault();                     // read fault register
  uint8_t ChargeErr = (Fault>>4)&0x3F;                 // charging fault:
  bool    BattErr = Fault&0x08;                        // Battery OVP
  bool    OTGerr = Fault&0x40;                         // VBus problem
  uint8_t NTCerr = Fault&0x03;                         //
  uint8_t Status = BQ.readStatus();                    // read status register
  uint8_t State = (Status>>4)&0x03;                    // charging status
  const char *StateName[4] = { "" /* "Not charging" */ , "Pre-charge", "Charging", "Full" } ;
  // u8g2_SetFont(OLED, u8g2_font_amstrad_cpc_extended_8r);
  u8g2_SetFont(OLED, u8g2_font_6x10_tr);
  if(Fault)
  { strcpy(Line, "Fault: "); Format_Hex(Line+7, Fault); Line[9]=0;
    u8g2_DrawStr(OLED, 60, 28, Line); }
  else
    u8g2_DrawStr(OLED, 60, 28, StateName[State]);
  // u8g2_DrawStr(OLED, 0, 60, Status&0x04?"Power-is-Good":"Power-is-not-Good");

/* print BQ registers for debug
  u8g2_SetFont(OLED, u8g2_font_6x10_tr);
  for(uint8_t Reg=0; Reg<=10; Reg++)
  { uint8_t Val = BQ.readReg(Reg);
    Format_Hex(Line+3*Reg, Val); Line[3*Reg+2]=' '; }
  Line[33]=0;
  u8g2_DrawStr(OLED, 0, 60, Line+15);
  Line[15]=0; u8g2_DrawStr(OLED, 0, 50, Line);
*/
#endif

#ifdef WITH_AXP
  uint16_t InpCurr=AXP.readBatteryInpCurrent(); // [mA]
  uint16_t OutCurr=AXP.readBatteryOutCurrent(); // [mA]
   int16_t Current = InpCurr-OutCurr;
  // uint8_t Charging = Current>0;
  u8g2_SetFont(OLED, u8g2_font_6x10_tr);
  strcpy(Line, "    mA ");
  Format_SignDec(Line, Current, 3);
  u8g2_DrawStr(OLED, 60, 28, Line);
#endif
}

void OLED_DrawStatusBar(u8g2_t *OLED, GPS_Position *GPS)   // status bar on top of the OLED
{ static bool Odd=0;
#ifdef WITH_MAVLINK
   int8_t Cap = MAVLINK_BattCap;                           // [%]
#else
   int8_t Cap = BattCapacity(BatteryVoltage>>8);           // [%] est. battery capacity
#endif
  uint8_t BattLev = (Cap+10)/20;                           // [0..5] convert to display scale
  uint8_t Charging = 0;                                    // charging or not changing ?
#ifdef WITH_BQ
  uint8_t Status = BQ.readStatus();
  Charging = (Status>>4)&0x03;
#endif
#ifdef WITH_AXP
  uint16_t InpCurr=AXP.readBatteryInpCurrent(); // [mA]
  uint16_t OutCurr=AXP.readBatteryOutCurrent(); // [mA]
   int16_t Current = InpCurr-OutCurr;
  Charging = Current>0;
#endif
#if defined(WITH_BQ) || defined(WITH_AXP)
  static uint8_t DispLev = 0;
  if(Charging==1 || Charging==2) { DispLev++; if(DispLev>5) DispLev = BattLev?BattLev-1:0; }
                           else  { DispLev = BattLev; }
#else
  uint8_t &DispLev = BattLev;
#endif
  if(Cap>=0)
  { if(BattLev==0 && !Charging && Odd)                // when battery is empty, then flash it at 0.5Hz
    { }                                               // thus here avoid printing the battery symbol for flashing effect
    else                                              // print the battery symbol with DispLev
    { u8g2_SetFont(OLED, u8g2_font_battery19_tn);
      u8g2_SetFontDirection(OLED, 3);
      u8g2_DrawGlyph(OLED, 20, 10, '0'+DispLev);
      u8g2_SetFontDirection(OLED, 0); }
    Odd=!Odd; }
#ifdef WITH_SD
  if(SD_isMounted())
  { u8g2_SetFont(OLED, u8g2_font_twelvedings_t_all);
    u8g2_DrawGlyph(OLED, 24, 12, 0x73); }
#endif
#ifdef WITH_BT_SPP
  if(BT_SPP_isConnected())
  { u8g2_SetFont(OLED, u8g2_font_open_iconic_all_1x_t);
    u8g2_DrawGlyph(OLED, 36, 11, 0x5E); } // 0x4A
#endif
// #ifdef WITH_STRATUX
//   if(Stratux_isConnected())
//   { u8g2_SetFont(OLED, u8g2_font_open_iconic_all_1x_t);
//     u8g2_DrawGlyph(OLED, 43, 11, 0x50); }
// #endif
#ifdef WITH_WIFI
  if(WIFI_isConnected())
  { u8g2_SetFont(OLED, u8g2_font_open_iconic_all_1x_t);
    u8g2_DrawGlyph(OLED, 43, 11, 0x119); } // 0x50
#endif
#ifdef WITH_AP
  if(WIFI_isAP())
  { u8g2_SetFont(OLED, u8g2_font_open_iconic_all_1x_t);
    u8g2_DrawGlyph(OLED, 43, 11, 0xF8); } // 0x50
#endif
  // u8g2_SetFont(OLED, u8g2_font_5x7_tr);
  // u8g2_SetFont(OLED, u8g2_font_5x8_tr);
  static uint8_t Sec=0;
  u8g2_SetFont(OLED, u8g2_font_6x12_tr);
  // strcpy(Line, "[   %] --sat --:--");
  strcpy(Line, "--sat --:--Z");
  if(GPS && GPS->isTimeValid())
  { Format_UnsDec (Line+6, (uint16_t)GPS->Hour,  2, 0); Line[8]=':';
    Format_UnsDec (Line+9, (uint16_t)GPS->Min,   2, 0);
  } else Format_String(Line+6, "--:--");
  if(GPS)
  { if(Sec)
    { Format_UnsDec(Line, (uint16_t)GPS->Satellites,  2); memcpy(Line+2, "sat", 3); }
    else
    { Format_UnsDec(Line, (uint16_t)(GPS_SatSNR+2)/4,  2); memcpy(Line+2, "dB ", 3);}
  }
  else Format_String(Line, "--sat");
  u8g2_DrawStr(OLED, 52, 10, Line);
  Sec++; if(Sec>=3) Sec=0; }

#ifdef WITH_AP
void OLED_DrawNetwork(u8g2_t *OLED, GPS_Position *GPS)
{ // u8g2_SetFont(OLED, u8g2_font_6x12_tr);
  u8g2_SetFont(OLED, u8g2_font_7x13_tf);              // 5 lines, 12 pixels/line
  uint8_t Len=Format_String(Line, "AP: ");
  Len+=Format_String(Line+Len, (const char *)WIFI_Config.ap.ssid, 0, WIFI_Config.ap.ssid_len);
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 24, Line);
  Len=Format_String(Line, "IP: ");
  Len+=IP_Print(Line+Len, WIFI_IP.ip.addr);
  // Len+=Format_String(Line+Len, "  CH");
  // Len+=Format_UnsDec(Line+Len, WIFI_Config.ap.channel);
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 36, Line);
/*
  Len=Format_String(Line, "GW: ");
  Len+=IP_Print(Line+Len, WIFI_IP.gw.addr);
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 48, Line);
*/
}
#endif

void OLED_DrawSystem(u8g2_t *OLED, GPS_Position *GPS)
{ // u8g2_SetFont(OLED, u8g2_font_6x12_tr);
  u8g2_SetFont(OLED, u8g2_font_7x13_tf);              // 5 lines, 12 pixels/line
  uint8_t Len=0;
#ifdef WITH_MAVLINK
  Len+=Format_String(Line+Len, "MAVLINK ");
#else
  Len+=Format_String(Line+Len, "GPS ");
#ifdef WITH_GPS_UBX
  Len+=Format_String(Line+Len, "UBX ");
#endif
#ifdef WITH_GPS_MTK
  Len+=Format_String(Line+Len, "MTK ");
#endif
#ifdef WITH_GPS_SRF
  Len+=Format_String(Line+Len, "SRF ");
#endif
#endif // WITH_MAVLINK
  Len+=Format_UnsDec(Line+Len, GPS_getBaudRate(), 1);
  Len+=Format_String(Line+Len, "bps");
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 24, Line);

  Len=0;
#ifdef WITH_RFM69
  Len+=Format_String(Line+Len, "RFM69 v");            // Type of RF chip used
  if(Parameters.RFchipTypeHW) Line[Len++]='H';
  Line[Len++]='W';
#endif
#ifdef WITH_RFM95
  Len+=Format_String(Line+Len, "RFM95 v");
#endif
#ifdef WITH_SX1262
  Len+=Format_String(Line+Len, "SX1262 v");
#endif
#ifdef WITH_SX1272
  Len+=Format_String(Line+Len, "SX1272 v");
#endif
  Len+=Format_Hex(Line+Len, TRX.chipVer);
  Line[Len++]=' ';
  Len+=Format_SignDec(Line+Len, (int16_t)TRX.chipTemp);
  Line[Len++]=0xB0;
  Line[Len++]='C';
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 36, Line);

  Len=0;
#ifdef WITH_BMP180
  Len+=Format_String(Line+Len, "BMP180 0x");
  Len+=Format_Hex(Line+Len, Baro.ADDR);
#endif
#ifdef WITH_BMP280
  Len+=Format_String(Line+Len, "BMP280 0x");
  Len+=Format_Hex(Line+Len, Baro.ADDR);
#endif
#ifdef WITH_BME280
  Len+=Format_String(Line+Len, "BME280 0x");
  Len+=Format_Hex(Line+Len, Baro.ADDR);
#endif
#ifdef WITH_MS5607
  Len+=Format_String(Line+Len, "MS5607 0x");
  Len+=Format_Hex(Line+Len, Baro.ADDR);
#endif
#ifdef WITH_MS5611
  Len+=Format_String(Line+Len, "MS5611 0x");
  Len+=Format_Hex(Line+Len, Baro.ADDR);
#endif
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 48, Line);

#ifdef WITH_SPIFFS
  Len=0;
  Len+=Format_String(Line+Len, "SPIFFS ");
  size_t Total, Used;
  if(SPIFFS_Info(Total, Used)==0)                            // get the SPIFFS usage summary
  { Len+=Format_UnsDec(Line+Len, (Total-Used)/1024);
    Len+=Format_String(Line+Len, "/");
    Len+=Format_UnsDec(Line+Len, Total/1024);
    Len+=Format_String(Line+Len, "kB"); }
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 60, Line);
#endif
/*
#ifdef WITH_SD
  Len=0;
  Len+=Format_String(Line+Len, "SD ");
  if(SD_isMounted())
  { Len+=Format_UnsDec(Line+Len, (uint32_t)SD_getSectors());
    Line[Len++]='x';
    Len+=Format_UnsDec(Line+Len, (uint32_t)SD_getSectorSize()*5/512, 2, 1);
    Len+=Format_String(Line+Len, "KB"); }
  else
  { Len+=Format_String(Line+Len, "none"); }
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 60, Line);
#endif
*/
}

void OLED_DrawID(u8g2_t *OLED, GPS_Position *GPS)
{ u8g2_SetFont(OLED, u8g2_font_9x15_tr);
  Parameters.Print(Line); Line[10]=0;
  u8g2_DrawStr(OLED, 26, 25, Line);
  // u8g2_SetFont(OLED, u8g2_font_10x20_tr);
  u8g2_SetFont(OLED, u8g2_font_7x13_tf);
  u8g2_DrawStr(OLED, 0, 24, "ID:");
  if(Parameters.Pilot[0] || Parameters.Reg[0])
  { strcpy(Line, "Pilot: "); strcat(Line, Parameters.Pilot);
    u8g2_DrawStr(OLED, 0, 37, Line);
    strcpy(Line, "Reg: "); strcat(Line, Parameters.Reg);
    u8g2_DrawStr(OLED, 0, 49, Line); }
  else
  {
#ifdef WITH_FollowMe
  u8g2_DrawStr(OLED, 15, 37, "FollowMe868");
  u8g2_DrawStr(OLED, 20, 49, "by AVIONIX");
#endif
  }
  // u8g2_SetFont(OLED, u8g2_font_5x8_tr);
  u8g2_SetFont(OLED, u8g2_font_6x12_tr);
  // u8g2_DrawStr(OLED, 96, 62, "v" STR(VERSION));
  uint64_t ID=getUniqueID();
  uint8_t Len=Format_String(Line, "#");
  Len+=Format_Hex(Line+Len, (uint16_t)(ID>>32));
  Len+=Format_Hex(Line+Len, (uint32_t)ID);
  // Line[Len++]=' ';
  // Line[Len++]='v';
  Len+=Format_String(Line+Len, " v"STR(VERSION));
  Line[Len]=0;
  u8g2_DrawStr(OLED, 0, 62, Line); }

void OLED_DrawAltitudeAndSpeed(u8g2_t *OLED, GPS_Position *GPS)
{ uint8_t Len;

  bool isAltitudeUnitMeter = Parameters.AltitudeUnit == 0;  // display altitude in meters
  bool isAltitudeUnitFeet  = Parameters.AltitudeUnit == 1;  // display altitude in feet

  bool isSpeedUnitKMH  = Parameters.SpeedUnit == 0;  // display Speed in km/h
  bool isSpeedUnitKnot = Parameters.SpeedUnit == 1;  // display Speed in knot

  bool isVarioUnitMPS = Parameters.VarioUnit == 0;  // display Vario in m/s
  bool isVarioUnitFPM = Parameters.VarioUnit == 1;  // display Vario in fpm

  // Standard Pressure Altitude
  if(GPS && (GPS->hasBaro || GPS->isValid()))    // if GPS has lock or just the pressure data
  { int32_t Alt = GPS->Altitude;                 // [0.1m/s] take GPS (geometrical) altitude
    if(GPS->hasBaro) Alt = GPS->StdAltitude;     // but if pressure sensor is there then replace with pressure altitude
    if(isAltitudeUnitMeter) Alt = (Alt+5)/10;            // [0.1m] => [m]     // or to meters
    else if(isAltitudeUnitFeet)  Alt = (Alt*336+512)>>10;     // [0.1m] => [feet]  // convert to feet
    Len=Format_SignDec(Line, Alt, 1, 0, 1); }    // print altitude into the string
  else
    Len=Format_String(Line, "----");             // if altitude not available then print place holders
  Line[Len]=0;
  u8g2_SetFont(OLED, u8g2_font_fub20_tr);        // relatively big font
  uint8_t Altitude_width = u8g2_GetStrWidth(OLED, Line); // how wide the string would be on the OLED
  u8g2_DrawStr(OLED, 60-Altitude_width, 40, Line); // print the string

  u8g2_SetFont(OLED, u8g2_font_9x15_tr);         // smaller font
  if(isAltitudeUnitMeter) u8g2_DrawStr(OLED, 64, 40, "m");
  else if(isAltitudeUnitFeet)  u8g2_DrawStr(OLED, 62, 40, "ft");   // print units

  u8g2_SetFont(OLED, u8g2_font_fub17_tr);
  if(GPS && GPS->isValid())
  { uint16_t Heading = (GPS->Heading+5)/10; if(Heading>=360) Heading-=360;
    Len=Format_UnsDec(Line, Heading, 3); }
  else
    Len=Format_String(Line, "---");
  Line[Len]=0;
  uint8_t Track_width = u8g2_GetStrWidth(OLED, Line);
  u8g2_DrawStr(OLED, 118-Track_width, 40, Line);

  u8g2_SetFont(OLED, u8g2_font_6x12_tr);         // small font
  u8g2_DrawStr(OLED, 122, 28, "o");              // degree sign

  if(GPS && (GPS->hasBaro || GPS->isValid()))    // if GPS has lock or just the pressure data
  { int16_t vario_value = GPS->ClimbRate;        // [0.1m/s] climb rate
    if(isVarioUnitFPM) vario_value = (vario_value*5039+128)>>8;  // [0.1m/s] => [feet per meter]
    if(vario_value<0)
    { vario_value=(-vario_value);
      const int minus_width=10;
      const int minus_height=17;
      static unsigned char minus_bits[] =
      { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
        0x00, 0x00, 0xfe, 0x01, 0xfe, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
        0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
      u8g2_DrawXBM(OLED, 0, 47, minus_width, minus_height, minus_bits); }
    else
    {
      const int plus_width=10;
      const int plus_height=17;
      static unsigned char plus_bits[] =
      { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x00, 0x30, 0x00,
        0x30, 0x00, 0xfe, 0x01, 0xfe, 0x01, 0x30, 0x00, 0x30, 0x00, 0x30, 0x00,
        0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
      u8g2_DrawXBM(OLED, 0, 47, plus_width, plus_height, plus_bits);
    }
    if(isVarioUnitMPS) Len=Format_UnsDec(Line, vario_value, 2, 1);
    if(isVarioUnitFPM) Len=Format_UnsDec(Line, vario_value, 2, 0);
  }
  else
    Len=Format_String(Line, "-.-");
  Line[Len]=0;
  u8g2_SetFont(OLED, u8g2_font_fub17_tr);
  uint8_t Vario_width = u8g2_GetStrWidth(OLED, Line);
  u8g2_DrawStr(OLED, 54-Vario_width, 64, Line);

  if(isVarioUnitMPS)
  { const int ms_width=7;
    const int ms_height=17;
    static unsigned char ms_bits[] =
    { 0x00, 0x00, 0x16, 0x2a, 0x2a, 0x2a, 0x2a, 0x00, 0x7f, 0x00, 0x1c, 0x22,
      0x02, 0x1c, 0x20, 0x22, 0x1c };
    u8g2_DrawXBM(OLED, 58, 47, ms_width, ms_height, ms_bits); }
  else if(isVarioUnitFPM)
  { const int ms_width=7;
    const int ms_height=17;
    static unsigned char ms_bits[] =
    { 0x84, 0xa2, 0xf7, 0xa2, 0xa2, 0xa2, 0xc2, 0x80, 0xff, 0x80, 0x00, 0x16, 0x2a, 0x2a, 0x2a, 0x2a, 0x00 };
    u8g2_DrawXBM(OLED, 58, 47, ms_width, ms_height, ms_bits); }

  // Speed
  if(GPS && GPS->isValid())
  { uint16_t speed = (GPS->Speed*9+12)/25;
    if(isSpeedUnitKnot) speed = (GPS->Speed*199+512)>>10;
    Len=Format_UnsDec(Line, speed, 1, 0); }
  else
    Len=Format_String(Line, "--");
  Line[Len]=0;
  u8g2_SetFont(OLED, u8g2_font_fub17_tr);
  uint8_t Speed_width = u8g2_GetStrWidth(OLED, Line);
  u8g2_DrawStr(OLED, 114-Speed_width, 64, Line);

  if(isSpeedUnitKMH)
  { const int kmh_width=10;
    const int kmh_height=17;
    static unsigned char kmh_bits[] =
    { 0x01, 0x00, 0x01, 0x00, 0x69, 0x01, 0xa5, 0x02, 0xa3, 0x02, 0xa5, 0x02,
      0xa9, 0x02, 0x00, 0x00, 0xff, 0x03, 0x00, 0x00, 0x08, 0x00, 0x08, 0x00,
      0x08, 0x00, 0x38, 0x00, 0x48, 0x00, 0x48, 0x00, 0x48, 0x00 };
    u8g2_DrawXBM(OLED, 118, 47, kmh_width, kmh_height, kmh_bits); }
  else if(isSpeedUnitKnot)
  { const int kmh_width=10;
    const int kmh_height=17;
    static unsigned char kmh_bits[] =
    { 0x00, 0xfc, 0x00, 0xfc, 0x00, 0xfc, 0x00, 0xfc, 0x01, 0xfc, 0x01, 0xfc, 
      0xe9, 0xfc, 0x25, 0xfd, 0x23, 0xfd, 0x25, 0xfd, 0x29, 0xfd, 0x00, 0xfc, 
      0x00, 0xfc, 0x00, 0xfc, 0x00, 0xfc, 0x00, 0xfc, 0x00, 0xfc};
    u8g2_DrawXBM(OLED, 118, 47, kmh_width, kmh_height, kmh_bits); }
}

void OLED_DrawFlight(u8g2_t *OLED, GPS_Position *GPS) // draw flight status page
{ u8g2_SetFont(OLED, u8g2_font_7x13_tf);
  u8g2_DrawStr(OLED, 0, 28, "Flight");

}

void OLED_DrawLoRaWAN(u8g2_t *OLED, GPS_Position *GPS) // draw LoRaWAN status page
{
  u8g2_SetFont(OLED, u8g2_font_7x13_tf);
#ifndef WITH_LORAWAN
  u8g2_DrawStr(OLED, 0, 28, "LoRaWAN: -OFF-");
#endif
#ifdef WITH_LORAWAN
  const char *StateName[4] = { "Not-Joined", "Join-Req", "+Joined+", "PktSend" } ;
  int Len=Format_String(Line, "LoRaWAN: ");
  if(WANdev.State==2) Len+=Format_Hex(Line+Len, WANdev.DevAddr);
  else if(WANdev.State<=3) Len+=Format_String(Line+Len, StateName[WANdev.State]);
                 else Len+=Format_Hex(Line+Len, WANdev.State);
  Line[Len]=0; u8g2_DrawStr(OLED, 0, 24, Line);

  // if(WANdev.State<2)
  // { Len =Format_HexBytes(Line, WANdev.AppKey  , 8); Line[Len]=0; u8g2_DrawStr(OLED, 12, 36, Line);
  //   Len =Format_HexBytes(Line, WANdev.AppKey+8, 8); Line[Len]=0; u8g2_DrawStr(OLED, 12, 48, Line);
  //   u8g2_SetFont(OLED, u8g2_font_open_iconic_all_1x_t); u8g2_DrawGlyph(OLED, 1, 36, 0xC1); u8g2_DrawGlyph(OLED, 1, 48, 0xC1); }
  // else
  if(WANdev.State>=2)
  { Len =Format_String(Line    , "Up: "); Len+=Format_Hex(Line+Len, (uint16_t)WANdev.UpCount);
    Len+=Format_String(Line+Len, "  Dn: "); Len+=Format_Hex(Line+Len, (uint16_t)WANdev.DnCount);
    Line[Len]=0; u8g2_DrawStr(OLED, 0, 36, Line);

    Len =Format_String(Line    , "Rx:");
    Len+=Format_SignDec(Line+Len, (int16_t)WANdev.RxRSSI, 3);
    Len+=Format_String(Line+Len, "dBm ");
    Len+=Format_SignDec(Line+Len, ((int16_t)WANdev.RxSNR*10+2)>>2, 2, 1);
    Len+=Format_String(Line+Len, "dB");
    Line[Len]=0; u8g2_DrawStr(OLED, 0, 48, Line); }
  Len=Format_HexBytes(Line, WANdev.AppKey, 2); Line[Len++]='.'; Line[Len++]='.'; Len+=Format_Hex(Line+Len, WANdev.AppKey[15]);
  Line[Len]=0; u8g2_DrawStr(OLED, 72, 60, Line);
  u8g2_SetFont(OLED, u8g2_font_open_iconic_all_1x_t); u8g2_DrawGlyph(OLED, 61, 60, 0xC1);

  // if(WANdev.State>=2) { }
/*
  Len=0;
  for(int Idx=0; Idx<16; Idx++)
  { Len+=Format_Hex(Line+Len, WANdev.AppKey[Idx]); }
  Line[Len]=0;
  u8g2_SetFont(OLED, u8g2_font_5x8_tr);
  u8g2_DrawStr(OLED, 0, 48, Line);
*/
#endif // WITH_LORAWAN
}

#endif

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