compilation works again

2023-09-04 13:30:34 +02:00
parent 5f650982a7
commit 6a76470f45
23 changed files with 285 additions and 321 deletions
@@ -0,0 +1,166 @@
+/**
+ * @file senors.cpp
+ * @author Alexander Klein (alex@kleiax.de)
+ * @brief 
+ * @version 0.1
+ * @date 2023-09-02
+ * 
+ * @copyright Copyright (c) 2023
+ * 
+ */
+
+#include "sensorData.h"
+
+bool SensorData::outputStatusPrintPVTdata = false;
+bool SensorData::newData = false;
+uint32_t SensorData::ubxUpdateTimeStatic = 0;
+UBX_NAV_PVT_data_t* SensorData::ubxDataStatic = nullptr;
+
+SensorData::SensorData() {
+    this->loopDelay = 50;
+}
+
+SensorData::~SensorData() {
+    if (this->ntripClient)
+        delete this->ntripClient;
+}
+
+void SensorData::enableNtrip(String host, uint16_t port, String mountPoint, String user, String password) {
+    this->ntripClient = new NTRIPClient(this->gnss, host.c_str(), port, mountPoint.c_str(), user.c_str(), password.c_str());
+    this->ntripClient->gpsConfiguration();
+    this->ntripClient->loop();
+    this->ntripClient->setActivated(false);
+    this->isNtripInit = true;
+    this->addChildComponent(this->ntripClient);
+}
+
+void SensorData::enableGnss(SPIClass* spiPort, uint8_t csPin) {
+    this->gnss = new SFE_UBLOX_GNSS();
+    if (this->gnss->begin(*spiPort, csPin, 4000000) == false) {
+        std::cout << "u-blox GNSS not detected on SPI bus. Please check wiring. Freezing." << std::endl;
+        while (1);
+    }
+    this->initGnss();
+}
+
+void SensorData::enableGnss() {
+    this->gnss = new SFE_UBLOX_GNSS();
+    if (this->gnss->begin() == false) {
+        std::cout << "u-blox GNSS not detected at default I2C address. Please check wiring. Freezing." << std::endl;
+        while (1);
+    }
+    this->initGnss();
+}
+
+void SensorData::enableRealCompass() {
+    this->realCompass = new QMC5883LCompass();
+    // Init Compass
+    Wire.beginTransmission(0x0d);
+    Wire.write(0x0b);
+    Wire.write(0x01);
+    Wire.endTransmission();
+    this->realCompass->setMode(0x01,0x0C,0x10,0X00);
+    CalibrateCompass caliCompass(this->realCompass);
+    caliCompass.loadData();
+    caliCompass.useData();
+}
+
+void SensorData::enableCalcCompass() {
+
+}
+
+void SensorData::enableGyroskop() {
+    
+}
+
+CalcAzimuth::State SensorData::getCalcAzimuthState() const {
+    if (this->calcCompass)
+        return this->calcCompass->getState();
+    return CalcAzimuth::State::Invalid;
+}
+
+void SensorData::printPVTdata(UBX_NAV_PVT_data_t *ubxDataStruct) {
+    if (!SensorData::outputStatusPrintPVTdata)
+        return;
+
+    double latitude = (double) ubxDataStruct->lat / 10000000.0;
+    double longitude = (double) ubxDataStruct->lon / 10000000.0;
+    double altitude = (double) ubxDataStruct->hMSL / 1000.0;
+
+    uint8_t fixType = ubxDataStruct->fixType;
+    char fixTypeString[32];
+    if (fixType == 0)
+        strcpy(fixTypeString, "None");
+    else if (fixType == 1)
+        strcpy(fixTypeString, "Dead Reckoning");
+    else if (fixType == 2)
+        strcpy(fixTypeString, "2D");
+    else if (fixType == 3)
+        strcpy(fixTypeString, "3D");
+    else if (fixType == 3)
+        strcpy(fixTypeString, "GNSS + Dead Reckoning");
+    else if (fixType == 5)
+        strcpy(fixTypeString, "Time Only");
+    else
+        strcpy(fixTypeString, "UNKNOWN");
+
+    uint8_t carrSoln = ubxDataStruct->flags.bits.carrSoln;
+    char carrSolnString[16];
+    if (carrSoln == 0)
+        strcpy(carrSolnString, "None");
+    else if (carrSoln == 1)
+        strcpy(carrSolnString, "Floating");
+    else if (carrSoln == 2)
+        strcpy(carrSolnString, "Fixed");
+    else
+        strcpy(carrSolnString, "UNKNOWN");
+
+    uint32_t hAcc = ubxDataStruct->hAcc;
+
+    std::cout << "Lat: " << latitude
+              << " Lng: " << longitude
+              << " Alt: " << altitude << std::endl;
+
+    std::cout << "Fix: " << fixTypeString
+              << " Carrier Solution: " << carrSolnString
+              << " Horizontal Accuracy Estimate: " << hAcc << " mm" << std::endl;
+}
+
+void SensorData::savePVTdata(UBX_NAV_PVT_data_t *ubxDataStruct) {
+    SensorData::printPVTdata(ubxDataStruct);
+
+    SensorData::newData = true;
+    SensorData::ubxDataStatic = ubxDataStruct;
+    SensorData::ubxUpdateTimeStatic = millis();
+}
+
+void SensorData::setOutputStatusPrintPVTdata(bool status) {
+    SensorData::outputStatusPrintPVTdata = status;
+}
+
+void SensorData::run() {
+    this->realCompass->read();
+    this->realAzimuth = this->realCompass->getAzimuth();
+}
+
+void SensorData::runAsChild() {
+    this->gnss->checkUblox();
+    this->gnss->checkCallbacks();
+
+    if (SensorData::newData)
+        SensorData::newData = false;
+}
+
+void SensorData::initGnss() {
+    uint8_t versionHigh = this->gnss->getProtocolVersionHigh();
+    uint8_t versionLow = this->gnss->getProtocolVersionLow();
+    std::cout << "u-blox protocol version: " << unsigned(versionHigh) << "." << unsigned(versionLow) << std::endl;
+
+    this->gnss->setSPIOutput(COM_TYPE_UBX);
+    this->gnss->enableNMEAMessage(UBX_NMEA_GGA, COM_PORT_SPI, 10);
+    this->gnss->setUSBOutput(COM_TYPE_UBX | COM_TYPE_NMEA);
+    this->gnss->setAutoPVTcallbackPtr(&(SensorData::savePVTdata));
+    // SensorData::setOutputStatusPrintPVTdata(true);
+    this->gnss->setNavigationFrequency(1);
+    this->gnss->setAutoPVT(true);
+}