Dima Dudin / Mbed 2 deprecated DD_Robot

svoe

Dependencies:   mbed mbed-STM32F103C8T6 MPU6050_1

serva.h

Committer:
dima285
Date:
2019-08-06
Branch:
svoe
Revision:
23:bc05a104be10
Parent:
22:14e85f2068c7

File content as of revision 23:bc05a104be10:

PwmOut serva_out(PB_14);

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