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

EKF2: Report zero as position until local pos is valid

Browse Source
This commit is contained in:
Lorenz Meier
2016-07-31 14:01:32 +02:00
parent c835fb36a6
commit a1c8585342
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/ekf2/ekf2_main.cpp
+2 -2
View File
@@ -745,8 +745,8 @@ void Ekf2::task_main()
// Position of body origin in local NED frame // Position of body origin in local NED frame
_ekf.get_position(pos); _ekf.get_position(pos);
lpos.x = pos[0]; lpos.x = (_ekf.local_position_is_valid()) ? pos[0] : 0.0f;
lpos.y = pos[1]; lpos.y = (_ekf.local_position_is_valid()) ? pos[1] : 0.0f;
lpos.z = pos[2]; lpos.z = pos[2];
// Velocity of body origin in local NED frame (m/s) // Velocity of body origin in local NED frame (m/s)