svoe
Dependencies: mbed mbed-STM32F103C8T6 MPU6050_1
Diff: serva.h
- Revision:
- 0:e9488589a8ee
- Child:
- 1:e2a6e523bf1f
diff -r 000000000000 -r e9488589a8ee serva.h --- /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