SLRC-2019 / Mbed 2 deprecated speed_robot

code for the speed robot

Dependencies:   MPU6050-DMP mbed PololuQTRSensors vl53l0x

Diff: main.cpp

Revision:
1:b188e27eb7da
Parent:
0:c3a27228c31b
Child:
3:9b2f15b0d47b
diff -r c3a27228c31b -r b188e27eb7da main.cpp
--- a/main.cpp	Mon Sep 30 08:00:47 2019 +0000
+++ b/main.cpp	Mon Sep 30 08:43:34 2019 +0000
@@ -4,13 +4,15 @@
 #include "_pins.h"
 #include "_var.h"
 #include "gyro.h"
+#include "tof.h"
 
 int main()
 {
-    int i = 1;
     PrintSerial("hello world");
-    InitMPU();
+    InitTOFSensors();
+//    InitMPU();
     while(1) {
-        GetAngles(false);
+        PrintTOFDistance();
+//        GetAngles(false);
     }
 }