Tony Lin / Mbed 2 deprecated BX-car

hello

Dependencies:   mbed-rtos mbed

Fork of BX-car by kao yi

servo_api.cpp

Committer:
TonyLin
Date:
2014-06-26
Revision:
10:9f0ce6ba7663
Parent:
9:33b99cb45e99

File content as of revision 10:9f0ce6ba7663:

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

//memory opt
// 5 degree seperate

BX_servo::BX_servo(void){    
      angle = 0.085;
      servo_in= new  PwmOut(PTB0);
      servo_in->period_ms(20);
}

float BX_servo::set_angle(float a){    
    if(a > left_end)
        a=0.11;
    else if(a < right_end)
        a=0.06;        
    angle=a;
    *servo_in=angle;   

    return angle;
}