Yi Lin Chen / Mbed 2 deprecated Boboobooo

shared

Dependencies:   mbed-rtos mbed

Fork of Boboobooo by kao yi

servo_api.cpp

Committer:
Kruskal
Date:
2014-10-31
Revision:
8:089b778962c4
Parent:
1:82bc25a7b68b

File content as of revision 8:089b778962c4:

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