SLRC-2019 / Mbed 2 deprecated speed_robot

code for the speed robot

Dependencies:   MPU6050-DMP mbed PololuQTRSensors vl53l0x

Diff: main.cpp

Revision:
7:fd80a0d11658
Parent:
3:9b2f15b0d47b
--- a/main.cpp	Mon Sep 30 11:16:12 2019 +0000
+++ b/main.cpp	Mon Sep 30 13:16:04 2019 +0000
@@ -1,18 +1,22 @@
 #include "mbed.h"
 #include <string>
+#include <math.h>
 #include "_def.h"
 #include "_pins.h"
 #include "_var.h"
 #include "gyro.h"
 #include "tof.h"
+#include "motor_control.h"
 
 int main()
 {
     PrintSerial("hello world");
-    InitTOFSensors();
+    InitMotors();
+//    InitTOFSensors();
 //    InitMPU();
     while(1) {
-        PrintTOFDistances();
+        RunBothMotors(500,500);
+//        PrintTOFDistances();
 //        GetAngles(false);
     }
 }