Affichage de l'equipe lors du changement.

IO.hpp

@@ -7,6 +7,7 @@
 #include <CodeCell.h>
 #include <ESP32Servo.h>
 #include <cmath>
+#include "Ressources.hpp"
 
 #define PIN_TIRETTE 5
 #define PIN_BUTTON_COLOR 6
@@ -75,13 +76,54 @@ class IO {
 
     nb_errors += m_initScreen();
 
+    if(!nb_errors)
+    {
+      m_screen.setTextSize(1);
+      m_screen.setTextColor(WHITE, BLACK);
+      m_screen.setFont(&Res::Fonts::Freshman12pt7b);
+    }
+
     return nb_errors;
   }
 
   int update()
   {
+    static unsigned long last_color_change_time {0};
+    static bool has_color_changed {true};
+
+    bool is_color_blue = (digitalRead(PIN_BUTTON_COLOR) == HIGH);
+
+    if(m_is_color_blue != is_color_blue)
+    {
+      m_screen.clearDisplay();
+      m_screen.setCursor(0, 20);
+
+      if(is_color_blue)
+      {
+        m_screen.print("Blue\nTeam");
+      }
+      else
+      {
+        m_screen.print("Yellow\nTeam");
+      }
+
+      last_color_change_time = millis();
+
+      has_color_changed = true;
+    }
+
+    if(millis() - last_color_change_time > 1000 && has_color_changed)
+    {
+      m_screen.clearDisplay();
+      //m_screen.drawBitmap(38, 0, Res::Imgs::riombotique, 52, 64, WHITE);
+      //m_screen.drawBitmap(75, 0, Imgs::poivron_robotique, 52, 64, WHITE);
+      m_screen.drawBitmap(27, 0, Res::Imgs::diable_gaga, 75, 64, WHITE);
+
+      has_color_changed = false;
+    }
+
     m_is_tirette_pulled = (digitalRead(PIN_TIRETTE) == HIGH);
-    m_is_color_blue = (digitalRead(PIN_BUTTON_COLOR) == HIGH);
+    m_is_color_blue = is_color_blue;
 
     if(m_is_motor_control_activated)
     {

Main.ino

@@ -60,9 +60,6 @@ void setup()
     while(true);
   }
 
-  my_IO.getScreen()->drawBitmap(38, 0, Res::Imgs::riombotique, 52, 64, WHITE);
-  //my_IO.getScreen()->drawBitmap(75, 0, Imgs::poivron_robotique, 52, 64, WHITE);
-
   Serial.println("Initalisation Finished");
 
   my_IO.motorControlOff();