mirror of
https://github.com/dragonpilot/dragonpilot.git
synced 2026-07-18 03:12:05 +08:00
Dragonpilot Team
46a47f2580
version: dragonpilot v2022.09.07 release for EON/C2
date: 2022-09-07T07:01:54
dp-dev(priv2) beta2 commit: 30a852791f
18 lines
735 B
C++
18 lines
735 B
C++
#pragma once
|
|
#include <eigen3/Eigen/Dense>
|
|
#include "coordinates.hpp"
|
|
|
|
|
|
Eigen::Quaterniond ensure_unique(Eigen::Quaterniond quat);
|
|
|
|
Eigen::Quaterniond euler2quat(Eigen::Vector3d euler);
|
|
Eigen::Vector3d quat2euler(Eigen::Quaterniond quat);
|
|
Eigen::Matrix3d quat2rot(Eigen::Quaterniond quat);
|
|
Eigen::Quaterniond rot2quat(const Eigen::Matrix3d &rot);
|
|
Eigen::Matrix3d euler2rot(Eigen::Vector3d euler);
|
|
Eigen::Vector3d rot2euler(const Eigen::Matrix3d &rot);
|
|
Eigen::Matrix3d rot_matrix(double roll, double pitch, double yaw);
|
|
Eigen::Matrix3d rot(Eigen::Vector3d axis, double angle);
|
|
Eigen::Vector3d ecef_euler_from_ned(ECEF ecef_init, Eigen::Vector3d ned_pose);
|
|
Eigen::Vector3d ned_euler_from_ecef(ECEF ecef_init, Eigen::Vector3d ecef_pose);
|