Kontrolér - Serial

//══════════════════════════════════════════════════════════════════════════════════════════════════════//
//                                                                Hlavní lokomotivní kontrolér poměrného tahu                                                                    //
// Funkce pro ovládání hlavního kontroléru, má dva vstupní parametry : 1) První pin PISO registru, po kterém následují další 3, se spínači stavu kontroléru                      //
//                                                                     2) CVID - trojznak definovaný v programu TStoCOM                                                          //
// Funkce posílá pomocí sériové linky hodnotu v rozsahu (-2)-(+2) (násobitel je 1)                                                                                               //
//══════════════════════════════════════════════════════════════════════════════════════════════════════//
int aktualStavKontroleru = 0;
int staryStavKontroleru = 3;
//══════════════════════════════════════════════════════════════════════════════════════════════════════//
void Kontroler(int pointer, String CVID) {
  for (int i=pointer; i < (pointer + 4); i++) {
    bitWrite(aktualStavKontroleru, (i - pointer), tlacitko[i]);
  }

  if(staryStavKontroleru != aktualStavKontroleru)
  {
    if(aktualStavKontroleru == 1) {
        Serial.print(CVID);
        Serial.print("2");
        Serial.print("\r\n");
    }
    else if(aktualStavKontroleru == 2) {
        Serial.print(CVID);
        Serial.print("1");
        Serial.print("\r\n");
    }
    else if(aktualStavKontroleru == 4) {
        Serial.print(CVID);
        Serial.print("-1");
        Serial.print("\r\n");
    }
    else if(aktualStavKontroleru == 8) {
        Serial.print(CVID);
        Serial.print("-2");
        Serial.print("\r\n");
    }
    else if(aktualStavKontroleru == 0) {
        Serial.print(CVID);
        Serial.print("0");
        Serial.print("\r\n");
   }
    else {
        Serial.print("Chybna poloha kontroleru!");
        Serial.print("\r\n");
    }
    staryStavKontroleru = aktualStavKontroleru;
  }
}
//══════════════════════════════════════════════════════════════════════════════════════════════════════//