55+

Dependencies:   BEAR_Protocol_Edited BufferedSerial Debug MaxSonar PID Process QEI UI iSerial mbed

Fork of CleaningMachine_Betago by Betago

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?

UserRevisionLine numberNew 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 }