Brzdič BP - Serial

//══════════════════════════════════════════════════════════════════════════════════════════════════════//
//                                                                    Brzdič lokomotivní Dako BP                                                                                 //
// Funkce pro ovládání brzdiče DAKO BP, má dva vstupní parametry : 1) Pin Arduina, na který je připojen potenciometr                                                             //
//                                                                 2) CVID - trojznak definovaný v programu TStoCOM                                                              //
// Funkce posílá pomocí sériové linky hodnotu v rozsahu 1-50 (násobitel je 50), která je opožděna z důvodu nepřeplněnování Serialu o 40 nebo 80ms.                               //
//══════════════════════════════════════════════════════════════════════════════════════════════════════//
int aktualniHodnotaBP;
int staraHodnotaBP;
//══════════════════════════════════════════════════════════════════════════════════════════════════════//
void BrzdicBP(int PinBrzdicBP, String CVID) {
  int potHodnotaBP = analogRead(A0);
  int aktualniHodnotaBP = map(potHodnotaBP, 0, 1023, 0, 50);

  if(abs(aktualniHodnotaBP-staraHodnotaBP) > 2)
  {
    if(aktualniHodnotaBP < 5 && bpDelay.elapsed()) {
      Serial.print(CVID);
      Serial.print("0");
      Serial.print("\r\n");
      bpDelay.start(40);
      staraHodnotaBP = aktualniHodnotaBP;
    }
    else if(aktualniHodnotaBP > 45 && bpDelay.elapsed()) {
      Serial.print(CVID);
      Serial.print("50");
      Serial.print("\r\n");
      bpDelay.start(40);
      staraHodnotaBP = aktualniHodnotaBP;
    }
    else if(bpDelay.elapsed()) {
      Serial.print(CVID);
      Serial.print(aktualniHodnotaBP);
      Serial.print("\r\n");
      bpDelay.start(80);
      staraHodnotaBP = aktualniHodnotaBP;
    }
  }
}
//══════════════════════════════════════════════════════════════════════════════════════════════════════//