mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-14 16:23:34 +08:00
fix level horizon feature:
allow attitude to settle for a while if changes to the board rotation parameters are done
This commit is contained in:
@@ -595,7 +595,8 @@ int do_level_calibration(int mavlink_fd) {
|
||||
param_get(pitch_offset_handle, &pitch_offset_current);
|
||||
param_get(board_rot_handle, &board_rot_current);
|
||||
|
||||
if (board_rot_current == 0) {
|
||||
// give attitude some time to settle if there have been changes to the board rotation parameters
|
||||
if (board_rot_current == 0 && fabsf(roll_offset_current) < FLT_EPSILON && fabsf(pitch_offset_current) < FLT_EPSILON ) {
|
||||
settle_time = 0;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user