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

EKF: use common value for gravity

Browse Source
This commit is contained in:
Paul Riseborough 2016-04-12 07:56:06 +10:00
parent 163c08a3ac
commit 8c55e36ca9
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
EKF/ekf.cpp
View File

@ -628,7 +628,7 @@ void Ekf::calculateOutputStates()
Vector3f delta_vel_NED = _R_to_earth_now * delta_vel + _delta_vel_corr;
// corrrect for measured accceleration due to gravity
delta_vel_NED(2) += 9.81f * imu_new.delta_vel_dt;
delta_vel_NED(2) += _gravity_mss * imu_new.delta_vel_dt;
// save the previous velocity so we can use trapezidal integration
Vector3f vel_last = _output_new.vel;