ImuPos.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 "util/Eigen.hpp"
 
namespace NAV
{
// Forward declarations
class Imu;
class MultiImuFile;

class ImuPos
{
  public:
    [[nodiscard]] const Eigen::Vector3d& b_positionIMU_p() const
    {
        return _b_positionIMU_p;
    }

    [[nodiscard]] const Eigen::Quaterniond& b_quat_p() const
    {
        return _b_quat_p;
    }

    [[nodiscard]] Eigen::Quaterniond p_quat_b() const
    {
        return _b_quat_p.conjugate();
    }
 
  private:
    Eigen::Vector3d _b_positionIMU_p = Eigen::Vector3d::Zero();

    Eigen::Quaterniond _b_quat_p = Eigen::Quaterniond::Identity();
 
    friend class Imu;
    friend class MultiImuFile;
    friend void from_json(const json& j, ImuPos& pos);
};

void to_json(json& j, const ImuPos& pos);
void from_json(const json& j, ImuPos& pos);
 
} // namespace NAV