/*
This Source Code Form is subject to the
terms of the Mozilla Public License, v.
2.0. If a copy of the MPL was not
distributed with this file, You can
obtain one at
http://mozilla.org/MPL/2.0/.
*/
/*
MaSzyna EU07 - SPKS
Brakes. Oerlikon ESt.
Copyright (C) 2007-2014 Maciej Cierniak
*/

#include "stdafx.h"
#include "hamulce.h"
#include <typeinfo>
#include "MOVER.h"
#include "utilities/utilities.h"

//---FUNKCJE OGOLNE---

static double const DPL = 0.25;
double const TFV4aM::pos_table[11] = {-2, 6, -1, 0, -2, 1, 4, 6, 0, 0, 0};
double const TMHZ_EN57::pos_table[11] = {-1, 10, -1, 0, 0, 2, 9, 10, 0, 0, 0};
double const TMHZ_K5P::pos_table[11] = { -1, 3, -1, 0, 1, 1, 2, 3, 0, 0, 0 };
double const TMHZ_6P::pos_table[11] = { -1, 4, -1, 0, 2, 2, 3, 4, 0, 0, 0 };
double const TM394::pos_table[11] = {-1, 5, -1, 0, 1, 2, 4, 5, 0, 0, 0};
double const TH14K1::BPT_K[6][2] = {{10, 0}, {4, 1}, {0, 1}, {4, 0}, {4, -1}, {15, -1}};
double const TH14K1::pos_table[11] = {-1, 4, -1, 0, 1, 2, 3, 4, 0, 0, 0};
double const TSt113::BPT_K[6][2] = {{10, 0}, {4, 1}, {0, 1}, {4, 0}, {4, -1}, {15, -1}};
double const TSt113::BEP_K[7] = {0, -1, 1, 0, 0, 0, 0};
double const TSt113::pos_table[11] = {-1, 5, -1, 0, 2, 3, 4, 5, 0, 0, 1};
double const TFVel6::pos_table[11] = {-1, 6, -1, 0, 6, 4, 4.7, 5, -1, 0, 1};
double const TFVE408::pos_table[11] = { 0, 10, 0, 0, 10, 7, 8, 9, 0, 1, 5 };

double PR(double P1, double P2)
{
    double PH = Max0R(P1, P2) + 0.1;
    double PL = P1 + P2 - PH + 0.2;
    return (P2 - P1) / (1.13 * PH - PL);
}

double PF_old(double P1, double P2, double S)
{
    double PH = Max0R(P1, P2) + 1;
    double PL = P1 + P2 - PH + 2;
    if (PH - PL < 0.0001)
        return 0;
    else if ((PH - PL) < 0.05)
        return 20 * (PH - PL) * (PH + 1) * 222 * S * (P2 - P1) / (1.13 * PH - PL);
    else
        return (PH + 1) * 222 * S * (P2 - P1) / (1.13 * PH - PL);
}

double PF( double const P1, double const P2, double const S, double const DP )
{
    double const PH = std::max(P1, P2) + 1.0; // wyzsze cisnienie absolutne
    double const PL = P1 + P2 - PH + 2.0; // nizsze cisnienie absolutne
    double const sg = PL / PH; // bezwymiarowy stosunek cisnien
    double const FM = PH * 197.0 * S * Sign(P2 - P1); // najwyzszy mozliwy przeplyw, wraz z kierunkiem
    if (sg > 0.5) // jesli ponizej stosunku krytycznego
        if ((PH - PL) < DP) // niewielka roznica cisnien
            return (1.0 - sg) / DPL * FM * 2.0 * std::sqrt((DP) * (PH - DP));
        //      return 1/DPL*(PH-PL)*fm*2*SQRT((sg)*(1-sg));
        else
            return FM * 2.0 * std::sqrt((sg) * (1.0 - sg));
    else // powyzej stosunku krytycznego
        return FM;
}

double PF1( double const P1, double const P2, double const S )
{
    static double const DPS = 0.001;

    double const PH = std::max(P1, P2) + 1.0; // wyzsze cisnienie absolutne
    double const PL = P1 + P2 - PH + 2.0; // nizsze cisnienie absolutne
    double const sg = PL / PH; // bezwymiarowy stosunek cisnien
    double const FM = PH * 197.0 * S * Sign(P2 - P1); // najwyzszy mozliwy przeplyw, wraz z kierunkiem
    if (sg > 0.5) // jesli ponizej stosunku krytycznego
        if (sg < DPS) // niewielka roznica cisnien
            return (1.0 - sg) / DPS * FM * 2.0 * std::sqrt((DPS) * (1.0 - DPS));
        else
            return FM * 2.0 * std::sqrt((sg) * (1.0 - sg));
    else // powyzej stosunku krytycznego
        return FM;
}

double PFVa( double PH, double PL, double const S, double LIM, double const DP )
// zawor napelniajacy z PH do PL, PL do LIM
{
    if (LIM > PL)
    {
        LIM = LIM + 1;
        PH = PH + 1; // wyzsze cisnienie absolutne
        PL = PL + 1; // nizsze cisnienie absolutne
        double sg = std::min( 1.0, PL / PH ); // bezwymiarowy stosunek cisnien. NOTE: sg is capped at 1 to prevent calculations from going awry. TODO, TBD: log these as errors?
        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
        if ((sg > 0.5)) // jesli ponizej stosunku krytycznego
            if ((PH - PL) < DPL) // niewielka roznica cisnien
                return (PH - PL) / DPL * FM * 2 * std::sqrt((sg) * (1 - sg)); // BUG: (1-sg) can be < 0, leading to sqrt(-x)
            else
                return FM * 2 * std::sqrt( (sg) * ( 1 - sg ) ); // BUG: (1-sg) can be < 0, leading to sqrt(-x)
        else // powyzej stosunku krytycznego
            return FM;
    }
    else
        return 0;
}

double PFVd( double PH, double PL, double const S, double LIM, double const DP )
// zawor wypuszczajacy z PH do PL, PH do LIM
{
    if (LIM < PH)
    {
        LIM = LIM + 1;
        PH = PH + 1.0; // wyzsze cisnienie absolutne
        PL = PL + 1.0; // nizsze cisnienie absolutne
        double sg = std::min( 1.0, PL / PH ); // bezwymiarowy stosunek cisnien
        double FM = PH * 197.0 * 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
        if ((sg > 0.5)) // jesli ponizej stosunku krytycznego
            if ((PH - PL) < DPL) // niewielka roznica cisnien
                return (PH - PL) / DPL * FM * 2.0 * std::sqrt((sg) * (1.0 - sg));
            else
                return FM * 2.0 * std::sqrt((sg) * (1.0 - sg));
        else // powyzej stosunku krytycznego
            return FM;
    }
    else
        return 0;
}

bool is_EQ(double pos, double i_pos)
{
	return (pos <= i_pos + 0.5) && (pos > i_pos - 0.5);
}

//---ZBIORNIKI---

double TReservoir::pa()
{
    return 0.1 * Vol / Cap;
}

double TReservoir::P()
{
    return Vol / Cap;
}

void TReservoir::Flow(double dv)
{
    dVol = dVol + dv;
}

void TReservoir::Act()
{
    Vol = std::max( 0.0, Vol + dVol );
    dVol = 0;
}

void TReservoir::CreateCap(double Capacity)
{
    Cap = Capacity;
}

void TReservoir::CreatePress(double Press)
{
    Vol = Cap * Press;
    dVol = 0;
}

//---SILOWNIK---
double TBrakeCyl::pa()
// var VtoC: real;
{
    //  VtoC:=Vol/Cap;
    return P() * 0.1;
}

/* NOWSZA WERSJA - maksymalne ciśnienie to ok. 4,75 bar, co powoduje
//                 problemy przy rapidzie w lokomotywach, gdyz jest3
//                 osiagany wierzcholek paraboli
function TBrakeCyl.P:real;
var VtoC: real;
begin
  VtoC:=Vol/Cap;
  if VtoC<0.06 then P:=VtoC/4
  else if VtoC>0.88 then P:=0.5+(VtoC-0.88)*1.043-0.064*(VtoC-0.88)*(VtoC-0.88)
  else P:=0.15+0.35/0.82*(VtoC-0.06);
end; */

//(* STARA WERSJA
double TBrakeCyl::P()
{
    static double const VS = 0.005;
    static double const pS = 0.05;
    static double const VD = 1.10;
    static double const cD = 1;
    static double const pD = VD - cD;

    double VtoC = ( Cap > 0.0 ? Vol / Cap : 0.0 ); // stosunek cisnienia do objetosci.
                                                   // Added div/0 trap for vehicles with incomplete definitions (cars etc)
    //  P:=VtoC;
    if (VtoC < VS)
        return VtoC * pS / VS; // objetosc szkodliwa
    else if (VtoC > VD)
        return VtoC - cD; // caly silownik;
    else
        return pS + (VtoC - VS) / (VD - VS) * (pD - pS); // wysuwanie tloka
} //*)

//---HAMULEC---
/*
constructor TBrake.Create(i_mbp, i_bcr, i_bcd, i_brc: real; i_bcn, i_BD, i_mat, i_ba, i_nbpa: int);
begin
  inherited Create;
  MaxBP:=i_mbp;
  BCN:=i_bcn;
  BCA:=i_bcn*i_bcr*i_bcr*pi;
  BA:=i_ba;
  NBpA:=i_nbpa;
  BrakeDelays:=i_BD;

//tworzenie zbiornikow
  BrakeCyl.CreateCap(i_bcd*BCA*1000);
  BrakeRes.CreateCap(i_brc);
  ValveRes.CreateCap(0.2);

//  FM.Free;
//materialy cierne
  case i_mat of
  bp_P10Bg:   FM:=TP10Bg.Create;
  bp_P10Bgu:  FM:=TP10Bgu.Create;
  else //domyslnie
  FM:=TP10.Create;
  end;


end  ; */

TBrake::TBrake(double i_mbp, double i_bcr, double i_bcd, double i_brc, int i_bcn, int i_BD,
               int i_mat, int i_ba, int i_nbpa)
{
    // inherited:: Create;
    MaxBP = i_mbp;
    BCN = i_bcn;
    BCM = 1;
    BCA = i_bcn * i_bcr * i_bcr * M_PI;
    BA = i_ba;
    NBpA = i_nbpa;
    BrakeDelays = i_BD;
    BrakeDelayFlag = bdelay_P;
    // 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
    SizeBR = i_brc * 0.0128;
    SizeBC = i_bcn * i_bcr * i_bcr * i_bcd * 210.88 * MaxBP /
             4.2; // objetosc CH w stosunku do cylindra 14" i cisnienia 4.2 atm

    BrakeCyl = std::make_shared<TBrakeCyl>();
    BrakeRes = std::make_shared<TReservoir>();
    ValveRes = std::make_shared<TReservoir>();

    // tworzenie zbiornikow
    BrakeCyl->CreateCap(i_bcd * BCA * 1000);
    BrakeRes->CreateCap(i_brc);
    ValveRes->CreateCap(0.25);

    // materialy cierne
    i_mat = i_mat & (255 - bp_MHS);
    switch (i_mat)
    {
    case bp_P10Bg:
        FM = std::make_shared<TP10Bg>();
        break;
    case bp_P10Bgu:
        FM = std::make_shared<TP10Bgu>();
        break;
    case bp_FR513:
        FM = std::make_shared<TFR513>();
        break;
    case bp_FR510:
        FM = std::make_shared<TFR510>();
        break;
    case bp_Cosid:
        FM = std::make_shared<TCosid>();
        break;
    case bp_P10yBg:
        FM = std::make_shared<TP10yBg>();
        break;
    case bp_P10yBgu:
        FM = std::make_shared<TP10yBgu>();
        break;
    case bp_D1:
        FM = std::make_shared<TDisk1>();
        break;
    case bp_D2:
        FM = std::make_shared<TDisk2>();
        break;
    default: // domyslnie
        FM = std::make_shared<TP10>();
    }
}

// inicjalizacja hamulca (stan poczatkowy)
void TBrake::Init( double const PP, double const HPP, double const LPP, double const BP, int const BDF )
{
    BrakeDelayFlag = BDF;
}

// pobranie wspolczynnika tarcia materialu
double TBrake::GetFC( double const Vel, double const N )
{
    return FM->GetFC(N, Vel);
}

// cisnienie cylindra hamulcowego
double TBrake::GetBCP()
{
    return BrakeCyl->P();
}

// ciśnienie sterujące hamowaniem elektro-dynamicznym
double TBrake::GetEDBCP()
{
    return 0;
}

// cisnienie zbiornika pomocniczego
double TBrake::GetBRP()
{
    return BrakeRes->P();
}

// cisnienie komory wstepnej
double TBrake::GetVRP()
{
    return ValveRes->P();
}

// cisnienie zbiornika sterujacego
double TBrake::GetCRP()
{
    return GetBRP();
}

// przeplyw z przewodu glowneg
double TBrake::GetPF( double const PP, double const dt, double const Vel )
{
    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    return 0;
}

// przeplyw z przewodu zasilajacego
double TBrake::GetHPFlow( double const HP, double const dt )
{
    return 0;
}

double TBrake::GetBCF()
{
    return BCA * 100 * BrakeCyl->P();
}

bool TBrake::SetBDF( int const nBDF )
{
    if (((nBDF & BrakeDelays) == nBDF) && (nBDF != BrakeDelayFlag))
    {
        BrakeDelayFlag = nBDF;
        return true;
    }
    else
        return false;
}

void TBrake::Releaser( int const state )
{
    BrakeStatus = (BrakeStatus & ~b_rls) | ( state * b_rls );
}

bool TBrake::Releaser() const {

    return ( ( BrakeStatus & b_rls ) == b_rls );
}

void TBrake::SetEPS( double const nEPS )
{
}

void TBrake::ASB( int const state )
{ // 255-b_asb(32)
    BrakeStatus = (BrakeStatus & ~b_asb) | ( (state / 2) * b_asb );
	BrakeStatus = (BrakeStatus & ~b_asb_unbrake) | ( (state % 2) * b_asb_unbrake);
}

int TBrake::GetStatus()
{
    return BrakeStatus;
}

int TBrake::GetSoundFlag()
{
    int result = SoundFlag;
    SoundFlag = 0;
    return result;
}

void TBrake::SetASBP( double const Press )
{
    ASBP = Press;
}

void TBrake::ForceEmptiness()
{
    ValveRes->CreatePress(0);
    BrakeRes->CreatePress(0);

    ValveRes->Act();
    BrakeRes->Act();
}

// removes specified amount of air from the reservoirs
// NOTE: experimental feature, for now limited only to brake reservoir
void TBrake::ForceLeak( double const Amount ) {

    BrakeRes->Flow( -Amount * BrakeRes->P() );
    ValveRes->Flow( -Amount * ValveRes->P() * 0.01 ); // this reservoir has hard coded, tiny capacity compared to other parts

    BrakeRes->Act();
    ValveRes->Act();
}

//---WESTINGHOUSE---

void TWest::Init( double const PP, double const HPP, double const LPP, double const BP, int const BDF )
{
    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);
}

double TWest::GetPF( double const PP, double const dt, double const Vel )
{
    double dv;
    double dV1;
    double VVP;
    double BVP;
    double CVP;
    double BCP;
    double temp;

    BVP = BrakeRes->P();
    VVP = ValveRes->P();
    CVP = BrakeCyl->P();
    BCP = BrakeCyl->P();

    if ((BrakeStatus & b_hld) == b_hld)
        if ((VVP + 0.03 < BVP))
            BrakeStatus |= b_on;
        else if ((VVP > BVP + 0.1))
            BrakeStatus &= ~(b_on | b_hld);
        else if ((VVP > BVP))
            BrakeStatus &= ~b_on;
        else
            ;
    else if ((VVP + 0.25 < BVP))
        BrakeStatus |= (b_on | b_hld);

    if (((BrakeStatus & b_hld) == b_off) && (!DCV))
        dv = PF(0, CVP, 0.0068 * SizeBC) * dt;
    else
        dv = 0;
    BrakeCyl->Flow(-dv);

    if ((BCP > LBP + 0.01) && (DCV))
        dv = PF(0, CVP, 0.1 * SizeBC) * dt;
    else
        dv = 0;
    BrakeCyl->Flow(-dv);

	if ((BrakeStatus & b_rls) == b_rls) //odluzniacz
		dv = PF(0, CVP, 0.1 * SizeBC) * dt;
	else
		dv = 0;
	BrakeCyl->Flow(-dv);

    // hamulec EP
    temp = BVP * int(EPS > 0);
    dv = PF(temp, LBP, 0.0015) * dt * EPS * EPS * int(LBP * EPS < MaxBP * LoadC);
    LBP = LBP - dv;
    dv = 0;

    // przeplyw ZP <-> silowniki
    if (((BrakeStatus & b_on) == b_on) && ((TareBP < 0.1) || (BCP < MaxBP * LoadC)))
        if ((BVP > LBP))
        {
            DCV = false;
            dv = PF(BVP, CVP, 0.017 * SizeBC) * dt;
        }
        else
            dv = 0;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    BrakeCyl->Flow(-dv);
    if ((DCV))
        dVP = PF(LBP, BCP, 0.01 * SizeBC) * dt;
    else
        dVP = 0;
    BrakeCyl->Flow(-dVP);
    if ((dVP > 0))
        dVP = 0;
    // przeplyw ZP <-> rozdzielacz
    if (((BrakeStatus & b_hld) == b_off))
        dv = PF(BVP, VVP, 0.0011 * SizeBR) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    dV1 = dv * 0.95;
    ValveRes->Flow(-0.05 * dv);
    // przeplyw PG <-> rozdzielacz
    dv = PF(PP, VVP, 0.01 * SizeBR) * dt;
    ValveRes->Flow(-dv);

    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    return dv - dV1;
}

double TWest::GetHPFlow( double const HP, double const dt )
{
    return dVP;
}

void TWest::SetLBP( double const P )
{
    LBP = P;
    if (P > BrakeCyl->P())
        //   begin
        DCV = true;
    //   end
    //  else
    //    LBP:=P;
}

void TWest::SetEPS( double const nEPS )
{
    double BCP;

    BCP = BrakeCyl->P();
    if (nEPS > 0)
        DCV = true;
    else if (nEPS == 0)
    {
        if ((EPS != 0))
        {
            if ((LBP > 0.4))
                LBP = BrakeCyl->P();
            if ((LBP < 0.15))
                LBP = 0;
        }
    }
    EPS = nEPS;
}

void TWest::PLC( double const mass )
{
    LoadC = 1 +
            int(mass < LoadM) *
                ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1);
}

void TWest::SetLP( double const TM, double const LM, double const TBP )
{
    TareM = TM;
    LoadM = LM;
    TareBP = TBP;
}

//---OERLIKON EST4---
void TESt::CheckReleaser( double const dt )
{
    double VVP = std::min(ValveRes->P(), BrakeRes->P() + 0.05);
    double CVP = CntrlRes->P() - 0.0;

    // odluzniacz
    if ((BrakeStatus & b_rls) == b_rls)
        if ((CVP - VVP < 0))
            BrakeStatus &= ~b_rls;
        else
        {
            CntrlRes->Flow(+PF(CVP, 0, 0.1) * dt);
        }
}

void TESt::CheckState( double const BCP, double &dV1 ) {

    double const VVP { ValveRes->P() };
    double const BVP { BrakeRes->P() };
    double const CVP { CntrlRes->P() };

    // sprawdzanie stanu
    if( BCP > 0.25 ) {

        if( ( BrakeStatus & b_hld ) == b_hld ) {

            if( ( VVP + 0.003 + BCP / BVM ) < CVP ) {
                // hamowanie stopniowe
                BrakeStatus |= b_on;
            }
            else {
                if( ( VVP + BCP / BVM ) > CVP ) {
                // zatrzymanie napelaniania
                    BrakeStatus &= ~b_on;
                }
                if( ( VVP - 0.003 + ( BCP - 0.1 ) / BVM ) > CVP ) {
                    // luzowanie
                    BrakeStatus &= ~( b_on | b_hld );
                }
            }
        }
        else {

            if( ( VVP + BCP / BVM < CVP )
             && ( ( CVP - VVP ) * BVM > 0.25 ) ) {
                // zatrzymanie luzowanie
                BrakeStatus |= b_hld;
            }
        }
    }
    else {

        if( VVP + 0.1 < CVP ) {
            // poczatek hamowania
            if( ( BrakeStatus & b_hld ) == 0 ) {
                // przyspieszacz
                ValveRes->CreatePress( 0.02 * VVP );
                SoundFlag |= sf_Acc;
                ValveRes->Act();
            }
            BrakeStatus |= ( b_on | b_hld );
        }
    }

    if( ( BrakeStatus & b_hld ) == 0 ) {
        SoundFlag |= sf_CylU;
    }
}

double TESt::CVs( double const BP )
{
    double VVP;
    double BVP;
    double CVP;

    BVP = BrakeRes->P();
    CVP = CntrlRes->P();
    VVP = ValveRes->P();

    // przeplyw ZS <-> PG
    if ((VVP < CVP - 0.12) || (BVP < CVP - 0.3) || (BP > 0.4))
        return 0;
    else if ((VVP > CVP + 0.4))
        if ((BVP > CVP + 0.2))
            return 0.23;
        else
            return 0.05;
    else if ((BVP > CVP - 0.1))
        return 1;
    else
        return 0.3;
}

double TESt::BVs( double const BCP )
{
    double VVP;
    double BVP;
    double CVP;

    BVP = BrakeRes->P();
    CVP = CntrlRes->P();
    VVP = ValveRes->P();

    // przeplyw ZP <-> rozdzielacz
    if ((BVP < CVP - 0.3))
        return 0.6;
    else if ((BCP < 0.5))
        if ((VVP > CVP + 0.4))
            return 0.1;
        else
            return 0.3;
    else
        return 0;
}

double TESt::GetPF( double const PP, double const dt, double const Vel )
{
    double dv;
    double dV1;
    double temp;
    double VVP;
    double BVP;
    double BCP;
    double CVP;

    BVP = BrakeRes->P();
    VVP = ValveRes->P();
    BCP = BrakeCyl->P();
    CVP = CntrlRes->P() - 0.0;

    dv = 0;
    dV1 = 0;

    // sprawdzanie stanu
    CheckState(BCP, dV1);
    CheckReleaser(dt);

    CVP = CntrlRes->P();
    VVP = ValveRes->P();
    // przeplyw ZS <-> PG
    temp = CVs(BCP);
    dv = PF(CVP, VVP, 0.0015 * temp) * dt;
    CntrlRes->Flow(+dv);
    ValveRes->Flow(-0.04 * dv);
    dV1 = dV1 - 0.96 * dv;

    // luzowanie
    if ((BrakeStatus & b_hld) == b_off)
        dv = PF(0, BCP, 0.0058 * SizeBC) * dt;
    else
        dv = 0;
    BrakeCyl->Flow(-dv);

    // przeplyw ZP <-> silowniki
    if ((BrakeStatus & b_on) == b_on)
        dv = PF(BVP, BCP, 0.016 * SizeBC) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    BrakeCyl->Flow(-dv);

    // przeplyw ZP <-> rozdzielacz
    temp = BVs(BCP);
    //  if(BrakeStatus and b_hld)=b_off then
    if ((VVP - 0.05 > BVP))
        dv = PF(BVP, VVP, 0.02 * SizeBR * temp / 1.87) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    dV1 = dV1 + dv * 0.96;
    ValveRes->Flow(-0.04 * dv);
    // przeplyw PG <-> rozdzielacz
    dv = PF(PP, VVP, 0.01) * dt;
    ValveRes->Flow(-dv);

    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    return dv - dV1;
}

void TESt::Init( double const PP, double const HPP, double const LPP, double const BP, int const BDF )
{
    TBrake::Init(PP, HPP, LPP, BP, BDF);
    ValveRes->CreatePress(PP);
    BrakeCyl->CreatePress(BP);
    BrakeRes->CreatePress(PP);
    CntrlRes->CreateCap(15);
    CntrlRes->CreatePress(HPP);
    BrakeStatus = b_off;

    BVM = 1.0 / (HPP - LPP) * MaxBP;

    BrakeDelayFlag = BDF;
}

void TESt::EStParams( double const i_crc )
{
}

double TESt::GetCRP()
{
    return CntrlRes->P();
}

void TESt::ForceEmptiness() {

    ValveRes->CreatePress( 0 );
    BrakeRes->CreatePress( 0 );
    CntrlRes->CreatePress( 0 );

    ValveRes->Act();
    BrakeRes->Act();
    CntrlRes->Act();
}

//---EP2---

void TEStEP2::Init( double const PP, double const HPP, double const LPP, double const BP, int const BDF )
{
    TLSt::Init(PP, HPP, LPP, BP, BDF);
    ImplsRes->CreateCap(1);
    ImplsRes->CreatePress(BP);

    BrakeRes->CreatePress(PP);

    BrakeDelayFlag = bdelay_P;
    BrakeDelays = bdelay_P;
}

double TEStEP2::GetPF( double const PP, double const dt, double const Vel )
{
    double result;
    double dv;
    double dV1;
    double temp;
    double VVP;
    double BVP;
    double BCP;
    double CVP;

    BVP = BrakeRes->P();
    VVP = ValveRes->P();
    BCP = ImplsRes->P();
    CVP = CntrlRes->P(); // 110115 - konsultacje warszawa1

    dv = 0;
    dV1 = 0;

    // odluzniacz
    CheckReleaser(dt);

    // sprawdzanie stanu
    if (((BrakeStatus & b_hld) == b_hld) && (BCP > 0.25))
        if ((VVP + 0.003 + BCP / BVM < CVP - 0.12))
            BrakeStatus |= b_on; // hamowanie stopniowe;
        else if ((VVP - 0.003 + BCP / BVM > CVP - 0.12))
            BrakeStatus &= ~(b_on | b_hld); // luzowanie;
        else if ((VVP + BCP / BVM > CVP - 0.12))
            BrakeStatus &= ~b_on; // zatrzymanie napelaniania;
        else
            ;
    else if ((VVP + 0.10 < CVP - 0.12) && (BCP < 0.25)) // poczatek hamowania
    {
        // if ((BrakeStatus & 1) == 0)
        //{
        //    //       ValveRes.CreatePress(0.5*VVP);  //110115 - konsultacje warszawa1
        //    //       SoundFlag:=SoundFlag or sf_Acc;
        //    //       ValveRes.Act;
        //}
        BrakeStatus |= (b_on | b_hld);
    }
    else if ((VVP + BCP / BVM < CVP - 0.12) && (BCP > 0.25)) // zatrzymanie luzowanie
        BrakeStatus |= b_hld;

    if( ( BrakeStatus & b_hld ) == 0 ) {
        SoundFlag |= sf_CylU;
    }

    // przeplyw ZS <-> PG
    if ((BVP < CVP - 0.2) || (BrakeStatus != b_off) || (BCP > 0.25))
        temp = 0;
    else if ((VVP > CVP + 0.4))
        temp = 0.1;
    else
        temp = 0.5;

    dv = PF(CVP, VVP, 0.0015 * temp / 1.8) * dt;
    CntrlRes->Flow(+dv);
    ValveRes->Flow(-0.04 * dv);
    dV1 = dV1 - 0.96 * dv;

    // hamulec EP
	EPCalc(dt);

    // luzowanie KI
    if ((BrakeStatus & b_hld) == b_off)
        dv = PF(0, BCP, 0.00083) * dt;
    else
        dv = 0;
    ImplsRes->Flow(-dv);
    // przeplyw ZP <-> KI
    if (((BrakeStatus & b_on) == b_on) && (BCP < MaxBP * LoadC))
        dv = PF(BVP, BCP, 0.0006) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    ImplsRes->Flow(-dv);
    // przeplyw PG <-> rozdzielacz
    dv = PF(PP, VVP, 0.01 * SizeBR) * dt;
    ValveRes->Flow(-dv);

    result = dv - dV1;

    temp = Max0R(BCP, LBP);

    if ((ImplsRes->P() > LBP + 0.01))
        LBP = 0;

    // luzowanie CH
    if ((BrakeCyl->P() > temp + 0.005) || (Max0R(ImplsRes->P(), 8 * LBP) < 0.05))
        dv = PF(0, BrakeCyl->P(), 0.25 * SizeBC * (0.01 + (BrakeCyl->P() - temp))) * dt;
    else
        dv = 0;
    BrakeCyl->Flow(-dv);
    // przeplyw ZP <-> CH
    if ((BrakeCyl->P() < temp - 0.005) && (Max0R(ImplsRes->P(), 8 * LBP) > 0.10) &&
        (Max0R(BCP, LBP) < MaxBP * LoadC))
        dv = PF(BVP, BrakeCyl->P(), 0.35 * SizeBC * (0.01 - (BrakeCyl->P() - temp))) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    BrakeCyl->Flow(-dv);

    ImplsRes->Act();
    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    return result;
}

void TEStEP2::PLC( double const mass )
{
    LoadC = 1 +
            int(mass < LoadM) *
                ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1);
}

void TEStEP2::SetEPS( double const nEPS )
{
    EPS = nEPS;
    if ((EPS > 0) && (LBP + 0.01 < BrakeCyl->P()))
        LBP = BrakeCyl->P();
}

void TEStEP2::SetLP( double const TM, double const LM, double const TBP )
{
    TareM = TM;
    LoadM = LM;
    TareBP = TBP;
}

void TEStEP2::EPCalc(double dt)
{
	double temp = BrakeRes->P() * int(EPS > 0);
	double dv = PF(temp, LBP, 0.00053 + 0.00060 * int(EPS < 0)) * dt * EPS * EPS *
		int(LBP * EPS < MaxBP * LoadC);
	LBP = LBP - dv;
}


void TEStEP1::EPCalc(double dt)
{
	double temp = EPS - std::floor(EPS); //część ułamkowa jest hamulcem EP
	double LBPLim = Min0R(MaxBP * LoadC * temp, BrakeRes->P()); //do czego dążymy
	double S = 10 * clamp(LBPLim - LBP, -0.1, 0.1); //przymykanie zaworku
	double dv = PF(( S > 0 ? BrakeRes->P() : 0 ), LBP, abs(S)*(0.00053 + 0.00060 * int(S < 0))) * dt; //przepływ
	LBP = LBP - dv;
}

void TEStEP1::SetEPS( double const nEPS )
{
    EPS = nEPS;
}

//---EST3--

double TESt3::GetPF( double const PP, double const dt, double const Vel )
{
    double BVP{ BrakeRes->P() };
    double VVP{ ValveRes->P() };
    double BCP{ BrakeCyl->P() };
    double CVP{ CntrlRes->P() - 0.0 };

    double dv{ 0.0 };
    double dV1{ 0.0 };

    // sprawdzanie stanu
    CheckState(BCP, dV1);
    CheckReleaser(dt);

    CVP = CntrlRes->P();
    VVP = ValveRes->P();
    // przeplyw ZS <-> PG
    double temp = CVs(BCP);
    dv = PF(CVP, VVP, 0.0015 * temp) * dt;
    CntrlRes->Flow(+dv);
    ValveRes->Flow(-0.04 * dv);
    dV1 = dV1 - 0.96 * dv;

    // luzowanie
    if ((BrakeStatus & b_hld) == b_off)
        dv = PF(0, BCP, 0.0042 * (1.37 - (BrakeDelayFlag == bdelay_G ? 1.0 : 0.0)) * SizeBC) * dt;
    else
        dv = 0;
    BrakeCyl->Flow(-dv);
    // przeplyw ZP <-> silowniki
    if ((BrakeStatus & b_on) == b_on)
        dv = PF(
            BVP,
            BCP,
            0.017 *
            ( 1.00 + ( ((BCP < 0.58) && (BrakeDelayFlag == bdelay_G)) ? 1.0 : 0.0 ) ) *
            ( 1.13 - ( ((BCP > 0.60) && (BrakeDelayFlag == bdelay_G)) ? 1.0 : 0.0 ) ) * SizeBC
            ) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    BrakeCyl->Flow(-dv);
    // przeplyw ZP <-> rozdzielacz
    temp = BVs(BCP);
    if ((VVP - 0.05 > BVP))
        dv = PF(BVP, VVP, 0.02 * SizeBR * temp / 1.87) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    dV1 += dv * 0.96;
    ValveRes->Flow(-0.04 * dv);
    // przeplyw PG <-> rozdzielacz
    dv = PF(PP, VVP, 0.01) * dt;
    ValveRes->Flow(-dv);

    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    return dv - dV1;
}

//---EST4-RAPID---

double TESt4R::GetPF( double const PP, double const dt, double const Vel )
{
    double result;
    double dv;
    double dV1;
    double temp;
    double VVP;
    double BVP;
    double BCP;
    double CVP;

    BVP = BrakeRes->P();
    VVP = ValveRes->P();
    BCP = ImplsRes->P();
    CVP = CntrlRes->P();

    dv = 0;
    dV1 = 0;

    // sprawdzanie stanu
    CheckState(BCP, dV1);
    CheckReleaser(dt);

    CVP = CntrlRes->P();
    VVP = ValveRes->P();
    // przeplyw ZS <-> PG
    temp = CVs(BCP);
    dv = PF(CVP, VVP, 0.0015 * temp / 1.8) * dt;
    CntrlRes->Flow(+dv);
    ValveRes->Flow(-0.04 * dv);
    dV1 = dV1 - 0.96 * dv;

    // luzowanie KI
    if ((BrakeStatus & b_hld) == b_off)
        dv = PF(0, BCP, 0.00037 * 1.14 * 15 / 19) * dt;
    else
        dv = 0;
    ImplsRes->Flow(-dv);
    // przeplyw ZP <-> KI
    if ((BrakeStatus & b_on) == b_on)
        dv = PF(BVP, BCP, 0.0014) * dt;
    else
        dv = 0;
    //  BrakeRes->Flow(dV);
    ImplsRes->Flow(-dv);
    // przeplyw ZP <-> rozdzielacz
    temp = BVs(BCP);
    if ((BVP < VVP - 0.05)) // or((PP<CVP)and(CVP<PP-0.1)
        dv = PF(BVP, VVP, 0.02 * SizeBR * temp / 1.87) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    dV1 = dV1 + dv * 0.96;
    ValveRes->Flow(-0.04 * dv);
    // przeplyw PG <-> rozdzielacz
    dv = PF(PP, VVP, 0.01 * SizeBR) * dt;
    ValveRes->Flow(-dv);

    result = dv - dV1;

    RapidStatus = ( BrakeDelayFlag == bdelay_R )
               && ( ( ( Vel > 55 ) && ( RapidStatus == true ) )
                 || ( Vel > 70 ) );

    RapidTemp = RapidTemp + (0.9 * int(RapidStatus) - RapidTemp) * dt / 2;
    temp = 1.9 - RapidTemp;
    if (((BrakeStatus & b_asb) == b_asb))
        temp = 1000;
    // luzowanie CH
    if ((BrakeCyl->P() * temp > ImplsRes->P() + 0.005) || (ImplsRes->P() < 0.25))
        if (((BrakeStatus & b_asb) == b_asb))
            dv = PFVd(BrakeCyl->P(), 0, 0.115 * SizeBC * 4, ImplsRes->P() / temp) * dt;
        else
            dv = PFVd(BrakeCyl->P(), 0, 0.115 * SizeBC, ImplsRes->P() / temp) * dt;
    //   dV:=PF(0,BrakeCyl.P,0.115*sizeBC/2)*dt
    //   dV:=PFVd(BrakeCyl.P,0,0.015*sizeBC/2,ImplsRes.P/temp)*dt
    else
        dv = 0;
    BrakeCyl->Flow(-dv);
    // przeplyw ZP <-> CH
    if ((BrakeCyl->P() * temp < ImplsRes->P() - 0.005) && (ImplsRes->P() > 0.3))
        //   dV:=PFVa(BVP,BrakeCyl.P,0.020*sizeBC,ImplsRes.P/temp)*dt
        dv = PFVa(BVP, BrakeCyl->P(), 0.60 * SizeBC, ImplsRes->P() / temp) * dt;
    else
        dv = 0;
    BrakeRes->Flow(-dv);
    BrakeCyl->Flow(+dv);

    ImplsRes->Act();
    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    return result;
}

void TESt4R::Init( double const PP, double const HPP, double const LPP, double const BP, int const BDF )
{
    TESt::Init(PP, HPP, LPP, BP, BDF);
    ImplsRes->CreateCap(1);
    ImplsRes->CreatePress(BP);

    BrakeDelayFlag = bdelay_R;
}

//---EST3/AL2---

double TESt3AL2::GetPF( double const PP, double const dt, double const Vel )
{
    double result;
    double dv;
    double dV1;
    double temp;
    double VVP;
    double BVP;
    double BCP;
    double CVP;

    BVP = BrakeRes->P();
    VVP = ValveRes->P();
    BCP = ImplsRes->P();
    CVP = CntrlRes->P() - 0.0;

    dv = 0;
    dV1 = 0;

    // sprawdzanie stanu
    CheckState(BCP, dV1);
    CheckReleaser(dt);

    VVP = ValveRes->P();
    // przeplyw ZS <-> PG
    temp = CVs(BCP);
    dv = PF(CVP, VVP, 0.0015 * temp) * dt;
    CntrlRes->Flow(+dv);
    ValveRes->Flow(-0.04 * dv);
    dV1 = dV1 - 0.96 * dv;

    // luzowanie KI
    if ((BrakeStatus & b_hld) == b_off)
        dv = PF(0, BCP, 0.00017 * (1.37 - int(BrakeDelayFlag == bdelay_G))) * dt;
    else
        dv = 0;
    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)))) *
             dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    ImplsRes->Flow(-dv);
    // przeplyw ZP <-> rozdzielacz
    temp = BVs(BCP);
    if ((VVP - 0.05 > BVP))
        dv = PF(BVP, VVP, 0.02 * SizeBR * temp / 1.87) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    dV1 = dV1 + dv * 0.96;
    ValveRes->Flow(-0.04 * dv);
    // przeplyw PG <-> rozdzielacz
    dv = PF(PP, VVP, 0.01) * dt;
    ValveRes->Flow(-dv);
    result = dv - dV1;

    // luzowanie CH
    if ((BrakeCyl->P() > ImplsRes->P() * LoadC + 0.005) || (ImplsRes->P() < 0.15))
        dv = PF(0, BrakeCyl->P(), 0.015 * SizeBC) * dt;
    else
        dv = 0;
    BrakeCyl->Flow(-dv);

    // przeplyw ZP <-> CH
    if ((BrakeCyl->P() < ImplsRes->P() * LoadC - 0.005) && (ImplsRes->P() > 0.15))
        dv = PF(BVP, BrakeCyl->P(), 0.020 * SizeBC) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    BrakeCyl->Flow(-dv);

    ImplsRes->Act();
    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    return result;
}

void TESt3AL2::PLC( double const mass )
{
    LoadC = 1 +
            int(mass < LoadM) *
                ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1);
}

void TESt3AL2::SetLP( double const TM, double const LM, double const TBP )
{
    TareM = TM;
    LoadM = LM;
    TareBP = TBP;
}

void TESt3AL2::Init( double const PP, double const HPP, double const LPP, double const  BP, int const BDF )
{
    TESt::Init(PP, HPP, LPP, BP, BDF);
    ImplsRes->CreateCap(1);
    ImplsRes->CreatePress(BP);
}

//---LSt---

double TLSt::GetPF( double const PP, double const dt, double const Vel )
{
    double result;

    // ValveRes.CreatePress(LBP);
    // LBP:=0;

    double const BVP{ BrakeRes->P() };
    double const VVP{ ValveRes->P() };
    double const BCP{ ImplsRes->P() };
    double const CVP{ CntrlRes->P() };

    double dV{ 0.0 };
    double dV1{ 0.0 };

    // sprawdzanie stanu
    // NOTE: partial copypaste from checkstate() of base class
    // TODO: clean inheritance for checkstate() and checkreleaser() and reuse these instead of manual copypaste
    if( ( ( BrakeStatus & b_hld ) == b_hld ) && ( BCP > 0.25 ) ) {
        if( ( VVP + 0.003 + BCP / BVM < CVP ) ) {
            // hamowanie stopniowe
            BrakeStatus |= b_on;
        }
        else if( ( VVP - 0.003 + ( BCP - 0.1 ) / BVM > CVP ) ) {
            // luzowanie
            BrakeStatus &= ~( b_on | b_hld );
        }
        else if( ( VVP + BCP / BVM > CVP ) ) {
            // zatrzymanie napelaniania
            BrakeStatus &= ~b_on;
        }
    }
    else if ((VVP + 0.10 < CVP) && (BCP < 0.25)) {
        // poczatek hamowania
        if ((BrakeStatus & b_hld) == b_off)
        {
            SoundFlag |= sf_Acc;
        }
        BrakeStatus |= (b_on | b_hld);
    }
    else if( ( VVP + ( BCP - 0.1 ) / BVM < CVP )
          && ( ( CVP - VVP ) * BVM > 0.25 )
          && ( BCP > 0.25 ) ) {
        // zatrzymanie luzowanie
        BrakeStatus |= b_hld;
    }
    if( ( BrakeStatus & b_hld ) == 0 ) {
        SoundFlag |= sf_CylU;
    }
    // equivalent of checkreleaser() in the base class?
	bool is_releasing = ( ( BrakeStatus & b_rls)
						|| ( UniversalFlag & TUniversalBrake::ub_Release ) );
    if ( is_releasing ) {
        if( CVP < 0.0 ) {
            BrakeStatus &= ~b_rls;
        }
        else
        { // 008
            dV = PF1( CVP, BCP, 0.024 ) * dt;
            CntrlRes->Flow( dV );
        }
    }

    // przeplyw ZS <-> PG
    double temp;
    if (((CVP - BCP) * BVM > 0.5))
        temp = 0.0;
    else if ((VVP > CVP + 0.4))
        temp = 0.5;
    else
        temp = 0.5;

    dV = PF1(CVP, VVP, 0.0015 * temp / 1.8 / 2) * dt;
    CntrlRes->Flow(+dV);
    ValveRes->Flow(-0.04 * dV);
    dV1 = dV1 - 0.96 * dV;

    // luzowanie KI  {G}
    //   if VVP>BCP then
    //    dV:=PF(VVP,BCP,0.00004)*dt
    //   else if (CVP-BCP)<1.5 then
    //    dV:=PF(VVP,BCP,0.00020*(1.33-int((CVP-BCP)*BVM>0.65)))*dt
    //  else dV:=0;      0.00025 P
    /*P*/
    if( VVP > BCP ) {
        dV =
            PF( VVP, BCP,
                0.00043 * ( 1.5 - (
                    true == ( ( ( CVP - BCP ) * BVM > 1.0 )
                           && ( BrakeDelayFlag == bdelay_G ) ) ?
                        1.0 :
                        0.0 ) ),
                0.1 )
            * dt;
    }
    else if( ( CVP - BCP ) < 1.5 ) {
        dV = PF( VVP, BCP,
                0.001472 * ( 1.36 - (
                    true == ( ( ( CVP - BCP ) * BVM > 1.0 )
                           && ( BrakeDelayFlag == bdelay_G ) ) ?
                        1.0 :
                        0.0 ) ),
                0.1 )
            * dt;
    }
    else {
        dV = 0;
    }

    ImplsRes->Flow(-dV);
    ValveRes->Flow(+dV);
    // przeplyw PG <-> rozdzielacz
    dV = PF(PP, VVP, 0.01, 0.1) * dt;
    ValveRes->Flow(-dV);

    result = dV - dV1;

    //  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;
    temp = 1 - RapidTemp;
    if (EDFlag > 0.2)
        temp = 10000;
	double tempasb = 0;
	if ( ( (UniversalFlag & TUniversalBrake::ub_AntiSlipBrake) > 0)
		|| ( (BrakeStatus & b_asb_unbrake) == b_asb_unbrake ) )
		tempasb = ASBP;
    // powtarzacz — podwojny zawor zwrotny
    temp = Max0R( ( (CVP - BCP) * BVM + tempasb ) / temp, LBP );
    // luzowanie CH
    if ((BrakeCyl->P() > temp + 0.005) || (temp < 0.28))
        //   dV:=PF(0,BrakeCyl->P(),0.0015*3*sizeBC)*dt
        //   dV:=PF(0,BrakeCyl->P(),0.005*3*sizeBC)*dt
        dV = PFVd(BrakeCyl->P(), 0, 0.005 * 7 * SizeBC, temp) * dt;
    else
        dV = 0;
    BrakeCyl->Flow(-dV);
    // przeplyw ZP <-> CH
    if ((BrakeCyl->P() < temp - 0.005) && (temp > 0.29))
        //   dV:=PF(BVP,BrakeCyl->P(),0.002*3*sizeBC*2)*dt
        dV = -PFVa(BVP, BrakeCyl->P(), 0.002 * 7 * SizeBC * 2, temp) * dt;
    else
        dV = 0;
    BrakeRes->Flow(dV);
    BrakeCyl->Flow(-dV);

    ImplsRes->Act();
    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    //  LBP:=ValveRes->P();
    //  ValveRes.CreatePress(ImplsRes->P());
    return result;
}

void TLSt::Init( double const PP, double const HPP, double const LPP, double const BP, int const BDF )
{
    TESt4R::Init(PP, HPP, LPP, BP, BDF);
    ValveRes->CreateCap(1);
    ImplsRes->CreateCap(8);
    ImplsRes->CreatePress(PP);
    BrakeRes->CreatePress(8);
    ValveRes->CreatePress(PP);

    EDFlag = 0;

    BrakeDelayFlag = BDF;
}

void TLSt::SetLBP( double const P )
{
    LBP = P;
}

double TLSt::GetEDBCP()
{
    double CVP;
    double BCP;

    CVP = CntrlRes->P();
    BCP = ImplsRes->P();
    return (CVP - BCP) * BVM;
}

void TLSt::SetED( double const EDstate )
{
    EDFlag = EDstate;
}

void TLSt::SetRM( double const RMR )
{
    RM = 1 - RMR;
}

double TLSt::GetHPFlow( double const HP, double const dt )
{
    double dv;

    dv = Min0R(PF(HP, BrakeRes->P(), 0.01 * dt), 0);
    BrakeRes->Flow(-dv);
    return dv;
}

//---EStED---

double TEStED::GetPF( double const PP, double const dt, double const Vel )
{
    double dv;
    double dV1;
    double temp;
    double VVP;
    double BVP;
    double BCP;
    double CVP;
    double MPP;
    double nastG;

    BVP = BrakeRes->P();
    VVP = ValveRes->P();
    BCP = ImplsRes->P();
    CVP = CntrlRes->P() - 0.0;
    MPP = Miedzypoj->P();
    dV1 = 0;

    nastG = (BrakeDelayFlag & bdelay_G);

    // sprawdzanie stanu
    if ((BCP < 0.25) && (VVP + 0.08 > CVP))
        Przys_blok = false;

    // sprawdzanie stanu
    if ((VVP + 0.002 + BCP / BVM < CVP - 0.05) && (Przys_blok))
        BrakeStatus |= (b_on | b_hld); // hamowanie stopniowe;
    else if ((VVP - 0.002 + (BCP - 0.1) / BVM > CVP - 0.05))
        BrakeStatus &= ~(b_on | b_hld); // luzowanie;
    else if ((VVP + BCP / BVM > CVP - 0.05))
        BrakeStatus &= ~b_on; // zatrzymanie napelaniania;
    else if ((VVP + (BCP - 0.1) / BVM < CVP - 0.05) && (BCP > 0.25)) // zatrzymanie luzowania
        BrakeStatus |= b_hld;

    if ((VVP + 0.10 < CVP) && (BCP < 0.25)) // poczatek hamowania
        if ((!Przys_blok))
        {
            ValveRes->CreatePress(0.75 * VVP);
            SoundFlag |= sf_Acc;
            ValveRes->Act();
            Przys_blok = true;
        }

    if ((BCP > 0.5))
        Zamykajacy = true;
    else if ((VVP - 0.6 < MPP))
        Zamykajacy = false;

    if ((BrakeStatus & b_rls) == b_rls)
    {
        dv = PF(CVP, BCP, 0.024) * dt;
        CntrlRes->Flow(+dv);
    }

    // luzowanie
    if ((BrakeStatus & b_hld) == b_off)
        dv = PF(0, BCP, Nozzles[3] * nastG + (1 - nastG) * Nozzles[1]) * dt;
    else
        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;
    else
        dv = 0;
    ImplsRes->Flow(-dv);
    BrakeRes->Flow(dv);

    // przeplyw testowy miedzypojemnosci
    if ((MPP < CVP - 0.3))
        temp = Nozzles[4];
    else if ((BCP < 0.5))
        if ((Zamykajacy))
            temp = Nozzles[8]; // 1.25;
        else
            temp = Nozzles[7];
    else
        temp = 0;
    dv = PF(MPP, VVP, temp);

    if ((MPP < CVP - 0.17))
        temp = 0;
    else if ((MPP > CVP - 0.08))
        temp = Nozzles[5];
    else
        temp = Nozzles[6];
    dv = dv + PF(MPP, CVP, temp);

    if ((MPP - 0.05 > BVP))
        dv = dv + PF(MPP - 0.05, BVP, Nozzles[10] * nastG + (1 - nastG) * Nozzles[9]);
    if (MPP > VVP)
        dv = dv + PF(MPP, VVP, 0.02);
    Miedzypoj->Flow(dv * dt * 0.15);

    RapidTemp =
        RapidTemp + (RM * int((Vel > RV) && (BrakeDelayFlag == bdelay_R)) - RapidTemp) * dt / 2;
    temp = Max0R(1 - RapidTemp, 0.001);
    //  if EDFlag then temp:=1000;
    //  temp:=temp/(1-);

    // powtarzacz — podwojny zawor zwrotny
    temp = Max0R(LoadC * BCP / temp * Min0R(Max0R(1 - EDFlag, 0), 1), LBP);
	
	if ( ( UniversalFlag & TUniversalBrake::ub_AntiSlipBrake ) > 0 )
		temp = std::max(temp, ASBP);

	double speed = 1;
	if ((ASBP < 0.1) && ((BrakeStatus & b_asb_unbrake) == b_asb_unbrake))
	{
		temp = 0;
		speed = 3;
	}

    if ((BrakeCyl->P() > temp))
        dv = -PFVd(BrakeCyl->P(), 0, 0.05 * SizeBC * speed, temp) * dt;
    else if ((BrakeCyl->P() < temp) && ((BrakeStatus & b_asb) == 0))
        dv = PFVa(BVP, BrakeCyl->P(), 0.05 * SizeBC, temp) * dt;
    else
        dv = 0;

    BrakeCyl->Flow(dv);
    if (dv > 0)
        BrakeRes->Flow(-dv);

    // przeplyw ZS <-> PG
    if ((MPP < CVP - 0.17))
        temp = 0;
    else if ((MPP > CVP - 0.08))
        temp = Nozzles[5];
    else
        temp = Nozzles[6];
    dv = PF(CVP, MPP, temp) * dt;
    CntrlRes->Flow(+dv);
    ValveRes->Flow(-0.02 * dv);
    dV1 = dV1 + 0.98 * dv;

    // przeplyw ZP <-> MPJ
    if ((MPP - 0.05 > BVP))
        dv = PF(BVP, MPP - 0.05, Nozzles[10] * nastG + (1 - nastG) * Nozzles[9]) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    dV1 = dV1 + dv * 0.98;
    ValveRes->Flow(-0.02 * dv);
    // przeplyw PG <-> rozdzielacz
    dv = PF(PP, VVP, 0.005) * dt; // 0.01
    ValveRes->Flow(-dv);

    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    Miedzypoj->Act();
    ImplsRes->Act();
    return dv - dV1;
}

void TEStED::Init( double const PP, double const HPP, double const LPP, double const BP, int const BDF )
{
    TLSt::Init(PP, HPP, LPP, BP, BDF);
    int i;

    ValveRes->CreatePress(PP);
    BrakeCyl->CreatePress(BP);

    //  CntrlRes:=TReservoir.Create;
    //  CntrlRes.CreateCap(15);
    //  CntrlRes.CreatePress(1*HPP);

    BrakeStatus = (BP > 1.0) ? 1 : 0;
    Miedzypoj->CreateCap(5);
    Miedzypoj->CreatePress(PP);

    ImplsRes->CreateCap(1);
    ImplsRes->CreatePress(BP);

    BVM = 1.0 / (HPP - 0.05 - LPP) * MaxBP;

    BrakeDelayFlag = BDF;
    Zamykajacy = false;
    EDFlag = 0;

    Nozzles[0] = 1.250 / 1.7;
    Nozzles[1] = 0.907;
    Nozzles[2] = 0.510 / 1.7;
    Nozzles[3] = 0.524 / 1.17;
    Nozzles[4] = 7.4;
    Nozzles[7] = 5.3;
    Nozzles[8] = 2.5;
    Nozzles[9] = 7.28;
    Nozzles[10] = 2.96;
    Nozzles[5] = 1.1;
    Nozzles[6] = 0.9;

    {
        for (i = 0; i < 11; ++i)
        {
            Nozzles[i] = Nozzles[i] * Nozzles[i] * 3.14159 / 4000;
        }
    }
}

double TEStED::GetEDBCP()
{
    return ImplsRes->P() * LoadC;
}

void TEStED::PLC( double const mass )
{
    LoadC = 1 +
            int(mass < LoadM) *
                ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1);
}

void TEStED::SetLP( double const TM, double const LM, double const TBP )
{
    TareM = TM;
    LoadM = LM;
    TareBP = TBP;
}

//---DAKO CV1---

void TCV1::CheckState( double const BCP, double &dV1 )
{
    double VVP;
    double BVP;
    double CVP;

    BVP = BrakeRes->P();
    VVP = Min0R(ValveRes->P(), BVP + 0.05);
    CVP = CntrlRes->P();

    // odluzniacz
    if (((BrakeStatus & b_rls) == b_rls) && (CVP - VVP < 0))
        BrakeStatus &= ~b_rls;

    // sprawdzanie stanu
    if ((BrakeStatus & b_hld) == b_hld)
        if ((VVP + 0.003 + BCP / BVM < CVP))
            BrakeStatus |= b_on; // hamowanie stopniowe;
        else if ((VVP - 0.003 + BCP * 1.0 / BVM > CVP))
            BrakeStatus &= ~( b_on | b_hld ); // luzowanie;
        else if ((VVP + BCP * 1.0 / BVM > CVP))
            BrakeStatus &= ~b_on; // zatrzymanie napelaniania;
        else
            ;
    else if ((VVP + 0.10 < CVP) && (BCP < 0.1)) // poczatek hamowania
    {
        BrakeStatus |= ( b_on | b_hld );
        dV1 = 1.25;
    }
    else if ((VVP + BCP / BVM < CVP) && (BCP > 0.25)) // zatrzymanie luzowanie
        BrakeStatus |= b_hld;
}

double TCV1::CVs(double const BP)
{
    // przeplyw ZS <-> PG
    if ((BP > 0.05))
        return 0;
    else
        return 0.23;
}

double TCV1::BVs( double const BCP )
{
    double VVP;
    double BVP;
    double CVP;

    BVP = BrakeRes->P();
    CVP = CntrlRes->P();
    VVP = ValveRes->P();

    // przeplyw ZP <-> rozdzielacz
    if ((BVP < CVP - 0.1))
        return 1;
    else if ((BCP > 0.05))
        return 0;
    else
        return 0.2 * (1.5 - int(BVP > VVP));
}

double TCV1::GetPF( double const PP, double const dt, double const Vel )
{
    double dv;
    double dV1;
    double temp;
    double VVP;
    double BVP;
    double BCP;
    double CVP;

    BVP = BrakeRes->P();
    VVP = Min0R(ValveRes->P(), BVP + 0.05);
    BCP = BrakeCyl->P();
    CVP = CntrlRes->P();

    dv = 0;
    dV1 = 0;

    // sprawdzanie stanu
    CheckState(BCP, dV1);

    VVP = ValveRes->P();
    // przeplyw ZS <-> PG
    temp = CVs(BCP);
    dv = PF(CVP, VVP, 0.0015 * temp) * dt;
    CntrlRes->Flow(+dv);
    ValveRes->Flow(-0.04 * dv);
    dV1 = dV1 - 0.96 * dv;

    // luzowanie
    if ((BrakeStatus & b_hld) == b_off)
        dv = PF(0, BCP, 0.0042 * (1.37 - int(BrakeDelayFlag == bdelay_G)) * SizeBC) * dt;
    else
        dv = 0;
    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) *
             dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    BrakeCyl->Flow(-dv);

    // przeplyw ZP <-> rozdzielacz
    temp = BVs(BCP);
    if ((VVP + 0.05 > BVP))
        dv = PF(BVP, VVP, 0.02 * SizeBR * temp / 1.87) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    dV1 = dV1 + dv * 0.96;
    ValveRes->Flow(-0.04 * dv);
    // przeplyw PG <-> rozdzielacz
    dv = PF(PP, VVP, 0.01) * dt;
    ValveRes->Flow(-dv);

    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    return dv - dV1;
}

void TCV1::Init( double const PP, double const HPP, double const LPP, double const BP, int const BDF )
{
    TBrake::Init(PP, HPP, LPP, BP, BDF);
    ValveRes->CreatePress(PP);
    BrakeCyl->CreatePress(BP);
    BrakeRes->CreatePress(PP);
    CntrlRes->CreateCap(15);
    CntrlRes->CreatePress(HPP);
    BrakeStatus = b_off;

    BVM = 1.0 / (HPP - LPP) * MaxBP;

    BrakeDelayFlag = BDF;
}

double TCV1::GetCRP()
{
    return CntrlRes->P();
}

void TCV1::ForceEmptiness() {

    ValveRes->CreatePress( 0 );
    BrakeRes->CreatePress( 0 );
    CntrlRes->CreatePress( 0 );

    ValveRes->Act();
    BrakeRes->Act();
    CntrlRes->Act();
}

//---CV1-L-TR---

void TCV1L_TR::SetLBP( double const P )
{
    LBP = P;
}

double TCV1L_TR::GetHPFlow( double const HP, double const dt )
{
    double dv;

    dv = PF(HP, BrakeRes->P(), 0.01) * dt;
    dv = Min0R(0, dv);
    BrakeRes->Flow(-dv);
    return dv;
}

void TCV1L_TR::Init( double const PP, double const HPP, double const LPP, double const BP, int const BDF )
{
    TCV1::Init(PP, HPP, LPP, BP, BDF);
    ImplsRes->CreateCap(2.5);
    ImplsRes->CreatePress(BP);
}

double TCV1L_TR::GetPF( double const PP, double const dt, double const Vel )
{
    double result;
    double dv;
    double dV1;
    double temp;
    double VVP;
    double BVP;
    double BCP;
    double CVP;

    BVP = BrakeRes->P();
    VVP = Min0R(ValveRes->P(), BVP + 0.05);
    BCP = ImplsRes->P();
    CVP = CntrlRes->P();

    dv = 0;
    dV1 = 0;

    // sprawdzanie stanu
    CheckState(BCP, dV1);

    VVP = ValveRes->P();
    // przeplyw ZS <-> PG
    temp = CVs(BCP);
    dv = PF(CVP, VVP, 0.0015 * temp) * dt;
    CntrlRes->Flow(+dv);
    ValveRes->Flow(-0.04 * dv);
    dV1 = dV1 - 0.96 * dv;

    // luzowanie KI
    if ((BrakeStatus & b_hld) == b_off)
        dv = PF(0, BCP, 0.000425 * (1.37 - int(BrakeDelayFlag == bdelay_G))) * dt;
    else
        dv = 0;
    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)))) *
             dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    ImplsRes->Flow(-dv);

    // przeplyw ZP <-> rozdzielacz
    temp = BVs(BCP);
    if ((VVP + 0.05 > BVP))
        dv = PF(BVP, VVP, 0.02 * SizeBR * temp / 1.87) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    dV1 = dV1 + dv * 0.96;
    ValveRes->Flow(-0.04 * dv);
    // przeplyw PG <-> rozdzielacz
    dv = PF(PP, VVP, 0.01) * dt;
    result = dv - dV1;

    temp = Max0R(BCP, LBP);

    // luzowanie CH
    if ((BrakeCyl->P() > temp + 0.005) || (Max0R(ImplsRes->P(), 8 * LBP) < 0.25))
        dv = PF(0, BrakeCyl->P(), 0.015 * SizeBC) * dt;
    else
        dv = 0;
    BrakeCyl->Flow(-dv);

    // przeplyw ZP <-> CH
    if ((BrakeCyl->P() < temp - 0.005) && (Max0R(ImplsRes->P(), 8 * LBP) > 0.3) &&
        (Max0R(BCP, LBP) < MaxBP))
        dv = PF(BVP, BrakeCyl->P(), 0.020 * SizeBC) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    BrakeCyl->Flow(-dv);

    ImplsRes->Act();
    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    return result;
}

//--- KNORR KE ---
void TKE::CheckReleaser( double const dt )
{
    double VVP;
    double CVP;

    VVP = ValveRes->P();
    CVP = CntrlRes->P();

    // odluzniacz
    if ( true == ((BrakeStatus & b_rls) == b_rls))
        if ((CVP - VVP < 0))
            BrakeStatus &= ~b_rls;
        else
            CntrlRes->Flow(+PF(CVP, 0, 0.1) * dt);
}

void TKE::CheckState( double const BCP, double &dV1 )
{
    double VVP;
    double BVP;
    double CVP;

    BVP = BrakeRes->P();
    VVP = ValveRes->P();
    CVP = CntrlRes->P();

    // sprawdzanie stanu
    if( BCP > 0.1 ) {

        if( ( BrakeStatus & b_hld ) == b_hld ) {

            if( ( VVP + 0.003 + BCP / BVM ) < CVP ) {
                // hamowanie stopniowe;
                BrakeStatus |= b_on;
            }
            else {
                if( ( VVP + BCP / BVM ) > CVP ) {
                    // zatrzymanie napelaniania;
                    BrakeStatus &= ~b_on;
                }
                if( ( VVP - 0.003 + BCP / BVM ) > CVP ) {
                    // luzowanie;
                    BrakeStatus &= ~( b_on | b_hld );
                }
            }
        }
        else {

            if( ( VVP + BCP / BVM < CVP )
             && ( ( CVP - VVP ) * BVM > 0.25 ) ) {
              // zatrzymanie luzowanie
                BrakeStatus |= b_hld;
            }
        }
    }
    else {

        if( VVP + 0.1 < CVP ) {
            // poczatek hamowania
            if( ( BrakeStatus & b_hld ) == 0 ) {
                // przyspieszacz
                ValveRes->CreatePress( 0.8 * VVP );
                SoundFlag |= sf_Acc;
                ValveRes->Act();
            }
            BrakeStatus |= ( b_on | b_hld );
        }
    }

    if( ( BrakeStatus & b_hld ) == 0 ) {
        SoundFlag |= sf_CylU;
    }
}

double TKE::CVs( double const BP )
{
    double VVP;
    double BVP;
    double CVP;

    BVP = BrakeRes->P();
    CVP = CntrlRes->P();
    VVP = ValveRes->P();

    // przeplyw ZS <-> PG
    if ((BP > 0.2))
        return 0;
    else if ((VVP > CVP + 0.4))
        return 0.05;
    else
        return 0.23;
}

double TKE::BVs( double const BCP )
{
    double VVP;
    double BVP;
    double CVP;

    BVP = BrakeRes->P();
    CVP = CntrlRes->P();
    VVP = ValveRes->P();

    // przeplyw ZP <-> rozdzielacz
    if ((BVP > VVP))
        return 0;
    else if ((BVP < CVP - 0.3))
        return 0.6;
    else
        return 0.13;
}

double TKE::GetPF( double const PP, double const dt, double const Vel )
{
    double dv;
    double dV1;
    double temp;
    double VVP;
    double BVP;
    double BCP;
    double IMP;
    double CVP;

    BVP = BrakeRes->P();
    VVP = ValveRes->P();
    BCP = BrakeCyl->P();
    IMP = ImplsRes->P();
    CVP = CntrlRes->P();

    dv = 0;
    dV1 = 0;

    // sprawdzanie stanu
    CheckState(IMP, dV1);
    CheckReleaser(dt);

    // przeplyw ZS <-> PG
    temp = CVs(IMP);
    dv = PF(CVP, VVP, 0.0015 * temp) * dt;
    CntrlRes->Flow(+dv);
    ValveRes->Flow(-0.04 * dv);
    dV1 = dV1 - 0.96 * dv;

    // luzowanie
    if ((BrakeStatus & b_hld) == b_off)
    {
        if (((BrakeDelayFlag & bdelay_G) == 0))
            temp = 0.283 + 0.139;
        else
            temp = 0.139;
        dv = PF(0, IMP, 0.001 * temp) * dt;
    }
    else
        dv = 0;
    ImplsRes->Flow(-dv);

    // przeplyw ZP <-> silowniki
    if (((BrakeStatus & b_on) == b_on) && (IMP < MaxBP))
    {
        temp = 0.113;
        if (((BrakeDelayFlag & bdelay_G) == 0))
            temp = temp + 0.636;
        if ((BCP < 0.5))
            temp = temp + 0.785;
        dv = PF(BVP, IMP, 0.001 * temp) * dt;
    }
    else
        dv = 0;
    BrakeRes->Flow(dv);
    ImplsRes->Flow(-dv);

    // rapid
    if (!((typeid(*FM) == typeid(TDisk1)) ||
          (typeid(*FM) == typeid(TDisk2)))) // jesli zeliwo to schodz
        RapidStatus = ((BrakeDelayFlag & bdelay_R) == bdelay_R) &&
                      ((RV < 0) || ((Vel > RV) && (RapidStatus)) || (Vel > (RV + 20)));
    else // jesli tarczowki, to zostan
        RapidStatus = ((BrakeDelayFlag & bdelay_R) == bdelay_R);

    //  temp:=1.9-0.9*int(RapidStatus);

    if ((RM * RM > 0.001)) // jesli jest rapid
        if ((RM > 0)) // jesli dodatni (naddatek);
            temp = 1 - RM * int(RapidStatus);
        else
            temp = 1 - RM * (1 - int(RapidStatus));
    else
        temp = 1;
    temp = temp / LoadC;
    // luzowanie CH
    //  temp:=Max0R(BCP,LBP);
    IMP = Max0R(IMP / temp, Max0R(LBP, ASBP * int((BrakeStatus & b_asb) == b_asb)));
	if ((ASBP < 0.1) && ((BrakeStatus & b_asb) == b_asb))
		IMP = 0;
    // luzowanie CH
    if ((BCP > IMP + 0.005) || (Max0R(ImplsRes->P(), 8 * LBP) < 0.25))
        dv = PFVd(BCP, 0, 0.05, IMP) * dt;
    else
        dv = 0;
    BrakeCyl->Flow(-dv);
    if ((BCP < IMP - 0.005) && (Max0R(ImplsRes->P(), 8 * LBP) > 0.3))
        dv = PFVa(BVP, BCP, 0.05, IMP) * dt;
    else
        dv = 0;
    BrakeRes->Flow(-dv);
    BrakeCyl->Flow(+dv);

    // przeplyw ZP <-> rozdzielacz
    temp = BVs(IMP);
    //  if(BrakeStatus and b_hld)=b_off then
    if ((IMP < 0.25) || (VVP + 0.05 > BVP))
        dv = PF(BVP, VVP, 0.02 * SizeBR * temp / 1.87) * dt;
    else
        dv = 0;
    BrakeRes->Flow(dv);
    dV1 = dV1 + dv * 0.96;
    ValveRes->Flow(-0.04 * dv);
    // przeplyw PG <-> rozdzielacz
    dv = PF(PP, VVP, 0.01) * dt;
    ValveRes->Flow(-dv);

    ValveRes->Act();
    BrakeCyl->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    ImplsRes->Act();
    return dv - dV1;
}

void TKE::Init( double const PP, double const HPP, double const LPP, double const BP, int const BDF )
{
    TBrake::Init(PP, HPP, LPP, BP, BDF);
    ValveRes->CreatePress(PP);
    BrakeCyl->CreatePress(BP);
    BrakeRes->CreatePress(PP);

    CntrlRes->CreateCap(5);
    CntrlRes->CreatePress(HPP);

    ImplsRes->CreateCap(1);
    ImplsRes->CreatePress(BP);

    BrakeStatus = b_off;

    BVM = 1.0 / (HPP - LPP) * MaxBP;

    BrakeDelayFlag = BDF;
}

double TKE::GetCRP()
{
    return CntrlRes->P();
}

double TKE::GetHPFlow( double const HP, double const dt )
{
    double dv;

    dv = PF(HP, BrakeRes->P(), 0.01) * dt;
    dv = Min0R(0, dv);
    BrakeRes->Flow(-dv);
    return dv;
}

void TKE::PLC( double const mass )
{
    LoadC = 1 +
            int(mass < LoadM) *
                ((TareBP + (MaxBP - TareBP) * (mass - TareM) / (LoadM - TareM)) / MaxBP - 1);
}

void TKE::SetLP( double const TM, double const LM, double const TBP )
{
    TareM = TM;
    LoadM = LM;
    TareBP = TBP;
}

void TKE::SetRM( double const RMR )
{
    RM = 1.0 - RMR;
}

void TKE::SetLBP( double const P )
{
    LBP = P;
}

void TKE::ForceEmptiness() {

    ValveRes->CreatePress( 0 );
    BrakeRes->CreatePress( 0 );
    CntrlRes->CreatePress( 0 );
    ImplsRes->CreatePress( 0 );
    Brak2Res->CreatePress( 0 );

    ValveRes->Act();
    BrakeRes->Act();
    CntrlRes->Act();
    ImplsRes->Act();
    Brak2Res->Act();
}

//---KRANY---

double TDriverHandle::GetPF(double const i_bcp, double PP, double HP, double dt, double ep)
{
    return 0;
}

void TDriverHandle::Init(double Press)
{
    Time = false;
    TimeEP = false;
}

void TDriverHandle::SetReductor(double nAdj)
{
}

double TDriverHandle::GetCP()
{
    return 0;
}

double TDriverHandle::GetEP()
{
	return 0;
}

double TDriverHandle::GetRP()
{
	return 0;
}

double TDriverHandle::GetSound(int i)
{
    return 0;
}

double TDriverHandle::GetPos(int i)
{
    return 0;
}

double TDriverHandle::GetEP(double pos)
{
    return 0;
}

void TDriverHandle::OvrldButton(bool Active)
{
	ManualOvrldActive = Active;
}

void TDriverHandle::SetUniversalFlag(int flag)
{
	UniversalFlag = flag;
}
//---FV4a---

double TFV4a::GetPF(double i_bcp, double PP, double HP, double dt, double ep)
{
    static int const LBDelay = 100;

    ep = PP; // SPKS!!
    double LimPP = std::min(BPT[std::lround(i_bcp) + 2][1], HP);
    double ActFlowSpeed = BPT[std::lround(i_bcp) + 2][0];

    if ((i_bcp == i_bcpno))
        LimPP = 2.9;

    CP = CP + 20 * std::min(std::abs(LimPP - CP), 0.05) * PR(CP, LimPP) * dt / 1;
    RP = RP + 20 * std::min(std::abs(ep - RP), 0.05) * PR(RP, ep) * dt / 2.5;

    LimPP = CP;
    double dpPipe = std::min(HP, LimPP);

    double dpMainValve = PF(dpPipe, PP, ActFlowSpeed / LBDelay) * dt;
    if ((CP > RP + 0.05))
        dpMainValve = PF(std::min(CP + 0.1, HP), PP, 1.1 * ActFlowSpeed / LBDelay) * dt;
    if ((CP < RP - 0.05))
        dpMainValve = PF(CP - 0.1, PP, 1.1 * ActFlowSpeed / LBDelay) * dt;

    if (lround(i_bcp) == -1)
    {
        CP = CP + 5 * std::min(std::abs(LimPP - CP), 0.2) * PR(CP, LimPP) * dt / 2;
        if ((CP < RP + 0.03))
            if ((TP < 5))
                TP = TP + dt;
        //            if(cp+0.03<5.4)then
        if ((RP + 0.03 < 5.4) || (CP + 0.03 < 5.4)) // fala
            dpMainValve = PF(std::min(HP, 17.1), PP, ActFlowSpeed / LBDelay) * dt;
        //              dpMainValve:=20*Min0R(abs(ep-7.1),0.05)*PF(HP,pp,ActFlowSpeed/LBDelay)*dt;
        else
        {
            RP = 5.45;
            if ((CP < PP - 0.01)) //: /34*9
                dpMainValve = PF(dpPipe, PP, ActFlowSpeed / 34 * 9 / LBDelay) * dt;
            else
                dpMainValve = PF(dpPipe, PP, ActFlowSpeed / LBDelay) * dt;
        }
    }

    if ((lround(i_bcp) == 0))
    {
        if ((TP > 0.1))
        {
            CP = 5 + (TP - 0.1) * 0.08;
            TP = TP - dt / 12 / 2;
        }
        if ((CP > RP + 0.1) && (CP <= 5))
            dpMainValve = PF(std::min(CP + 0.25, HP), PP, 2 * ActFlowSpeed / LBDelay) * dt;
        else if (CP > 5)
            dpMainValve = PF(std::min(CP, HP), PP, 2 * ActFlowSpeed / LBDelay) * dt;
        else
            dpMainValve = PF(dpPipe, PP, ActFlowSpeed / LBDelay) * dt;
    }

    if ((lround(i_bcp) == i_bcpno))
    {
        dpMainValve = PF(0, PP, ActFlowSpeed / LBDelay) * dt;
    }

    return dpMainValve;
}

void TFV4a::Init(double Press)
{
    CP = Press;
    RP = Press;
}

//---FV4a/M--- nowonapisany kran bez poprawki IC

double TFV4aM::GetPF(double i_bcp, double PP, double HP, double dt, double ep)
{
    int const LBDelay { 100 };
    double const xpM { 0.3 }; // mnoznik membrany komory pod

    ep = (PP / 2.0) * 1.5 + (ep / 2.0) * 0.5; // SPKS!!

    for( int idx = 0; idx < 5; ++idx ) {
        Sounds[ idx ] = 0;
    }

    // na wszelki wypadek, zeby nie wyszlo poza zakres
    i_bcp = clamp( i_bcp, -1.999, 5.999 );

    double DP{ 0.0 };
    if( TP > 0.0 ) {
        // jesli czasowy jest niepusty
        DP = 0.045; // 2.5 w 55 sekund (5,35->5,15 w PG)
        TP -= DP * dt;
        Sounds[s_fv4a_t] = DP;
    }
    else {
        //.08
        TP = 0.0;
    }

    if (XP > 0) {
        // jesli komora pod niepusta jest niepusty
        DP = 2.5;
        Sounds[s_fv4a_x] = DP * XP;
        XP -= dt * DP * 2.0; // od cisnienia 5 do 0 w 10 sekund ((5-0)*dt/10)
    }
    else {
        // jak pusty, to pusty
        XP = 0.0;
    }

    double pom;
    if( EQ( i_bcp, -1.0 ) ) {
        pom = std::min( HP, 5.4 + RedAdj );
    }
    else {
        pom = std::min( CP, HP );
    }

    if( pom > RP + 0.25 ) {
        Fala = true;
    }
    if( Fala ) {
        if( pom > RP + 0.3 ) {
            XP = XP - 20.0 * PR( pom, XP ) * dt;
        }
        else {
            Fala = false;
        }
    }

    double LimPP = std::min(
        LPP_RP( i_bcp ) + TP * 0.08 + RedAdj,
        HP ); // pozycja + czasowy lub zasilanie

    // zbiornik sterujacy
    if( LimPP > CP ) {
        // podwyzszanie szybkie
        CP +=
            5.0 * 60.0
            * std::min(
                std::abs( LimPP - CP ),
                0.05 )
            * PR( CP, LimPP )
            * dt;
    }
    else {
        CP += 
            13
            * std::min(
                std::abs( LimPP - CP ),
                0.05 )
            * PR( CP, LimPP )
            * dt;
    }

    LimPP = pom; // cp
    double const dpPipe = std::min(HP, LimPP + XP * xpM);

    double const ActFlowSpeed = BPT[ std::lround( i_bcp ) + 2 ][ 0 ];

    double dpMainValve = (
        dpPipe > PP ?
            -PFVa( HP, PP, ActFlowSpeed / LBDelay, dpPipe, 0.4 ) :
             PFVd( PP,  0, ActFlowSpeed / LBDelay, dpPipe, 0.4 ) );

    if (EQ(i_bcp, -1)) {

        if( TP < 5 ) { TP += dt; }
        if( TP < 1 ) { TP -= 0.5 * dt; }
    }

    if (EQ(i_bcp, 0)) {

        if( TP > 2 ) {
            dpMainValve *= 1.5;
        }
    }

    ep = dpPipe;
    if( ( EQ( i_bcp, 0 )
     || ( RP > ep ) ) ) {
        // powolne wzrastanie, ale szybsze na jezdzie;
        RP += PF( RP, ep, 0.0007 ) * dt;
    }
    else {
        // powolne wzrastanie i to bardzo
        RP += PF( RP, ep, 0.000093 / 2 * 2 ) * dt;
    }
    // jednak trzeba wydluzyc, bo obecnie zle dziala
    if( ( RP < ep )
     && ( RP < BPT[ std::lround( i_bcpno ) + 2 ][ 1 ] ) ) {
        // jesli jestesmy ponizej cisnienia w sterujacym (2.9 bar)
        // przypisz cisnienie w PG - wydluzanie napelniania o czas potrzebny do napelnienia PG
        RP += PF( RP, CP, 0.005 ) * dt; 
    }

    if( ( EQ( i_bcp, i_bcpno ) )
     || ( EQ( i_bcp, -2 ) ) ) {

        DP = PF( 0.0, PP, ActFlowSpeed / LBDelay );
        dpMainValve = DP;
        Sounds[s_fv4a_e] = DP;
        Sounds[s_fv4a_u] = 0.0;
        Sounds[s_fv4a_b] = 0.0;
        Sounds[s_fv4a_x] = 0.0;
    }
    else {

        if( dpMainValve > 0.0 ) {
            Sounds[ s_fv4a_b ] = dpMainValve;
        }
        else {
            Sounds[ s_fv4a_u ] = -dpMainValve;
        }
    }

    return dpMainValve * dt;
}

void TFV4aM::Init(double Press)
{
    CP = Press;
    RP = Press;
}

void TFV4aM::SetReductor(double nAdj)
{
    RedAdj = nAdj;
}

double TFV4aM::GetSound(int i)
{
    if (i > 4)
        return 0;
    else
        return Sounds[i];
}

double TFV4aM::GetPos(int i)
{
    return pos_table[i];
}

double TFV4aM::GetCP()
{
	return TP;
}

double TFV4aM::GetRP()
{
	return 5.0 +TP * 0.08 + RedAdj;
}

double TFV4aM::LPP_RP(double pos) // cisnienie z zaokraglonej pozycji;
{
    int const i_pos = 2 + std::floor( pos ); // zaokraglone w dol

    return
        BPT[i_pos][1]
        + (BPT[i_pos + 1][1] - BPT[i_pos][1]) * ((pos + 2) - i_pos); // interpolacja liniowa
}
bool TFV4aM::EQ(double pos, double i_pos)
{
    return (pos <= i_pos + 0.5) && (pos > i_pos - 0.5);
}

//---MHZ_EN57--- manipulator hamulca zespolonego do EN57

double TMHZ_EN57::GetPF( double i_bcp, double PP, double HP, double dt, double ep ) {
    static int const LBDelay = 100;

    double LimPP;
    double dpPipe;
    double dpMainValve;
    double ActFlowSpeed;
    double DP;
    double pom;

    for( int idx = 0; idx < 5; ++idx ) {
        Sounds[ idx ] = 0;
    }

    DP = 0;

    i_bcp = Max0R(Min0R(i_bcp, 9.999), -0.999); // na wszelki wypadek, zeby nie wyszlo poza zakres

    if ((TP > 0)&&(CP > 4.9))
    {
        DP = OverloadPressureDecrease;
        if (EQ(i_bcp, 0))
            TP = TP - DP * dt;
        Sounds[s_fv4a_t] = DP;
    }
    else
    {
        TP = 0;
    }

    LimPP = Min0R(LPP_RP(i_bcp) + TP * 0.08 + RedAdj, HP); // pozycja + czasowy lub zasilanie
    ActFlowSpeed = 4;

	double uop = UnbrakeOverPressure; //unbrake over pressure in actual state
	ManualOvrldActive = (UniversalFlag & TUniversalBrake::ub_HighPressure); //button is pressed
	if (ManualOvrld && !ManualOvrldActive) //no overpressure for not pressed button if it does not exists
		uop = 0;

    if ( ( EQ( i_bcp, -1 ) ) && ( uop > 0 ) )
        pom = Min0R(HP, 5.4 + RedAdj + uop);
    else
        pom = Min0R(CP, HP);

    if ((LimPP > CP)) // podwyzszanie szybkie
        CP = CP + 60 * Min0R(abs(LimPP - CP), 0.05) * PR(CP, LimPP) * dt; // zbiornik sterujacy;
    else
        CP = CP + 13 * Min0R(abs(LimPP - CP), 0.05) * PR(CP, LimPP) * dt; // zbiornik sterujacy

    LimPP = pom; // cp
    //if (EQ(i_bcp, -1))
 //       dpPipe = HP;
 //   else
        dpPipe = Min0R(HP, LimPP);

    if (dpPipe > PP)
        dpMainValve = -PFVa(HP, PP, ActFlowSpeed / LBDelay, dpPipe, 0.4);
    else
        dpMainValve = PFVd(PP, 0, ActFlowSpeed / LBDelay, dpPipe, 0.4);

    if ( ( EQ(i_bcp, -1) && ( AutoOvrld ) )
		||(i_bcp<0.5 && (UniversalFlag & TUniversalBrake::ub_Overload)))
    {
        if ((TP < 5))
            TP = TP + dt; // 5/10
        if ((TP < OverloadMaxPressure))
            TP = TP - 0.5 * dt; // 5/10
    }

    if ((EQ(i_bcp, 10)) || (EQ(i_bcp, -2)))
    {
        DP = PF(0, PP, 2 * ActFlowSpeed / LBDelay);
        dpMainValve = DP;
        Sounds[s_fv4a_e] = DP;
        Sounds[s_fv4a_u] = 0;
        Sounds[s_fv4a_b] = 0;
        Sounds[s_fv4a_x] = 0;
    }
    else
    {
        if (dpMainValve > 0)
            Sounds[s_fv4a_b] = dpMainValve;
        else
            Sounds[s_fv4a_u] = -dpMainValve;
    }

    if ((i_bcp < 1.5))
        RP = Max0R(0, 0.125 * i_bcp);
    else
        RP = Min0R(1, 0.125 * i_bcp - 0.125);

    return dpMainValve * dt;
}

void TMHZ_EN57::Init(double Press)
{
    CP = Press;
}

void TMHZ_EN57::SetReductor(double nAdj)
{
    RedAdj = nAdj;
}

double TMHZ_EN57::GetSound(int i)
{
    if (i > 4)
        return 0;
    else
        return Sounds[i];
}

double TMHZ_EN57::GetPos(int i)
{
    return pos_table[i];
}

double TMHZ_EN57::GetCP()
{
    return RP;
}

double TMHZ_EN57::GetRP()
{
	return 5.0 + RedAdj;
}

double TMHZ_EN57::GetEP(double pos)
{
    if (pos < 9.5)
        return Min0R(Max0R(0, 0.125 * pos), 1);
    else
        return 0;
}

double TMHZ_EN57::LPP_RP(double pos) // cisnienie z zaokraglonej pozycji;
{
    if (pos > 8.5)
        return 5.0 - 0.15 * pos - 0.35;
    else if (pos > 0.5)
        return 5.0 - 0.15 * pos - 0.1;
    else
        return 5.0;
}

void TMHZ_EN57::SetParams(bool AO, bool MO, double OverP, double, double OMP, double OPD)
{
	AutoOvrld = AO;
	ManualOvrld = MO;
	UnbrakeOverPressure = std::max(0.0, OverP);
	Fala = (OverP > 0.01);
	OverloadMaxPressure = OMP;
	OverloadPressureDecrease = OPD;

}

bool TMHZ_EN57::EQ(double pos, double i_pos)
{
    return (pos <= i_pos + 0.5) && (pos > i_pos - 0.5);
}

//---MHZ_K5P--- manipulator hamulca zespolonego Knorr 5-ciopozycyjny

double TMHZ_K5P::GetPF(double i_bcp, double PP, double HP, double dt, double ep) {
	static int const LBDelay = 100;

	double LimCP;
	double dpPipe;
	double dpMainValve;
	double ActFlowSpeed;
	double DP;
	double pom;

	for (int idx = 0; idx < 5; ++idx) {
		Sounds[idx] = 0;
	}

	DP = 0;

	i_bcp = Max0R(Min0R(i_bcp, 2.999), -0.999); // na wszelki wypadek, zeby nie wyszlo poza zakres

	if ((TP > 0)&&(CP>4.9))
	{
		DP = OverloadPressureDecrease;
		TP = TP - DP * dt;
		Sounds[s_fv4a_t] = DP;
	}
	else
	{
		//TP = 0; //tu nie powinno być nic, ciśnienie zostaje jak było
	}
	
	if (EQ(i_bcp, 1)) //odcięcie - nie rób nic
		LimCP = CP;
	else if (i_bcp > 1) //hamowanie
		LimCP = 3.4;
	else //luzowanie
		LimCP = 5.0;
	pom = CP;
	LimCP = Min0R(LimCP, HP); // pozycja + czasowy lub zasilanie
	ActFlowSpeed = 4;

	if ((LimCP > CP)) // podwyzszanie szybkie
		CP = CP + 9 * Min0R(abs(LimCP - CP), 0.05) * PR(CP, LimCP) * dt; // zbiornik sterujacy;
	else
		CP = CP + 9 * Min0R(abs(LimCP - CP), 0.05) * PR(CP, LimCP) * dt; // zbiornik sterujacy

	double uop = UnbrakeOverPressure; //unbrake over pressure in actual state
	ManualOvrldActive = (UniversalFlag & TUniversalBrake::ub_HighPressure); //button is pressed
	if (ManualOvrld && !ManualOvrldActive) //no overpressure for not pressed button if it does not exists
		uop = 0;

	dpPipe = Min0R(HP, CP + TP + RedAdj);

	if (EQ(i_bcp, -1))
	{
		if (Fala)
		{
			dpPipe = 5.0 + TP + RedAdj + uop;
			ActFlowSpeed = 12;
		}
		else
		{
			ActFlowSpeed *= FillingStrokeFactor;
		}
	}

	if (dpPipe > PP)
		dpMainValve = -PFVa(HP, PP, ActFlowSpeed / LBDelay, dpPipe, 0.4);
	else
		dpMainValve = PFVd(PP, 0, ActFlowSpeed / LBDelay, dpPipe, 0.4);

	if ((EQ(i_bcp, -1) && (AutoOvrld)) || ((i_bcp<0.5) && (UniversalFlag & TUniversalBrake::ub_Overload)))
	{
		if ((TP < OverloadMaxPressure))
			TP = TP + 0.03  * dt;
	}

	if (EQ(i_bcp, 3))
	{
		DP = PF(0, PP, 2 * ActFlowSpeed / LBDelay);
		dpMainValve = DP;
		Sounds[s_fv4a_e] = DP;
		Sounds[s_fv4a_u] = 0;
		Sounds[s_fv4a_b] = 0;
		Sounds[s_fv4a_x] = 0;
	}
	else
	{
		if (dpMainValve > 0)
			Sounds[s_fv4a_b] = dpMainValve;
		else
			Sounds[s_fv4a_u] = -dpMainValve;
	}

	return dpMainValve * dt;
}

void TMHZ_K5P::Init(double Press)
{
	CP = Press;
	Time = true;
	TimeEP = true;
}

void TMHZ_K5P::SetReductor(double nAdj)
{
	RedAdj = nAdj;
}

double TMHZ_K5P::GetSound(int i)
{
	if (i > 4)
		return 0;
	else
		return Sounds[i];
}

double TMHZ_K5P::GetPos(int i)
{
	return pos_table[i];
}

double TMHZ_K5P::GetCP()
{
	return CP;
}

double TMHZ_K5P::GetRP()
{
	return 5.0 + TP + RedAdj;
}

void TMHZ_K5P::SetParams(bool AO, bool MO, double OverP, double FSF, double OMP, double OPD)
{
	AutoOvrld = AO;
	ManualOvrld = MO;
	UnbrakeOverPressure = std::max(0.0, OverP);
	Fala = (OverP > 0.01);
	OverloadMaxPressure = OMP;
	OverloadPressureDecrease = OPD;
	FillingStrokeFactor = 1 + FSF;
	
}

bool TMHZ_K5P::EQ(double pos, double i_pos)
{
	return (pos <= i_pos + 0.5) && (pos > i_pos - 0.5);
}

//---MHZ_6P--- manipulator hamulca zespolonego 6-ciopozycyjny

double TMHZ_6P::GetPF(double i_bcp, double PP, double HP, double dt, double ep) {
	static int const LBDelay = 100;

	double LimCP;
	double dpPipe;
	double dpMainValve;
	double ActFlowSpeed;
	double DP;
	double pom;

	for (int idx = 0; idx < 5; ++idx) {
		Sounds[idx] = 0;
	}

	DP = 0;

	i_bcp = Max0R(Min0R(i_bcp, 3.999), -0.999); // na wszelki wypadek, zeby nie wyszlo poza zakres

	if ((TP > 0)&&(CP>4.9))
	{
		DP = OverloadPressureDecrease;
		TP = TP - DP * dt;
		Sounds[s_fv4a_t] = DP;
	}
	else
	{
		//TP = 0; //tu nie powinno być nic, ciśnienie zostaje jak było
	}

	if (EQ(i_bcp, 2)) //odcięcie - nie rób nic
		LimCP = CP;
	else if (i_bcp > 2.5) //hamowanie
		LimCP = 3.4;
	else //luzowanie
		LimCP = 5.0;
	pom = CP;
	LimCP = Min0R(LimCP, HP); // pozycja + czasowy lub zasilanie
	ActFlowSpeed = 4;

	if ((LimCP > CP)) // podwyzszanie szybkie
		CP = CP + 9 * Min0R(abs(LimCP - CP), 0.05) * PR(CP, LimCP) * dt; // zbiornik sterujacy;
	else
		CP = CP + 9 * Min0R(abs(LimCP - CP), 0.05) * PR(CP, LimCP) * dt; // zbiornik sterujacy

	dpPipe = Min0R(HP, CP + TP + RedAdj);

	double uop = UnbrakeOverPressure; //unbrake over pressure in actual state
	ManualOvrldActive = (UniversalFlag & TUniversalBrake::ub_HighPressure); //button is pressed
	if (ManualOvrld && !ManualOvrldActive) //no overpressure for not pressed button if it does not exists
		uop = 0;

	if (EQ(i_bcp, -1))
	{
		if (Fala)
		{
			dpPipe = 5.0 + TP + RedAdj + uop;
			ActFlowSpeed = 12;
		}
		else
		{
			ActFlowSpeed *= FillingStrokeFactor;
		}
	}

	if (dpPipe > PP)
		dpMainValve = -PFVa(HP, PP, ActFlowSpeed / LBDelay, dpPipe, 0.4);
	else
		dpMainValve = PFVd(PP, 0, ActFlowSpeed / LBDelay, dpPipe, 0.4);

	if ((EQ(i_bcp, -1) && (AutoOvrld)) || ((i_bcp<0.5) && (UniversalFlag & TUniversalBrake::ub_Overload)))
	{
		if ((TP < OverloadMaxPressure))
			TP = TP + 0.03  * dt;
	}

	if (EQ(i_bcp, 4))
	{
		DP = PF(0, PP, 2 * ActFlowSpeed / LBDelay);
		dpMainValve = DP;
		Sounds[s_fv4a_e] = DP;
		Sounds[s_fv4a_u] = 0;
		Sounds[s_fv4a_b] = 0;
		Sounds[s_fv4a_x] = 0;
	}
	else
	{
		if (dpMainValve > 0)
			Sounds[s_fv4a_b] = dpMainValve;
		else
			Sounds[s_fv4a_u] = -dpMainValve;
	}

	return dpMainValve * dt;
}

void TMHZ_6P::Init(double Press)
{
	CP = Press;
	Time = true;
	TimeEP = true;
}

void TMHZ_6P::SetReductor(double nAdj)
{
	RedAdj = nAdj;
}

double TMHZ_6P::GetSound(int i)
{
	if (i > 4)
		return 0;
	else
		return Sounds[i];
}

double TMHZ_6P::GetPos(int i)
{
	return pos_table[i];
}

double TMHZ_6P::GetCP()
{
	return CP;
}

double TMHZ_6P::GetRP()
{
	return 5.0 + TP + RedAdj;
} 

void TMHZ_6P::SetParams(bool AO, bool MO, double OverP, double FSF, double OMP, double OPD)
{
	AutoOvrld = AO;
	ManualOvrld = MO;
	UnbrakeOverPressure = std::max(0.0, OverP);
	Fala = (OverP > 0.01);
	OverloadMaxPressure = OMP;
	OverloadPressureDecrease = OPD;
	FillingStrokeFactor = 1 + FSF;

}

bool TMHZ_6P::EQ(double pos, double i_pos)
{
	return (pos <= i_pos + 0.5) && (pos > i_pos - 0.5);
}

//---M394--- Matrosow

double TM394::GetPF(double i_bcp, double PP, double HP, double dt, double ep)
{
    static int const LBDelay = 65;

    double LimPP;
    double dpPipe;
    double dpMainValve;
    double ActFlowSpeed;
    int BCP;

    BCP = lround(i_bcp);
    if (BCP < -1)
        BCP = 1;

    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))
        LimPP = LimPP + RedAdj;
    if ((BCP != 2))
        if (CP < LimPP)
            CP = CP + 4 * Min0R(abs(LimPP - CP), 0.05) * PR(CP, LimPP) * dt; // zbiornik sterujacy
        //      cp:=cp+6*(2+int(bcp<0))*Min0R(abs(Limpp-cp),0.05)*PR(cp,Limpp)*dt //zbiornik
        //      sterujacy;
        else if (BCP == 0)
            CP = CP - 0.2 * dt / 100;
        else
            CP = CP +
                 4 * (1 + int(BCP != 3) + int(BCP > 4)) * Min0R(abs(LimPP - CP), 0.05) *
                     PR(CP, LimPP) * dt; // zbiornik sterujacy

    LimPP = CP;
    dpPipe = Min0R(HP, LimPP);

    //  if(dpPipe>pp)then //napelnianie
    //    dpMainValve:=PF(dpPipe,pp,ActFlowSpeed/LBDelay)*dt
    //  else //spuszczanie
    dpMainValve = PF(dpPipe, PP, ActFlowSpeed / LBDelay) * dt;

    if (BCP == -1)
        dpMainValve = PF(HP, PP, ActFlowSpeed / LBDelay) * dt;

    if (BCP == i_bcpno)
        dpMainValve = PF(0, PP, ActFlowSpeed / LBDelay) * dt;

    return dpMainValve;
}

void TM394::Init(double Press)
{
    CP = Press;
    Time = true;
}

void TM394::SetReductor(double nAdj)
{
    RedAdj = nAdj;
}

double TM394::GetCP()
{
    return CP;
}

double TM394::GetRP()
{
	return std::max(5.0, CP) + RedAdj;
}

double TM394::GetPos(int i)
{
    return pos_table[i];
}

//---H14K1-- Knorr

double TH14K1::GetPF(double i_bcp, double PP, double HP, double dt, double ep)
{
    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) };
    double const NomPress = 5.0;

    int BCP = std::lround(i_bcp);
    if( i_bcp < -1 ) { BCP = 1; }

    double LimPP = BPT_K[BCP + 1][1];
         if( LimPP < 0.0 ) { LimPP = 0.5 * PP; }
    else if( LimPP > 0.0 ) { LimPP = PP; }
    else                   { LimPP = CP; }
    double ActFlowSpeed = BPT_K[BCP + 1][0];

    CP = CP + 6 * std::min( std::abs(LimPP - CP), 0.05 ) * PR(CP, LimPP) * dt; // zbiornik sterujacy

    double dpMainValve = 0.0;

    if (BCP == -1)
        dpMainValve = PF(HP, PP, ActFlowSpeed / LBDelay) * dt;
    if ((BCP == 0))
        dpMainValve = -PFVa(HP, PP, ActFlowSpeed / LBDelay, NomPress + RedAdj) * dt;
    if ((BCP > 1) && (PP > CP))
        dpMainValve = PFVd(PP, 0, ActFlowSpeed / LBDelay, CP) * dt;
    if (BCP == i_bcpno)
        dpMainValve = PF(0, PP, ActFlowSpeed / LBDelay) * dt;

    return dpMainValve;
}

void TH14K1::Init(double Press)
{
    CP = Press;
    Time = true;
    TimeEP = true;
}

void TH14K1::SetReductor(double nAdj)
{
    RedAdj = nAdj;
}

double TH14K1::GetCP()
{
    return CP;
}

double TH14K1::GetRP()
{
    return 5.0 + RedAdj;
}

double TH14K1::GetPos(int i)
{
    return pos_table[i];
}

//---St113-- Knorr EP

double TSt113::GetPF(double i_bcp, double PP, double HP, double dt, double ep)
{
    static int const LBDelay = 100; // szybkosc + zasilanie sterujacego
    static double const NomPress = 5.0;

    double LimPP;
    double dpMainValve;
    double ActFlowSpeed;
    int BCP;

	CP = PP;

    BCP = lround(i_bcp);

    EPS = BEP_K[BCP + 1];

    if (BCP > 0)
        BCP = BCP - 1;

    if (BCP < -1)
        BCP = 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];

    CP = CP + 6 * Min0R(abs(LimPP - CP), 0.05) * PR(CP, LimPP) * dt; // zbiornik sterujacy

    dpMainValve = 0;

    if (BCP == -1)
        dpMainValve = PF(HP, PP, ActFlowSpeed / LBDelay) * dt;
    if ((BCP == 0))
        dpMainValve = -PFVa(HP, PP, ActFlowSpeed / LBDelay, NomPress + RedAdj) * dt;
    if ((BCP > 1) && (PP > CP))
        dpMainValve = PFVd(PP, 0, ActFlowSpeed / LBDelay, CP) * dt;
    if (BCP == i_bcpno)
        dpMainValve = PF(0, PP, ActFlowSpeed / LBDelay) * dt;

    return dpMainValve;
}

double TSt113::GetCP()
{
    return CP;
}

double TSt113::GetRP()
{
	return 5.0 + RedAdj;
}

double TSt113::GetEP()
{
	return EPS;
}

double TSt113::GetPos(int i)
{
    return pos_table[i];
}

void TSt113::Init(double Press)
{
    Time = true;
    TimeEP = true;
}

//--- test ---

double Ttest::GetPF(double i_bcp, double PP, double HP, double dt, double ep)
{
    static int const LBDelay = 100;

    double LimPP;
    double dpPipe;
    double dpMainValve;
    double ActFlowSpeed;

    LimPP = BPT[lround(i_bcp) + 2][1];
    ActFlowSpeed = BPT[lround(i_bcp) + 2][0];

    if ((i_bcp == i_bcpno))
        LimPP = 0.0;

    if ((i_bcp == -1))
        LimPP = 7;

    CP = CP + 20 * Min0R(abs(LimPP - CP), 0.05) * PR(CP, LimPP) * dt / 1;

    LimPP = CP;
    dpPipe = Min0R(HP, LimPP);

    dpMainValve = PF(dpPipe, PP, ActFlowSpeed / LBDelay) * dt;

    if ((lround(i_bcp) == i_bcpno))
    {
        dpMainValve = PF(0, PP, ActFlowSpeed / LBDelay) * dt;
    }

    return dpMainValve;
}

void Ttest::Init(double Press)
{
    CP = Press;
}

//---FD1---

double TFD1::GetPF(double i_bcp, double PP, double HP, double dt, double ep)
{
    double DP;
    double temp;

    //  MaxBP:=4;
    //  temp:=Min0R(i_bcp*MaxBP,Min0R(5.0,HP));
    temp = std::min(i_bcp * MaxBP, HP); // 0011
    DP = 10.0 * std::min(std::abs(temp - BP), 0.1) * PF(temp, BP, 0.0006 * (temp > BP ? 3.0 : 2.0) ) * dt * Speed;
    BP = BP - DP;
    return -DP;
}

void TFD1::Init(double Press)
{
    MaxBP = Press;
    Speed = 1.0;
}

double TFD1::GetCP()
{
    return BP;
}

void TFD1::SetSpeed(double nSpeed)
{
    Speed = nSpeed;
}

//---KNORR---

double TH1405::GetPF(double i_bcp, double PP, double HP, double dt, double ep)
{
    double DP;
    double temp;
    double A;

    PP = Min0R(PP, MaxBP);
    if (i_bcp > 0.5)
    {
        temp = Min0R(MaxBP, HP);
        A = 2 * (i_bcp - 0.5) * 0.0011;
        BP = Max0R(BP, PP);
    }
    else
    {
        temp = 0;
        A = 0.2 * (0.5 - i_bcp) * 0.0033;
        BP = Min0R(BP, PP);
    }
    DP = PF(temp, BP, A) * dt;
    BP = BP - DP;
    return -DP;
}

void TH1405::Init(double Press)
{
    MaxBP = Press;
    Time = true;
}

double TH1405::GetCP()
{
    return BP;
}

//---FVel6---

double TFVel6::GetPF(double i_bcp, double PP, double HP, double dt, double ep)
{
    static int const LBDelay = 100;

    double LimPP;
    double dpMainValve;
    double ActFlowSpeed;

	CP = PP;

    LimPP = Min0R(5 * int(i_bcp < 3.5), HP);
    if ((i_bcp >= 3.5) && ((i_bcp < 4.3) || (i_bcp > 5.5)))
        ActFlowSpeed = 0;
    else if ((i_bcp > 4.3) && (i_bcp < 4.8))
        ActFlowSpeed = 4 * (i_bcp - 4.3); // konsultacje wawa1 - bylo 8;
    else if ((i_bcp < 4))
        ActFlowSpeed = 2;
    else
        ActFlowSpeed = 4;
    dpMainValve = PF(LimPP, PP, ActFlowSpeed / LBDelay) * dt;

    Sounds[s_fv4a_e] = 0;
    Sounds[s_fv4a_u] = 0;
    Sounds[s_fv4a_b] = 0;
    if ((i_bcp < 3.5))
        Sounds[s_fv4a_u] = -dpMainValve;
    else if ((i_bcp < 4.8))
        Sounds[s_fv4a_b] = dpMainValve;
    else if ((i_bcp < 5.5))
        Sounds[s_fv4a_e] = dpMainValve;

    if ((i_bcp < -0.5))
        EPS = -1;
    else if ((i_bcp > 0.5) && (i_bcp < 4.7))
        EPS = 1;
    else
        EPS = 0;
    //    EPS:=i_bcp*int(i_bcp<2)
    return dpMainValve;
}

double TFVel6::GetCP()
{
    return CP;
}

double TFVel6::GetRP()
{
	return 5.0;
}

double TFVel6::GetEP()
{
	return EPS;
}

double TFVel6::GetPos(int i)
{
    return pos_table[i];
}

double TFVel6::GetSound(int i)
{
    if (i > 2)
        return 0;
    else
        return Sounds[i];
}

void TFVel6::Init(double Press)
{
    Time = true;
    TimeEP = true;
}

//---FVE408---

double TFVE408::GetPF(double i_bcp, double PP, double HP, double dt, double ep)
{
	static int const LBDelay = 100;

	double LimPP;
	double dpMainValve;
	double ActFlowSpeed;

	CP = PP;

	LimPP = Min0R(5 * int(i_bcp < 6.5), HP);
	if ((i_bcp >= 6.5) && ((i_bcp < 7.5) || (i_bcp > 9.5)))
		ActFlowSpeed = 0;
	else if ((i_bcp > 7.5) && (i_bcp < 8.5))
		ActFlowSpeed = 2; // konsultacje wawa1 - bylo 8;
	else if ((i_bcp < 6.5))
		ActFlowSpeed = 2;
	else
		ActFlowSpeed = 4;
	dpMainValve = PF(LimPP, PP, ActFlowSpeed / LBDelay) * dt;

	Sounds[s_fv4a_e] = 0;
	Sounds[s_fv4a_u] = 0;
	Sounds[s_fv4a_b] = 0;
	if ((i_bcp < 6.5))
		Sounds[s_fv4a_u] = -dpMainValve;
	else if ((i_bcp < 8.5))
		Sounds[s_fv4a_b] = dpMainValve;
	else if ((i_bcp < 9.5))
		Sounds[s_fv4a_e] = dpMainValve;

	if (is_EQ(i_bcp, 1)) EPS = 1.15; else
	if (is_EQ(i_bcp, 2)) EPS = 1.40; else
	if (is_EQ(i_bcp, 3)) EPS = 2.64; else
	if (is_EQ(i_bcp, 4)) EPS = 3.84; else
	if (is_EQ(i_bcp, 5)) EPS = 3.99; else
						 EPS = 0;

	return dpMainValve;
}

double TFVE408::GetCP()
{
	return CP;
}

double TFVE408::GetEP()
{
	return EPS;
}

double TFVE408::GetRP()
{
	return 5.0;
}

double TFVE408::GetPos(int i)
{
	return pos_table[i];
}

double TFVE408::GetSound(int i)
{
	if (i > 2)
		return 0;
	else
		return Sounds[i];
}

void TFVE408::Init(double Press)
{
	Time = true;
	TimeEP = false;
}

// END