companion/src/simulation/telemetrysimu.h

   1 /*
   2  * Copyright (C) OpenTX
   3  *
   4  * Based on code named
   5  *   th9x - http://code.google.com/p/th9x
   6  *   er9x - http://code.google.com/p/er9x
   7  *   gruvin9x - http://code.google.com/p/gruvin9x
   8  *
   9  * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License version 2 as
  13  * published by the Free Software Foundation.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  */
  20
  21 #ifndef _TELEMETRYSIMU_H_
  22 #define _TELEMETRYSIMU_H_
  23
  24 #include <QCloseEvent>
  25 #include <QWidget>
  26 #include <QTimer>
  27 #include <QDateTime>
  28 #include <QtCore/qmath.h>
  29 #include <QFileDialog>
  30
  31 #include "simulatorinterface.h"
  32
  33 static double const SPEEDS[] = { 0.2, 0.4, 0.6, 0.8, 1, 2, 3, 4, 5 };
  34 template<class t> t LIMIT(t mi, t x, t ma) { return std::min(std::max(mi, x), ma); }
  35
  36 namespace Ui {
  37   class TelemetrySimulator;
  38 }
  39
  40 class TelemetrySimulator : public QWidget
  41 {
  42   Q_OBJECT
  43
  44   public:
  45
  46     explicit TelemetrySimulator(QWidget * parent, SimulatorInterface * simulator);
  47     virtual ~TelemetrySimulator();
  48
  49   signals:
  50
  51     void telemetryDataChanged(const QByteArray data);
  52
  53   protected slots:
  54
  55     virtual void hideEvent(QHideEvent *event);
  56     virtual void showEvent(QShowEvent *event);
  57     void onSimulatorStarted();
  58     void onSimulatorStopped();
  59     void setupDataFields();
  60     void onSimulateToggled(bool isChecked);
  61     void onLogTimerEvent();
  62     void onLoadLogFile();
  63     void onPlay();
  64     void onRewind();
  65     void onStepForward();
  66     void onStepBack();
  67     void onStop();
  68     void onPositionIndicatorChanged(int value);
  69     void onReplayRateChanged(int value);
  70     void refreshSensorRatios();
  71     void generateTelemetryFrame();
  72
  73   protected:
  74
  75     Ui::TelemetrySimulator * ui;
  76     QTimer timer;
  77     QTimer logTimer;
  78     SimulatorInterface *simulator;
  79     bool m_simuStarted;
  80     bool m_telemEnable;
  81     bool m_logReplayEnable;
  82
  83   // protected classes follow
  84
  85     class LogPlaybackController
  86     {
  87       public:
  88         LogPlaybackController(Ui::TelemetrySimulator * ui);
  89         bool isReady();
  90         void loadLogFile();
  91         void play();
  92         void stop();
  93         void rewind();
  94         void stepForward(bool focusOnStop = false);
  95         void stepBack();
  96         void updatePositionLabel(int32_t percentage);
  97         void setUiDataValues();
  98         double logFrequency; // in seconds
  99         bool logFileGpsCordsInDecimalFormat;
 100
 101       private:
 102         enum CONVERT_TYPE {
 103           RXBT_V,
 104           RSSI,
 105           RAS,
 106           A1,
 107           A2,
 108           A3,
 109           A4,
 110           T1_DEGC,
 111           T1_DEGF,
 112           T2_DEGC,
 113           T2_DEGF,
 114           RPM,
 115           FUEL,
 116           VSPD_MS,
 117           VSPD_FS,
 118           ALT_FEET,
 119           ALT_METERS,
 120           FASV,
 121           FASC,
 122           CELS_GRE,
 123           ASPD_KTS,
 124           ASPD_KMH,
 125           ASPD_MPH,
 126           GALT_FEET,
 127           GALT_METERS,
 128           GSPD_KNTS,
 129           GSPD_KMH,
 130           GSPD_MPH,
 131           GHDG_DEG,
 132           GDATE,
 133           G_LATLON,
 134           ACCX,
 135           ACCY,
 136           ACCZ,
 137           FUEL_QTY,
 138         };
 139
 140         struct DATA_TO_FUNC_XREF {
 141           CONVERT_TYPE functionIndex;
 142           int32_t dataIndex;
 143         };
 144
 145         double convertFeetToMeters(QString input);
 146         double convertFahrenheitToCelsius(QString input);
 147         QString convertGPSDate(QString input);
 148         QString convertGPS(QString input);
 149         void addColumnHash(QString key, CONVERT_TYPE functionIndex);
 150         double convertDegMin(QString input);
 151         QDateTime parseTransmittterTimestamp(QString row);
 152         void calcLogFrequency();
 153         void checkGpsFormat();
 154
 155         QMap<QString, CONVERT_TYPE> colToFuncMap; // contains all 'known' column headings and how they are to be processed
 156         Ui::TelemetrySimulator * ui;
 157         QStringList csvRecords; // contents of the log file (one string per line);
 158         QStringList columnNames;
 159         QList<DATA_TO_FUNC_XREF> supportedCols;
 160         int32_t recordIndex;
 161         bool stepping;
 162     };  // LogPlaybackController
 163
 164     LogPlaybackController *logPlayback;
 165
 166     class FlvssEmulator
 167     {
 168       public:
 169         uint32_t setAllCells_GetNextPair(double cellValues[6]);
 170         static const uint32_t MAXCELLS = 6;
 171
 172       private:
 173         void encodeAllCells();
 174         void splitIntoCells(double totalVolts);
 175         static uint32_t encodeCellPair(uint8_t cellNum, uint8_t firstCellNo, double cell1, double cell2);
 176         double cellFloats[6];
 177         uint32_t nextCellNum;
 178         uint32_t numCells;
 179         uint32_t cellData1;
 180         uint32_t cellData2;
 181         uint32_t cellData3;
 182     };  // FlvssEmulator
 183
 184     class GPSEmulator
 185     {
 186       public:
 187         GPSEmulator();
 188         uint32_t getNextPacketData(uint32_t packetType);
 189         void setGPSDateTime(QString dateTime);
 190         void setGPSLatLon(QString latLon);
 191         void setGPSCourse(double course);
 192         void setGPSSpeedKMH(double speed);
 193         void setGPSAltitude(double altitude);
 194
 195       private:
 196         QDateTime dt;
 197         bool sendLat;
 198         bool sendDate;
 199         double lat;
 200         double lon;
 201         double course;
 202         double speedKNTS;
 203         double altitude; // in meters
 204         uint32_t encodeLatLon(double latLon, bool isLat);
 205         uint32_t encodeDateTime(uint8_t yearOrHour, uint8_t monthOrMinute, uint8_t dayOrSecond, bool isDate);
 206     };  // GPSEmulator
 207
 208 };  // TelemetrySimulator
 209
 210 #endif // _TELEMETRYSIMU_H_
 211