main.cpp

00001 #include "mbed.h"
00002 
00003 DigitalOut In1(p21);
00004 DigitalOut In2(p22);
00005 DigitalOut In3(p23);
00006 DigitalOut In4(p24);
00007 
00008 double delayTime;
00009 int revolDir;
00010 
00011 Timer timer;
00012 float temp_time;
00013 
00014 
00015 int main() {
00016     In1 = 0;
00017     In2 = 0;
00018     In3 = 0;
00019     In4 = 0;
00020     
00021     delayTime = 0.001;
00022     revolDir = 0;
00023     
00024     timer.start();
00025     
00026     
00027     while(1) {
00028         
00029         temp_time = timer.read();
00030         
00031         if(temp_time>10)
00032         {
00033             timer.reset();
00034         }
00035         
00036         if(temp_time<=5)
00037         {
00038             //1
00039             In1 = 1; In2 = 0; In3 = 0; In4 = 0;
00040             wait(delayTime);     
00041             //2
00042             In1 = 1; In2 = 1; In3 = 0; In4 = 0;
00043             wait(delayTime);
00044             //3
00045             In1 = 0; In2 = 1; In3 = 0; In4 = 0;
00046             wait(delayTime);
00047             //4
00048             In1 = 0; In2 = 1; In3 = 1; In4 = 0;
00049             wait(delayTime);
00050             //5
00051             In1 = 0; In2 = 0; In3 = 1; In4 = 0;
00052             wait(delayTime);
00053             //6
00054             In1 = 0; In2 = 0; In3 = 1; In4 = 1;
00055             wait(delayTime);
00056             //7
00057             In1 = 0; In2 = 0; In3 = 0; In4 = 1;
00058             wait(delayTime);
00059             //8
00060             In1 = 1; In2 = 0; In3 = 0; In4 = 1;
00061             wait(delayTime);
00062         }
00063         else
00064         {
00065             //8
00066             In1 = 1; In2 = 0; In3 = 0; In4 = 1;
00067             wait(delayTime);     
00068             //7
00069             In1 = 0; In2 = 0; In3 = 0; In4 = 1;
00070             wait(delayTime);
00071             //6
00072             In1 = 0; In2 = 0; In3 = 1; In4 = 1;
00073             wait(delayTime);
00074             //5
00075             In1 = 0; In2 = 0; In3 = 1; In4 = 0;
00076             wait(delayTime);
00077             //4
00078             In1 = 0; In2 = 1; In3 = 1; In4 = 0;
00079             wait(delayTime);
00080             //3
00081             In1 = 0; In2 = 1; In3 = 0; In4 = 0;
00082             wait(delayTime);
00083             //2
00084             In1 = 1; In2 = 1; In3 = 0; In4 = 0;
00085             wait(delayTime);
00086             //1
00087             In1 = 1; In2 = 0; In3 = 0; In4 = 0;
00088             wait(delayTime);
00089         }
00090 
00091         
00092         
00093         
00094     }
00095 }