2019-10-09 14:59:27 +02:00
|
|
|
#include <Arduino.h>
|
2019-10-21 08:57:58 +02:00
|
|
|
#include "vars.h"
|
2019-10-21 15:30:28 +02:00
|
|
|
#include "data_source_bno055.h"
|
2019-11-11 22:26:34 +01:00
|
|
|
#include "drivecontroller.h"
|
|
|
|
|
#include "sensors.h"
|
2019-10-09 14:59:27 +02:00
|
|
|
|
2019-10-21 15:30:28 +02:00
|
|
|
|
2019-10-09 14:59:27 +02:00
|
|
|
void setup() {
|
2019-12-05 11:53:01 +01:00
|
|
|
delay(500);
|
2019-11-18 14:37:55 +01:00
|
|
|
|
2019-12-05 11:53:01 +01:00
|
|
|
DEBUG.begin(9600);
|
2019-11-11 22:26:34 +01:00
|
|
|
initSensors();
|
2019-12-05 11:53:01 +01:00
|
|
|
delay(2000);
|
2019-10-09 14:59:27 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void loop() {
|
2019-11-11 22:26:34 +01:00
|
|
|
updateSensors();
|
2019-12-05 11:53:01 +01:00
|
|
|
|
|
|
|
|
drive->prepareDrive(0,0,0);
|
|
|
|
|
linesCtrl->update();
|
|
|
|
|
|
|
|
|
|
drive->drivePrepared();
|
|
|
|
|
|
|
|
|
|
}
|
