2015_robocon_bteam / Mbed 2 deprecated 2015robot_main

Dependencies:   PID QEI mbed

Fork of 2015robot_main by Naoto Deguchi

Revision:
61:e018207ae860
Parent:
60:4a75f3f3a934
Child:
62:02a44f5bc51e
--- a/Swing.h	Fri Oct 02 07:24:52 2015 +0000
+++ b/Swing.h	Sat Oct 03 00:52:21 2015 +0000
@@ -29,7 +29,7 @@
 double swingSita=0.0;
 inline void mesureSwing() {
     PulsesSwing       = ( double )SwingSens.getPulses();
-    swingRadVelocity  = ((((PulsesSwing - PrefPulsesSwing) / 4.0) / pprS) * 2 * PI) / RATE;
+    swingRadVelocity  = ((((PulsesSwing - PrefPulsesSwing) 3450.0) * 2 * PI) / RATE;
     PrefPulsesSwing   = PulsesSwing;
 }