mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-28 21:13:34 +08:00
Added hysteresis to still detector
This commit is contained in:
@@ -274,7 +274,9 @@ int detect_orientation(int mavlink_fd, int sub_sensor_combined) {
|
|||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
} else {
|
} else if ( accel_disp[0] > still_thr_raw2 * 2.0f ||
|
||||||
|
accel_disp[1] > still_thr_raw2 * 2.0f ||
|
||||||
|
accel_disp[2] > still_thr_raw2 * 2.0f) {
|
||||||
/* not still, reset still start time */
|
/* not still, reset still start time */
|
||||||
if (t_still != 0) {
|
if (t_still != 0) {
|
||||||
mavlink_log_info(mavlink_fd, "moving");
|
mavlink_log_info(mavlink_fd, "moving");
|
||||||
|
|||||||
Reference in New Issue
Block a user