Dima Dudin / Mbed 2 deprecated DD_Robot

svoe

Dependencies:   mbed mbed-STM32F103C8T6 MPU6050_1

serva.h

Committer:
Stas285
Date:
2017-05-02
Revision:
0:e9488589a8ee
Child:
1:e2a6e523bf1f

File content as of revision 0:e9488589a8ee:

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);
    }