scribe robot working with stepper motors
Dependencies: BLE_nRF8001 BNO055 HC_SR04_Ultrasonic_Library localization mbed-rtos mbed
Diff: stepper.cpp
- Revision:
- 5:2c196f871096
- Parent:
- 4:1da4d4050306
- Child:
- 6:ca112c3083bb
--- a/stepper.cpp Mon Apr 25 05:38:48 2016 +0000 +++ b/stepper.cpp Wed May 04 23:51:57 2016 +0000 @@ -1,9 +1,10 @@ +// stepper.cpp of SCRIBE stepper -> updated for pololu motors #include "mbed.h"; -DigitalOut yellow_l(p9); -DigitalOut orange_l(p14); -DigitalOut brown_l(p15); -DigitalOut black_l(p16); +DigitalOut yellow_l(p5); +DigitalOut orange_l(p6); +DigitalOut brown_l(p7); +DigitalOut black_l(p8); DigitalOut yellow_r(p17); DigitalOut orange_r(p18); @@ -136,7 +137,7 @@ return 1; } -int step_right(){ +int step_left(){ switch(case_right){ case 0: //step 0101 @@ -204,7 +205,7 @@ } -int step_left(){ +int step_right(){ switch(case_left){ case 0: //step 0011