The servo version of SCRIBE

Dependencies:   BLE_nRF8001 BNO055 HC_SR04_Ultrasonic_Library mbed-rtos mbed

Fork of SCRIBE_stepper by SCRIBE

Committer:
nibab
Date:
Fri May 06 00:18:02 2016 +0000
Revision:
13:d49cb8b52a1e
Parent:
8:4d7b2dbdb694
Child:
14:82248fb06e53
Add servo_slowleft() and servo_slowright()

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nibab 6:91ff95c9a44e 1 #include "mbed.h"
nibab 6:91ff95c9a44e 2
nibab 6:91ff95c9a44e 3 PwmOut pin25(p25);
nibab 6:91ff95c9a44e 4 PwmOut pin26(p26);
nibab 6:91ff95c9a44e 5
nibab 6:91ff95c9a44e 6 void servo_reset(){
nibab 6:91ff95c9a44e 7 pin25.period_ms(20); //Set the period: 20ms
nibab 6:91ff95c9a44e 8 pin26.period_ms(20); //Set the period: 20ms
nibab 6:91ff95c9a44e 9 }
nibab 6:91ff95c9a44e 10
nibab 6:91ff95c9a44e 11 void servo_f(){
nibab 6:91ff95c9a44e 12 pin25.pulsewidth_us(1300);
nibab 6:91ff95c9a44e 13 pin26.pulsewidth_us(1700);
nibab 6:91ff95c9a44e 14 }
nibab 6:91ff95c9a44e 15
nibab 6:91ff95c9a44e 16 void servo_b(){
nibab 6:91ff95c9a44e 17 pin25.pulsewidth_us(1700);
nibab 6:91ff95c9a44e 18 pin26.pulsewidth_us(1300);
nibab 6:91ff95c9a44e 19 }
nibab 6:91ff95c9a44e 20
nibab 6:91ff95c9a44e 21 void servo_right(){
nibab 6:91ff95c9a44e 22 pin25.pulsewidth_us(1700);
nibab 6:91ff95c9a44e 23 pin26.pulsewidth_us(1700);
nibab 6:91ff95c9a44e 24 }
nibab 6:91ff95c9a44e 25
nibab 6:91ff95c9a44e 26 void servo_left(){
nibab 6:91ff95c9a44e 27 pin25.pulsewidth_us(1300);
nibab 6:91ff95c9a44e 28 pin26.pulsewidth_us(1300);
nibab 6:91ff95c9a44e 29 }
nibab 6:91ff95c9a44e 30
nibab 6:91ff95c9a44e 31 void servo_stop(){
nibab 6:91ff95c9a44e 32 pin25.pulsewidth_us(1500);
nibab 8:4d7b2dbdb694 33 pin26.pulsewidth_us(1510);
nibab 13:d49cb8b52a1e 34 }
nibab 13:d49cb8b52a1e 35
nibab 13:d49cb8b52a1e 36 void servo_slowright(){
nibab 13:d49cb8b52a1e 37 pin25.pulsewidth_us(1550);
nibab 13:d49cb8b52a1e 38 pin26.pulsewidth_us(1550);
nibab 13:d49cb8b52a1e 39 }
nibab 13:d49cb8b52a1e 40
nibab 13:d49cb8b52a1e 41 void servo_slowleft(){
nibab 13:d49cb8b52a1e 42 pin25.pulsewidth_us(1450);
nibab 13:d49cb8b52a1e 43 pin26.pulsewidth_us(1450);
nibab 6:91ff95c9a44e 44 }