SPQR-Team1-2020/src/main.cpp

34 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);
camera->test();
// Last thing to do: movement and update status vector
drive->drivePrepared();
updateStatusVector(); */
}