Clark Lin / Mbed 2 deprecated BX-car_s

QQQ

Dependencies:   mbed-rtos mbed

Fork of BX-car_s by Tony Lin

servo_api.cpp

Committer:
TonyLin
Date:
2014-06-28
Revision:
16:b1e11b865d05
Parent:
15:57567d3ee27e

File content as of revision 16:b1e11b865d05:

// 0~180 angle    1~2ms
#include "mbed.h"
#include "servo_api.h"
#define right_end 0.093  //90
#define left_end 0.061   //-90

//memory opt
// 5 degree seperate
BX_servo::BX_servo(void)
{
    angle = 0;
    servo_in= new  PwmOut(PTB0);
    servo_in->period_ms(20);
}

float BX_servo::set_angle(float a)
{

    if( a<left_end )
        a=left_end;
    else if(a>right_end)
        a=right_end;
    angle=a;
    *servo_in=angle;

    return angle;
}