Mapping for TP2

Dependencies:   ISR_Mini-explorer mbed

Fork of GoToPointWithAngle by Georgios Tsamis

Revision:
16:ff73cc7b3156
Parent:
15:d58f2bdbf42e
Parent:
14:44ab4626f1ad
Child:
17:caf393b63e27
--- a/main.cpp	Mon Mar 27 16:49:49 2017 +0000
+++ b/main.cpp	Mon Mar 27 16:51:07 2017 +0000
@@ -137,6 +137,9 @@
 
         pc.printf("\n\r X=%f", X);
         pc.printf("\n\r Y=%f", Y);
+        pc.printf("\n\r leftMm=%f", leftMm);
+        pc.printf("\n\r frontMm=%f", frontMm);
+        pc.printf("\n\r rightMm=%f", rightMm);
 
         //Updating motor velocities
         leftMotor(1,angular_left);