WebSVN - Projects - Diff - Rev 462 and 500 - /QMK-Groundstation/branches/libMK/libMK/Handler.cpp

 #include "Handler.h"
-#include <iostream>
+#include "FlightLog.h"
 /**
  * Constructor that gets a communication instance
  */
+}
 /**
  * receive data
+ */
+void Handler::receive_data(char * incomming, int length) {
+    if (incomming[0] != '#')
+        FlightLog::error("this frame is not correct");
+        FlightLog::info(incomming);
+        return;
+    int hardwareID = incomming[1] - 'a';
+    //The cmd is also known as ID-Byte (or ID for short) in the wiki-dokumentation
- */
+    char cmd = incomming[2];
+    //decode data
+    unsigned char data[150];
-//Parser::decode64(data);
+    Parser::decode64(incomming, length, data, 3);
 void Handler::receive_data(int hardwareID, int cmd, char * data) {
     switch(hardwareID)
+    {
         case ADDRESS_FC :
             switch(cmd)
                 case 'N' :
                     //if (Parser::decode64(RX))
                     //{
                         com->stop_resend();
                         //decoded data
+                        FlightLog::info("received motortest values from FlightCtrl");
                         if (data[0] == VERSION_MIXER)
+                        {
                             //f_MotorMixer->set_MotorConfig(RX);
+                        }
                     //}
                 case 'M' :
                     com->stop_resend();
                     if (data[0] == 1)
+                    {
                         FlightLog::info("motor values written to FlightCtrl.");
+                        //lb_Status->setText(tr("MotorMixer-Daten in FC geschrieben."));
+                    } else {
-                        //lb_Status->setText(tr("MotorMixer-Daten in FC geschrieben."));
+                        FlightLog::warning("could not write motor values to FlightCtrl!");
+                    }
                     break;
+                // Stick-Belegung der Fernsteuerung
-                // Stick-Belegung der Fernsteuerung
+                case 'P' : // DONE 0.71g
-                case 'P' : // DONE 0.71g
+                    FlightLog::info("received stick-settings from FlightCtrl:");
                     /*f_Settings->pb_K1->setValue(Parser::dataToInt(RX.decode,  2,true));
                     f_Settings->pb_K2->setValue(Parser::dataToInt(RX.decode,  4,true));
                     f_Settings->pb_K3->setValue(Parser::dataToInt(RX.decode,  6,true));
                     f_Settings->pb_K8->setValue(Parser::dataToInt(RX.decode, 16,true));*/
                     break;
                 // Settings lesen
                 case 'Q' : // DONE 0.71g
                     com->stop_resend();
+                    FlightLog::info("received settings from FlightCtrl");
                     if (data[1] == VERSION_SETTINGS)
+                    {
                         int Settings_ID = data[0];
                         /*for (int a = 0; a < MaxParameter; a++)
+                        {
                         f_Settings->pb_Read->setEnabled(true);
                         f_Settings->pb_Write->setEnabled(true);*/
+                    }
                     else
+                    {
+                        FlightLog::error("wrong FlightCtrl version");
                         /*f_Settings->pb_Read->setDisabled(true);
                         f_Settings->pb_Write->setDisabled(true);
                         QString name = QString("Versionen inkompatibel.\n") +
+                    }
                     break;
                 // Settings written
                 case 'S' : // DONE 0.71g
                     com->stop_resend();
+                    FlightLog::info("settings written successfully to FlightCtrl");
                     //TODO: QMessagebox("settings written successful") ?
                     break;
+            }
         case ADDRESS_NC :
             switch(cmd)
+            {
                 // Navigationsdaten
                 case 'O' : // NOT DONE 0.12h
+                    //new_NaviData(RX);
-                    //new_NaviData(RX);
+                    FlightLog::info("received navigation data from NaviCtrl");
                     break;
+            }
 //        case ADDRESS_MK3MAG :
         default :
             switch(cmd)
+            {
                 // LCD-Anzeige
-                case 'L' : // DONE 0.71g
+                case 'L' : // DONE 0.71g
                     com->stop_resend();
                     FlightLog::info("received LCD page.");
                     /*int LCD[150];
                     */
                     break;
                 // Analoglabels
                 case 'A' : // DONE 0.71g
                     com->stop_resend();
+                    FlightLog::info("received analog labels");
                     //check position
                     if (data[0] != 31) {
                         /*
                         Settings->Analog1.Label[Position] = ToolBox::dataToQString(RX.decode,1,17).trimmed();
                         if (Settings->Analog1.Label[Position] == "")
                         config_Plot();*/
+                    }
                     break;
                 // Debug-Daten
                 case 'D' : // DONE 0.71g
+                    FlightLog::info("received debug data:");
                     for (int i = 0; i < MaxAnalog; i++) {
+                        /*
-                        std::cout << Parser::dataToInt(data, (i * 2) + 2) << std::endl;
+                        Parser::dataToInt((char *)data, (i * 2) + 2, false);
+                        */
+                    }
                     //show_DebugData();
                     break;
                 // Version
                 case 'V' : // DONE 0.71h
                     com->stop_resend();
+                    FlightLog::info("received version");
                     /*
                     Mode.ID            = HardwareID;
                     Mode.VERSION_MAJOR = RX.decode[0];
                     Mode.VERSION_MINOR = RX.decode[1];
                     Mode.VERSION_PATCH = RX.decode[4];

Subversion Repositories Projects

(root)/QMK-Groundstation/branches/libMK/libMK/Handler.cpp - Rev 462 → 500