Problème "semi-automatisation" électronique de signaux

/*
 * broches en sortie pour commander les feux
 * À l'état haut, 5V, le feux est vert.
 * À l'état bas, 0V, le feux est rouge.
 */
int feux0 = 2;
int feux1 = 3;
int feux2 = 4;
int feux3 = 5;

/*
 * Broches d'entrée pour le commutateur 4 positions
 * Les entrées sont tirées à 0V par des résistances de 47kΩ
 * Les commutateur place 5V sur l'entrée
 */
int bouton0 = 8;
int bouton1 = 9;
int bouton2 = 10;
int bouton3 = 11;

/*
 * La table d'état des feux 4 lignes, 4 colonnes
 * Les lignes sont la position du commutateur
 * Les colonnes l'état de chaque feux
 * Il n'y en a donc qu'un au vert tandis que les autres sont rouges
 */
const uint8_t etatfeux[4][4] = {
  { HIGH, LOW, LOW, LOW },
  { LOW, HIGH, LOW, LOW },
  { LOW, LOW, HIGH, LOW },
  { LOW, LOW, LOW, HIGH }
};

/*
 * Setup est exécuté 1 fois au démarrage
 */
void setup() {                
  /* Les broches de pilotage des feux sont en sortie */
  pinMode(feux0, OUTPUT);
  pinMode(feux1, OUTPUT);
  pinMode(feux2, OUTPUT);
  pinMode(feux3, OUTPUT);
  /* Les broches du commutateur sont en entrée */
  pinMode(bouton0, INPUT);  
  pinMode(bouton1, INPUT);  
  pinMode(bouton2, INPUT);  
  pinMode(bouton3, INPUT);  
}

/*
 * loop est exécute répétitivement
 */
void loop() {
  /*
   * Au début on considère que le pole 0 du commutateur est sélectionné
   * Ceci afin d'avoir une valeur par défaut au cas où le commutateur ne
   * fonctionnerait pas
   */
  static int positionBouton = 0;
  
  /* Lit chaque pole  et met son rang dans positionBouton si le pole est a 5V */
  if (digitalRead(bouton0) == HIGH) {
    positionBouton = 0;
  }
  else if (digitalRead(bouton1) == HIGH) {
    positionBouton = 1;
  }
  else if (digitalRead(bouton2) == HIGH) {
    positionBouton = 2;
  }
  else if (digitalRead(bouton3) == HIGH) {
    positionBouton = 3;
  }
  
  /* Allume les feux, positionBouton sélectionne la ligne du tableau, le feu sélectionne la colonne */
  digitalWrite(feux0,etatfeux[positionBouton][0]);
  digitalWrite(feux1,etatfeux[positionBouton][1]);
  digitalWrite(feux2,etatfeux[positionBouton][2]);
  digitalWrite(feux3,etatfeux[positionBouton][3]);
}

// VARIABLES
// Définition des PIN pour les 8 signaux rouge/vert (16 PIN)
int signal1A = A4;
int signal1B = A5;
int signal2A = 0;
int signal2B = 1;
int signal3A = 2;
int signal3B = 3;
int signal4A = 4;
int signal4B = 5;
int signal5A = 6;
int signal5B = 7;
int signal6A = 8;
int signal6B = 9;
int signal7A = 10;
int signal7B = 11;
int signal8A = 12;
int signal8B = 13;
// Définition des PIN pour les 8 bouttons matricés (2 PIN)
int buttonA = A0;
int buttonB = A1;
// Définition des tableaux des états pour les deux groupes de boutons
int arraySignaux0[4] = {0, 0, 0, 0};
int arraySignaux1[4] = {0, 0, 0, 0};
// Définition des variables antirebonds pour les deux groupes de boutons
int antiRebond0 = 0;
int antiRebond1 = 0;

// PARAMETRAGE
void setup() {
  // Paramétrage des PIN des signaux en sorties
  pinMode(signal1A, OUTPUT);
  pinMode(signal1B, OUTPUT);
  pinMode(signal2A, OUTPUT);
  pinMode(signal2B, OUTPUT);
  pinMode(signal3A, OUTPUT);
  pinMode(signal3B, OUTPUT);
  pinMode(signal4A, OUTPUT);
  pinMode(signal4B, OUTPUT);
  pinMode(signal5A, OUTPUT);
  pinMode(signal5B, OUTPUT);
  pinMode(signal6A, OUTPUT);
  pinMode(signal6B, OUTPUT);
  pinMode(signal7A, OUTPUT);
  pinMode(signal7B, OUTPUT);
  pinMode(signal8A, OUTPUT);
  pinMode(signal8B, OUTPUT);
  // Paramétrage des PIN des boutons en entrées
  pinMode(buttonA, INPUT);
  pinMode(buttonB, INPUT);
  // Activation de la résistance interne sur les PIN des boutons
  digitalWrite(buttonA, HIGH); // enable the 20k internal pullup
  digitalWrite(buttonB, HIGH); // enable the 20k internal pullup
  // Passage de tous les signaux au rouge
  signauxGroup0Red();
  signauxGroup1Red();
  // Debug : Initialisation du port série
  //Serial.begin(9600);
  
}

// SCENARIO
void loop() {
  // Lecture des valeurs des deux PIN des boutons
  int sensorValue0 = analogRead(A0);
  int sensorValue1 = analogRead(A1);
  // Détection de l'appui et du rappui sur un bouton du 1er groupe
  if (sensorValue0 > 773 and sensorValue0 < 777) {
    if (antiRebond0 == 0) {
      if (arraySignaux0[0] == 0) {
        arraySignaux0[0] = 1;
        arraySignaux0[1] = 0;
        arraySignaux0[2] = 0;
        arraySignaux0[3] = 0;
        signalGreen0();
        antiRebond0 = 1;
      }
      else if (arraySignaux0[0] == 1) {
        arraySignaux0[0] = 0;
        signauxGroup0Red();
        antiRebond0 = 1;
      }
    }
  }
  else if (sensorValue0 > 524 and sensorValue0 < 528) {
    if (antiRebond0 == 0) {
      if (arraySignaux0[1] == 0) {
        arraySignaux0[0] = 0;
        arraySignaux0[1] = 1;
        arraySignaux0[2] = 0;
        arraySignaux0[3] = 0;
        signalGreen0();
        antiRebond0 = 1;
      }
      else if (arraySignaux0[1] == 1) {
        arraySignaux0[1] = 0;
        signauxGroup0Red();
        antiRebond0 = 1;
      }
    }
  }
  else if (sensorValue0 > 272 and sensorValue0 < 276) {
    if (antiRebond0 == 0) {
      if (arraySignaux0[2] == 0) {
        arraySignaux0[0] = 0;
        arraySignaux0[1] = 0;
        arraySignaux0[2] = 1;
        arraySignaux0[3] = 0;
        signalGreen0();
        antiRebond0 = 1;
      }
      else if (arraySignaux0[2] == 1) {
        arraySignaux0[2] = 0;
        signauxGroup0Red();
        antiRebond0 = 1;
      }
    }
  }
  else if (sensorValue0 > 13 and sensorValue0 < 17) {
    if (antiRebond0 == 0) {
      if (arraySignaux0[3] == 0) {
        arraySignaux0[0] = 0;
        arraySignaux0[1] = 0;
        arraySignaux0[2] = 0;
        arraySignaux0[3] = 1;
        signalGreen0();
        antiRebond0 = 1;
      }
      else if (arraySignaux0[3] == 1) {
        arraySignaux0[3] = 0;
        signauxGroup0Red();
        antiRebond0 = 1;
      }
    }
  }
  else {
    antiRebond0 = 0;
  }
  // Détection de l'appui et du rappui sur un bouton du 2nd groupe
  if (sensorValue1 > 773 and sensorValue1 < 777) {
    if (antiRebond1 == 0) {
      if (arraySignaux1[0] == 0) {
        arraySignaux1[0] = 1;
        arraySignaux1[1] = 0;
        arraySignaux1[2] = 0;
        arraySignaux1[3] = 0;
        signalGreen1();
        antiRebond1 = 1;
      }
      else if (arraySignaux1[0] == 1) {
        arraySignaux1[0] = 0;
        signauxGroup1Red();
        antiRebond1 = 1;
      }
    }
  }
  else if (sensorValue1 > 524 and sensorValue1 < 528) {
    if (antiRebond1 == 0) {
      if (arraySignaux1[1] == 0) {
        arraySignaux1[0] = 0;
        arraySignaux1[1] = 1;
        arraySignaux1[2] = 0;
        arraySignaux1[3] = 0;
        signalGreen1();
        antiRebond1 = 1;
      }
      else if (arraySignaux1[1] == 1) {
        arraySignaux1[1] = 0;
        signauxGroup1Red();
        antiRebond1 = 1;
      }
    }
  }
  else if (sensorValue1 > 272 and sensorValue1 < 276) {
    if (antiRebond1 == 0) {
      if (arraySignaux1[2] == 0) {
        arraySignaux1[0] = 0;
        arraySignaux1[1] = 0;
        arraySignaux1[2] = 1;
        arraySignaux1[3] = 0;
        signalGreen1();
        antiRebond1 = 1;
      }
      else if (arraySignaux1[2] == 1) {
        arraySignaux1[2] = 0;
        signauxGroup1Red();
        antiRebond1 = 1;
      }
    }
  }
  else if (sensorValue1 > 13 and sensorValue1 < 17) {
    if (antiRebond1 == 0) {
      if (arraySignaux1[3] == 0) {
        arraySignaux1[0] = 0;
        arraySignaux1[1] = 0;
        arraySignaux1[2] = 0;
        arraySignaux1[3] = 1;
        signalGreen1();
        antiRebond1 = 1;
      }
      else if (arraySignaux1[3] == 1) {
        arraySignaux1[3] = 0;
        signauxGroup1Red();
        antiRebond1 = 1;
      }
    }
  }
  else {
    antiRebond1 = 0;
  }
  // Debug : Impression des valeurs lues sur les deux PIN
  /*Serial.println("-----------------");
  Serial.print("Valeur PIN 1 : ");
  Serial.println(sensorValue0);
  Serial.println("Tableau 1 :");
  int i;
  for (i = 0; i < 4; i = i + 1) {
    Serial.println(arraySignaux0[i]);
  }
  Serial.print("Valeur PIN 2 :");
  Serial.println(sensorValue1);
  Serial.println("Tableau 2 :");
  int j;
  for (j = 0; j < 4; j = j + 1) {
    Serial.println(arraySignaux1[j]);
  }
  Serial.println("-----------------");
  delay(1000);*/
  // Délais avant de recommencer la boucle
  delay(150);  
}

// FONCTIONS
// Passage de tous les signaux du 1er groupe au rouge
void signauxGroup0Red() {
  digitalWrite(signal1A, HIGH);
  digitalWrite(signal1B, LOW);
  digitalWrite(signal2A, HIGH);
  digitalWrite(signal2B, LOW);  
  digitalWrite(signal3A, HIGH);
  digitalWrite(signal3B, LOW);
  digitalWrite(signal4A, HIGH);
  digitalWrite(signal4B, LOW);
}
// Passage de tous les signaux du 2nd groupe au rouge
void signauxGroup1Red() {
  digitalWrite(signal5A, HIGH);
  digitalWrite(signal5B, LOW);
  digitalWrite(signal6A, HIGH);
  digitalWrite(signal6B, LOW);
  digitalWrite(signal7A, HIGH);
  digitalWrite(signal7B, LOW);
  digitalWrite(signal8A, HIGH);
  digitalWrite(signal8B, LOW);
}
// Passage d'un des signaux du 1er groupe au vert
void signalGreen0() {
  if (arraySignaux0[0] == 1) {
    signauxGroup0Red();
    digitalWrite(signal1A, LOW);
    digitalWrite(signal1B, HIGH);
  }
  else if (arraySignaux0[1] == 1) {
    signauxGroup0Red();
    digitalWrite(signal2A, LOW);
    digitalWrite(signal2B, HIGH);
  }
  else if (arraySignaux0[2] == 1) {
    signauxGroup0Red();
    digitalWrite(signal3A, LOW);
    digitalWrite(signal3B, HIGH);
  }
  else if (arraySignaux0[3] == 1) {
    signauxGroup0Red();
    digitalWrite(signal4A, LOW);
    digitalWrite(signal4B, HIGH);
  }
  else {
    signauxGroup0Red();
  }
}
// Passage d'un des signaux du 2nd groupe au vert
void signalGreen1() {
  if (arraySignaux1[0] == 1) {
    signauxGroup1Red();
    digitalWrite(signal5A, LOW);
    digitalWrite(signal5B, HIGH);
  }
  else if (arraySignaux1[1] == 1) {
    signauxGroup1Red();
    digitalWrite(signal6A, LOW);
    digitalWrite(signal6B, HIGH);
  }
  else if (arraySignaux1[2] == 1) {
    signauxGroup1Red();
    digitalWrite(signal7A, LOW);
    digitalWrite(signal7B, HIGH);
  }
  else if (arraySignaux1[3] == 1) {
    signauxGroup1Red();
    digitalWrite(signal8A, LOW);
    digitalWrite(signal8B, HIGH);
  }
  else {
    signauxGroup1Red();
  }
}