li lei / motor

sf

motor.cpp@0:597047b3b728, 2016-09-27 (annotated)

Committer:
floatlei
Date:
Tue Sep 27 09:41:43 2016 +0000
Revision:
0:597047b3b728
sf

Who changed what in which revision?

UserRevisionLine numberNew contents of line
floatlei 0:597047b3b728 1
floatlei 0:597047b3b728 2 #include "motor.h"
floatlei 0:597047b3b728 3
floatlei 0:597047b3b728 4 DigitalIn motorguan(PB_12);
floatlei 0:597047b3b728 5 DigitalIn motorkai(PB_13);
floatlei 0:597047b3b728 6 DigitalOut motorzheng(PB_14);
floatlei 0:597047b3b728 7 DigitalOut motorfan(PB_15);
floatlei 0:597047b3b728 8
floatlei 0:597047b3b728 9 MotorCtl::MotorCtl()
floatlei 0:597047b3b728 10 {
floatlei 0:597047b3b728 11 //motorguan.DigitalIn(PB_12);
floatlei 0:597047b3b728 12 motorfan=0;
floatlei 0:597047b3b728 13 motorzheng=0;
floatlei 0:597047b3b728 14 }
floatlei 0:597047b3b728 15
floatlei 0:597047b3b728 16 unsigned short MotorCtl::open(void)
floatlei 0:597047b3b728 17 {
floatlei 0:597047b3b728 18 unsigned short MotorTimeout=10;
floatlei 0:597047b3b728 19
floatlei 0:597047b3b728 20 motorzheng=1; //start open
floatlei 0:597047b3b728 21
floatlei 0:597047b3b728 22 while(MotorTimeout&&motorkai)
floatlei 0:597047b3b728 23 {
floatlei 0:597047b3b728 24 wait(1);
floatlei 0:597047b3b728 25 MotorTimeout--;
floatlei 0:597047b3b728 26 }
floatlei 0:597047b3b728 27 if(motorkai==0)
floatlei 0:597047b3b728 28
floatlei 0:597047b3b728 29 motorzheng=0;
floatlei 0:597047b3b728 30
floatlei 0:597047b3b728 31 if(MotorTimeout!=0)
floatlei 0:597047b3b728 32 MotorTimeout=1;
floatlei 0:597047b3b728 33
floatlei 0:597047b3b728 34 return MotorTimeout; //Err
floatlei 0:597047b3b728 35 }
floatlei 0:597047b3b728 36
floatlei 0:597047b3b728 37
floatlei 0:597047b3b728 38 unsigned short MotorCtl::close()
floatlei 0:597047b3b728 39 {
floatlei 0:597047b3b728 40 unsigned short MotorTimeout=10;
floatlei 0:597047b3b728 41
floatlei 0:597047b3b728 42 motorfan=1;
floatlei 0:597047b3b728 43
floatlei 0:597047b3b728 44 while(MotorTimeout&&motorguan)
floatlei 0:597047b3b728 45 {
floatlei 0:597047b3b728 46 wait(1);
floatlei 0:597047b3b728 47 MotorTimeout--;
floatlei 0:597047b3b728 48 }
floatlei 0:597047b3b728 49
floatlei 0:597047b3b728 50 motorfan=0;
floatlei 0:597047b3b728 51 if(motorguan==0)
floatlei 0:597047b3b728 52
floatlei 0:597047b3b728 53 if(MotorTimeout!=0) //close done Err?
floatlei 0:597047b3b728 54 MotorTimeout=1;
floatlei 0:597047b3b728 55
floatlei 0:597047b3b728 56 return MotorTimeout; //Err
floatlei 0:597047b3b728 57 }