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:
Thu May 05 01:43:03 2016 +0000
Revision:
8:4d7b2dbdb694
Parent:
6:91ff95c9a44e
Child:
13:d49cb8b52a1e
Adjust servo arguments and the timing coefficient

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 6:91ff95c9a44e 34 }