display: added voltage status indication (red/green)

diff --git a/src/disp-4dgl/control.4dg b/src/disp-4dgl/control.4dg
index bfb18118cd1566afc6eb6140f2715f0b011c64bd..c25ad96d5c39715e41fd07043b7f50d4f2a260d1 100644 (file)
--- a/src/disp-4dgl/control.4dg
+++ b/src/disp-4dgl/control.4dg
@@ -14,6 +14,7 @@
 \r
 #constant MSG_START 150\r
 \r
+#constant MSG_VOLTAGE_STATUS 159\r
 #constant MSG_VOLTAGE 160\r
 #constant MSG_FSM_STATE 161\r
 #constant MSG_BALLS 162\r
@@ -878,6 +879,14 @@ func process_msg()
             switch_to_control_done();\r
         endif\r
     endif\r
+    \r
+    if((msg_buff[0]==MSG_VOLTAGE_STATUS)&&(isStatus==1))\r
+        voltage_status[VOLTAGE33]:=msg_buff[1];\r
+        voltage_status[VOLTAGE50]:=msg_buff[2];\r
+        voltage_status[VOLTAGE80]:=msg_buff[3];\r
+        voltage_status[VOLTAGE_BAT]:=msg_buff[4];\r
+    endif\r
+\r
     if((msg_buff[0]==MSG_VOLTAGE)&&(isStatus==1))\r
         \r
         voltage33[0]:=msg_buff[1];\r