Implement new_safety_system

scripts/qt_wrapper.py

@@ -28,7 +28,7 @@ class QtWrapper:
 
         if lang == 'eng':
             self.language = ET
-            self.log_info('Started english version of plugin NEW')
+            self.log_info('Started english version of plugin')
         elif lang == 'pol':
             self.language = PT
             self.log_info('Polska wersja pluginu uruchomiona')
@@ -335,4 +335,4 @@ class QtWrapper:
         self.widget.obstacleText.setText(self.language.obstacle_text)
         self.widget.robotText.setText(self.language.robot_text)
         self.widget.historyLabel.setText(self.language.history_text)
-        self.widget.restrictionsLabel.setText(self.language.restrictions_text)
+        self.widget.restrictionsLabel.setText(self.language.restrictions_text)

scripts/ros_wrapper.py

@@ -57,10 +57,10 @@ class ROSWrapper:
         if self.periodic_timer != None:
             self.shutdown_timer(self.periodic_timer)
         self.periodic_timer = rospy.Timer(rospy.Duration(0.1),self.publish_periodic_update)
-        print("NEW")
+
         if self.connection_timer != None:
             self.shutdown_timer(self.connection_timer)        
-        self.connection_timer = rospy.Timer(rospy.Duration(5),self.handle_robot_connection_lost)
+        self.connection_timer = rospy.Timer(rospy.Duration(1.5),self.handle_robot_connection_lost)
 
         if self.master_connection_timer != None:
             self.shutdown_timer(self.master_connection_timer)