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-11-18 14:37:55 +01:00
|
|
|
delay(1000);
|
|
|
|
|
|
2019-10-21 08:57:58 +02:00
|
|
|
DEBUG_PRINT.begin(9600);
|
2019-11-18 14:37:55 +01:00
|
|
|
|
2019-11-11 22:26:34 +01:00
|
|
|
initSensors();
|
2019-10-09 14:59:27 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void loop() {
|
2019-11-11 22:26:34 +01:00
|
|
|
updateSensors();
|
|
|
|
|
//should recenter using predefined values
|
2019-11-18 14:42:43 +01:00
|
|
|
// drive->drive(0, 0, 0);
|
2019-11-18 15:07:46 +01:00
|
|
|
compass->test();
|
|
|
|
|
delay(100);
|
2019-10-09 14:59:27 +02:00
|
|
|
}
|
