fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-26 16:23:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

Rvis transposed, in this way we have consisency

Browse Source
This commit is contained in:
Andrea Nistico
2015-04-24 16:45:17 +02:00
parent c5ce8f39ae
commit 1f5775615f
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/attitude_estimator_ekf/attitude_estimator_ekf_main.cpp
+2 -2
View File
@@ -465,8 +465,8 @@ int attitude_estimator_ekf_thread_main(int argc, char *argv[])
math::Vector<3> v(1.0f, 0.0f, 0.4f); math::Vector<3> v(1.0f, 0.0f, 0.4f);
math::Vector<3> vn = Rvis * v; math::Vector<3> vn = Rvis.transposed() * v; //Rvis is Rwr (robot respect to world) while v is respect to world. Hence Rvis must be transposed having (Rwr)' * Vw
// Rrw * Vw = vn. This way we have consistency
z_k[6] = vn(0); z_k[6] = vn(0);
z_k[7] = vn(1); z_k[7] = vn(1);
z_k[8] = vn(2); z_k[8] = vn(2);