diff --git a/McZapkie/Mover.cpp b/McZapkie/Mover.cpp index af03bdd8..4d74017d 100644 --- a/McZapkie/Mover.cpp +++ b/McZapkie/Mover.cpp @@ -6484,7 +6484,7 @@ bool TMoverParameters::LoadFIZ(std::string chkpath) eMaxCP = atof(getkeyval(3, "MaxCP").c_str()); eBCS = atof(getkeyval(3, "BCS").c_str()); eBSA = atof(getkeyval(3, "BSA").c_str()); - eBM = atof(getkeyval(1, "BM").c_str()); + eBM = (getkeyval(1, "BM")); eBVV = atoi(getkeyval(2, "BVV").c_str()); eBRE = atof(getkeyval(3, "BRE").c_str()); eHiPP = atof(getkeyval(3, "HiPP").c_str()); diff --git a/McZapkie/Oerlikon_ESt.cpp b/McZapkie/Oerlikon_ESt.cpp index 1297d5a1..953982df 100644 --- a/McZapkie/Oerlikon_ESt.cpp +++ b/McZapkie/Oerlikon_ESt.cpp @@ -230,7 +230,7 @@ double TNESt3::GetPF(double PP, double dt, double Vel) // przeplyw miedzy komora MPP = Miedzypoj->P(); dV1 = 0; - nastG = (BrakeDelayFlag & bdelay_G); + nastG = static_cast(BrakeDelayFlag & bdelay_G); // sprawdzanie stanu CheckState(BCP, dV1); @@ -245,8 +245,8 @@ double TNESt3::GetPF(double PP, double dt, double Vel) // przeplyw miedzy komora // BrakeCyl.Flow(-dV); Przekladniki[1]->Flow(-dV); if (((BrakeStatus & b_on) == b_on) && (Przekladniki[1]->P() * HBG300 < MaxBP)) - dV = PF(BVP, BCP, Nozzles[dTN] * (nastG + 2 * short(BCP < Podskok)) + - Nozzles[dON] * (1 - nastG)) * + dV = PF(BVP, BCP, + Nozzles[dTN] * (nastG + 2 * short(BCP < Podskok)) + Nozzles[dON] * (1 - nastG)) * dt * (0.1 + 4.9 * Min0R(0.2, (CVP - 0.05 - VVP) * BVM - BCP)); else dV = 0; @@ -255,8 +255,7 @@ double TNESt3::GetPF(double PP, double dt, double Vel) // przeplyw miedzy komora BrakeRes->Flow(dV); { - short i_end = 4; - for (i = 1; i < i_end; ++i) + for (i = 1; i < 4; ++i) { Przekladniki[i]->Update(dt); if (typeid(*Przekladniki[i]) == typeid(TRapid)) @@ -272,7 +271,7 @@ double TNESt3::GetPF(double PP, double dt, double Vel) // przeplyw miedzy komora if ((Vel < -15)) Przekladniki[i]->SetP(0); else - Przekladniki[i]->SetP(MaxBP * 3); + Przekladniki[i]->SetP(MaxBP * 3); else if (typeid(*Przekladniki[i]) == typeid(TPrzekCiagly)) Przekladniki[i]->SetMult(LoadC); else if (typeid(*Przekladniki[i]) == typeid(TPrzek_PZZ)) @@ -283,9 +282,9 @@ double TNESt3::GetPF(double PP, double dt, double Vel) // przeplyw miedzy komora // przeplyw testowy miedzypojemnosci dV = PF(MPP, VVP, BVs(BCP)) + PF(MPP, CVP, CVs(BCP)); if ((MPP - 0.05 > BVP)) - dV = dV + PF(MPP - 0.05, BVP, Nozzles[dPT] * nastG + (1 - nastG) * Nozzles[dPO]); + dV += PF(MPP - 0.05, BVP, Nozzles[dPT] * nastG + (1 - nastG) * Nozzles[dPO]); if (MPP > VVP) - dV = dV + PF(MPP, VVP, d2A(5)); + dV += PF(MPP, VVP, d2A(5)); Miedzypoj->Flow(dV * dt * 0.15); // przeplyw ZS <-> PG @@ -293,7 +292,7 @@ double TNESt3::GetPF(double PP, double dt, double Vel) // przeplyw miedzy komora dV = PF(CVP, MPP, temp) * dt; CntrlRes->Flow(+dV); ValveRes->Flow(-0.02 * dV); - dV1 = dV1 + 0.98 * dV; + dV1 += 0.98 * dV; // przeplyw ZP <-> MPJ if ((MPP - 0.05 > BVP)) @@ -301,7 +300,7 @@ double TNESt3::GetPF(double PP, double dt, double Vel) // przeplyw miedzy komora else dV = 0; BrakeRes->Flow(dV); - dV1 = dV1 + dV * 0.98; + dV1 += dV * 0.98; ValveRes->Flow(-0.02 * dV); // przeplyw PG <-> rozdzielacz dV = PF(PP, VVP, 0.005) * dt; // 0.01 @@ -324,23 +323,23 @@ void TNESt3::EStParams(double i_crc) // parametry charakterystyczne dla ESt void TNESt3::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TBrake::Init(PP, HPP, LPP, BP, BDF); - ValveRes->CreatePress(PP); + TBrake::Init(PP, HPP, LPP, BP, BDF); + ValveRes->CreatePress(PP); BrakeCyl->CreatePress(BP); BrakeRes->CreatePress(PP); CntrlRes = new TReservoir(); CntrlRes->CreateCap(15); CntrlRes->CreatePress(HPP); - BrakeStatus = int(BP > 1); + BrakeStatus = static_cast(BP > 1.0); Miedzypoj = new TReservoir(); Miedzypoj->CreateCap(5); Miedzypoj->CreatePress(PP); - BVM = 1 / (HPP - 0.05 - LPP) * MaxBP; + BVM = 1.0 / (HPP - 0.05 - LPP) * MaxBP; BrakeDelayFlag = BDF; - RapidStatus = false; - LoadC, LoadM, TareBP, TareM, Podskok, LBP = 0.0; + RapidStatus = false; + LoadC, LoadM, TareBP, TareM, Podskok, LBP = 0.0; Zamykajacy, Przys_blok = false; @@ -375,23 +374,22 @@ void TNESt3::CheckState(double BCP, double &dV1) // glowny przyrzad rozrzadczy // sprawdzanie stanu // if ((BrakeStatus and 1)=1)and(BCP>0.25)then if ((VVP + 0.01 + BCP * 1.0 / BVM < CVP - 0.05) && (Przys_blok)) - BrakeStatus = - (BrakeStatus | - 3); // hamowanie stopniowe;else if( ( VVP-0.01+( BCP-0.1 )*1.0/BVM>CVP-0.05 ) ) - BrakeStatus = (BrakeStatus & 252); // luzowanie;else if( ( VVP+BCP*1.0/BVM>CVP-0.05 ) ) - BrakeStatus = - (BrakeStatus & 253); // zatrzymanie napelaniania;else if( ( VVP+( BCP-0.1 - // )*1.0/BVM0.25 ) ) //zatrzymanie luzowania - BrakeStatus = (BrakeStatus | 1); + BrakeStatus |= 3; // hamowanie stopniowe; + else if ((VVP - 0.01 + (BCP - 0.1) * 1.0 / BVM > CVP - 0.05)) + BrakeStatus &= 252; // luzowanie; + else if ((VVP + BCP * 1.0 / BVM > CVP - 0.05)) + BrakeStatus &= 253; // zatrzymanie napelaniania; + else if ((VVP + (BCP - 0.1) * 1.0 / BVM < CVP - 0.05) && (BCP > 0.25)) // zatrzymanie luzowania + BrakeStatus |= 1; if ((BrakeStatus & 1) == 0) - SoundFlag = SoundFlag | sf_CylU; + SoundFlag |= sf_CylU; if ((VVP + 0.10 < CVP) && (BCP < 0.25)) // poczatek hamowania if ((!Przys_blok)) { ValveRes->CreatePress(0.1 * VVP); - SoundFlag = SoundFlag | sf_Acc; + SoundFlag |= sf_Acc; ValveRes->Act(); Przys_blok = true; } @@ -415,7 +413,7 @@ void TNESt3::CheckReleaser(double dt) // odluzniacz { CntrlRes->Flow(+PF(CVP, 0, 0.02) * dt); if ((CVP < VVP + 0.3) || (!autom)) - BrakeStatus = BrakeStatus & 247; + BrakeStatus &= 247; } } @@ -458,11 +456,9 @@ double TNESt3::BVs(double BCP) // napelniacz pomocniczego void TNESt3::PLC(double mass) { - LoadC = - 1 + - double(mass < LoadM) * - ((TareBP + (MaxBP - TareBP) * (mass - TareM) * 1.0 / (LoadM - TareM)) * 1.0 / MaxBP - - 1); + LoadC = 1 + + double(mass < LoadM) * + ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1); } void TNESt3::ForceEmptiness() @@ -518,7 +514,7 @@ void TNESt3::SetSize(int size, std::string params) // ustawianie dysz (rozmiaru Przekladniki[3] = new TPrzeciwposlizg(); if (params.find("-ED") != std::string::npos) { - delete Przekladniki[3]; //tutaj ma być destruktor + delete Przekladniki[3]; // tutaj ma być destruktor Przekladniki[1]->SetRapidParams(2, 18); Przekladniki[3] = new TPrzekED(); } @@ -654,24 +650,19 @@ void TNESt3::SetSize(int size, std::string params) // ustawianie dysz (rozmiaru Nozzles[dSm] = 0.9; // przeliczanie z mm^2 na l/m + for (i = 0; i < dMAX; ++i) { - for (i = 0; i < dMAX; ++i) - { - Nozzles[i] = d2A(Nozzles[i]); //(/1000^2*pi/4*1000) - } + Nozzles[i] = d2A(Nozzles[i]); //(/1000^2*pi/4*1000) } - + for (i = 1; i < 4; ++i) { - for (i = 1; i < 4; ++i) - { - Przekladniki[i]->BrakeRes = BrakeRes; - Przekladniki[i]->CreateCap(i); - Przekladniki[i]->CreatePress(BrakeCyl->P()); - if (i < 3) - Przekladniki[i]->Next = Przekladniki[i + 1]; - else - Przekladniki[i]->Next = BrakeCyl; - } + Przekladniki[i]->BrakeRes = BrakeRes; + Przekladniki[i]->CreateCap(i); + Przekladniki[i]->CreatePress(BrakeCyl->P()); + if (i < 3) + Przekladniki[i]->Next = Przekladniki[i + 1]; + else + Przekladniki[i]->Next = BrakeCyl; } } diff --git a/McZapkie/hamulce.cpp b/McZapkie/hamulce.cpp index 31f772bf..00ffb490 100644 --- a/McZapkie/hamulce.cpp +++ b/McZapkie/hamulce.cpp @@ -14,24 +14,21 @@ Copyright (C) 2007-2014 Maciej Cierniak #include "hamulce.h" #include "Mover.h" -#include #include +#include //---FUNKCJE OGOLNE--- static double const DPL = 0.25; -double TFV4aM::pos_table[11] = { -2, 6, -1, 0, -2, 1, 4, 6, 0, 0, 0 }; -double TMHZ_EN57::pos_table[11] = { -2, 10, -1, 0, 0, 2, 9, 10, 0, 0, 0 }; -double TM394::pos_table[11] = { -1, 5, -1, 0, 1, 2, 4, 5, 0, 0, 0 }; -double TH14K1::BPT_K[6][2] = -{ {10, 0}, {4, 1}, {0, 1}, {4, 0}, {4, -1}, {15, -1} }; -double TH14K1::pos_table[11] = { -1, 4, -1, 0, 1, 2, 3, 4, 0, 0, 0 }; -double TSt113::BPT_K[6][2] = -{ {10, 0}, {4, 1}, {0, 1}, {4, 0}, {4, -1}, {15, -1} }; -double TSt113::BEP_K[7] = { 0, -1, 1, 0, 0, 0, 0 }; -double TSt113::pos_table[11] = { -1, 5, -1, 0, 2, 3, 4, 5, 0, 0, 1 }; -double TFVel6::pos_table[11] = { -1, 6, -1, 0, 6, 4, 4.7, 5, -1, 0, 1 }; - +double TFV4aM::pos_table[11] = {-2, 6, -1, 0, -2, 1, 4, 6, 0, 0, 0}; +double TMHZ_EN57::pos_table[11] = {-2, 10, -1, 0, 0, 2, 9, 10, 0, 0, 0}; +double TM394::pos_table[11] = {-1, 5, -1, 0, 1, 2, 4, 5, 0, 0, 0}; +double TH14K1::BPT_K[6][2] = {{10, 0}, {4, 1}, {0, 1}, {4, 0}, {4, -1}, {15, -1}}; +double TH14K1::pos_table[11] = {-1, 4, -1, 0, 1, 2, 3, 4, 0, 0, 0}; +double TSt113::BPT_K[6][2] = {{10, 0}, {4, 1}, {0, 1}, {4, 0}, {4, -1}, {15, -1}}; +double TSt113::BEP_K[7] = {0, -1, 1, 0, 0, 0, 0}; +double TSt113::pos_table[11] = {-1, 5, -1, 0, 2, 3, 4, 5, 0, 0, 1}; +double TFVel6::pos_table[11] = {-1, 6, -1, 0, 6, 4, 4.7, 5, -1, 0, 1}; double PR(double P1, double P2) { @@ -87,7 +84,7 @@ double PF1(double P1, double P2, double S) long lround(double value) { - return floorl(value + 0.5); + return floorl(value + 0.5); } double PFVa(double PH, double PL, double S, double LIM, @@ -101,8 +98,7 @@ double PFVa(double PH, double PL, double S, double LIM, double sg = PL / PH; // bezwymiarowy stosunek cisnien double FM = PH * 197 * S; // najwyzszy mozliwy przeplyw, wraz z kierunkiem if ((LIM - PL) < DP) - FM = FM * (LIM - PL) / - DP; // jesli jestesmy przy nastawieniu, to zawor sie przymyka + FM = FM * (LIM - PL) / DP; // jesli jestesmy przy nastawieniu, to zawor sie przymyka if ((sg > 0.5)) // jesli ponizej stosunku krytycznego if ((PH - PL) < DPL) // niewielka roznica cisnien return (PH - PL) / DPL * FM * 2 * sqrt((sg) * (1 - sg)); @@ -126,8 +122,7 @@ double PFVd(double PH, double PL, double S, double LIM, double sg = PL / PH; // bezwymiarowy stosunek cisnien double FM = PH * 197 * S; // najwyzszy mozliwy przeplyw, wraz z kierunkiem if ((PH - LIM) < 0.1) - FM = FM * (PH - LIM) / - DP; // jesli jestesmy przy nastawieniu, to zawor sie przymyka + FM = FM * (PH - LIM) / DP; // jesli jestesmy przy nastawieniu, to zawor sie przymyka if ((sg > 0.5)) // jesli ponizej stosunku krytycznego if ((PH - PL) < DPL) // niewielka roznica cisnien return (PH - PL) / DPL * FM * 2 * sqrt((sg) * (1 - sg)); @@ -162,7 +157,7 @@ TReservoir::TReservoir() // inherited:: Create; Cap = 1; Vol = 0; - dVol = 0; + dVol = 0; } void TReservoir::Act() @@ -214,7 +209,7 @@ double TBrakeCyl::P() double VtoC = Vol / Cap; // stosunek cisnienia do objetosci // P:=VtoC; if (VtoC < VS) - return VtoC *pS / VS; // objetosc szkodliwa + return VtoC * pS / VS; // objetosc szkodliwa else if (VtoC > VD) return VtoC - cD; // caly silownik; else @@ -256,16 +251,16 @@ TBrake::TBrake(double i_mbp, double i_bcr, double i_bcd, double i_brc, int i_bcn // inherited:: Create; MaxBP = i_mbp; BCN = i_bcn; - BCM = 1; + BCM = 1; BCA = i_bcn * i_bcr * i_bcr * pi; BA = i_ba; NBpA = i_nbpa; BrakeDelays = i_BD; - BrakeDelayFlag = bdelay_P; - DCV = false; - ASBP = 0.0; - BrakeStatus = b_hld; - SoundFlag = 0; + BrakeDelayFlag = bdelay_P; + DCV = false; + ASBP = 0.0; + BrakeStatus = b_hld; + SoundFlag = 0; // 210.88 // SizeBR:=i_bcn*i_bcr*i_bcr*i_bcd*40.17*MaxBP/(5-MaxBP); //objetosc ZP w stosunku do cylindra // 14" i cisnienia 4.2 atm @@ -285,27 +280,36 @@ TBrake::TBrake(double i_mbp, double i_bcr, double i_bcd, double i_brc, int i_bcn // FM.Free; // materialy cierne - i_mat = i_mat && (255 - bp_MHS); + i_mat = i_mat & (255 - bp_MHS); switch (i_mat) { case bp_P10Bg: FM = new TP10Bg(); + break; case bp_P10Bgu: FM = new TP10Bgu(); + break; case bp_FR513: FM = new TFR513(); + break; case bp_FR510: FM = new TFR510(); + break; case bp_Cosid: FM = new TCosid(); + break; case bp_P10yBg: FM = new TP10yBg(); + break; case bp_P10yBgu: FM = new TP10yBgu(); + break; case bp_D1: FM = new TDisk1(); + break; case bp_D2: FM = new TDisk2(); + break; default: // domyslnie FM = new TP10(); } @@ -314,7 +318,7 @@ TBrake::TBrake(double i_mbp, double i_bcr, double i_bcd, double i_brc, int i_bcn // inicjalizacja hamulca (stan poczatkowy) void TBrake::Init(double PP, double HPP, double LPP, double BP, int BDF) { - BrakeDelayFlag = BDF; + BrakeDelayFlag = BDF; } // pobranie wspolczynnika tarcia materialu @@ -333,7 +337,7 @@ double TBrake::GetBCP() // ciśnienie sterujące hamowaniem elektro-dynamicznym double TBrake::GetEDBCP() { - return 0; + return 0; } // cisnienie zbiornika pomocniczego @@ -429,8 +433,8 @@ void TBrake::ForceEmptiness() void TWest::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TBrake::Init(PP, HPP, LPP, BP, BDF); - ValveRes->CreatePress(PP); + TBrake::Init(PP, HPP, LPP, BP, BDF); + ValveRes->CreatePress(PP); BrakeCyl->CreatePress(BP); BrakeRes->CreatePress(PP / 2 + HPP / 2); // BrakeStatus:=3*int(BP>0.1); @@ -557,11 +561,9 @@ void TWest::SetEPS(double nEPS) void TWest::PLC(double mass) { - LoadC = - 1 + - int(mass < LoadM) * - ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - - 1); + LoadC = 1 + + int(mass < LoadM) * + ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1); } void TWest::SetLP(double TM, double LM, double TBP) @@ -749,15 +751,15 @@ double TESt::GetPF(double PP, double dt, double Vel) void TESt::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TBrake::Init(PP, HPP, LPP, BP, BDF); - ValveRes->CreatePress(PP); + TBrake::Init(PP, HPP, LPP, BP, BDF); + ValveRes->CreatePress(PP); BrakeCyl->CreatePress(BP); BrakeRes->CreatePress(PP); CntrlRes->CreateCap(15); CntrlRes->CreatePress(HPP); BrakeStatus = 0; - BVM = 1 / (HPP - LPP) * MaxBP; + BVM = 1.0 / (HPP - LPP) * MaxBP; BrakeDelayFlag = BDF; } @@ -775,8 +777,8 @@ double TESt::GetCRP() void TEStEP2::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TLSt::Init(PP, HPP, LPP, BP, BDF); - ImplsRes->CreateCap(1); + TLSt::Init(PP, HPP, LPP, BP, BDF); + ImplsRes->CreateCap(1); ImplsRes->CreatePress(BP); BrakeRes->CreatePress(PP); @@ -898,11 +900,9 @@ double TEStEP2::GetPF(double PP, double dt, double Vel) void TEStEP2::PLC(double mass) { - LoadC = - 1 + - int(mass < LoadM) * - ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - - 1); + LoadC = 1 + + int(mass < LoadM) * + ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1); } void TEStEP2::SetEPS(double nEPS) @@ -960,8 +960,9 @@ double TESt3::GetPF(double PP, double dt, double Vel) BrakeCyl->Flow(-dv); // przeplyw ZP <-> silowniki if ((BrakeStatus & b_on) == b_on) - dv = PF(BVP, BCP, 0.017 * (1 + int((BCP < 0.58) && (BrakeDelayFlag == bdelay_G))) * - (1.13 - int((BCP > 0.6) && (BrakeDelayFlag == bdelay_G))) * SizeBC) * + dv = PF(BVP, BCP, + 0.017 * (1 + int((BCP < 0.58) && (BrakeDelayFlag == bdelay_G))) * + (1.13 - int((BCP > 0.6) && (BrakeDelayFlag == bdelay_G))) * SizeBC) * dt; else dv = 0; @@ -1085,7 +1086,7 @@ double TESt4R::GetPF(double PP, double dt, double Vel) void TESt4R::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TESt::Init(PP, HPP, LPP, BP, BDF); + TESt::Init(PP, HPP, LPP, BP, BDF); ImplsRes->CreateCap(1); ImplsRes->CreatePress(BP); @@ -1133,8 +1134,9 @@ double TESt3AL2::GetPF(double PP, double dt, double Vel) ImplsRes->Flow(-dv); // przeplyw ZP <-> KI if (((BrakeStatus & b_on) == b_on) && (BCP < MaxBP)) - dv = PF(BVP, BCP, 0.0008 * (1 + int((BCP < 0.58) && (BrakeDelayFlag == bdelay_G))) * - (1.13 - int((BCP > 0.6) && (BrakeDelayFlag == bdelay_G)))) * + dv = PF(BVP, BCP, + 0.0008 * (1 + int((BCP < 0.58) && (BrakeDelayFlag == bdelay_G))) * + (1.13 - int((BCP > 0.6) && (BrakeDelayFlag == bdelay_G)))) * dt; else dv = 0; @@ -1179,11 +1181,9 @@ double TESt3AL2::GetPF(double PP, double dt, double Vel) void TESt3AL2::PLC(double mass) { - LoadC = - 1 + - int(mass < LoadM) * - ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - - 1); + LoadC = 1 + + int(mass < LoadM) * + ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1); } void TESt3AL2::SetLP(double TM, double LM, double TBP) @@ -1195,8 +1195,8 @@ void TESt3AL2::SetLP(double TM, double LM, double TBP) void TESt3AL2::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TESt::Init(PP, HPP, LPP, BP, BDF); - ImplsRes->CreateCap(1); + TESt::Init(PP, HPP, LPP, BP, BDF); + ImplsRes->CreateCap(1); ImplsRes->CreatePress(BP); } @@ -1281,15 +1281,14 @@ double TLSt::GetPF(double PP, double dt, double Vel) // if Vel>55 then temp:=0.72 else // temp:=1;{R} // cisnienie PP - RapidTemp = RapidTemp + - (RM * int((Vel > 55) && (BrakeDelayFlag == bdelay_R)) - RapidTemp) * dt / 2; + RapidTemp = + RapidTemp + (RM * int((Vel > 55) && (BrakeDelayFlag == bdelay_R)) - RapidTemp) * dt / 2; temp = 1 - RapidTemp; if (EDFlag > 0.2) temp = 10000; // powtarzacz — podwojny zawor zwrotny - temp = - Max0R(((CVP - BCP) * BVM + ASBP * int((BrakeStatus & b_asb) == b_asb)) / temp, LBP); + temp = Max0R(((CVP - BCP) * BVM + ASBP * int((BrakeStatus & b_asb) == b_asb)) / temp, LBP); // luzowanie CH if ((BrakeCyl->P() > temp + 0.005) || (temp < 0.28)) // dV:=PF(0,BrakeCyl->P(),0.0015*3*sizeBC)*dt @@ -1319,7 +1318,7 @@ double TLSt::GetPF(double PP, double dt, double Vel) void TLSt::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TESt4R::Init(PP, HPP, LPP, BP, BDF); + TESt4R::Init(PP, HPP, LPP, BP, BDF); ValveRes->CreateCap(1); ImplsRes->CreateCap(8); ImplsRes->CreatePress(PP); @@ -1430,8 +1429,8 @@ double TEStED::GetPF(double PP, double dt, double Vel) dv = 0; ImplsRes->Flow(-dv); if (((BrakeStatus & b_on) == b_on) && (BCP < MaxBP)) - dv = PF(BVP, BCP, Nozzles[2] * (nastG + 2 * int(BCP < 0.8)) + Nozzles[0] * (1 - nastG)) * - dt; + dv = + PF(BVP, BCP, Nozzles[2] * (nastG + 2 * int(BCP < 0.8)) + Nozzles[0] * (1 - nastG)) * dt; else dv = 0; ImplsRes->Flow(-dv); @@ -1463,8 +1462,8 @@ double TEStED::GetPF(double PP, double dt, double Vel) dv = dv + PF(MPP, VVP, 0.02); Miedzypoj->Flow(dv * dt * 0.15); - RapidTemp = RapidTemp + - (RM * int((Vel > 55) && (BrakeDelayFlag == bdelay_R)) - RapidTemp) * dt / 2; + RapidTemp = + RapidTemp + (RM * int((Vel > 55) && (BrakeDelayFlag == bdelay_R)) - RapidTemp) * dt / 2; temp = Max0R(1 - RapidTemp, 0.001); // if EDFlag then temp:=1000; // temp:=temp/(1-); @@ -1518,8 +1517,8 @@ double TEStED::GetPF(double PP, double dt, double Vel) void TEStED::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TLSt::Init(PP, HPP, LPP, BP, BDF); - int i; + TLSt::Init(PP, HPP, LPP, BP, BDF); + int i; ValveRes->CreatePress(1 * PP); BrakeCyl->CreatePress(1 * BP); @@ -1569,11 +1568,9 @@ double TEStED::GetEDBCP() void TEStED::PLC(double mass) { - LoadC = - 1 + - int(mass < LoadM) * - ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - - 1); + LoadC = 1 + + int(mass < LoadM) * + ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1); } void TEStED::SetLP(double TM, double LM, double TBP) @@ -1600,23 +1597,22 @@ void TCV1::CheckState(double BCP, double &dV1) BrakeStatus = BrakeStatus & 247; // sprawdzanie stanu - if ((BrakeStatus & b_hld) == b_hld) - if ((VVP + 0.003 + BCP / BVM < CVP)) - BrakeStatus = - (BrakeStatus | 2); // hamowanie stopniowe; - else if ((VVP - 0.003 + BCP*1.0 / BVM>CVP)) - BrakeStatus = (BrakeStatus & 252); // luzowanie; - else if ((VVP + BCP*1.0 / BVM > CVP)) - BrakeStatus = (BrakeStatus & 253); // zatrzymanie napelaniania; - else - ; - else if ((VVP + 0.10 < CVP) && (BCP < 0.1)) // poczatek hamowania - { - BrakeStatus = (BrakeStatus | 3); - dV1 = 1.25; - } - else if ((VVP + BCP / BVM < CVP) && (BCP > 0.25)) // zatrzymanie luzowanie - BrakeStatus = (BrakeStatus | 1); + if ((BrakeStatus & b_hld) == b_hld) + if ((VVP + 0.003 + BCP / BVM < CVP)) + BrakeStatus = (BrakeStatus | 2); // hamowanie stopniowe; + else if ((VVP - 0.003 + BCP * 1.0 / BVM > CVP)) + BrakeStatus = (BrakeStatus & 252); // luzowanie; + else if ((VVP + BCP * 1.0 / BVM > CVP)) + BrakeStatus = (BrakeStatus & 253); // zatrzymanie napelaniania; + else + ; + else if ((VVP + 0.10 < CVP) && (BCP < 0.1)) // poczatek hamowania + { + BrakeStatus = (BrakeStatus | 3); + dV1 = 1.25; + } + else if ((VVP + BCP / BVM < CVP) && (BCP > 0.25)) // zatrzymanie luzowanie + BrakeStatus = (BrakeStatus | 1); } double TCV1::CVs(double BP) @@ -1685,8 +1681,9 @@ double TCV1::GetPF(double PP, double dt, double Vel) // przeplyw ZP <-> silowniki if ((BrakeStatus & b_on) == b_on) - dv = PF(BVP, BCP, 0.017 * (1 + int((BCP < 0.58) && (BrakeDelayFlag == bdelay_G))) * - (1.13 - int((BCP > 0.6) && (BrakeDelayFlag == bdelay_G))) * SizeBC) * + dv = PF(BVP, BCP, + 0.017 * (1 + int((BCP < 0.58) && (BrakeDelayFlag == bdelay_G))) * + (1.13 - int((BCP > 0.6) && (BrakeDelayFlag == bdelay_G))) * SizeBC) * dt; else dv = 0; @@ -1715,8 +1712,8 @@ double TCV1::GetPF(double PP, double dt, double Vel) void TCV1::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TBrake::Init(PP, HPP, LPP, BP, BDF); - ValveRes->CreatePress(PP); + TBrake::Init(PP, HPP, LPP, BP, BDF); + ValveRes->CreatePress(PP); BrakeCyl->CreatePress(BP); BrakeRes->CreatePress(PP); CntrlRes->CreateCap(15); @@ -1752,8 +1749,8 @@ double TCV1L_TR::GetHPFlow(double HP, double dt) void TCV1L_TR::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TCV1::Init(PP, HPP, LPP, BP, BDF); - ImplsRes->CreateCap(2.5); + TCV1::Init(PP, HPP, LPP, BP, BDF); + ImplsRes->CreateCap(2.5); ImplsRes->CreatePress(BP); } @@ -1795,8 +1792,9 @@ double TCV1L_TR::GetPF(double PP, double dt, double Vel) ImplsRes->Flow(-dv); // przeplyw ZP <-> KI if (((BrakeStatus & b_on) == b_on) && (BCP < MaxBP)) - dv = PF(BVP, BCP, 0.002 * (1 + int((BCP < 0.58) && (BrakeDelayFlag == bdelay_G))) * - (1.13 - int((BCP > 0.6) && (BrakeDelayFlag == bdelay_G)))) * + dv = PF(BVP, BCP, + 0.002 * (1 + int((BCP < 0.58) && (BrakeDelayFlag == bdelay_G))) * + (1.13 - int((BCP > 0.6) && (BrakeDelayFlag == bdelay_G)))) * dt; else dv = 0; @@ -1988,7 +1986,8 @@ double TKE::GetPF(double PP, double dt, double Vel) ImplsRes->Flow(-dv); // rapid - if (!((typeid(FM) == typeid(TDisk1)) || (typeid(FM) == typeid(TDisk2)))) // jesli zeliwo to schodz + if (!((typeid(FM) == typeid(TDisk1)) || + (typeid(FM) == typeid(TDisk2)))) // jesli zeliwo to schodz RapidStatus = ((BrakeDelayFlag & bdelay_R) == bdelay_R) && (((Vel > 50) && (RapidStatus)) || (Vel > 70)); else // jesli tarczowki, to zostan @@ -2045,8 +2044,8 @@ double TKE::GetPF(double PP, double dt, double Vel) void TKE::Init(double PP, double HPP, double LPP, double BP, int BDF) { - TBrake::Init(PP, HPP, LPP, BP, BDF); - ValveRes->CreatePress(PP); + TBrake::Init(PP, HPP, LPP, BP, BDF); + ValveRes->CreatePress(PP); BrakeCyl->CreatePress(BP); BrakeRes->CreatePress(PP); @@ -2080,11 +2079,9 @@ double TKE::GetHPFlow(double HP, double dt) void TKE::PLC(double mass) { - LoadC = - 1 + - int(mass < LoadM) * - ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - - 1); + LoadC = 1 + + int(mass < LoadM) * + ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1); } void TKE::SetLP(double TM, double LM, double TBP) @@ -2138,7 +2135,7 @@ double TDriverHandle::GetPos(int i) double TDriverHandle::GetEP(double pos) { - return 0; + return 0; } //---FV4a--- @@ -2308,7 +2305,7 @@ double TFV4aM::GetPF(double i_bcp, double PP, double HP, double dt, double ep) if ((TP < 1)) TP = TP - 0.5 * dt; // 5/10 // dpMainValve:=dpMainValve*2; - //+1*PF(dpPipe,pp,(ActFlowSpeed)/(LBDelay))//coby + //+1*PF(dpPipe,pp,(ActFlowSpeed)/(LBDelay))//coby // nie przeszkadzal przy ladowaniu z zaworu obok } @@ -2316,7 +2313,7 @@ double TFV4aM::GetPF(double i_bcp, double PP, double HP, double dt, double ep) { if ((TP > 2)) dpMainValve = dpMainValve * 1.5; //+0.5*PF(dpPipe,pp,(ActFlowSpeed)/(LBDelay))//coby nie - //przeszkadzal przy ladowaniu z zaworu obok + // przeszkadzal przy ladowaniu z zaworu obok } ep = dpPipe; @@ -2324,12 +2321,13 @@ double TFV4aM::GetPF(double i_bcp, double PP, double HP, double dt, double ep) RP = RP + PF(RP, ep, 0.0007) * dt; // powolne wzrastanie, ale szybsze na jezdzie; else RP = RP + PF(RP, ep, 0.000093 / 2 * 2) * dt; // powolne wzrastanie i to bardzo - // jednak trzeba wydluzyc, bo - // obecnie zle dziala + // jednak trzeba wydluzyc, bo + // obecnie zle dziala if ((RP < ep) && - (RP < BPT[lround(i_bcpno) + 2][1])) // jesli jestesmy ponizej cisnienia w sterujacym (2.9 bar) + (RP < + BPT[lround(i_bcpno) + 2][1])) // jesli jestesmy ponizej cisnienia w sterujacym (2.9 bar) RP = RP + PF(RP, CP, 0.005) * dt; // przypisz cisnienie w PG - wydluzanie napelniania o czas - // potrzebny do napelnienia PG + // potrzebny do napelnienia PG if ((EQ(i_bcp, i_bcpno)) || (EQ(i_bcp, -2))) { @@ -2359,8 +2357,8 @@ void TFV4aM::Init(double Press) XP = 0.0; Time = false; TimeEP = false; - RedAdj = 0.0; - Fala = false; + RedAdj = 0.0; + Fala = false; } void TFV4aM::SetReductor(double nAdj) @@ -2386,14 +2384,14 @@ double TFV4aM::LPP_RP(double pos) // cisnienie z zaokraglonej pozycji; int i_pos; i_pos = lround(pos - 0.5) + 2; // zaokraglone w dol - double i, j, k, l; - i = BPT[i_pos][1]; - j = BPT[i_pos + 1][1]; - k = pos + 2 - i_pos; - l = i + (j - i) * k; - double r = - BPT[i_pos][1] + (BPT[i_pos + 1][1] - BPT[i_pos][1]) * (pos + 2 - i_pos); // interpolacja liniowa - return r; + double i, j, k, l; + i = BPT[i_pos][1]; + j = BPT[i_pos + 1][1]; + k = pos + 2 - i_pos; + l = i + (j - i) * k; + double r = BPT[i_pos][1] + + (BPT[i_pos + 1][1] - BPT[i_pos][1]) * (pos + 2 - i_pos); // interpolacja liniowa + return r; } bool TFV4aM::EQ(double pos, double i_pos) { @@ -2499,8 +2497,8 @@ void TMHZ_EN57::Init(double Press) RP = 0.0; Time = false; TimeEP = false; - RedAdj = 0.0; - Fala = false; + RedAdj = 0.0; + Fala = false; } void TMHZ_EN57::SetReductor(double nAdj) @@ -2565,8 +2563,8 @@ double TM394::GetPF(double i_bcp, double PP, double HP, double dt, double ep) if (BCP < -1) BCP = 1; - LimPP = Min0R(BPT_394[BCP+1][1], HP); - ActFlowSpeed = BPT_394[BCP+1][0]; + LimPP = Min0R(BPT_394[BCP + 1][1], HP); + ActFlowSpeed = BPT_394[BCP + 1][0]; if ((BCP == 1) || (BCP == i_bcpno)) LimPP = PP; if ((BCP == 0)) @@ -2628,8 +2626,8 @@ double TM394::GetPos(int i) double TH14K1::GetPF(double i_bcp, double PP, double HP, double dt, double ep) { static int const LBDelay = 100; // szybkosc + zasilanie sterujacego - // static double const BPT_K[/*?*/ /*-1..4*/ (4) - (-1) + 1][2] = - //{ (10, 0), (4, 1), (0, 1), (4, 0), (4, -1), (15, -1) }; + // static double const BPT_K[/*?*/ /*-1..4*/ (4) - (-1) + 1][2] = + //{ (10, 0), (4, 1), (0, 1), (4, 0), (4, -1), (15, -1) }; static double const NomPress = 5.0; double LimPP; @@ -2641,14 +2639,14 @@ double TH14K1::GetPF(double i_bcp, double PP, double HP, double dt, double ep) BCP = lround(i_bcp); if (i_bcp < -1) BCP = 1; - LimPP = BPT_K[BCP+1][1]; + LimPP = BPT_K[BCP + 1][1]; if (LimPP < 0) LimPP = 0.5 * PP; else if (LimPP > 0) LimPP = PP; else LimPP = CP; - ActFlowSpeed = BPT_K[BCP+1][0]; + ActFlowSpeed = BPT_K[BCP + 1][0]; CP = CP + 6 * Min0R(abs(LimPP - CP), 0.05) * PR(CP, LimPP) * dt; // zbiornik sterujacy @@ -2711,14 +2709,14 @@ double TSt113::GetPF(double i_bcp, double PP, double HP, double dt, double ep) if (BCP < -1) BCP = 1; - LimPP = BPT_K[BCP+1][1]; + LimPP = BPT_K[BCP + 1][1]; if (LimPP < 0) LimPP = 0.5 * PP; else if (LimPP > 0) LimPP = PP; else LimPP = CP; - ActFlowSpeed = BPT_K[BCP+1][0]; + ActFlowSpeed = BPT_K[BCP + 1][0]; CP = CP + 6 * Min0R(abs(LimPP - CP), 0.05) * PR(CP, LimPP) * dt; // zbiornik sterujacy @@ -2750,7 +2748,7 @@ void TSt113::Init(double Press) { Time = true; TimeEP = true; - EPS = 0.0; + EPS = 0.0; } //--- test --- @@ -2765,8 +2763,8 @@ double Ttest::GetPF(double i_bcp, double PP, double HP, double dt, double ep) double dpMainValve; double ActFlowSpeed; - LimPP = BPT[lround(i_bcp)+2][1]; - ActFlowSpeed = BPT[lround(i_bcp)+2][0]; + LimPP = BPT[lround(i_bcp) + 2][1]; + ActFlowSpeed = BPT[lround(i_bcp) + 2][0]; if ((i_bcp == i_bcpno)) LimPP = 0.0; @@ -2804,8 +2802,7 @@ double TFD1::GetPF(double i_bcp, double PP, double HP, double dt, double ep) // MaxBP:=4; // temp:=Min0R(i_bcp*MaxBP,Min0R(5.0,HP)); temp = Min0R(i_bcp * MaxBP, HP); // 0011 - DP = - 10 * Min0R(abs(temp - BP), 0.1) * PF(temp, BP, 0.0006 * (2 + int(temp > BP))) * dt * Speed; + DP = 10 * Min0R(abs(temp - BP), 0.1) * PF(temp, BP, 0.0006 * (2 + int(temp > BP))) * dt * Speed; BP = BP - DP; return -DP; } @@ -2932,7 +2929,7 @@ void TFVel6::Init(double Press) { Time = true; TimeEP = true; - EPS = 0.0; + EPS = 0.0; } -//END +// END