Merge remote-tracking branch 'youby/master' into sim

McZapkie/MOVER.h

@@ -906,6 +906,7 @@ public:
 	TBrakeValve BrakeValve = TBrakeValve::NoValve;
 	TBrakeHandle BrakeHandle = TBrakeHandle::NoHandle;
 	TBrakeHandle BrakeLocHandle = TBrakeHandle::NoHandle;
+	bool LocHandleTimeTraxx = false; /*hamulec dodatkowy typu traxx*/
 	double MBPM = 1.0; /*masa najwiekszego cisnienia*/
 
 	std::shared_ptr<TBrake> Hamulec;
@@ -1145,6 +1146,7 @@ public:
 	double AccN = 0.0; // przyspieszenie normalne w [m/s^2]
 	double AccVert = 0.0; // vertical acceleration
 	double nrot = 0.0;
+	double nrot_eps = 0.0; //przyspieszenie kątowe kół (bez kierunku)
 	double WheelFlat = 0.0;
     bool TruckHunting { true }; // enable/disable truck hunting calculation
 	/*! rotacja kol [obr/s]*/
@@ -1320,6 +1322,7 @@ public:
     /*- zmienne dla lokomotyw z silnikami indukcyjnymi -*/
 	double eimic = 0; /*aktualna pozycja zintegrowanego sterowania jazda i hamowaniem*/
 	double eimic_real = 0; /*faktycznie uzywana pozycja zintegrowanego sterowania jazda i hamowaniem*/
+	double eim_localbrake = 0; /*nastawa hamowania dodatkowego pneumatycznego lokomotywy*/
 	int EIMCtrlType = 0; /*rodzaj wariantu zadajnika jazdy*/
 	bool SpeedCtrlTypeTime = false; /*czy tempomat sterowany czasowo*/
 	double eimv_pr = 0; /*realizowany procent dostepnej sily rozruchu/hamowania*/

McZapkie/Mover.cpp

@@ -613,7 +613,7 @@ bool TMoverParameters::Dettach(int ConnectNo)
 
 bool TMoverParameters::DirectionForward()
 {
-    if ((MainCtrlPosNo > 0) && (ActiveDir < 1) && (MainCtrlPos <= MaxMainCtrlPosNoDirChange) && (EIMDirectionChangeAllow()))
+    if ((MainCtrlPosNo > 0) && (ActiveDir < 1) && (EIMDirectionChangeAllow()))
     {
         ++ActiveDir;
         DirAbsolute = ActiveDir * CabNo;
@@ -2349,7 +2349,7 @@ bool TMoverParameters::DirectionBackward(void)
             DB = true; //
             return DB; // exit;  TODO: czy dobrze przetlumaczone?
         }
-    if ((MainCtrlPosNo > 0) && (ActiveDir > -1) && (MainCtrlPos <= MaxMainCtrlPosNoDirChange) && (EIMDirectionChangeAllow()))
+    if ((MainCtrlPosNo > 0) && (ActiveDir > -1) && (EIMDirectionChangeAllow()))
     {
         if (EngineType == TEngineType::WheelsDriven)
             CabNo--;
@@ -2367,7 +2367,11 @@ bool TMoverParameters::DirectionBackward(void)
 bool TMoverParameters::EIMDirectionChangeAllow(void)
 {
     bool OK = false;
+/*
+    // NOTE: disabled while eimic variables aren't immediately synced with master controller changes inside ai module
     OK = (EngineType != TEngineType::ElectricInductionMotor || ((eimic <= 0) && (eimic_real <= 0) && (Vel < 0.1)));
+*/
+    OK = ( MainCtrlPos <= MaxMainCtrlPosNoDirChange );
     return OK;
 }
 
@@ -3696,7 +3700,7 @@ void TMoverParameters::UpdatePipePressure(double dt)
     Pipe->Flow( temp * Hamulec->GetPF( temp * PipePress, dt, Vel ) + GetDVc( dt ) );
 
     if (ASBType == 128)
-        Hamulec->ASB(int(SlippingWheels));
+        Hamulec->ASB(int(SlippingWheels && (Vel>1))*(1+2*int(nrot_eps<-0.01)));
 
     dpPipe = 0;
 
@@ -3944,6 +3948,7 @@ void TMoverParameters::ComputeTotalForce(double dt) {
 
     // juz zoptymalizowane:
     FStand = FrictionForce(RunningShape.R, RunningTrack.DamageFlag); // siła oporów ruchu
+	double old_nrot = abs(nrot);
     nrot = v2n(); // przeliczenie prędkości liniowej na obrotową
 
     if( ( true == TestFlag( BrakeMethod, bp_MHS ) )
@@ -4016,8 +4021,9 @@ void TMoverParameters::ComputeTotalForce(double dt) {
 		}
 		else
 		{
-			Fb = -Fwheels*Sign(V);
-			FTrain = 0;
+			double factor = (FTrain - Fb * Sign(V) != 0 ? Fwheels/(FTrain - Fb * Sign(V)) : 1.0);
+			Fb *= factor;
+			FTrain *= factor;
 		}
 		if (nrot < 0.1)
 		{
@@ -4026,6 +4032,7 @@ void TMoverParameters::ComputeTotalForce(double dt) {
 
 		nrot = temp_nrot;
     }
+	nrot_eps = (abs(nrot) - (old_nrot))/dt;
     // doliczenie sił z innych pojazdów
     for( int end = end::front; end <= end::rear; ++end ) {
         if( Neighbours[ end ].vehicle != nullptr ) {
@@ -4318,6 +4325,7 @@ double TMoverParameters::CouplerForce( int const End, double dt ) {
                 // zderzenie
                 coupler.CheckCollision = true;
                 if( ( coupler.CouplerType == TCouplerType::Automatic )
+                 && ( coupler.CouplerType == othercoupler.CouplerType )
                  && ( coupler.CouplingFlag == coupling::faux ) ) {
                     // sprzeganie wagonow z samoczynnymi sprzegami
                     // EN57
@@ -6000,6 +6008,26 @@ void TMoverParameters::CheckEIMIC(double dt)
 		}
 		if (MainCtrlPos >= 3 && eimic < 0) eimic = 0;
 		if (MainCtrlPos <= 3 && eimic > 0) eimic = 0;
+		if (LocHandleTimeTraxx)
+		{
+			if (LocalBrakeRatio() < 0.05) //pozycja 0
+			{
+				eim_localbrake -= dt*0.17; //zmniejszanie
+			}
+
+			if (LocalBrakeRatio() > 0.15) //pozycja 2
+			{
+				eim_localbrake += dt*0.17; //wzrastanie
+				eim_localbrake = std::max(eim_localbrake, BrakePress / MaxBrakePress[0]);
+			}
+			else
+			{
+				if (eim_localbrake < Hamulec->GetEDBCP() / MaxBrakePress[0])
+					eim_localbrake = 0;
+			}
+			eim_localbrake = clamp(eim_localbrake, 0.0, 1.0);
+			if (eim_localbrake > 0.04 && eimic > 0) eimic = 0;
+		}
 		break;
 	case 2:
 		switch (MainCtrlPos)
@@ -8620,6 +8648,7 @@ void TMoverParameters::LoadFIZ_Cntrl( std::string const &line ) {
     extract_value( CoupledCtrl, "CoupledCtrl", line, "" );
 	extract_value( EIMCtrlType, "EIMCtrlType", line, "" );
 	clamp( EIMCtrlType, 0, 3 );
+	LocHandleTimeTraxx = (extract_value("LocalBrakeTraxx", line) == "Yes");
 
     extract_value( ScndS, "ScndS", line, "" ); // brak pozycji rownoleglej przy niskiej nastawie PSR
 

McZapkie/hamulce.cpp

@@ -391,7 +391,8 @@ void TBrake::SetEPS( double const nEPS )
 
 void TBrake::ASB( int const state )
 { // 255-b_asb(32)
-    BrakeStatus = (BrakeStatus & ~b_asb) | ( state * b_asb );
+    BrakeStatus = (BrakeStatus & ~b_asb) | ( (state / 2) * b_asb );
+	BrakeStatus = (BrakeStatus & ~b_asb_unbrake) | ( (state % 2) * b_asb_unbrake);
 }
 
 int TBrake::GetStatus()
@@ -1551,7 +1552,7 @@ double TEStED::GetPF( double const PP, double const dt, double const Vel )
     // powtarzacz — podwojny zawor zwrotny
     temp = Max0R(LoadC * BCP / temp * Min0R(Max0R(1 - EDFlag, 0), 1), LBP);
 	double speed = 1;
-	if ((ASBP < 0.1) && ((BrakeStatus & b_asb) == b_asb))
+	if ((ASBP < 0.1) && ((BrakeStatus & b_asb_unbrake) == b_asb_unbrake))
 	{
 		temp = 0;
 		speed = 3;
@@ -1559,7 +1560,7 @@ double TEStED::GetPF( double const PP, double const dt, double const Vel )
 
     if ((BrakeCyl->P() > temp))
         dv = -PFVd(BrakeCyl->P(), 0, 0.02 * SizeBC * speed, temp) * dt;
-    else if ((BrakeCyl->P() < temp))
+    else if ((BrakeCyl->P() < temp) && ((BrakeStatus & b_asb) == 0))
         dv = PFVa(BVP, BrakeCyl->P(), 0.02 * SizeBC, temp) * dt;
     else
         dv = 0;

McZapkie/hamulce.h

@@ -53,7 +53,8 @@ static int const b_on = 2;   //napelnianie
 static int const b_rfl = 4;   //uzupelnianie
 static int const b_rls = 8;   //odluzniacz
 static int const b_ep = 16;   //elektropneumatyczny
-static int const b_asb = 32;   //elektropneumatyczny   
+static int const b_asb = 32;   //przeciwposlizg-wstrzymanie
+static int const b_asb_unbrake = 64; //przeciwposlizg-luzowanie
 static int const b_dmg = 128;   //wylaczony z dzialania
 
 /*uszkodzenia hamulca*/