Kyle Zampaglione
/
GloveBoxTester
Code for testing glovebox.
GloveBoxTester.cpp@2:73be4f9f04f9, 2013-07-16 (annotated)
- Committer:
- kzampag
- Date:
- Tue Jul 16 19:03:26 2013 +0000
- Revision:
- 2:73be4f9f04f9
- Parent:
- 1:f0943cae3bee
- Child:
- 3:ae51b59d29b8
Open 1 box at a time;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
kzampag | 0:4c49d95a1f05 | 1 | #include "mbed.h" |
kzampag | 0:4c49d95a1f05 | 2 | |
kzampag | 0:4c49d95a1f05 | 3 | Serial pc(USBTX, USBRX); |
kzampag | 0:4c49d95a1f05 | 4 | Serial lcd(p13,p14); |
kzampag | 0:4c49d95a1f05 | 5 | |
kzampag | 0:4c49d95a1f05 | 6 | DigitalOut pneumatics1(p11); |
kzampag | 0:4c49d95a1f05 | 7 | DigitalOut pneumatics2(p12); |
kzampag | 0:4c49d95a1f05 | 8 | DigitalOut box1(p23); |
kzampag | 0:4c49d95a1f05 | 9 | DigitalOut box2(p22); |
kzampag | 0:4c49d95a1f05 | 10 | DigitalOut box3(p21); |
kzampag | 0:4c49d95a1f05 | 11 | |
kzampag | 0:4c49d95a1f05 | 12 | |
kzampag | 0:4c49d95a1f05 | 13 | int count = 1; |
kzampag | 2:73be4f9f04f9 | 14 | int cycles = 5500; |
kzampag | 0:4c49d95a1f05 | 15 | |
kzampag | 0:4c49d95a1f05 | 16 | |
kzampag | 0:4c49d95a1f05 | 17 | |
kzampag | 0:4c49d95a1f05 | 18 | |
kzampag | 0:4c49d95a1f05 | 19 | int main() |
kzampag | 0:4c49d95a1f05 | 20 | { |
kzampag | 1:f0943cae3bee | 21 | |
kzampag | 1:f0943cae3bee | 22 | pc.printf(" \n \rHere we go! \n \r"); |
kzampag | 0:4c49d95a1f05 | 23 | while(count< cycles) { |
kzampag | 0:4c49d95a1f05 | 24 | |
kzampag | 0:4c49d95a1f05 | 25 | |
kzampag | 0:4c49d95a1f05 | 26 | //Trigger solenoid |
kzampag | 2:73be4f9f04f9 | 27 | box1 = 1; |
kzampag | 2:73be4f9f04f9 | 28 | box2 = 0; |
kzampag | 2:73be4f9f04f9 | 29 | box3 = 0; |
kzampag | 2:73be4f9f04f9 | 30 | wait(.3); |
kzampag | 0:4c49d95a1f05 | 31 | |
kzampag | 2:73be4f9f04f9 | 32 | box1 = 0; |
kzampag | 2:73be4f9f04f9 | 33 | box2 = 1; |
kzampag | 2:73be4f9f04f9 | 34 | wait(.3); |
kzampag | 2:73be4f9f04f9 | 35 | |
kzampag | 2:73be4f9f04f9 | 36 | box2 = 0; |
kzampag | 2:73be4f9f04f9 | 37 | box3 = 1; |
kzampag | 2:73be4f9f04f9 | 38 | wait(.3); |
kzampag | 2:73be4f9f04f9 | 39 | |
kzampag | 2:73be4f9f04f9 | 40 | |
kzampag | 2:73be4f9f04f9 | 41 | box3 = 0; |
kzampag | 2:73be4f9f04f9 | 42 | |
kzampag | 0:4c49d95a1f05 | 43 | |
kzampag | 0:4c49d95a1f05 | 44 | //Wait until box completely opens then trigger pneumatics |
kzampag | 2:73be4f9f04f9 | 45 | wait(.7); |
kzampag | 0:4c49d95a1f05 | 46 | pneumatics1 = 1; |
kzampag | 0:4c49d95a1f05 | 47 | pneumatics2 = 0; |
kzampag | 0:4c49d95a1f05 | 48 | |
kzampag | 0:4c49d95a1f05 | 49 | //Wait until cylinder has finished travel |
kzampag | 2:73be4f9f04f9 | 50 | wait(.8); |
kzampag | 0:4c49d95a1f05 | 51 | pneumatics1 = 0; |
kzampag | 0:4c49d95a1f05 | 52 | pneumatics2 = 1; |
kzampag | 0:4c49d95a1f05 | 53 | |
kzampag | 0:4c49d95a1f05 | 54 | //Wait to full retract then repeat |
kzampag | 2:73be4f9f04f9 | 55 | wait(2); |
kzampag | 2:73be4f9f04f9 | 56 | pneumatics1 = 0; |
kzampag | 2:73be4f9f04f9 | 57 | pneumatics2 = 0; |
kzampag | 1:f0943cae3bee | 58 | pc.printf("%d\r",count); |
kzampag | 0:4c49d95a1f05 | 59 | count++; |
kzampag | 2:73be4f9f04f9 | 60 | |
kzampag | 0:4c49d95a1f05 | 61 | |
kzampag | 0:4c49d95a1f05 | 62 | } |
kzampag | 0:4c49d95a1f05 | 63 | } |