diff --git a/McZapkie/MOVER.h b/McZapkie/MOVER.h index 2bf11d38..82a48f4a 100644 --- a/McZapkie/MOVER.h +++ b/McZapkie/MOVER.h @@ -1715,6 +1715,9 @@ class TMoverParameters /*- zmienne dla lokomotyw z silnikami indukcyjnymi -*/ double eimic = 0; /*aktualna pozycja zintegrowanego sterowania jazda i hamowaniem*/ + double eimtcp = 0; /* target controller position - docelowa pozycja nastawnika */ + double eimic_last = 0; /* ostatnia pozycja eimtcp przy obliczeniach */ + double eimtcptau = 0.0; /* stała czasowa układu bezwladnosci falownika */ double eimic_analog = 0; /*pozycja zadajnika analogowa*/ double eimic_real = 0; /*faktycznie uzywana pozycja zintegrowanego sterowania jazda i hamowaniem*/ double eim_localbrake = 0; /*nastawa hamowania dodatkowego pneumatycznego lokomotywy*/ diff --git a/McZapkie/Mover.cpp b/McZapkie/Mover.cpp index e381a059..ccde0754 100644 --- a/McZapkie/Mover.cpp +++ b/McZapkie/Mover.cpp @@ -7328,7 +7328,20 @@ void TMoverParameters::CheckEIMIC(double dt) { eimic = (LocalBrakeRatio() > 0.01 ? -LocalBrakeRatio() : eimic); } + case 4: // vectron + // TARGET + eimtcp = (LocalBrakeRatio() > 0.01 ? -LocalBrakeRatio() : (eimic_analog > 0.01 ? eimic_analog : (double)MainCtrlPos / (double)MainCtrlPosNo)); + if ((eimtcp > 0.001) && SpeedCtrlUnit.IsActive) + eimtcp = std::max(eimtcp, SpeedCtrlUnit.MinPower); + + // smoothing + double alpha = std::clamp(dt / eimtcptau, 0.0, 1.0); + double newValue = eimic_last + (eimtcp - eimic_last) * alpha; + if (std::abs(newValue) < 0.05 && eimtcp == 0.0) + newValue = 0.0; + eimic = newValue; + eimic_last = newValue; } if (LocHandleTimeTraxx) { @@ -10719,7 +10732,9 @@ void TMoverParameters::LoadFIZ_Cntrl( std::string const &line ) { EIMCtrlType = clamp( EIMCtrlType, 0, 3 ); extract_value( LocHandleTimeTraxx, "LocalBrakeTraxx", line, "" ); extract_value( EIMCtrlAdditionalZeros, "EIMCtrlAddZeros", line, "" ); - extract_value( EIMCtrlEmergency, "EIMCtrlEmergency", line, ""); + extract_value( EIMCtrlEmergency, "EIMCtrlEmergency", line, ""); + extract_value( eimtcptau, "EIMTau", line, ""); + extract_value( ScndS, "ScndS", line, "" ); // brak pozycji rownoleglej przy niskiej nastawie PSR