esc_calibration: use hrt_elapsed_time instead of manually calculating the diff

Signed-off-by: Roman <bapstroman@gmail.com>
This commit is contained in:
Roman 2018-04-23 16:43:22 +02:00 committed by Lorenz Meier
parent 73577df994
commit 5d87eed41c

View File

@ -161,7 +161,7 @@ int do_esc_calibration(orb_advert_t *mavlink_log_pub, struct actuator_armed_s* a
// sit high.
hrt_abstime timeout_wait = batt_connected ? pwm_high_timeout : battery_connect_wait_timeout;
if (hrt_absolute_time() - timeout_start > timeout_wait) {
if (hrt_elapsed_time(&timeout_start) > timeout_wait) {
if (!batt_connected) {
calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, "Timeout waiting for battery");
goto Error;