GCS_MAVLink: battery2 current is in 10*mAh over mavlink

This commit is contained in:
Tom Pittenger 2016-06-02 15:39:54 -07:00
parent a8c14e68da
commit 8b405e26ea
1 changed files with 7 additions and 1 deletions

View File

@ -1401,7 +1401,13 @@ void GCS_MAVLINK::send_parameter_value_all(const char *param_name, ap_var_type p
void GCS_MAVLINK::send_battery2(const AP_BattMonitor &battery)
{
if (battery.num_instances() > 1) {
mavlink_msg_battery2_send(chan, battery.voltage(1)*1000, battery.current_amps(1));
int16_t current;
if (battery.has_current(1)) {
current = battery.current_amps(1) * 100; // 10*mA
} else {
current = -1;
}
mavlink_msg_battery2_send(chan, battery.voltage(1)*1000, current);
}
}