aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_EFI: added fuel usage integration for Lutan EFI

Browse Source 
allows for EFI_COEF1 and EFI_COEF2 to be set to get fuel consumption
on GCS
This commit is contained in:
Andrew Tridgell 2022-05-14 20:12:23 +10:00
parent 3cb104f537
commit 234abece59
2 changed files with 15 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_EFI/AP_EFI.cpp
View File

@ -40,14 +40,14 @@ const AP_Param::GroupInfo AP_EFI::var_info[] = {
// @Param: _COEF1
// @DisplayName: EFI Calibration Coefficient 1
// @Description: Used to calibrate fuel flow for MS protocol (Slope)
// @Description: Used to calibrate fuel flow for MS protocol (Slope). This should be calculated from a log at constant fuel usage rate. Plot (ECYL[0].InjT*EFI.Rpm)/600.0 to get the duty_cycle. Measure actual fuel usage in cm^3/min, and set EFI_COEF1 = fuel_usage_cm3permin / duty_cycle
// @Range: 0 1
// @User: Advanced
AP_GROUPINFO("_COEF1", 2, AP_EFI, coef1, 0),
// @Param: _COEF2
// @DisplayName: EFI Calibration Coefficient 2
// @Description: Used to calibrate fuel flow for MS protocol (Offset)
// @Description: Used to calibrate fuel flow for MS protocol (Offset). This can be used to correct for a non-zero offset in the fuel consumption calculation of EFI_COEF1
// @Range: 0 10
// @User: Advanced
AP_GROUPINFO("_COEF2", 3, AP_EFI, coef2, 0),

14
libraries/AP_EFI/AP_EFI_Serial_Lutan.cpp
View File

@ -24,6 +24,9 @@
#include <AP_Math/AP_Math.h>
#include <AP_SerialManager/AP_SerialManager.h>
// RPM Threshold for fuel consumption estimator
#define RPM_THRESHOLD 100
extern const AP_HAL::HAL &hal;
AP_EFI_Serial_Lutan::AP_EFI_Serial_Lutan(AP_EFI &_frontend):
@ -63,7 +66,6 @@ void AP_EFI_Serial_Lutan::update()
const uint32_t crc2 = ~crc_crc32(~0U, &pkt[2], length);
if (crc == crc2) {
// valid data
internal_state.last_updated_ms = now;
internal_state.spark_dwell_time_ms = int16_t(be16toh(data.dwell))*0.1;
internal_state.cylinder_status[0].injection_time_ms = be16toh(data.pulseWidth1)*0.00666;
internal_state.engine_speed_rpm = be16toh(data.rpm);
@ -74,6 +76,16 @@ void AP_EFI_Serial_Lutan::update()
// CHT is in coolant field
internal_state.cylinder_status[0].cylinder_head_temperature = internal_state.coolant_temperature;
internal_state.throttle_position_percent = int16_t(be16toh(data.tps))*0.1;
// integrate fuel consumption
if (internal_state.engine_speed_rpm > RPM_THRESHOLD) {
const float duty_cycle = (internal_state.cylinder_status[0].injection_time_ms * internal_state.engine_speed_rpm)/600.0f;
internal_state.fuel_consumption_rate_cm3pm = duty_cycle*get_coef1() - get_coef2();
internal_state.estimated_consumed_fuel_volume_cm3 += internal_state.fuel_consumption_rate_cm3pm * (now - internal_state.last_updated_ms)/60000.0f;
} else {
internal_state.fuel_consumption_rate_cm3pm = 0;
}
internal_state.last_updated_ms = now;
copy_to_frontend();
}
pkt_nbytes = 0;