mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-04 03:10:36 +08:00
Added kalman filter.
This commit is contained in:
+7
-3
@@ -1,15 +1,19 @@
|
||||
#include "Dcm.hpp"
|
||||
#include <assert.h>
|
||||
#include <stdio.h>
|
||||
|
||||
#include "matrix.hpp"
|
||||
|
||||
using namespace matrix;
|
||||
|
||||
int main()
|
||||
{
|
||||
Dcmf dcm;
|
||||
Quatf q = Quatf(dcm);
|
||||
Quatf q(1,0,0,0);
|
||||
dcm = Dcmf(q);
|
||||
Matrix3f I = eye<float, 3>();
|
||||
dcm = Dcmf(q);
|
||||
Eulerf e = Eulerf(dcm);
|
||||
return 0;
|
||||
}
|
||||
};
|
||||
|
||||
/* vim: set et fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : */
|
||||
|
||||
Reference in New Issue
Block a user