fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-28 12:03:34 +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
Download Patch File Download Diff File Expand all files Collapse all files
test/integration.cpp
+4 -12
View File
@@ -5,28 +5,20 @@
using namespace matrix; using namespace matrix;
// instantiate template to ensure coverage check Vector<float, 6> f(float t, const Vector<float, 6> & y, const Vector<float, 3> & u);
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, Vector<float, 6> y); 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) {
return ones<float, 6, 1>(); return ones<float, 6, 1>();
} }
int main() int main()
{ {
Vector<float, 6> y = ones<float, 6, 1>(); Vector<float, 6> y = ones<float, 6, 1>();
Vector<float, 3> u = ones<float, 3, 1>();
float t = 1; float t = 1;
float h = 0.1f; float h = 0.1f;
y.T().print(); y.T().print();
integrate_rk4(f, y, t, h, y); integrate_rk4(f, y, u, t, h, y);
y.T().print(); y.T().print();
assert(y == (ones<float, 6, 1>()*1.1f)); assert(y == (ones<float, 6, 1>()*1.1f));
return 0; return 0;