Add safety controller status

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({