mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-02 05:04:08 +08:00
20 lines
421 B
C++
20 lines
421 B
C++
#include "test_macros.hpp"
|
|
#include <matrix/math.hpp>
|
|
|
|
using namespace matrix;
|
|
|
|
int main()
|
|
{
|
|
Euler<float> euler(0.1f, 0.2f, 0.3f);
|
|
Dcm<float> R(euler);
|
|
Dcm<float> skew = R - R.T();
|
|
Vector3<float> w = skew.vee();
|
|
Vector3<float> w_check(0.1348f, 0.4170f, 0.5647f);
|
|
|
|
TEST(isEqual(w, w_check));
|
|
TEST(isEqual(skew, w.hat()));
|
|
return 0;
|
|
}
|
|
|
|
/* vim: set et fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : */
|