diff --git a/pps_ws/src/d_fall_pps/crazyradio/CrazyRadio.py b/pps_ws/src/d_fall_pps/crazyradio/CrazyRadio.py index 4b4f945b43ddfa790dc2023ef31549fd0dd96026..27a539d626b7b0e68f505bb9e4b5d101c62c8c19 100755 --- a/pps_ws/src/d_fall_pps/crazyradio/CrazyRadio.py +++ b/pps_ws/src/d_fall_pps/crazyradio/CrazyRadio.py @@ -81,6 +81,7 @@ class PPSRadioClient: self.status_pub = rospy.Publisher(node_name + '/CrazyRadioStatus', Int32, queue_size=1) self.PPSClient_command_pub = rospy.Publisher('PPSClient/Command', Int32, queue_size=1) + time.sleep(1.0) # Initialize the CrazyFlie and add callbacks self._init_cf() diff --git a/pps_ws/src/d_fall_pps/launch/Student.launch b/pps_ws/src/d_fall_pps/launch/Student.launch index 5edb6b73b36b2af540d89ef3e3f9d6e72ee9df32..fb7a91d364edee96159b5aebc0d5f7c25769f5a5 100755 --- a/pps_ws/src/d_fall_pps/launch/Student.launch +++ b/pps_ws/src/d_fall_pps/launch/Student.launch @@ -1,5 +1,10 @@ <launch> + <!-- When we have a GUI, this has to be adapted and included --> + <node pkg="d_fall_pps" name="student_GUI" output="screen" type="student_GUI"> + <!-- <rosparam command="load" file="$(find d_fall_pps)/launch/ControlParams.yaml" /> --> + </node> + <node pkg="d_fall_pps" name="CrazyRadio" output="screen" type="CrazyRadio.py"> <rosparam command="load" file="$(find d_fall_pps)/param/ClientConfig.yaml" /> </node> @@ -16,9 +21,6 @@ <node pkg="d_fall_pps" name="CustomControllerService" output="screen" type="CustomControllerService"> </node> - <!-- When we have a GUI, this has to be adapted and included --> - <node pkg="d_fall_pps" name="student_GUI" output="screen" type="student_GUI"> - <!-- <rosparam command="load" file="$(find d_fall_pps)/launch/ControlParams.yaml" /> --> - </node> + </launch>