Clark Lin / Mbed 2 deprecated 0709

QQQQQQQ

Dependencies:   mbed

Fork of 7_7Boboobooo by 譯文 張

servo_api.cpp

Committer:
physicsgood
Date:
2014-07-07
Revision:
6:b046d6ff3745
Parent:
1:82bc25a7b68b
Child:
7:f04bde0ca846

File content as of revision 6:b046d6ff3745:

// 0~180 angle    1~2ms
#include "mbed.h"
#include "servo_api.h"
#define right_end 1.0  //90
#define left_end 0.0  //-90
//middle 0.057

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