33 lines
585 B
C++
Executable File
33 lines
585 B
C++
Executable File
#include <Arduino.h>
|
|
|
|
#include "test_menu.h"
|
|
#include "behaviour_control/status_vector.h"
|
|
#include "position/positionsys_zone.h"
|
|
#include "sensors/sensors.h"
|
|
#include "strategy_roles/games.h"
|
|
|
|
void setup() {
|
|
delay(1500);
|
|
|
|
DEBUG.begin(9600);
|
|
initStatusVector();
|
|
initSensors();
|
|
initGames();
|
|
|
|
delay(500);
|
|
}
|
|
|
|
|
|
void loop() {
|
|
updateSensors();
|
|
/* TestMenu testmenu;
|
|
testmenu.testMenu();
|
|
goalie->play(role==1);
|
|
keeper->play(role==0);
|
|
*/
|
|
drive->m1->test();
|
|
// Last thing to do: movement and update status vector
|
|
drive->drivePrepared();
|
|
updateStatusVector();
|
|
}
|