Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-11 02:18:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

Plane: quadplane: double log QPOS state change

Browse Source
This commit is contained in:
Iampete1 2022-02-19 22:21:52 +00:00 committed by Randy Mackay
parent dab83e292e
commit 2a7e0e225e
1 changed files with 7 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
ArduPlane/quadplane.cpp
View File

@ -2162,6 +2162,7 @@ void QuadPlane::log_QPOS(void)
*/
void QuadPlane::PosControlState::set_state(enum position_control_state s)
{
const uint32_t now = AP_HAL::millis();
if (state != s) {
auto &qp = plane.quadplane;
pilot_correction_done = false;
@ -2183,14 +2184,17 @@ void QuadPlane::PosControlState::set_state(enum position_control_state s)
Vector2f rpos;
last_pos_reset_ms = plane.ahrs.getLastPosNorthEastReset(rpos);
}
// double log to capture the state change
qp.log_QPOS();
state = s;
qp.log_QPOS();
last_log_ms = now;
}
state = s;
last_state_change_ms = AP_HAL::millis();
last_state_change_ms = now;
// we consider setting the state to be equivalent to running to
// prevent code from overriding the state as stale
last_run_ms = last_state_change_ms;
last_run_ms = now;
}
/*