byte BlokPins[] = {11, 10, 9, 8};

#define RECHT     0
#define AFBUIGEN  1
#define VRIJ      0
#define BEZET     1

void setup() {

  for(byte i = 0; i < sizeof(BlokPins); i++){
    pinMode(BlokPins[i], OUTPUT);
  }

  Serial.begin(115200); //tijd voor 115200?
}

void loop() {
  checkIngekomenSerial();

}

void checkIngekomenSerial(){
  // Ga dan uit dat de serial commando's eruit zien als
  // [commando letter] [adres]
  // Waarbij ieder [] één byte is. Dus geen adressen in ASCII zenden ;)
  if (Serial.available() >= 2) {
    switch(Serial.read()){
      case 'W':
        //Schakel een wissel recht
        //Ga even uit dat de functie schakeWissel(wisselnummer, richting) bestaat
        schakelWissel(Serial.read(), RECHT);
        break;
      //schakel een wissel afbuigend
      case 'w':
        schakelWissel(Serial.read(), AFBUIGEN);
        break;
      //Maak blok vrij
      case 'b':
        setBlok(Serial.read(), VRIJ);
        break;
      case 'B':
        setBlok(Serial.read(), BEZET);
        break;
    }
  }
}


void schakelWissel(byte address, bool state){
  Serial.print("Wissel ");
  Serial.print(address);
  if(state){
    Serial.println(" afbuigen");
  }
  else{
    Serial.println(" recht");
  }
}

void setBlok(byte address, bool state){
  Serial.print("Blok ");
  Serial.print(address);
  if(state){
    Serial.println(" bezet");
  }
  else{
    Serial.println(" vrij");
  }
}