wu

Dependencies:   mbed-rtos mbed

Fork of Boboobooov4 by kao yi

servo_api.cpp

Committer:
backman
Date:
2014-07-02
Revision:
20:30799cbda86b
Parent:
15:585df3979be8

File content as of revision 20:30799cbda86b:

// 0~180 angle    1~2ms
#include "mbed.h"
#include "servo_api.h"


#define right_end 0.037  //90 0.037

#define left_end 0.073   //-90  0.073

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