WebSVN - Projects - Diff - Rev 358 and 391 - /QMK-Groundstation/branches/own_com

 #include "dlg_Config.h"
 #include "dlg_Motortest.h"
 #include "dlg_Preferences.h"
 #include "../global.h"
 #include "../Classes/ToolBox.h"
+#include "../com/Parser.h"
 #include <stdlib.h>
 void MKTool::slot_Test()
+{
     sRxData RX;
-    RX.String = IN->text();
+    RX.str = IN->text().toLatin1().data();
-    RX.Input = RX.String.toLatin1().data();
+    RX.input = (char *)RX.str.c_str();
     desired_pos.reserve[3] = 0; // reserve
     //...und sende ihn an die NaviCtrl
     int max_radius = 10000;
     if (ok_lat && ok_lon &&
-        abs(Navi.Current.Longitude - desired_pos.Position.Longitude) < max_radius &&
+        abs((double)(Navi.Current.Longitude - desired_pos.Position.Longitude)) < max_radius &&
-        abs(Navi.Current.Latitude  - desired_pos.Position.Latitude) < max_radius)
+        abs((double)(Navi.Current.Latitude  - desired_pos.Position.Latitude)) < max_radius)
+    {
             o_Connection->send_Cmd('s', ADDRESS_NC, (char *)&desired_pos, sizeof(desired_pos), false);
+    }
     else
         TX_Data[2] = 0x55;
         TX_Data[3] = 0xAA;
         TX_Data[4] = 0x00;
         TX_Data[5] = '\r';
         o_Connection->send_Cmd('#', ADDRESS_NC, TX_Data, 6, false);
-        ToolBox::Wait(SLEEP);
+        ToolBox::wait(SLEEP);
+    }
     if (rb_SelFC->isChecked())
+    {
         TX_Data[3] = 0xAA;
         TX_Data[4] = 0x00;
         TX_Data[5] = '\r';
         o_Connection->send_Cmd('#', ADDRESS_NC, TX_Data, 6, false);
+    }
-    ToolBox::Wait(SLEEP);
+    ToolBox::wait(SLEEP);
 //    qDebug("Select RB Hardware");
     o_Connection->send_Cmd('v', ADDRESS_ALL, TX_Data, 0, true);
     double Longitude, Latitude;
     // Waypoint-Liste löschen
     WayPoint.Position.Status = INVALID;
     o_Connection->send_Cmd('w', ADDRESS_NC, (char *)&WayPoint, sizeof(WayPoint), false);
-    ToolBox::Wait(SLEEP);
+    ToolBox::wait(SLEEP);
     for (int z = 0; z < l_WayPoints.count(); z++)
+    {
 void MKTool::new_NaviData(sRxData RX)
+{
 //    qDebug("Navi-Data");
-    switch(RX.Decode[N_NC_FLAGS])
+    switch(RX.decode[N_NC_FLAGS])
+    {
         case 0x01 : lb_Mode->setText(tr("Free")); break;
         case 0x02 : lb_Mode->setText(tr("Position Hold")); break;
         case 0x04 : lb_Mode->setText(tr("Coming Home")); break;
         case 0x08 : lb_Mode->setText(tr("Range Limit")); break;
         case 0x10 : lb_Mode->setText(tr("Serial Error")); break;
         case 0x20 : lb_Mode->setText(tr("Target reached")); break;
         case 0x40 : lb_Mode->setText(tr("Manual Control")); break;
     }
-    Navi.Current.Longitude = ToolBox::Data2Long(RX.Decode, N_CUR_LONGITUDE, true);
+    Navi.Current.Longitude = Parser::dataToLong(RX.decode, N_CUR_LONGITUDE, true);
-    Navi.Current.Latitude  = ToolBox::Data2Long(RX.Decode, N_CUR_LATITUDE,  true);
+    Navi.Current.Latitude  = Parser::dataToLong(RX.decode, N_CUR_LATITUDE,  true);
-    Navi.Current.Altitude  = ToolBox::Data2Long(RX.Decode, N_CUR_ALTITUDE,  true);
+    Navi.Current.Altitude  = Parser::dataToLong(RX.decode, N_CUR_ALTITUDE,  true);
-    Navi.Target.Longitude  = ToolBox::Data2Long(RX.Decode, N_TAR_LONGITUDE, true);
+    Navi.Target.Longitude  = Parser::dataToLong(RX.decode, N_TAR_LONGITUDE, true);
-    Navi.Target.Latitude   = ToolBox::Data2Long(RX.Decode, N_TAR_LATITUDE,  true);
+    Navi.Target.Latitude   = Parser::dataToLong(RX.decode, N_TAR_LATITUDE,  true);
-    Navi.Target.Altitude   = ToolBox::Data2Long(RX.Decode, N_TAR_ALTITUDE,  true);
+    Navi.Target.Altitude   = Parser::dataToLong(RX.decode, N_TAR_ALTITUDE,  true);
-    le_CDistance->setText(QString("%1 cm").arg(ToolBox::Data2Int(RX.Decode, N_HOME_DISTANCE)));
+    le_CDistance->setText(QString("%1 cm").arg(Parser::dataToInt(RX.decode, N_HOME_DISTANCE)));
-    le_CWPA->setText(QString("%1").arg(RX.Decode[N_WP_INDEX]));
+    le_CWPA->setText(QString("%1").arg(RX.decode[N_WP_INDEX]));
-    le_CWPT->setText(QString("%1").arg(RX.Decode[N_WP_NUMBER]));
+    le_CWPT->setText(QString("%1").arg(RX.decode[N_WP_NUMBER]));
-    le_CSats->setText(QString("%1").arg(RX.Decode[N_SATS_IN_USER]));
+    le_CSats->setText(QString("%1").arg(RX.decode[N_SATS_IN_USER]));
-    qwt_Rate->setValue(double(ToolBox::Data2Int(RX.Decode, N_VARIOMETER, true)));
+    qwt_Rate->setValue(double(Parser::dataToInt(RX.decode, N_VARIOMETER, true)));
-    le_CTime->setText(QString("%1 sec.").arg(ToolBox::Data2Int(RX.Decode, N_FLYING_TIME)));
+    le_CTime->setText(QString("%1 sec.").arg(Parser::dataToInt(RX.decode, N_FLYING_TIME)));
         SpeedMeter->setProperty("END", 20);
+    }
     SpeedMeter->setValue(Speed);
-    Compass->setValue(ToolBox::Data2Int(RX.Decode, N_COMAPSS_HEADING)); //(68)
+    Compass->setValue(Parser::dataToInt(RX.decode, N_COMAPSS_HEADING)); //(68)
-    bar_RX->setValue(RX.Decode[N_RC_QUALITY]);
+    bar_RX->setValue(RX.decode[N_RC_QUALITY]);
-    int Nick = RX.Decode[N_ANGLE_NICK];
+    int Nick = RX.decode[N_ANGLE_NICK];
     Attitude->setAngle(Roll);
     Attitude->setGradient(double(0.0 - (double(Nick) / 100.0)));
     sNaviString NaviString;
-    NaviString.Longitude = ToolBox::get_Float(Navi.Current.Longitude,7);
+    NaviString.Longitude = Parser::getFloat(Navi.Current.Longitude,7);
-    NaviString.Latitude  = ToolBox::get_Float(Navi.Current.Latitude,7);
+    NaviString.Latitude  = Parser::getFloat(Navi.Current.Latitude,7);
-    NaviString.Altitude  = ToolBox::get_Float(Navi.Current.Altitude,3);
+    NaviString.Altitude  = Parser::getFloat(Navi.Current.Altitude,3);
-    le_CurLong->setText(NaviString.Longitude);
+    le_CurLong->setText(QString::number(NaviString.Longitude));
-    le_CurLat->setText(NaviString.Latitude);
+    le_CurLat->setText(QString::number(NaviString.Latitude));
     KML_Server->store_NaviString(NaviString);
 void MKTool::slot_newData(sRxData RX) // DONE 0.71g
+{
     if (LastSend.length() > 2)
+    {
+    }
-    int HardwareID = RX.Input[1] - 'a';
+    int HardwareID = RX.input[1] - 'a';
     switch(HardwareID)
+    {
         case ADDRESS_FC :
-            switch(RX.Input[2])
+            switch(RX.input[2])
+            {
                 // Motor-Mixer
                 case 'N' :
-                    if (ToolBox::Decode64(RX))
+                    if (Parser::decode64(RX))
+                    {
                         o_Connection->stop_ReSend();
-                        if (RX.Decode[0] == VERSION_MIXER)
+                        if (RX.decode[0] == VERSION_MIXER)
+                        {
                             f_MotorMixer->set_MotorConfig(RX);
+                        }
+                    }
                 break;
                 // Motor-Mixer Schreib-Bestätigung
                 case 'M' :
-                    if (ToolBox::Decode64(RX))
+                    if (Parser::decode64(RX))
                     {
                         o_Connection->stop_ReSend();
-                        if (RX.Decode[0] == 1)
+                        if (RX.decode[0] == 1)
+                        {
                             lb_Status->setText(tr("MotorMixer-Daten in FC geschrieben."));
+                        }
+                    }
                 break;
                 // Stick-Belegung der Fernsteuerung
                 case 'P' : // DONE 0.71g
-                    if (ToolBox::Decode64(RX))
+                    if (Parser::decode64(RX))
                     {
-                        f_Settings->pb_K1->setValue(ToolBox::Data2Int(RX.Decode,  2,true));
+                        f_Settings->pb_K1->setValue(Parser::dataToInt(RX.decode,  2,true));
-                        f_Settings->pb_K2->setValue(ToolBox::Data2Int(RX.Decode,  4,true));
+                        f_Settings->pb_K2->setValue(Parser::dataToInt(RX.decode,  4,true));
-                        f_Settings->pb_K3->setValue(ToolBox::Data2Int(RX.Decode,  6,true));
+                        f_Settings->pb_K3->setValue(Parser::dataToInt(RX.decode,  6,true));
-                        f_Settings->pb_K4->setValue(ToolBox::Data2Int(RX.Decode,  8,true));
+                        f_Settings->pb_K4->setValue(Parser::dataToInt(RX.decode,  8,true));
-                        f_Settings->pb_K5->setValue(ToolBox::Data2Int(RX.Decode, 10 ,true));
+                        f_Settings->pb_K5->setValue(Parser::dataToInt(RX.decode, 10 ,true));
-                        f_Settings->pb_K6->setValue(ToolBox::Data2Int(RX.Decode, 12,true));
+                        f_Settings->pb_K6->setValue(Parser::dataToInt(RX.decode, 12,true));
-                        f_Settings->pb_K7->setValue(ToolBox::Data2Int(RX.Decode, 14,true));
+                        f_Settings->pb_K7->setValue(Parser::dataToInt(RX.decode, 14,true));
-                        f_Settings->pb_K8->setValue(ToolBox::Data2Int(RX.Decode, 16,true));
+                        f_Settings->pb_K8->setValue(Parser::dataToInt(RX.decode, 16,true));
                     }
                 break;
                 // Settings lesen
                 case 'Q' : // DONE 0.71g
-                    if (ToolBox::Decode64(RX))
+                    if (Parser::decode64(RX))
                     {
                         o_Connection->stop_ReSend();
-                        if (RX.Decode[1] == VERSION_SETTINGS)
+                        if (RX.decode[1] == VERSION_SETTINGS)
+                        {
-                            int Settings_ID = RX.Decode[0];
+                            int Settings_ID = RX.decode[0];
                             for (int a = 0; a < MaxParameter; a++)
+                            {
-                                FCSettings[a] = RX.Decode[a + 2];
+                                FCSettings[a] = RX.decode[a + 2];
+                            }
                             f_Settings->show_FCSettings(Settings_ID, FCSettings);
                             f_Settings->pb_Read->setEnabled(true);
                             f_Settings->pb_Write->setEnabled(true);
+                        }
+                        else
+                        {
+                            f_Settings->pb_Read->setDisabled(true);
+                            f_Settings->pb_Write->setDisabled(true);
                             QString name = QString("Versionen inkompatibel.\n") +
-                        else
+                                      QString("Version von GroundStation benoetigt: ") +
                                       QString(VERSION_SETTINGS) +
-                            f_Settings->pb_Read->setDisabled(true);
+                                      QString("\nVersion auf der FlightCtrl: ") +
-                            f_Settings->pb_Write->setDisabled(true);
+                                      QString(RX.decode[1]) +
                                       QString("\nParameterbearbeitung nicht moeglich.");
                             QMessageBox::warning(this, QA_NAME,
-                                   tr("Versionen inkompatibel. \nParameterbearbeitung nicht moeglich."), QMessageBox::Ok);
+                                   name, QMessageBox::Ok);
+                        }
+                    }
                 break;
                 // Settings geschrieben
                 case 'S' : // DONE 0.71g
                     o_Connection->stop_ReSend();
                 break;
             }
         case ADDRESS_NC :
-            switch(RX.Input[2])
+            switch(RX.input[2])
+            {
                 // Navigationsdaten
                 case 'O' : // NOT DONE 0.12h
-                    if (ToolBox::Decode64(RX))
+                    if (Parser::decode64(RX))
                     {
                         new_NaviData(RX);
+                    }
                 break;
             }
 //        case ADDRESS_MK3MAG :
         default :
-            switch(RX.Input[2])
+            switch(RX.input[2])
+            {
                 // LCD-Anzeige
                 case 'L' : // DONE 0.71g
-                    if (ToolBox::Decode64(RX))
+                    if (Parser::decode64(RX))
+                    {
                         o_Connection->stop_ReSend();
                         int LCD[150];
-                        memcpy(LCD,RX.Decode, sizeof(RX.Decode));
+                        memcpy(LCD,RX.decode, sizeof(RX.decode));
                         f_LCD->show_Data(LCD);
-                        LCD_Page     = RX.Decode[0];
+                        LCD_Page     = RX.decode[0];
-                        LCD_MAX_Page = RX.Decode[1];
+                        LCD_MAX_Page = RX.decode[1];
+                    }
                 break;
                 // Analoglabels
                 case 'A' : // DONE 0.71g
-                    if (ToolBox::Decode64(RX))
+                    if (Parser::decode64(RX))
+                        }
+                    }
                 break;
                 // Debug-Daten
                 case 'D' : // DONE 0.71g
-                    if (ToolBox::Decode64(RX))
+                    if (Parser::decode64(RX))
+                    {
                         for (int i = 0; i < MaxAnalog; i++)
+                        {
-                            AnalogData[i] = ToolBox::Data2Int(RX.Decode, (i * 2) + 2);
+                            AnalogData[i] = Parser::dataToInt(RX.decode, (i * 2) + 2);
+                        }
                         show_DebugData();
+                    }
                 break;
                 // Version
                 case 'V' : // DONE 0.71h
-                    if (ToolBox::Decode64(RX))
+                    if (Parser::decode64(RX))
+                    {
                         o_Connection->stop_ReSend();
                         Mode.ID            = HardwareID;
-                        Mode.VERSION_MAJOR = RX.Decode[0];
+                        Mode.VERSION_MAJOR = RX.decode[0];
-                        Mode.VERSION_MINOR = RX.Decode[1];
+                        Mode.VERSION_MINOR = RX.decode[1];
-                        Mode.VERSION_PATCH = RX.Decode[4];
+                        Mode.VERSION_PATCH = RX.decode[4];
-                        Mode.VERSION_SERIAL_MAJOR = RX.Decode[2];
+                        Mode.VERSION_SERIAL_MAJOR = RX.decode[2];
-                        Mode.VERSION_SERIAL_MINOR = RX.Decode[3];
+                        Mode.VERSION_SERIAL_MINOR = RX.decode[3];
+                        Mode.Hardware   = HardwareType[Mode.ID];
-                        Mode.Hardware   = HardwareType[Mode.ID];
+                        //TODO: Funktion im Handler get_version() oder sowas
+                        QString version = QString("%1").arg(RX.decode[0]) + "." +
+                                          QString("%1").arg(RX.decode[1]) +
-                        Mode.Version    = QString("%1").arg(RX.Decode[0]) + "." + QString("%1").arg(RX.Decode[1]) + QString(RX.Decode[4] + 'a');
+                                          QString(RX.decode[4] + 'a');
+                        Mode.Version = version.toLatin1();
                         setWindowTitle(QA_NAME + " v" + QA_VERSION + " - " +
-                        setWindowTitle(QA_NAME + " v" + QA_VERSION + " - " + Mode.Hardware + " " + Mode.Version);
+                                 QString(Mode.Hardware) + " " + Mode.Version);
                         if (Mode.VERSION_SERIAL_MAJOR != VERSION_SERIAL_MAJOR)
     if ((QMK_Server->property("Connect")) == true)
+    {
 //        QMK_Server->send_RawData(RX.String);
+    }
-    slot_showTerminal(1, RX.String);
+    slot_showTerminal(1, RX.str);
+}
 void MKTool::slot_showTerminal(int Typ, QString Text)
+{
     if (o_Connection->isOpen())
+    {
         TX_Data[0] = Settings->Data.Debug_Off / 10;
         o_Connection->send_Cmd('d', ADDRESS_ALL, TX_Data, 1, false);
-        ToolBox::Wait(SLEEP);
+        ToolBox::wait(SLEEP);
         if (Mode.ID == ADDRESS_NC)
+        {
             TX_Data[0] = Settings->Data.Navi_Off / 10;
             o_Connection->send_Cmd('o', ADDRESS_NC, TX_Data, 1, false);
-            ToolBox::Wait(SLEEP);
+            ToolBox::wait(SLEEP);
+        }
         if (Mode.ID == ADDRESS_FC)
+        {
             TX_Data[0] = 0;
             TX_Data[1] = 0;
             TX_Data[2] = 0;
             TX_Data[3] = 0;
             o_Connection->send_Cmd('t', ADDRESS_FC, TX_Data, 4, false);
-            ToolBox::Wait(SLEEP);
+            ToolBox::wait(SLEEP);
+        }

Subversion Repositories Projects

(root)/QMK-Groundstation/branches/own_com_lib/Forms/mktool.cpp - Rev 358 → 391