M9 Biorobotics Group 8 / Mbed 2 deprecated servomotorcode

servo motor werkt eindelijk!!!! wiehoe!!!

Dependencies:   mbed QEI Servo HIDScope biquadFilter MODSERIAL FastPWM

Diff: main.cpp

Revision:
1:1b33fd02e6b1
Parent:
0:009a005982e5
Child:
2:f92eadfd1a27
--- a/main.cpp	Tue Oct 29 19:12:00 2019 +0000
+++ b/main.cpp	Tue Oct 29 19:29:45 2019 +0000
@@ -7,20 +7,24 @@
 
 
 MODSERIAL pc(USBTX, USBRX);
+
+
 Servo myservo(D3);
 
 
 int main()
 {
-myservo.Enable(1500,20000);
+    pc.baud(115200);
+    pc.printf("starting main .\r.\n");
+    myservo.Enable(1500,20000);
 
     while(true) {
         pc.printf("starting");
-        for (int pos = 1000; pos < 2000; pos += 25) {
+        for (int pos = 1000; pos < 2000; pos += 10) {
             myservo.SetPosition(pos);
             wait_ms(20);
         }
-        for (int pos = 2000; pos > 1000; pos -= 25) {
+        for (int pos = 2000; pos > 1000; pos -= 10) {
             myservo.SetPosition(pos);
             wait_ms(20);
         }