Tony YI
/
ESDC2014
123123123123123123123123123
main.cpp@3:4306d042af6f, 2014-07-03 (annotated)
- Committer:
- TonyYI
- Date:
- Thu Jul 03 14:52:44 2014 +0000
- Revision:
- 3:4306d042af6f
- Parent:
- 2:442902ec3aa1
123123
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
TonyYI | 0:3417ca0a36c0 | 1 | /****************************************************** |
TonyYI | 0:3417ca0a36c0 | 2 | |
TonyYI | 0:3417ca0a36c0 | 3 | ****┏┓ ┏┓ |
TonyYI | 0:3417ca0a36c0 | 4 | **┏┛┻━━━━━━┛┻┓ |
TonyYI | 0:3417ca0a36c0 | 5 | **┃ ┃ |
TonyYI | 0:3417ca0a36c0 | 6 | **┃ ━━━ ┃ |
TonyYI | 0:3417ca0a36c0 | 7 | **┃ ┳┛ ┗┳ ┃ |
TonyYI | 0:3417ca0a36c0 | 8 | **┃ ┃ |
TonyYI | 0:3417ca0a36c0 | 9 | **┃ ''' ┻ ''' ┃ |
TonyYI | 0:3417ca0a36c0 | 10 | **┃ ┃ |
TonyYI | 0:3417ca0a36c0 | 11 | **┗━━┓ ┏━━┛ |
TonyYI | 0:3417ca0a36c0 | 12 | *******┃ ┃ |
TonyYI | 0:3417ca0a36c0 | 13 | *******┃ ┃ |
TonyYI | 0:3417ca0a36c0 | 14 | *******┃ ┃ |
TonyYI | 0:3417ca0a36c0 | 15 | *******┃ ┗━━━━━━━━┓ |
TonyYI | 0:3417ca0a36c0 | 16 | *******┃ ┃━┓ |
TonyYI | 0:3417ca0a36c0 | 17 | *******┃ NO BUG ┏━┛ |
TonyYI | 0:3417ca0a36c0 | 18 | *******┃ ┃ |
TonyYI | 0:3417ca0a36c0 | 19 | *******┗━┓ ┓ ┏━┏━┓ ━┛ |
TonyYI | 0:3417ca0a36c0 | 20 | ***********┃ ┛ ┛ ┃ ┛ ┛ |
TonyYI | 0:3417ca0a36c0 | 21 | ***********┃ ┃ ┃ ┃ ┃ ┃ |
TonyYI | 0:3417ca0a36c0 | 22 | ***********┗━┛━┛ ┗━┛━┛ |
TonyYI | 0:3417ca0a36c0 | 23 | |
TonyYI | 0:3417ca0a36c0 | 24 | This part is added by project ESDC2014 of CUHK team. |
TonyYI | 0:3417ca0a36c0 | 25 | All the code with this header are under GPL open source license. |
TonyYI | 0:3417ca0a36c0 | 26 | This program is running on Mbed Platform 'mbed LPC1768' avaliable in 'http://mbed.org'. |
TonyYI | 0:3417ca0a36c0 | 27 | **********************************************************/ |
TonyYI | 0:3417ca0a36c0 | 28 | #include "mbed.h" |
TonyYI | 0:3417ca0a36c0 | 29 | #include "communication.h" |
TonyYI | 0:3417ca0a36c0 | 30 | #include "port.h" |
TonyYI | 0:3417ca0a36c0 | 31 | |
TonyYI | 0:3417ca0a36c0 | 32 | int main() |
TonyYI | 0:3417ca0a36c0 | 33 | { |
TonyYI | 0:3417ca0a36c0 | 34 | init_PORT(); |
terryLAI | 1:cbec1283a16a | 35 | |
TonyYI | 0:3417ca0a36c0 | 36 | while(1) |
TonyYI | 0:3417ca0a36c0 | 37 | { |
terryLAI | 1:cbec1283a16a | 38 | buzzer.OFF(); |
TonyYI | 0:3417ca0a36c0 | 39 | com.parseMessage(); |
terryLAI | 1:cbec1283a16a | 40 | buzzer.time_out_init(); |
TonyYI | 0:3417ca0a36c0 | 41 | if(com.getInfoOK(0) == 1) //car |
TonyYI | 0:3417ca0a36c0 | 42 | { |
TonyYI | 3:4306d042af6f | 43 | printf("main(). Car action starting...\r\n"); |
TonyYI | 0:3417ca0a36c0 | 44 | com.forwardMessage(); |
TonyYI | 0:3417ca0a36c0 | 45 | com.ACK(&lifter, &camera_platform); |
TonyYI | 0:3417ca0a36c0 | 46 | com.resetInfoOK(0); |
TonyYI | 0:3417ca0a36c0 | 47 | com.resetInfoOK(1); |
TonyYI | 3:4306d042af6f | 48 | printf("main(). Car action ended...\r\n"); |
TonyYI | 0:3417ca0a36c0 | 49 | } |
TonyYI | 0:3417ca0a36c0 | 50 | else if(com.getInfoOK(0) == 2) //lifter |
TonyYI | 0:3417ca0a36c0 | 51 | { |
TonyYI | 3:4306d042af6f | 52 | printf("main(). Lifter action starting...\r\n"); |
TonyYI | 0:3417ca0a36c0 | 53 | lifter.lifterMove(com.getMoveDis(), com.getMoveDir(), com.getRotateDis(), com.getRotateDir()); |
TonyYI | 0:3417ca0a36c0 | 54 | com.ACK(&lifter, &camera_platform); |
TonyYI | 0:3417ca0a36c0 | 55 | com.resetInfoOK(0); |
TonyYI | 0:3417ca0a36c0 | 56 | com.resetInfoOK(1); |
TonyYI | 3:4306d042af6f | 57 | printf("main(). Lifter action ended...\r\n"); |
TonyYI | 0:3417ca0a36c0 | 58 | } |
TonyYI | 0:3417ca0a36c0 | 59 | else if(com.getInfoOK(0) == 3) //camera_platform |
TonyYI | 0:3417ca0a36c0 | 60 | { |
TonyYI | 3:4306d042af6f | 61 | printf("main(). camera_platform action starting...\r\n"); |
TonyYI | 0:3417ca0a36c0 | 62 | camera_platform.cameraPlatformMove(com.getMoveDis(), com.getMoveDir(), com.getRotateDis(), com.getRotateDir()); |
TonyYI | 0:3417ca0a36c0 | 63 | com.ACK(&lifter, &camera_platform); |
TonyYI | 0:3417ca0a36c0 | 64 | com.resetInfoOK(0); |
TonyYI | 0:3417ca0a36c0 | 65 | com.resetInfoOK(1); |
TonyYI | 3:4306d042af6f | 66 | printf("main(). Camera_platform action ended...\r\n"); |
TonyYI | 0:3417ca0a36c0 | 67 | } |
TonyYI | 0:3417ca0a36c0 | 68 | else if(com.getInfoOK(0) == 4) //compass |
TonyYI | 0:3417ca0a36c0 | 69 | { |
TonyYI | 3:4306d042af6f | 70 | printf("main(). Compass action starting...\r\n"); |
TonyYI | 0:3417ca0a36c0 | 71 | com.ACK(&lifter, &camera_platform); |
TonyYI | 0:3417ca0a36c0 | 72 | com.resetInfoOK(0); |
TonyYI | 0:3417ca0a36c0 | 73 | com.resetInfoOK(1); |
TonyYI | 3:4306d042af6f | 74 | printf("main(). Compass action ended...\r\n"); |
TonyYI | 0:3417ca0a36c0 | 75 | } |
TonyYI | 3:4306d042af6f | 76 | else if(com.getInfoOK(0) == 5) //buzzer |
terryLAI | 2:442902ec3aa1 | 77 | { |
TonyYI | 3:4306d042af6f | 78 | printf("main(). Buzzer action starting...\r\n"); |
terryLAI | 2:442902ec3aa1 | 79 | buzzer.ON(); |
terryLAI | 2:442902ec3aa1 | 80 | wait(0.1); |
terryLAI | 2:442902ec3aa1 | 81 | buzzer.OFF(); |
terryLAI | 2:442902ec3aa1 | 82 | wait(0.1); |
terryLAI | 2:442902ec3aa1 | 83 | buzzer.ON(); |
terryLAI | 2:442902ec3aa1 | 84 | wait(0.2); |
terryLAI | 2:442902ec3aa1 | 85 | buzzer.OFF(); |
terryLAI | 2:442902ec3aa1 | 86 | com.ACK(&lifter, &camera_platform); |
terryLAI | 2:442902ec3aa1 | 87 | com.resetInfoOK(0); |
terryLAI | 2:442902ec3aa1 | 88 | com.resetInfoOK(1); |
TonyYI | 3:4306d042af6f | 89 | printf("main(). Buzzer action ended...\r\n"); |
terryLAI | 2:442902ec3aa1 | 90 | } |
terryLAI | 2:442902ec3aa1 | 91 | |
terryLAI | 1:cbec1283a16a | 92 | buzzer.cleanFlag(); |
TonyYI | 0:3417ca0a36c0 | 93 | } |
terryLAI | 1:cbec1283a16a | 94 | } |
terryLAI | 1:cbec1283a16a | 95 | |
terryLAI | 1:cbec1283a16a | 96 | |
terryLAI | 1:cbec1283a16a | 97 | |
terryLAI | 1:cbec1283a16a | 98 |