diff --git a/coordinator/coordinator.html b/coordinator/coordinator.html index e56c72e..7a14021 100644 --- a/coordinator/coordinator.html +++ b/coordinator/coordinator.html @@ -4,22 +4,40 @@ Select Operation Mode
- - - - - +
+ + + + + +
+
+ Safety Monitor Status: +
+

Running

+
+
+

Stopped

+
+
+ +
+
+ +
diff --git a/coordinator/js/ros_scripts.js b/coordinator/js/ros_scripts.js index 8a8a335..ebd53bc 100644 --- a/coordinator/js/ros_scripts.js +++ b/coordinator/js/ros_scripts.js @@ -60,6 +60,28 @@ modeStatus.subscribe(function(message) { } }); +// Safety Status +var safetyStatusTopic = new ROSLIB.Topic({ + ros : ros, + name : '/aescape/mode/safety_status', + messageType : 'std_msgs/String', + throttle_rate : 500 // 2Hz +}); + +safetyStatusTopic.subscribe(function(message) { + document.getElementById("safetyRunning").className = 'label-default'; + document.getElementById("safetyStopped").className = 'label-default'; + + if (message.data == "stopped") + { + document.getElementById("safetyStopped").className = 'label-danger'; + } + else if (message.data == "running") + { + document.getElementById("safetyRunning").className = 'label-success'; + } +}); + // Recording Bag var recordingBagTopic = new ROSLIB.Topic({