Dima Dudin / Mbed 2 deprecated DD_Robot

svoe

Dependencies:   mbed mbed-STM32F103C8T6 MPU6050_1

serva.h

Committer:
Stas285
Date:
2017-05-06
Revision:
1:e2a6e523bf1f
Parent:
0:e9488589a8ee
Child:
22:14e85f2068c7

File content as of revision 1:e2a6e523bf1f:

PwmOut serva_out(PB_14);

void serva(int degrees){ //{-80;80} lim speed (20 deg, 50ms)
    int microsec = 1300 - degrees*9;
    //pc.printf("%d \n", microsec);
    serva_out.pulsewidth_us(microsec);
    }
   
void serva_init(){
    serva_out.period_ms(25);
    serva(0);
    }