code for the speed robot
Dependencies: MPU6050-DMP mbed PololuQTRSensors vl53l0x
Diff: main.cpp
- Revision:
- 7:fd80a0d11658
- Parent:
- 3:9b2f15b0d47b
diff -r a635edf31d8b -r fd80a0d11658 main.cpp --- 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); } }