Směr - Serial

//══════════════════════════════════════════════════════════════════════════════════════════════════════//
//                                                               Kontrolér směru pro ovládání směrového válce                                                                    //
// Funkce pro ovládání hlavního kontroléru, má dva vstupní parametry : 1) První pin PISO registru, po kterém následuje 1 další, se spínači stavu kontroléru                      //
//                                                                     2) CVID - trojznak definovaný v programu TStoCOM                                                          //
// Funkce posílá pomocí sériové linky hodnotu v rozsahu (-1)-(+1) (násobitel je 1)                                                                                               //
//══════════════════════════════════════════════════════════════════════════════════════════════════════//
int aktualStavSmeru = 0;
int staryStavSmeru = 3;
//══════════════════════════════════════════════════════════════════════════════════════════════════════//
void Smer(int pointer, String CVID) {
  for (int i = pointer; i < (pointer + 2); i++) {
    bitWrite(aktualStavSmeru, (i - pointer), tlacitko[i]);
  }
  if(staryStavSmeru != aktualStavSmeru)
  {
    if(aktualStavSmeru == 1) {
        Serial.print(CVID);
        Serial.print("1");
        Serial.print("\r\n");
    }
    else if(aktualStavSmeru == 2) {
        Serial.print(CVID);
        Serial.print("-1");
        Serial.print("\r\n");
    }
    else if(aktualStavKontroleru == 0) {
        Serial.print(CVID);
        Serial.print("0");
        Serial.print("\r\n");
   }
    else {
        Serial.print("Chybna poloha smerove paky!");
        Serial.print("\r\n");
    }
    staryStavSmeru = aktualStavSmeru;
  }
}

//══════════════════════════════════════════════════════════════════════════════════════════════════════//