mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-02 03:49:12 +08:00
mavlink receiver: battery status - publish cells voltage
This commit is contained in:
@@ -1729,7 +1729,8 @@ MavlinkReceiver::handle_message_battery_status(mavlink_message_t *msg)
|
|||||||
uint8_t cell_count = 0;
|
uint8_t cell_count = 0;
|
||||||
|
|
||||||
while (battery_mavlink.voltages[cell_count] < UINT16_MAX && cell_count < 10) {
|
while (battery_mavlink.voltages[cell_count] < UINT16_MAX && cell_count < 10) {
|
||||||
voltage_sum += (float)(battery_mavlink.voltages[cell_count]) / 1000.0f;
|
battery_status.voltage_cell_v[cell_count] = (float)(battery_mavlink.voltages[cell_count]) / 1000.0f;
|
||||||
|
voltage_sum += battery_status.voltage_cell_v[cell_count];
|
||||||
cell_count++;
|
cell_count++;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user