mirror of https://github.com/ArduPilot/ardupilot
AP_ICEngine: Update for AHRS NED changes
This commit is contained in:
parent
d71533dc2b
commit
42b6ca9eed
|
@ -152,7 +152,7 @@ void AP_ICEngine::update(void)
|
||||||
Vector3f pos;
|
Vector3f pos;
|
||||||
if (!should_run) {
|
if (!should_run) {
|
||||||
state = ICE_OFF;
|
state = ICE_OFF;
|
||||||
} else if (ahrs.get_relative_position_NED(pos)) {
|
} else if (ahrs.get_relative_position_NED_origin(pos)) {
|
||||||
if (height_pending) {
|
if (height_pending) {
|
||||||
height_pending = false;
|
height_pending = false;
|
||||||
initial_height = -pos.z;
|
initial_height = -pos.z;
|
||||||
|
@ -201,7 +201,7 @@ void AP_ICEngine::update(void)
|
||||||
if (state == ICE_START_HEIGHT_DELAY) {
|
if (state == ICE_START_HEIGHT_DELAY) {
|
||||||
// when disarmed we can be waiting for takeoff
|
// when disarmed we can be waiting for takeoff
|
||||||
Vector3f pos;
|
Vector3f pos;
|
||||||
if (ahrs.get_relative_position_NED(pos)) {
|
if (ahrs.get_relative_position_NED_origin(pos)) {
|
||||||
// reset initial height while disarmed
|
// reset initial height while disarmed
|
||||||
initial_height = -pos.z;
|
initial_height = -pos.z;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue