Navio2Sensor.hpp

Go to the documentation of this file.

// This file is part of INSTINCT, the INS Toolkit for Integrated
// Navigation Concepts and Training by the Institute of Navigation of
// the University of Stuttgart, Germany.
//
// This Source Code Form is subject to the terms of the Mozilla Public
// License, v. 2.0. If a copy of the MPL was not distributed with this
// file, You can obtain one at https://mozilla.org/MPL/2.0/.
 
 
#pragma once
 
#include "Nodes/DataProvider/IMU/Imu.hpp"
 
#if !__APPLE__ && !defined(WIN32) && !defined(_WIN32) && !defined(__WIN32)
    #include "Navio/Common/InertialSensor.h"
#endif
 
#include "util/CallbackTimer.hpp"
#include <chrono>
 
namespace NAV
{
class Navio2Sensor : public Imu
{
  public:
    Navio2Sensor();
    ~Navio2Sensor() override;
    Navio2Sensor(const Navio2Sensor&) = delete;
    Navio2Sensor(Navio2Sensor&&) = delete;
    Navio2Sensor& operator=(const Navio2Sensor&) = delete;
    Navio2Sensor& operator=(Navio2Sensor&&) = delete;
 
    [[nodiscard]] static std::string typeStatic();
 
    [[nodiscard]] std::string type() const override;
 
    [[nodiscard]] static std::string category();
 
    void guiConfig() override;
 
    [[nodiscard]] json save() const override;
 
    void restore(const json& j) override;
 
    bool resetNode() override;
 
  private:
    constexpr static size_t OUTPUT_PORT_INDEX_IMU_OBS = 0; 
 
    bool initialize() override;
 
    void deinitialize() override;
 
    enum ImuType : uint8_t
    {
        MPU,
        LSM
    };
 
#if !__APPLE__ && !defined(WIN32) && !defined(_WIN32) && !defined(__WIN32)
    std::unique_ptr<InertialSensor> _sensor;
#endif
 
    ImuType _imuType = ImuType::MPU;
 
    int _outputFrequency = 100;
 
    CallbackTimer _timer;
    std::chrono::time_point<std::chrono::steady_clock> _startTime;
 
    float _ax{};
    float _ay{};
    float _az{};
    float _gx{};
    float _gy{};
    float _gz{};
    float _mx{};
    float _my{};
    float _mz{};
 
    static void readImuThread(void* userData);
};
 
} // namespace NAV