Dima Dudin / Mbed 2 deprecated DD_Robot

svoe

Dependencies:   mbed mbed-STM32F103C8T6 MPU6050_1

serva.h

Committer:
dima285
Date:
2019-07-23
Branch:
svoe
Revision:
22:14e85f2068c7
Parent:
1:e2a6e523bf1f

File content as of revision 22:14e85f2068c7:

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