hiro ng / stepping_moter
Committer:
paasukusai
Date:
Tue May 15 03:45:15 2012 +0000
Revision:
0:110462dc43d1
act_stepping_motor

Who changed what in which revision?

UserRevisionLine numberNew contents of line
paasukusai 0:110462dc43d1 1 #include"mbed.h"
paasukusai 0:110462dc43d1 2 #include"stepping_moter.h"
paasukusai 0:110462dc43d1 3
paasukusai 0:110462dc43d1 4 stepping_moter::stepping_moter(PinName p1,PinName p2,PinName p3,PinName p4) : _d(p1,p2,p3,p4){
paasukusai 0:110462dc43d1 5 _d=0;
paasukusai 0:110462dc43d1 6 }
paasukusai 0:110462dc43d1 7
paasukusai 0:110462dc43d1 8 void stepping_moter::step_moter(int deg_set,double wait_time){
paasukusai 0:110462dc43d1 9 unsigned int end=1;
paasukusai 0:110462dc43d1 10 static int deg_m=0,i;
paasukusai 0:110462dc43d1 11 while(end){
paasukusai 0:110462dc43d1 12 if(deg_m<deg_set){
paasukusai 0:110462dc43d1 13 if (i==3) i=0;
paasukusai 0:110462dc43d1 14 else i+=1;
paasukusai 0:110462dc43d1 15 deg_m+=1;
paasukusai 0:110462dc43d1 16 }//if
paasukusai 0:110462dc43d1 17 else if(deg_m>deg_set){
paasukusai 0:110462dc43d1 18 if (i==0) i=3;
paasukusai 0:110462dc43d1 19 else i-=1;
paasukusai 0:110462dc43d1 20 deg_m-=1;
paasukusai 0:110462dc43d1 21 }
paasukusai 0:110462dc43d1 22 else if(deg_m==deg_set){
paasukusai 0:110462dc43d1 23 end=0;
paasukusai 0:110462dc43d1 24 }
paasukusai 0:110462dc43d1 25
paasukusai 0:110462dc43d1 26 switch(i){
paasukusai 0:110462dc43d1 27 case 0:
paasukusai 0:110462dc43d1 28 _d=9;
paasukusai 0:110462dc43d1 29 break;
paasukusai 0:110462dc43d1 30 case 1:
paasukusai 0:110462dc43d1 31 _d=3;
paasukusai 0:110462dc43d1 32 break;
paasukusai 0:110462dc43d1 33 case 2:
paasukusai 0:110462dc43d1 34 _d=6;
paasukusai 0:110462dc43d1 35 break;
paasukusai 0:110462dc43d1 36 case 3:
paasukusai 0:110462dc43d1 37 _d=12;
paasukusai 0:110462dc43d1 38 break;
paasukusai 0:110462dc43d1 39 }//switch
paasukusai 0:110462dc43d1 40
paasukusai 0:110462dc43d1 41 wait(wait_time);
paasukusai 0:110462dc43d1 42 }//while
paasukusai 0:110462dc43d1 43 }//step_moter