2015_robocon_bteam / Mbed 2 deprecated 2015robot_main_zenkoku

Dependencies:   PID QEI mbed

Revision:
22:4127fcf8c7d7
Parent:
7:4aa57a35ec0b
--- a/Swing.h	Thu Nov 05 11:43:43 2015 +0000
+++ b/Swing.h	Sat Nov 07 00:16:09 2015 +0000
@@ -44,7 +44,7 @@
 double swingSita=0.0;
 inline void mesureSwing() {
     PulsesSwing       = ( double )SwingSens.getPulses();
-    swingRadVelocity  = (((PulsesSwing - PrefPulsesSwing) / 3000.0) * 2.0 * PI) / RATE;
+    swingRadVelocity  = ((PulsesSwing - PrefPulsesSwing / 360.0) * 2.0 * PI ) / RATE;
     PrefPulsesSwing   = PulsesSwing;
 }