2014 sift / Mbed 2 deprecated TVDctrller2017_brdRev1_PandA

Dependencies:   mbed

Fork of TVDctrller2017_brdRev1_ver6 by 2014 sift

Revision:
10:87ad65eef0e9
Parent:
9:220e4e77e056
--- a/TVDcontrolDEMO_main.cpp	Wed Jul 27 05:42:33 2016 +0000
+++ b/TVDcontrolDEMO_main.cpp	Sat Aug 06 05:39:00 2016 +0000
@@ -65,6 +65,8 @@
     initSteering();
 
     timer.start();
+    
+    wait(1);
 
     float time;
 
@@ -79,7 +81,7 @@
 
         //printf("%f\n\r", 45.0/0xFFFF * calcRequestTorque());
 
-        //printf("%1.2f\t%d\t%1.6f\t%1.5f\r\n", 45.0f / 0xffff * calcRequestTorque(), (int)(1.0/(getPulseTime(RIGHT_MOTOR)*0.000001)*60.0), time, getSteerAngle());
+        printf("%2.2f\t%3.2f\t%1.2f\r\n", 45.0f / 0xffff * calcRequestTorque(), getVelocity(), getSteerAngle());
         //printf("%1.6f\r\n", time);
         time = timer.read();