mirror of https://github.com/FOME-Tech/fome-fw.git
49 lines
1.2 KiB
C++
49 lines
1.2 KiB
C++
#include "injector_model.h"
|
|
|
|
EXTERN_ENGINE;
|
|
|
|
void InjectorModelBase::prepare() {
|
|
m_massFlowRate = getInjectorMassFlowRate();
|
|
float deadtime = getDeadtime();
|
|
m_deadtime = deadtime;
|
|
|
|
postState(deadtime);
|
|
}
|
|
|
|
constexpr float convertToGramsPerSecond(float ccPerMinute) {
|
|
float ccPerSecond = ccPerMinute / 60;
|
|
return ccPerSecond * 0.72f; // 0.72g/cc fuel density
|
|
}
|
|
|
|
float InjectorModel::getInjectorMassFlowRate() const {
|
|
// TODO: injector flow dependent upon rail pressure (and temperature/ethanol content?)
|
|
auto injectorVolumeFlow = CONFIG(injector.flow);
|
|
return convertToGramsPerSecond(injectorVolumeFlow);
|
|
}
|
|
|
|
float InjectorModel::getDeadtime() const {
|
|
return interpolate2d(
|
|
"lag",
|
|
ENGINE(sensors.vBatt),
|
|
engineConfiguration->injector.battLagCorrBins,
|
|
engineConfiguration->injector.battLagCorr
|
|
);
|
|
}
|
|
|
|
void InjectorModel::postState(float deadtime) const {
|
|
engine->engineState.running.injectorLag = deadtime;
|
|
}
|
|
|
|
float InjectorModelBase::getInjectionDuration(float fuelMassGram) const {
|
|
// TODO: support injector nonlinearity correction
|
|
|
|
floatms_t baseDuration = fuelMassGram / m_massFlowRate * 1000;
|
|
|
|
if (baseDuration <= 0) {
|
|
// If 0 duration, don't add deadtime, just skip the injection.
|
|
return 0.0f;
|
|
} else {
|
|
return baseDuration + m_deadtime;
|
|
}
|
|
}
|