Diff: main_processing/setup_command_active/command.cpp

Revision:

42:02aaa806d929

Parent:

32:247115c03176

Child:

44:a793dd45f84c

--- a/main_processing/setup_command_active/command.cpp	Thu Feb 04 11:43:53 2016 +0000
+++ b/main_processing/setup_command_active/command.cpp	Thu Feb 04 20:45:41 2016 +0000
@@ -111,8 +111,16 @@
 }
 uint8_t LoopFunction3(uint8_t x){
     char buf[0x10];
-    sprintf(buf, "A:%1d B:%1d C:%1d ", Line[0].read(), Line[1].read(), Line[2].read());
-    Lcd.locate(0, 1);Lcd.print(buf);wait_ms(50);return 0;
+    if(x==1){
+        sprintf(buf, "A:%1d B:%1d C:%1d ", Line[0].read(), Line[1].read(), Line[2].read());
+        Lcd.locate(0, 1);Lcd.print(buf);wait_ms(50);return 0;
+    }
+    if(x==2){
+        ReadPing();
+        sprintf(buf, "L:%3d R:%3d", data.ping[L_PING], data.ping[R_PING]);
+        Lcd.locate(0, 1);Lcd.print(buf);wait_ms(50);return 0;
+    }
+    return 0;
 }
 uint8_t LoopFunction4(uint8_t x){
     char buf[0x10];