This is the initial motor driver code
Dependencies: DebounceIn mbed
main.cpp@0:f9546c3e2e72, 2015-05-26 (annotated)
- Committer:
- figlax
- Date:
- Tue May 26 19:46:52 2015 +0000
- Revision:
- 0:f9546c3e2e72
- Child:
- 1:357e2c6d4e66
commit 1
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
figlax | 0:f9546c3e2e72 | 1 | #include "mbed.h" |
figlax | 0:f9546c3e2e72 | 2 | |
figlax | 0:f9546c3e2e72 | 3 | DigitalOut myled(LED1); //Indicator light to indicate the program is running |
figlax | 0:f9546c3e2e72 | 4 | DigitalOut motor(D4); //To MOSFET |
figlax | 0:f9546c3e2e72 | 5 | DigitalOut indic(LED2); //Indicate Hall ES State |
figlax | 0:f9546c3e2e72 | 6 | DigitalIn hall(D6); //HFS (deprecated?) |
figlax | 0:f9546c3e2e72 | 7 | DigitalIn swiRe(D1); //Rear Limit Switch |
figlax | 0:f9546c3e2e72 | 8 | DigitalIn swiFr(D2); //Front Limit Switch |
figlax | 0:f9546c3e2e72 | 9 | |
figlax | 0:f9546c3e2e72 | 10 | int main() { |
figlax | 0:f9546c3e2e72 | 11 | myled = 1; |
figlax | 0:f9546c3e2e72 | 12 | wait(0.2); |
figlax | 0:f9546c3e2e72 | 13 | myled = 0; |
figlax | 0:f9546c3e2e72 | 14 | wait(0.2); |
figlax | 0:f9546c3e2e72 | 15 | myled = 1; |
figlax | 0:f9546c3e2e72 | 16 | wait(0.2); |
figlax | 0:f9546c3e2e72 | 17 | myled = 0; |
figlax | 0:f9546c3e2e72 | 18 | wait(0.2); |
figlax | 0:f9546c3e2e72 | 19 | myled = 1; |
figlax | 0:f9546c3e2e72 | 20 | while(1) { |
figlax | 0:f9546c3e2e72 | 21 | if (swiRe&&(~swiFr)){ |
figlax | 0:f9546c3e2e72 | 22 | motor = 1; |
figlax | 0:f9546c3e2e72 | 23 | indic = 1; |
figlax | 0:f9546c3e2e72 | 24 | } |
figlax | 0:f9546c3e2e72 | 25 | |
figlax | 0:f9546c3e2e72 | 26 | if((~swiRe)&&swiFr){ |
figlax | 0:f9546c3e2e72 | 27 | motor = 0; |
figlax | 0:f9546c3e2e72 | 28 | indic = 0; |
figlax | 0:f9546c3e2e72 | 29 | } |
figlax | 0:f9546c3e2e72 | 30 | //if (hall==1){ |
figlax | 0:f9546c3e2e72 | 31 | // motor = 1; |
figlax | 0:f9546c3e2e72 | 32 | // indic = 1; |
figlax | 0:f9546c3e2e72 | 33 | // } |
figlax | 0:f9546c3e2e72 | 34 | //if (hall == 0) { |
figlax | 0:f9546c3e2e72 | 35 | // motor= 0; |
figlax | 0:f9546c3e2e72 | 36 | // indic = 0; |
figlax | 0:f9546c3e2e72 | 37 | // } |
figlax | 0:f9546c3e2e72 | 38 | |
figlax | 0:f9546c3e2e72 | 39 | |
figlax | 0:f9546c3e2e72 | 40 | |
figlax | 0:f9546c3e2e72 | 41 | |
figlax | 0:f9546c3e2e72 | 42 | } |
figlax | 0:f9546c3e2e72 | 43 | } |