###
 # @Date: 2020-10-27 19:13:07
 # @LastEditors: Tonser
 # @LastEditTime: 2020-11-02 20:30:09
 # @FilePath: /swarm_ws/src/px4_gcs/scripts/start.sh
 # @Description: start 启动脚本 使用前需要执行config.sh
### 
#!/bin/bash


roscore &

sleep 5
roslaunch mavros px4.launch fcu_url:=$MUC &

#test uwb
sleep 5
roslaunch px4_swarm_control uwb_node_test.launch serial_name:=$UWB &

sleep 2
roslaunch camera_detect usb_camera_detect.launch id:=$ID index:=0 display:=false &


# sleep 5
# roslaunch px4_swarm_control swarm_drone_consensus.launch

# record 记录这个topic
# sleep 5
# rosbag record /collect_image/image /mavros/local_position/pose /mavros/global_position/global /mavros/ready /swarm/state