svoe

Dependencies:   mbed mbed-STM32F103C8T6 MPU6050_1

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers serva.h Source File

serva.h

00001 PwmOut serva_out(PB_14);
00002 
00003 void serva(int degrees){ //{-80;80} lim speed (20 deg, 50ms)
00004     int microsec = 1300 - degrees*10;
00005     //pc.printf("%d \n", microsec);
00006     serva_out.pulsewidth_us(microsec);
00007     }
00008    
00009 void serva_init(){
00010     serva_out.period_ms(25);
00011     serva(0);
00012     }