group14 - k9 / Mbed 2 deprecated robot_2

2nd draft

Dependencies:   HIDScope MODSERIAL QEI biquadFilter mbed Servo

Fork of robot_mockup by Martijn Kern

Diff: main.cpp

Revision:
60:6541eec8d6ad
Parent:
59:ca85ce2b1ffc
Child:
61:8226830f3272
--- a/main.cpp	Wed Oct 28 08:08:19 2015 +0000
+++ b/main.cpp	Wed Oct 28 09:09:55 2015 +0000
@@ -483,7 +483,7 @@
     deltatheta1 = theta1 - theta1_lower;
     deltatheta2 = theta2 - theta2_lower;
     theta3 = deltatheta1 + deltatheta2;
-    servopos = -(2100/PI)*theta3 + 2700;
+    servopos = (2100/PI)*theta3 + 600;
     servoPwm.SetPosition(servopos);
     
     //old: