55+
Dependencies: BEAR_Protocol_Edited BufferedSerial Debug MaxSonar PID Process QEI UI iSerial mbed
Fork of CleaningMachine_Betago by
main.cpp@0:84f05cd2f197, 2016-02-15 (annotated)
- Committer:
- icyzkungz
- Date:
- Mon Feb 15 17:48:23 2016 +0000
- Revision:
- 0:84f05cd2f197
- Child:
- 1:45f1573d65a1
first publish
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
icyzkungz | 0:84f05cd2f197 | 1 | #include "Debug.h" |
icyzkungz | 0:84f05cd2f197 | 2 | #include "UI.h" |
icyzkungz | 0:84f05cd2f197 | 3 | #include "pinconfig.h" |
icyzkungz | 0:84f05cd2f197 | 4 | #include "BEAR_Protocol.h" |
icyzkungz | 0:84f05cd2f197 | 5 | |
icyzkungz | 0:84f05cd2f197 | 6 | DigitalIn button(USER_BUTTON); |
icyzkungz | 0:84f05cd2f197 | 7 | Serial pc(SERIAL_TX,SERIAL_RX); |
icyzkungz | 0:84f05cd2f197 | 8 | |
icyzkungz | 0:84f05cd2f197 | 9 | void DebugMode(); |
icyzkungz | 0:84f05cd2f197 | 10 | |
icyzkungz | 0:84f05cd2f197 | 11 | int main() |
icyzkungz | 0:84f05cd2f197 | 12 | { |
icyzkungz | 0:84f05cd2f197 | 13 | if(!button) { |
icyzkungz | 0:84f05cd2f197 | 14 | while(!button); |
icyzkungz | 0:84f05cd2f197 | 15 | DebugMode(); //-->Debug.h |
icyzkungz | 0:84f05cd2f197 | 16 | } |
icyzkungz | 0:84f05cd2f197 | 17 | |
icyzkungz | 0:84f05cd2f197 | 18 | UI ui(SW_WALK1,SW_WALK2,SW_WALK3,SW_SWEEP,SW_WATER,EMERGENCY); |
icyzkungz | 0:84f05cd2f197 | 19 | |
icyzkungz | 0:84f05cd2f197 | 20 | pc.printf("System Start\n"); |
icyzkungz | 0:84f05cd2f197 | 21 | while(1) |
icyzkungz | 0:84f05cd2f197 | 22 | { |
icyzkungz | 0:84f05cd2f197 | 23 | while(!ui.getEmergencyStatus()) { |
icyzkungz | 0:84f05cd2f197 | 24 | ui.RunSystem(); |
icyzkungz | 0:84f05cd2f197 | 25 | } |
icyzkungz | 0:84f05cd2f197 | 26 | } |
icyzkungz | 0:84f05cd2f197 | 27 | } |
icyzkungz | 0:84f05cd2f197 | 28 | |
icyzkungz | 0:84f05cd2f197 | 29 | void DebugMode() |
icyzkungz | 0:84f05cd2f197 | 30 | { |
icyzkungz | 0:84f05cd2f197 | 31 | float temp; |
icyzkungz | 0:84f05cd2f197 | 32 | int option; |
icyzkungz | 0:84f05cd2f197 | 33 | bool first_time = true; |
icyzkungz | 0:84f05cd2f197 | 34 | Debug debug(SERIAL_TX,SERIAL_RX); |
icyzkungz | 0:84f05cd2f197 | 35 | do { |
icyzkungz | 0:84f05cd2f197 | 36 | debug.PrintListMode(); |
icyzkungz | 0:84f05cd2f197 | 37 | option = debug.ScanInputData(1); |
icyzkungz | 0:84f05cd2f197 | 38 | |
icyzkungz | 0:84f05cd2f197 | 39 | if(option == 1) { |
icyzkungz | 0:84f05cd2f197 | 40 | do { |
icyzkungz | 0:84f05cd2f197 | 41 | temp = debug.Mode1(); |
icyzkungz | 0:84f05cd2f197 | 42 | debug.PrintAll(temp); |
icyzkungz | 0:84f05cd2f197 | 43 | } while(temp!=9999); |
icyzkungz | 0:84f05cd2f197 | 44 | } |
icyzkungz | 0:84f05cd2f197 | 45 | |
icyzkungz | 0:84f05cd2f197 | 46 | else if(option == 2) { |
icyzkungz | 0:84f05cd2f197 | 47 | do { |
icyzkungz | 0:84f05cd2f197 | 48 | if(first_time==false) { |
icyzkungz | 0:84f05cd2f197 | 49 | temp = debug.Mode2(); |
icyzkungz | 0:84f05cd2f197 | 50 | debug.PrintAll(temp); |
icyzkungz | 0:84f05cd2f197 | 51 | } else { |
icyzkungz | 0:84f05cd2f197 | 52 | temp = debug.Mode2(); |
icyzkungz | 0:84f05cd2f197 | 53 | if(temp!=0) first_time = false; |
icyzkungz | 0:84f05cd2f197 | 54 | } |
icyzkungz | 0:84f05cd2f197 | 55 | |
icyzkungz | 0:84f05cd2f197 | 56 | if(temp==9999) first_time = true; |
icyzkungz | 0:84f05cd2f197 | 57 | } while(temp!=9999); |
icyzkungz | 0:84f05cd2f197 | 58 | } |
icyzkungz | 0:84f05cd2f197 | 59 | |
icyzkungz | 0:84f05cd2f197 | 60 | |
icyzkungz | 0:84f05cd2f197 | 61 | debug.setChange(); |
icyzkungz | 0:84f05cd2f197 | 62 | } while(option!=9999); |
icyzkungz | 0:84f05cd2f197 | 63 | } |