Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_EFI: correct EFI ignition_voltage flag values

This commit is contained in:
Peter Barker 2023-02-03 12:34:37 +11:00 committed by Andrew Tridgell
parent 1d57ada441
commit 9b8a61c048
2 changed files with 15 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
libraries/AP_EFI/AP_EFI.cpp
View File

@ -247,6 +247,19 @@ void AP_EFI::send_mavlink_status(mavlink_channel_t chan)
if (!backend) {
return;
}
float ignition_voltage;
if (isnan(state.ignition_voltage) ||
is_equal(state.ignition_voltage, -1.0f)) {
// zero means "unknown" in mavlink, 0.0001 means 0 volts
ignition_voltage = 0;
} else if (is_zero(state.ignition_voltage)) {
// zero means "unknown" in mavlink, 0.0001 means 0 volts
ignition_voltage = 0.0001f;
} else {
ignition_voltage = state.ignition_voltage;
};
mavlink_msg_efi_status_send(
chan,
AP_EFI::is_healthy(),
@ -266,7 +279,7 @@ void AP_EFI::send_mavlink_status(mavlink_channel_t chan)
KELVIN_TO_C(state.cylinder_status.exhaust_gas_temperature),
state.throttle_out,
state.pt_compensation,
state.ignition_voltage
ignition_voltage
);
}

2
libraries/AP_EFI/AP_EFI_State.h
View File

@ -199,7 +199,7 @@ struct EFI_State {
Cylinder_Status cylinder_status;
// ignition voltage in Volts
float ignition_voltage;
float ignition_voltage = -1; // -1 is "unknown";
// throttle output percentage
float throttle_out;