Diff: main.cpp

Revision:

0:d3f9c4187789

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri Feb 05 07:33:38 2016 +0000
@@ -0,0 +1,102 @@
+// "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);
+        }
+    }
+}
\ No newline at end of file