Dima Dudin / Mbed 2 deprecated DD_Robot

svoe

Dependencies:   mbed mbed-STM32F103C8T6 MPU6050_1

Diff: serva.h

Revision:
0:e9488589a8ee
Child:
1:e2a6e523bf1f
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/serva.h	Tue May 02 16:50:18 2017 +0000
@@ -0,0 +1,12 @@
+PwmOut serva_out(PB_14);
+
+void serva(int degrees){ //{-80;80} lim speed (20 deg, 50ms)
+    int microsec = degrees*9+1300;
+    //pc.printf("%d \n", microsec);
+    serva_out.pulsewidth_us(microsec);
+    }
+   
+void serva_init(){
+    serva_out.period_ms(20);
+    serva(0);
+    }   
\ No newline at end of file