Stepper motor moves in steps depending on the 4 bit input given by switches
Dependencies: StepperMotorUni mbed
main.cpp
- Committer:
- EduRemo
- Date:
- 2016-02-05
- Revision:
- 0:d3f9c4187789
File content as of revision 0:d3f9c4187789:
// "Hello" program for StepperMotorUni class library #include "mbed.h" #include "StepperMotorUni.h" StepperMotorUni motor( PTB0, PTB1, PTB2, PTB3); DigitalIn sw0(PTD1); // Switch selected as input DigitalIn sw1(PTD3); DigitalIn sw2(PTD2); DigitalIn sw3(PTD0); int main() { motor.set_pps( 200 ); while (1) { if (sw0==0 && sw1==0 && sw2==0 && sw3==0) { motor.move_steps(150); } else if (sw0==0 && sw1==0 && sw2==0 && sw3==1) { motor.move_steps(140); wait(5); } else if (sw0==0 && sw1==0 && sw2==1 && sw3==0) { motor.move_steps(130); wait(5); } else if (sw0==0 && sw1==0 && sw2==1 && sw3==1) { motor.move_steps(120); wait(5); } else if (sw0==0 && sw1==1 && sw2==0 && sw3==0) { motor.move_steps(110); wait(5); } else if (sw0==0 && sw1==1 && sw2==0 && sw3==1) { motor.move_steps(100); wait(5); } else if (sw0==0 && sw1==1 && sw2==1 && sw3==0) { motor.move_steps(90); wait(5); } else if (sw0==0 && sw1==1 && sw2==1 && sw3==1) { motor.move_steps(80); wait(5); } else if (sw0==1 && sw1==0 && sw2==0 && sw3==0) { motor.move_steps(70); wait(5); } else if (sw0==1 && sw1==0 && sw2==0 && sw3==1) { motor.move_steps(60); wait(5); } else if (sw0==1 && sw1==0 && sw2==1 && sw3==0) { motor.move_steps(50); wait(5); } else if (sw0==1 && sw1==0 && sw2==1 && sw3==1) { motor.move_steps(40); wait(5); } else if (sw0==1 && sw1==1 && sw2==0 && sw3==0) { motor.move_steps(30); wait(5); } else if (sw0==1 && sw1==1 && sw2==0 && sw3==1) { motor.move_steps(20); wait(5); } else if (sw0==1 && sw1==1 && sw2==1 && sw3==0) { motor.move_steps(10); wait(5); } else if (sw0==1 && sw1==1 && sw2==1 && sw3==1) { motor.move_steps(00); wait(5); } else { motor.move_steps(0); } } }