Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_TECS: Update for AHRS NED changes

This commit is contained in:
Michael du Breuil 2017-01-30 12:07:48 -07:00 committed by Andrew Tridgell
parent 95edf6ab66
commit 666c63da9f
1 changed files with 2 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_TECS/AP_TECS.cpp
View File

@ -272,12 +272,8 @@ void AP_TECS::update_50hz(void)
if we have a vertical position estimate from the EKF then use
it, otherwise use barometric altitude
*/
Vector3f posned;
if (_ahrs.get_relative_position_NED(posned)) {
_height = - posned.z;
} else {
_height = _ahrs.get_baro().get_altitude();
}
_ahrs.get_relative_position_D_home(_height);
_height *= -1.0f;
// Calculate time in seconds since last update
uint64_t now = AP_HAL::micros64();