Matthew Maat / Mbed 2 deprecated template_biorobotics

fancy lampje

Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FXOS8700Q FastPWM

Diff: main.cpp

Revision:
19:fb3d570a115e
Parent:
18:8002c75b8e20
Child:
21:a316452da8cd
--- a/main.cpp	Mon Oct 21 10:14:53 2019 +0000
+++ b/main.cpp	Mon Oct 21 12:16:42 2019 +0000
@@ -99,8 +99,8 @@
 {
     float pulses1=motor1_pos.getPulses();
     float pulses2=motor2_pos.getPulses();
-    theta1=angle1_offset+pulses1*16.0/17.0*2*pi/131.0/32.0;
-    theta2=angle2_offset+pulses2*16.0/17.0*2*pi/131.0/32.0; 
+    theta1=angle1_offset+pulses1*17.0/16.0*2*pi/131.0/32.0;
+    theta2=angle2_offset+pulses2*17.0/16.0*2*pi/131.0/32.0; 
 }
 
 void pos_cal(void)