22 lines
340 B
C++
22 lines
340 B
C++
#include <Arduino.h>
|
|
#include "vars.h"
|
|
#include "data_source_bno055.h"
|
|
#include "drivecontroller.h"
|
|
#include "sensors.h"
|
|
|
|
|
|
void setup() {
|
|
delay(1000);
|
|
|
|
DEBUG_PRINT.begin(9600);
|
|
|
|
initSensors();
|
|
}
|
|
|
|
void loop() {
|
|
updateSensors();
|
|
//should recenter using predefined values
|
|
// drive->drive(0, 0, 0);
|
|
compass->test();
|
|
delay(100);
|
|
} |