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-10-21 08:57:58 +02:00
|
|
|
DEBUG_PRINT.begin(9600);
|
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();
|
2019-10-21 15:30:28 +02:00
|
|
|
|
2019-11-11 22:26:34 +01:00
|
|
|
//should recenter using predefined values
|
2019-11-13 16:26:03 +01:00
|
|
|
drive->drive(0, 0, 0);
|
|
|
|
|
DEBUG_PRINT.println(compass->getValue());
|
2019-10-09 14:59:27 +02:00
|
|
|
}
|
