2015_robocon_bteam / Mbed 2 deprecated 2015robot_main

Dependencies:   PID QEI mbed

Fork of 2015robot_main by Naoto Deguchi

Revision:
98:ffe1247b9784
Parent:
95:deb2e75c42ff
Child:
99:ee7f78d64c14
--- a/Swing.h	Fri Oct 16 07:42:06 2015 +0000
+++ b/Swing.h	Fri Oct 16 08:08:32 2015 +0000
@@ -43,7 +43,7 @@
 double swingSita=0.0;
 inline void mesureSwing() {
     PulsesSwing       = ( double )SwingSens.getPulses();
-    swingRadVelocity  = (((PulsesSwing - PrefPulsesSwing) / 3000.0) * 2 * PI) / RATE;
+    swingRadVelocity  = (((PulsesSwing - PrefPulsesSwing) / 3000.0) * 2.0 * PI) / RATE;
     PrefPulsesSwing   = PulsesSwing;
 }