fix merge bugs

lib/Component/component.cpp

@@ -19,7 +19,7 @@ void Component::loop()
             (*it)->loop();
         }
     }
-    this->runAsChild();F
+    this->runAsChild();
 
     if (this->onlyChilds)
     {

lib/Sensors/sensorData.cpp

@@ -68,46 +68,6 @@ void SensorData::enableCalcCompass()
     // TODO: !!! implementieren
 }
 
-void SensorData::enableGyroscope()
-{
-    this->gyroscope = new MPU6050();
-    this->gyroscope->initialize();
-    if (!this->gyroscope->testConnection())
-    {
-        std::cout << "SensorData::enableGyroscope: Gyroskop is not conntected. Freeze!" << std::endl;
-        while (true)
-        {
-        }
-    }
-
-    const uint8_t deviceStatus = this->gyroscope->dmpInitialize();
-
-    // TODO: !!! MagicNumer 6x
-    this->gyroscope->setXGyroOffset(220);
-    this->gyroscope->setYGyroOffset(76);
-    this->gyroscope->setZGyroOffset(-85);
-    this->gyroscope->setZAccelOffset(1788);
-
-    if (deviceStatus == 0)
-    {
-        this->gyroscope->CalibrateAccel(6);
-        this->gyroscope->CalibrateGyro(6);
-        this->gyroscope->PrintActiveOffsets();
-        this->gyroscope->setDMPEnabled(true);
-    }
-    else
-    {
-        // ERROR!
-        // 1 = initial memory load failed
-        // 2 = DMP configuration updates failed
-        // (if it's going to break, usually the code will be 1)
-        std::cout << "SensorData::enableGyroscope: DMP Initialization failed (code" << static_cast<int>(deviceStatus) << "). Freeze!" << std::endl;
-        while (true)
-        {
-        }
-    }
-}
-
 CalcAzimuth::State SensorData::getCalcAzimuthState() const
 {
     if (static_cast<bool>(this->calcCompass))
@@ -117,15 +77,6 @@ CalcAzimuth::State SensorData::getCalcAzimuthState() const
     return CalcAzimuth::State::Invalid;
 }
 
-NTRIPClientStates SensorData::getNtripState() const
-{
-    if (static_cast<bool>(this->ntripClient))
-    {
-        return this->ntripClient->getClientState();
-    }
-    return NTRIPClientStates::notAvailable;
-}
-
 void SensorData::printPVTdata(UBX_NAV_PVT_data_t *ubxDataStruct)
 {
     static constexpr uint8_t stringSize = 32;
@@ -220,13 +171,6 @@ void SensorData::run()
         this->realCompass->read();
         this->realAzimuth = this->realCompass->getAzimuth();
     }
-
-    if (static_cast<bool>(this->gyroscope) && this->gyroscope->dmpGetCurrentFIFOPacket(static_cast<uint8_t *>(this->gyroBuffer)))
-    {
-        this->gyroscope->dmpGetQuaternion(&this->quaternion, static_cast<uint8_t *>(this->gyroBuffer));
-        this->gyroscope->dmpGetGravity(&this->gravity, &this->quaternion);
-        this->gyroscope->dmpGetYawPitchRoll(static_cast<float *>(this->yawPitchRoll), &this->quaternion, &this->gravity);
-    }
 }
 
 void SensorData::runAsChild()

lib/Sensors/sensorData.h

@@ -21,7 +21,6 @@
 
 #include <SparkFun_u-blox_GNSS_Arduino_Library.h>
 #include <QMC5883LCompass.h>
-#include <MPU6050_6Axis_MotionApps20.h>
 #include "calcAzimuth.h"
 
 #include "point.h"
@@ -37,8 +36,6 @@ public:
     SensorData();
     ~SensorData();
 
-    void enableNtrip(String host, uint16_t port, String mountPoint, String user, String password);
-
     /**
      * @brief Enable the gnss module over spi
      *
@@ -54,7 +51,6 @@ public:
 
     void enableRealCompass();
     void enableCalcCompass();
-    void enableGyroscope();
 
     // Interface Const
     /**
@@ -84,19 +80,6 @@ public:
 
     Point getCurrentPos() const { return this->currentPosition; }
     const UBX_NAV_PVT_data_t *getGnssData() const { return this->gnssData; };
-    NTRIPClientStates getNtripState() const;
-
-    /**
-     * @brief Get the data from the gyroscope
-     *
-     * The returned float pointer is an array of 3 floats
-     * - Yaw
-     * - Pitch
-     * - Roll
-     *
-     * @return const float*
-     */
-    const float *getGyroData() const { return this->yawPitchRoll; }
 
     /**
      * @brief Get the CalcCompass object
@@ -110,18 +93,6 @@ public:
      */
     QMC5883LCompass *getRealCompass() const { return this->realCompass; }
 
-    /**
-     * @brief Get the NTRIPClient object
-     * @return NTRIPClient*
-     */
-    NTRIPClient *getNtripClient() const { return this->ntripClient; }
-
-    /**
-     * @brief Get the Gyroscope object
-     * @return MPU6050*
-     */
-    MPU6050 *getGyroscope() const { return this->gyroscope; }
-
     // static
     /**
      * @brief Set the output status for PVTdata.
@@ -142,29 +113,14 @@ private:
     QMC5883LCompass *realCompass = nullptr;
     CalcAzimuth *calcCompass = nullptr;
     SFE_UBLOX_GNSS *gnss = nullptr;
-    NTRIPClient *ntripClient = nullptr;
-    MPU6050 *gyroscope = nullptr;
 
     UBX_NAV_PVT_data_t *gnssData = nullptr;
     Point currentPosition;
-    Quaternion quaternion;
-    VectorFloat gravity;
 
-    char *host = nullptr;
-    char *mountPoint = nullptr;
-    char *user = nullptr;
-    char *password = nullptr;
-
-    bool isNtripInit = false;
-
-    uint8_t gyroBuffer[64];
-    uint16_t port = 0;
     int16_t realAzimuth = INT16_MAX;
     int16_t calcAzimuth = INT16_MAX;
     uint32_t lastUbxUpdate = 0;
 
-    float yawPitchRoll[3]{0, 0, 0};
-
     // static
     static void printPVTdata(UBX_NAV_PVT_data_t *ubxDataStruct);
     static void savePVTdata(UBX_NAV_PVT_data_t *ubxDataStruct);