Code development platform for open source projects from the European Union institutions :large_blue_circle: EU Login authentication by SMS will be completely phased out by mid-2025. To see alternatives please check here

Skip to content
Snippets Groups Projects
Commit 56f1b5e7 authored by Michael KRISPER's avatar Michael KRISPER
Browse files

autoformat

parent 5b3c9f46
No related branches found
No related tags found
No related merge requests found
Hide whitespace changes
Inline Side-by-side
VectoCore/Models/SimulationComponent/Impl/CombustionEngine.cs
+ 153
− 152
View file @ 56f1b5e7
......@@ -8,178 +8,179 @@ using TUGraz.VectoCore.Utils;
namespace TUGraz.VectoCore.Models.SimulationComponent.Impl
{
public class CombustionEngine : VectoSimulationComponent, ICombustionEngine, ITnOutPort
{
private const int EngineIdleSpeedStopThreshold = 100;
private const double MaxPowerExceededThreshold = 1.05;
private const double ZeroThreshold = 0.0001;
private const double FullLoadMargin = 0.01;
public enum EngineOperationMode
{
Idle,
Drag,
FullDrag,
Load,
FullLoad,
Stopped,
Undef
}
public class CombustionEngine : VectoSimulationComponent, ICombustionEngine, ITnOutPort
{
private const int EngineIdleSpeedStopThreshold = 100;
private const double MaxPowerExceededThreshold = 1.05;
private const double ZeroThreshold = 0.0001;
private const double FullLoadMargin = 0.01;
public enum EngineOperationMode
{
Idle,
Drag,
FullDrag,
Load,
FullLoad,
Stopped,
Undef
}
private CombustionEngineData _data;
private CombustionEngineData _data;
private EngineState _previousState = new EngineState();
private EngineState _currentState = new EngineState(); // current state is computed in request method
private EngineState _previousState = new EngineState();
private EngineState _currentState = new EngineState(); // current state is computed in request method
private List<TimeSpan> _enginePowerCorrections = new List<TimeSpan>();
private List<TimeSpan> _enginePowerCorrections = new List<TimeSpan>();
public CombustionEngine(CombustionEngineData data)
{
_data = data;
public CombustionEngine(CombustionEngineData data)
{
_data = data;
_previousState.OperationMode = EngineOperationMode.Idle;
_previousState.EnginePower = 0;
_previousState.EngineSpeed = _data.IdleSpeed;
}
_previousState.OperationMode = EngineOperationMode.Idle;
_previousState.EnginePower = 0;
_previousState.EngineSpeed = _data.IdleSpeed;
}
public ITnOutPort OutShaft()
{
return this;
}
{
return this;
}
public override void CommitSimulationStep(IModalDataWriter writer)
{
writer[ModalResultField.PaEng] = _currentState.EnginePowerLoss;
_previousState = _currentState;
_currentState = new EngineState();
}
public override void CommitSimulationStep(IModalDataWriter writer)
{
writer[ModalResultField.PaEng] = _currentState.EnginePowerLoss;
_previousState = _currentState;
_currentState = new EngineState();
}
public void Request(TimeSpan absTime, TimeSpan dt, double torque, double engineSpeed)
{
_currentState.EngineSpeed = engineSpeed;
_currentState.AbsTime = absTime;
_currentState.EngineSpeed = engineSpeed;
_currentState.AbsTime = absTime;
var requestedPower = VectoMath.ConvertRpmToPower(engineSpeed, torque);
var enginePowerLoss = InertiaPowerLoss(torque, engineSpeed);
var requestedEnginePower = requestedPower + enginePowerLoss;
if (engineSpeed < _data.IdleSpeed - EngineIdleSpeedStopThreshold)
{
_currentState.OperationMode = EngineOperationMode.Stopped;
_currentState.EnginePowerLoss = enginePowerLoss;
}
uint currentGear = 0; // TODO: get current Gear from Vehicle!
var minEnginePower = _data.GetFullLoadCurve(currentGear).DragLoadStationaryPower(engineSpeed);
var maxEnginePower = FullLoadPowerDyamic(currentGear, engineSpeed);
ValidatePowerDemand(requestedEnginePower, maxEnginePower, minEnginePower);
requestedEnginePower = LimitEnginePower(requestedEnginePower, maxEnginePower, minEnginePower);
UpdateEngineState(requestedEnginePower, maxEnginePower, minEnginePower);
}
protected void ValidatePowerDemand(double requestedEnginePower, double maxEnginePower, double minEnginePower)
{
if (minEnginePower >= 0 && requestedEnginePower < 0)
{
throw new VectoSimulationException(String.Format("t: {0} P_engine_drag > 0! n: {1} [1/min] ", _currentState.AbsTime, _currentState.EngineSpeed));
}
if (maxEnginePower <= 0 && requestedEnginePower > 0)
{
throw new VectoSimulationException(String.Format("t: {0} P_engine_full < 0! n: {1} [1/min] ", _currentState.AbsTime, _currentState.EngineSpeed));
}
}
var requestedPower = VectoMath.ConvertRpmToPower(engineSpeed, torque);
var enginePowerLoss = InertiaPowerLoss(torque, engineSpeed);
var requestedEnginePower = requestedPower + enginePowerLoss;
protected double LimitEnginePower(double requestedEnginePower, double maxEnginePower, double minEnginePower)
{
if (requestedEnginePower > maxEnginePower)
{
if (requestedEnginePower / maxEnginePower > MaxPowerExceededThreshold)
{
_enginePowerCorrections.Add(_currentState.AbsTime);
Log.WarnFormat("t: {0} requested power > P_engine_full * 1.05 - corrected. P_request: {1} P_engine_full: {2}", _currentState.AbsTime, requestedEnginePower, maxEnginePower);
return maxEnginePower;
}
}
else if (requestedEnginePower < minEnginePower)
{
if (requestedEnginePower / minEnginePower > MaxPowerExceededThreshold && requestedEnginePower > -99999)
{
_enginePowerCorrections.Add(_currentState.AbsTime);
Log.WarnFormat("t: {0} requested power < P_engine_drag * 1.05 - corrected. P_request: {1} P_engine_drag: {2}", _currentState.AbsTime, requestedEnginePower, minEnginePower);
return minEnginePower;
}
}
return requestedEnginePower;
if (engineSpeed < _data.IdleSpeed - EngineIdleSpeedStopThreshold) {
_currentState.OperationMode = EngineOperationMode.Stopped;
_currentState.EnginePowerLoss = enginePowerLoss;
}
uint currentGear = 0; // TODO: get current Gear from Vehicle!
}
var minEnginePower = _data.GetFullLoadCurve(currentGear).DragLoadStationaryPower(engineSpeed);
var maxEnginePower = FullLoadPowerDyamic(currentGear, engineSpeed);
protected void UpdateEngineState(double requestedEnginePower, double maxEnginePower, double minEnginePower)
{
if (requestedEnginePower < -ZeroThreshold)
{
_currentState.OperationMode = IsFullLoad(requestedEnginePower, maxEnginePower)
? EngineOperationMode.FullLoad
: EngineOperationMode.Load;
}
else if (requestedEnginePower > ZeroThreshold)
{
_currentState.OperationMode = IsFullLoad(requestedEnginePower, minEnginePower)
? EngineOperationMode.FullDrag
: EngineOperationMode.Drag;
}
else
{
// -ZeroThreshold <= requestedEnginePower <= ZeroThreshold
_currentState.OperationMode = EngineOperationMode.Idle;
}
}
ValidatePowerDemand(requestedEnginePower, maxEnginePower, minEnginePower);
public IList<string> Warnings()
{
IList<string> retVal = new List<string>();
retVal.Add(string.Format("Engine power corrected (>5%) in {0} time steps ", _enginePowerCorrections.Count));
return retVal;
}
requestedEnginePower = LimitEnginePower(requestedEnginePower, maxEnginePower, minEnginePower);
protected double FullLoadPowerDyamic(uint gear, double rpm)
{
var staticFullLoadPower = _data.GetFullLoadCurve(gear).FullLoadStationaryPower(rpm);
var pt1 = _data.GetFullLoadCurve(gear).PT1(rpm);
UpdateEngineState(requestedEnginePower, maxEnginePower, minEnginePower);
return Math.Min((1 / (pt1 + 1)) * (staticFullLoadPower + pt1 * _previousState.EnginePower),
staticFullLoadPower);
}
protected void ValidatePowerDemand(double requestedEnginePower, double maxEnginePower, double minEnginePower)
{
if (minEnginePower >= 0 && requestedEnginePower < 0)
{
throw new VectoSimulationException(String.Format("t: {0} P_engine_drag > 0! n: {1} [1/min] ", _currentState.AbsTime, _currentState.EngineSpeed));
}
if (maxEnginePower <= 0 && requestedEnginePower > 0)
{
throw new VectoSimulationException(String.Format("t: {0} P_engine_full < 0! n: {1} [1/min] ", _currentState.AbsTime, _currentState.EngineSpeed));
}
}
protected double LimitEnginePower(double requestedEnginePower, double maxEnginePower, double minEnginePower)
{
if (requestedEnginePower > maxEnginePower)
{
if (requestedEnginePower / maxEnginePower > MaxPowerExceededThreshold)
{
_enginePowerCorrections.Add(_currentState.AbsTime);
Log.WarnFormat("t: {0} requested power > P_engine_full * 1.05 - corrected. P_request: {1} P_engine_full: {2}", _currentState.AbsTime, requestedEnginePower, maxEnginePower);
return maxEnginePower;
}
}
else if (requestedEnginePower < minEnginePower)
{
if (requestedEnginePower / minEnginePower > MaxPowerExceededThreshold && requestedEnginePower > -99999)
{
_enginePowerCorrections.Add(_currentState.AbsTime);
Log.WarnFormat("t: {0} requested power < P_engine_drag * 1.05 - corrected. P_request: {1} P_engine_drag: {2}", _currentState.AbsTime, requestedEnginePower, minEnginePower);
return minEnginePower;
}
}
return requestedEnginePower;
}
protected void UpdateEngineState(double requestedEnginePower, double maxEnginePower, double minEnginePower)
{
if (requestedEnginePower < -ZeroThreshold)
{
_currentState.OperationMode = IsFullLoad(requestedEnginePower, maxEnginePower)
? EngineOperationMode.FullLoad
: EngineOperationMode.Load;
}
else if (requestedEnginePower > ZeroThreshold)
{
_currentState.OperationMode = IsFullLoad(requestedEnginePower, minEnginePower)
? EngineOperationMode.FullDrag
: EngineOperationMode.Drag;
}
else
{
// -ZeroThreshold <= requestedEnginePower <= ZeroThreshold
_currentState.OperationMode = EngineOperationMode.Idle;
}
}
public IList<string> Warnings()
{
IList<string> retVal = new List<string>();
retVal.Add(string.Format("Engine power corrected (>5%) in {0} time steps ", _enginePowerCorrections.Count));
return retVal;
}
protected double FullLoadPowerDyamic(uint gear, double rpm)
{
var staticFullLoadPower = _data.GetFullLoadCurve(gear).FullLoadStationaryPower(rpm);
var pt1 = _data.GetFullLoadCurve(gear).PT1(rpm);
return Math.Min( (1 / (pt1 + 1)) * (staticFullLoadPower + pt1 * _previousState.EnginePower),
staticFullLoadPower);
}
protected bool IsFullLoad(double requestedPower, double maxPower)
{
return Math.Abs(requestedPower / maxPower - 1.0) < FullLoadMargin;
}
protected double InertiaPowerLoss(double torque, double engineSpeed)
{
var deltaEngineSpeed = engineSpeed - _previousState.EngineSpeed;
var avgEngineSpeed = (_previousState.EngineSpeed + engineSpeed) / 2.0;
return _data.Inertia*VectoMath.RpmTpAngularVelocity(deltaEngineSpeed)*VectoMath.RpmTpAngularVelocity(avgEngineSpeed);
}
// accelleration los rotation engine
//Return (ENG.I_mot * (nU - nUBefore) * 0.01096 * ((nU + nUBefore) / 2)) * 0.001
public class EngineState
{
public EngineOperationMode OperationMode { get; set; }
public double EnginePower { get; set; }
public double EngineSpeed { get; set; }
public double EnginePowerLoss { get; set; }
public TimeSpan AbsTime { get; set; }
}
}
protected bool IsFullLoad(double requestedPower, double maxPower)
{
return Math.Abs(requestedPower / maxPower - 1.0) < FullLoadMargin;
}
protected double InertiaPowerLoss(double torque, double engineSpeed)
{
var deltaEngineSpeed = engineSpeed - _previousState.EngineSpeed;
var avgEngineSpeed = (_previousState.EngineSpeed + engineSpeed) / 2.0;
return _data.Inertia * VectoMath.RpmTpAngularVelocity(deltaEngineSpeed) * VectoMath.RpmTpAngularVelocity(avgEngineSpeed);
}
// accelleration los rotation engine
//Return (ENG.I_mot * (nU - nUBefore) * 0.01096 * ((nU + nUBefore) / 2)) * 0.001
public class EngineState
{
public EngineOperationMode OperationMode { get; set; }
public double EnginePower { get; set; }
public double EngineSpeed { get; set; }
public double EnginePowerLoss { get; set; }
public TimeSpan AbsTime { get; set; }
}
}
}
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment

For further information about the platform and support, please see https://code.europa.eu/info/about