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);
        }
    }
}