Dima Dudin / Mbed 2 deprecated DD_Robot

svoe

Dependencies:   mbed mbed-STM32F103C8T6 MPU6050_1

Diff: serva.h

Revision:
1:e2a6e523bf1f
Parent:
0:e9488589a8ee
Child:
22:14e85f2068c7
--- a/serva.h	Tue May 02 16:50:18 2017 +0000
+++ b/serva.h	Sat May 06 18:21:55 2017 +0000
@@ -1,12 +1,12 @@
 PwmOut serva_out(PB_14);
 
 void serva(int degrees){ //{-80;80} lim speed (20 deg, 50ms)
-    int microsec = degrees*9+1300;
+    int microsec = 1300 - degrees*9;
     //pc.printf("%d \n", microsec);
     serva_out.pulsewidth_us(microsec);
     }
    
 void serva_init(){
-    serva_out.period_ms(20);
+    serva_out.period_ms(25);
     serva(0);
     }   
\ No newline at end of file