Clark Lin / Mbed 2 deprecated 0709

QQQQQQQ

Dependencies:   mbed

Fork of 7_7Boboobooo by 譯文 張

servo_api.cpp

Committer:
physicsgood
Date:
2014-07-09
Revision:
9:c318ee86d6e9
Parent:
7:f04bde0ca846

File content as of revision 9:c318ee86d6e9:

// 0~180 angle    1~2ms
#include "mbed.h"
#include "servo_api.h"
#define right_end 0.057  //90
#define left_end 0.025  //-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;
}