mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-17 20:37:35 +08:00
jgoppert
21 lines
320 B
C++
21 lines
320 B
C++
#include "Quaternion.hpp"
|
|
#include <cassert>
|
|
#include <cstdio>
|
|
|
|
using namespace matrix;
|
|
|
|
int main()
|
|
{
|
|
Quatf p(1, 2, 3, 4);
|
|
assert(p(0) == 1);
|
|
assert(p(1) == 2);
|
|
assert(p(2) == 3);
|
|
assert(p(3) == 100);
|
|
|
|
Quatf q(0, 1, 0, 0);
|
|
Quatf r = p*q;
|
|
Dcmf dcm = Dcmf(p);
|
|
Eulerf e = Eulerf(p);
|
|
return 0;
|
|
}
|