@@ -15,9 +15,11 @@ Robot robot;
15
15
16
16
OpticalTrackingOdometrySensor otos;
17
17
18
+ Team team;
19
+ Mode mode;
20
+
18
21
PoseF goTo = {500 , 500 , 0 }; // TODO: pourquoi parfois il démarre en 0;0 ? c'est réinitialisé à 0 par défaut au lieu de ces valeurs ?
19
22
20
- bool mode_test = false ;
21
23
22
24
unsigned long startChrono = 0 ;
23
25
unsigned long endChrono = 0 ;
@@ -44,12 +46,14 @@ void setup()
44
46
println (" Robot Holonome Firmware" );
45
47
46
48
// Init IHM
47
- pinMode (SWITCH_PIN , INPUT);
49
+ pinMode (MODE_PIN , INPUT);
48
50
pinMode (TEAM_PIN, INPUT);
49
51
pinMode (BAU_PIN, INPUT);
50
52
pinMode (START_PIN, INPUT);
51
53
52
- mode_test = digitalRead (SWITCH_PIN); // Mode TEST ou OK
54
+ // TODO : boucle de lecture dans la loop de démarrage
55
+ digitalRead (MODE_PIN) == LOW ? mode = Mode::Match : mode = Mode::Test;
56
+ digitalRead (TEAM_PIN) == LOW ? team = Team::Jaune : team = Team::Bleue;
53
57
54
58
led_builtin.Initialisation (1 , RGB_BUILTIN);
55
59
// led_ring.Initialisation(36, WS2812_LED);
@@ -78,7 +82,7 @@ void setup()
78
82
Trajectory::Initialisation (&linear, &angular, &robot);
79
83
80
84
// Init Path Planning
81
- Mapping::Initialize_Map (TEAM_A );
85
+ Mapping::Initialize_Map (team );
82
86
Obstacle::Initialize_Obstacle ();
83
87
Mapping::Initialize_Passability_Graph ();
84
88
0 commit comments