dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

esc_calibration: use batter status connected flag instead of checking voltage 

Signed-off-by: Roman <bapstroman@gmail.com>
This commit is contained in:
Roman 2018-04-23 16:42:58 +02:00 committed by Lorenz Meier
parent beb8c3e152
commit 73577df994
1 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
src/modules/commander/esc_calibration.cpp
View File

@ -114,8 +114,8 @@ int do_esc_calibration(orb_advert_t *mavlink_log_pub, struct actuator_armed_s* a
// Make sure battery is disconnected
if (orb_copy(ORB_ID(battery_status), batt_sub, &battery) == PX4_OK) {
// battery is not connected if voltage is lower than 3V and we have a recent battery measurement
if (battery.voltage_filtered_v < 3.0f && (hrt_absolute_time() - battery.timestamp < 500*1000)) {
// battery is not connected if the connected flag is not set and we have a recent battery measurement
if (!battery.connected && (hrt_absolute_time() - battery.timestamp < 500_ms)) {
batt_connected = false;
}
}
@ -175,7 +175,7 @@ int do_esc_calibration(orb_advert_t *mavlink_log_pub, struct actuator_armed_s* a
orb_check(batt_sub, &batt_updated);
if (batt_updated) {
orb_copy(ORB_ID(battery_status), batt_sub, &battery);
if (battery.voltage_filtered_v > 3.0f) {
if (battery.connected) {
// Battery is connected, signal to user and start waiting again
batt_connected = true;
timeout_start = hrt_absolute_time();