fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-02 05:04:08 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixed integration test.

Browse Source
This commit is contained in:
jgoppert 2015-11-12 15:15:31 -05:00
parent aa3a086cda
commit 0a110a1b02
1 changed files with 4 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
test/integration.cpp
View File

@ -5,28 +5,20 @@
using namespace matrix;
// instantiate template to ensure coverage check
template int integrate_rk4<float, 6>(
Vector<float, 6> (*f)(float, Vector<float, 6>),
const Vector<float, 6> & y0,
float t0,
float h,
Vector<float, 6> & y1
);
Vector<float, 6> f(float t, const Vector<float, 6> & y, const Vector<float, 3> & u);
Vector<float, 6> f(float t, Vector<float, 6> y);
Vector<float, 6> f(float t, Vector<float, 6> y) {
Vector<float, 6> f(float t, const Vector<float, 6> & y, const Vector<float, 3> & u) {
return ones<float, 6, 1>();
}
int main()
{
Vector<float, 6> y = ones<float, 6, 1>();
Vector<float, 3> u = ones<float, 3, 1>();
float t = 1;
float h = 0.1f;
y.T().print();
integrate_rk4(f, y, t, h, y);
integrate_rk4(f, y, u, t, h, y);
y.T().print();
assert(y == (ones<float, 6, 1>()*1.1f));
return 0;