svoe

Dependencies:   mbed mbed-STM32F103C8T6 MPU6050_1

Committer:
Stas285
Date:
Sat May 06 18:21:55 2017 +0000
Revision:
1:e2a6e523bf1f
Parent:
0:e9488589a8ee
Child:
22:14e85f2068c7
wifi + echo + rc

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Stas285 0:e9488589a8ee 1 PwmOut serva_out(PB_14);
Stas285 0:e9488589a8ee 2
Stas285 0:e9488589a8ee 3 void serva(int degrees){ //{-80;80} lim speed (20 deg, 50ms)
Stas285 1:e2a6e523bf1f 4 int microsec = 1300 - degrees*9;
Stas285 0:e9488589a8ee 5 //pc.printf("%d \n", microsec);
Stas285 0:e9488589a8ee 6 serva_out.pulsewidth_us(microsec);
Stas285 0:e9488589a8ee 7 }
Stas285 0:e9488589a8ee 8
Stas285 0:e9488589a8ee 9 void serva_init(){
Stas285 1:e2a6e523bf1f 10 serva_out.period_ms(25);
Stas285 0:e9488589a8ee 11 serva(0);
Stas285 0:e9488589a8ee 12 }