QQ

Dependencies:   mbed

Fork of BX-car by kao yi

Committer:
physicsgood
Date:
Mon Jun 30 03:13:49 2014 +0000
Revision:
16:7ada30380595
Parent:
15:3fa780990a6a
11

Who changed what in which revision?

UserRevisionLine numberNew contents of line
backman 1:82bc25a7b68b 1 // 0~180 angle 1~2ms
backman 1:82bc25a7b68b 2 #include "mbed.h"
backman 1:82bc25a7b68b 3 #include "servo_api.h"
backman 1:82bc25a7b68b 4
backman 1:82bc25a7b68b 5
physicsgood 15:3fa780990a6a 6 #define right_end 0.05 //left
backman 1:82bc25a7b68b 7
physicsgood 15:3fa780990a6a 8 #define left_end 0.1 //right
backman 1:82bc25a7b68b 9
backman 1:82bc25a7b68b 10 //memory opt
backman 1:82bc25a7b68b 11 // 5 degree seperate
backman 1:82bc25a7b68b 12
backman 1:82bc25a7b68b 13
physicsgood 15:3fa780990a6a 14 //0.075 middle
backman 1:82bc25a7b68b 15 BX_servo::BX_servo(void){
backman 1:82bc25a7b68b 16
backman 1:82bc25a7b68b 17
backman 1:82bc25a7b68b 18 angle = 0;
backman 1:82bc25a7b68b 19
backman 1:82bc25a7b68b 20 servo_in= new PwmOut(PTB0);
backman 1:82bc25a7b68b 21
backman 1:82bc25a7b68b 22 servo_in->period_ms(20);
backman 1:82bc25a7b68b 23
backman 9:33b99cb45e99 24
backman 1:82bc25a7b68b 25
backman 1:82bc25a7b68b 26 }
backman 1:82bc25a7b68b 27
backman 1:82bc25a7b68b 28
backman 1:82bc25a7b68b 29
backman 1:82bc25a7b68b 30
backman 1:82bc25a7b68b 31
backman 1:82bc25a7b68b 32
backman 9:33b99cb45e99 33 float BX_servo::set_angle(float a){
backman 9:33b99cb45e99 34
backman 9:33b99cb45e99 35 if(a > left_end)
physicsgood 15:3fa780990a6a 36 a=0.1;
physicsgood 15:3fa780990a6a 37 else if(a< 0.05)
physicsgood 15:3fa780990a6a 38 a=0.05;
backman 1:82bc25a7b68b 39
backman 1:82bc25a7b68b 40
backman 1:82bc25a7b68b 41 angle=a;
backman 1:82bc25a7b68b 42
backman 9:33b99cb45e99 43 *servo_in=angle;
backman 1:82bc25a7b68b 44
backman 1:82bc25a7b68b 45
backman 1:82bc25a7b68b 46
backman 1:82bc25a7b68b 47 return angle;
backman 1:82bc25a7b68b 48
backman 1:82bc25a7b68b 49 }