Brzdič BSE - Serial

//══════════════════════════════════════════════════════════════════════════════════════════════════════//
//                                                                    Ovladač OBE1 brzdiče Dako BSE                                                                              //
// Funkce pro ovládání brzdiče DAKO BSE, má dva vstupní parametry : 1) První pin PISO registru, po kterém následuje dalších 6, se spínači stavu ovladače                         //
//                                                                  2) CVID - trojznak definovaný v programu TStoCOM                                                             //
// Funkce posílá pomocí sériové linky hodnotu v rozsahu 0-1 (násobitel je 100)                                                                                                   //
//══════════════════════════════════════════════════════════════════════════════════════════════════════//
int aktualStavBrzdice = 0;
int staryStavBrzdice = 2;
//══════════════════════════════════════════════════════════════════════════════════════════════════════//
void BrzdicBSE(int pointer, String CVID) {
  for (int i=pointer; i < (pointer + 7); i++) {
    bitWrite(aktualStavBrzdice, (i - pointer), tlacitko[i]);
  }

  if(staryStavBrzdice != aktualStavBrzdice)
  {
    if(aktualStavBrzdice == 1) {           //Pokud je stav vstupů 1
        Serial.print(CVID);                //Pošli na Serial nastavené CVID
        Serial.print("0");                 //Hodnota CV pro ovladač OBE v poloze švih je 0
        Serial.print("\r\n");
    }
    else if(aktualStavBrzdice == 2) {
        Serial.print(CVID);
        Serial.print("20");               //Hodnota CV pro ovladač OBE v poloze přebytí je 0.2
        Serial.print("\r\n");
    }
    else if(aktualStavBrzdice == 4) {
        Serial.print(CVID);
        Serial.print("35");              //Hodnota CV pro ovladač OBE v poloze závěr je 0.35
        Serial.print("\r\n");
    }
    else if(aktualStavBrzdice == 8) {
        Serial.print(CVID);
        Serial.print("50");               //Hodnota CV pro ovladač OBE v poloze odbržděno je 0.5
        Serial.print("\r\n");
    }
    else if(aktualStavBrzdice == 16) {
        Serial.print(CVID);
        Serial.print("65");              //Hodnota CV pro ovladač OBE v poloze jízda je 0.65
        Serial.print("\r\n");
   }
   else if(aktualStavBrzdice == 32) {
        Serial.print(CVID);
        Serial.print("75");              //Hodnota CV pro ovladač OBE v poloze brzda je 0.75
        Serial.print("\r\n");
   }
   else if(aktualStavBrzdice == 64) {
        Serial.print(CVID);
        Serial.print("100");             //Hodnota CV pro ovladač OBE v poloze rychlobrzda je 1
        Serial.print("\r\n");
   }
   else if(aktualStavBrzdice == 0) {
//        Serial.print("Chybi kontakt pro polohu ovladace brzdice OBE1!");
//        Serial.print("\r\n");
   }

    else {
        Serial.print("Chybna poloha ovladace brzdice OBE1!");
        Serial.print("\r\n");
    }
    staryStavBrzdice = aktualStavBrzdice;
  }
}
//══════════════════════════════════════════════════════════════════════════════════════════════════════//