mavlink / mavros

MAVLink to ROS gateway with proxy for Ground Control Station
Other
902 stars 993 forks source link

Issues with multi-uav simulation #881

Closed Seiwert closed 6 years ago

Seiwert commented 6 years ago

Issue details

Multiple UAV control is only working with one UAV. (Example: I can arm "uav1" through Mavros but I am unable to arm "uav2" or "uav3")

However, I can query info from all UAV's (e.g. GPS data) and QGroundControl is able to communicate and control all UAV's as well. My setup is in simulation and is based off of these instructions.

MAVROS version and platform

Mavros: 0.21.4 ROS: Kinetic Ubuntu: 16.04

Autopilot type and version

[ ] ArduPilot [X] PX4

Version: 1.0.0

Node logs

... logging to /home/aseiwert/.ros/log/535fa4f6-d958-11e7-8dc8-34f39a77e61a/roslaunch-AL3-5585.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.
]2;/home/aseiwert/src/Firmware/launch/multi_uav_mavros_sitl.launch
started roslaunch server http://AL3:33065/

SUMMARY
========

CLEAR PARAMETERS
 * /uav1/mavros/
 * /uav2/mavros/
 * /uav3/mavros/

PARAMETERS
 * /rosdistro: kinetic
 * /rosversion: 1.12.7
 * /uav1/iris_1_sdf: <sdf version='1.6...
 * /uav1/mavros/cmd/use_comp_id_system_control: False
 * /uav1/mavros/conn/heartbeat_rate: 1.0
 * /uav1/mavros/conn/system_time_rate: 1.0
 * /uav1/mavros/conn/timeout: 10.0
 * /uav1/mavros/conn/timesync_rate: 10.0
 * /uav1/mavros/distance_sensor/hrlv_ez4_pub/field_of_view: 0.0
 * /uav1/mavros/distance_sensor/hrlv_ez4_pub/frame_id: hrlv_ez4_sonar
 * /uav1/mavros/distance_sensor/hrlv_ez4_pub/id: 0
 * /uav1/mavros/distance_sensor/hrlv_ez4_pub/orientation: ROLL_180
 * /uav1/mavros/distance_sensor/hrlv_ez4_pub/send_tf: True
 * /uav1/mavros/distance_sensor/hrlv_ez4_pub/sensor_position/x: 0.0
 * /uav1/mavros/distance_sensor/hrlv_ez4_pub/sensor_position/y: 0.0
 * /uav1/mavros/distance_sensor/hrlv_ez4_pub/sensor_position/z: -0.1
 * /uav1/mavros/distance_sensor/laser_1_sub/id: 3
 * /uav1/mavros/distance_sensor/laser_1_sub/orientation: ROLL_180
 * /uav1/mavros/distance_sensor/laser_1_sub/subscriber: True
 * /uav1/mavros/distance_sensor/lidarlite_pub/field_of_view: 0.0
 * /uav1/mavros/distance_sensor/lidarlite_pub/frame_id: lidarlite_laser
 * /uav1/mavros/distance_sensor/lidarlite_pub/id: 1
 * /uav1/mavros/distance_sensor/lidarlite_pub/orientation: ROLL_180
 * /uav1/mavros/distance_sensor/lidarlite_pub/send_tf: True
 * /uav1/mavros/distance_sensor/lidarlite_pub/sensor_position/x: 0.0
 * /uav1/mavros/distance_sensor/lidarlite_pub/sensor_position/y: 0.0
 * /uav1/mavros/distance_sensor/lidarlite_pub/sensor_position/z: -0.1
 * /uav1/mavros/distance_sensor/sonar_1_sub/id: 2
 * /uav1/mavros/distance_sensor/sonar_1_sub/orientation: ROLL_180
 * /uav1/mavros/distance_sensor/sonar_1_sub/subscriber: True
 * /uav1/mavros/fake_gps/eph: 2.0
 * /uav1/mavros/fake_gps/epv: 2.0
 * /uav1/mavros/fake_gps/fix_type: 3
 * /uav1/mavros/fake_gps/geo_origin/alt: 408.0
 * /uav1/mavros/fake_gps/geo_origin/lat: 47.3667
 * /uav1/mavros/fake_gps/geo_origin/lon: 8.55
 * /uav1/mavros/fake_gps/gps_rate: 5.0
 * /uav1/mavros/fake_gps/mocap_transform: True
 * /uav1/mavros/fake_gps/satellites_visible: 5
 * /uav1/mavros/fake_gps/tf/child_frame_id: fix
 * /uav1/mavros/fake_gps/tf/frame_id: map
 * /uav1/mavros/fake_gps/tf/listen: False
 * /uav1/mavros/fake_gps/tf/rate_limit: 10.0
 * /uav1/mavros/fake_gps/tf/send: False
 * /uav1/mavros/fake_gps/use_mocap: True
 * /uav1/mavros/fake_gps/use_vision: False
 * /uav1/mavros/fcu_url: udp://:14540@loca...
 * /uav1/mavros/gcs_url: 
 * /uav1/mavros/global_position/frame_id: map
 * /uav1/mavros/global_position/rot_covariance: 99999.0
 * /uav1/mavros/global_position/tf/child_frame_id: base_link
 * /uav1/mavros/global_position/tf/frame_id: map
 * /uav1/mavros/global_position/tf/global_frame_id: earth
 * /uav1/mavros/global_position/tf/send: False
 * /uav1/mavros/global_position/use_relative_alt: True
 * /uav1/mavros/image/frame_id: px4flow
 * /uav1/mavros/imu/angular_velocity_stdev: 0.000349065850399
 * /uav1/mavros/imu/frame_id: base_link
 * /uav1/mavros/imu/linear_acceleration_stdev: 0.0003
 * /uav1/mavros/imu/magnetic_stdev: 0.0
 * /uav1/mavros/imu/orientation_stdev: 1.0
 * /uav1/mavros/local_position/frame_id: map
 * /uav1/mavros/local_position/tf/child_frame_id: base_link
 * /uav1/mavros/local_position/tf/frame_id: map
 * /uav1/mavros/local_position/tf/send: False
 * /uav1/mavros/local_position/tf/send_fcu: False
 * /uav1/mavros/mission/pull_after_gcs: True
 * /uav1/mavros/mocap/use_pose: True
 * /uav1/mavros/mocap/use_tf: False
 * /uav1/mavros/odometry/estimator_type: 3
 * /uav1/mavros/odometry/frame_tf/desired_frame: ned
 * /uav1/mavros/plugin_blacklist: ['safety_area', '...
 * /uav1/mavros/plugin_whitelist: []
 * /uav1/mavros/px4flow/frame_id: px4flow
 * /uav1/mavros/px4flow/ranger_fov: 0.118682389136
 * /uav1/mavros/px4flow/ranger_max_range: 5.0
 * /uav1/mavros/px4flow/ranger_min_range: 0.3
 * /uav1/mavros/safety_area/p1/x: 1.0
 * /uav1/mavros/safety_area/p1/y: 1.0
 * /uav1/mavros/safety_area/p1/z: 1.0
 * /uav1/mavros/safety_area/p2/x: -1.0
 * /uav1/mavros/safety_area/p2/y: -1.0
 * /uav1/mavros/safety_area/p2/z: -1.0
 * /uav1/mavros/setpoint_accel/send_force: False
 * /uav1/mavros/setpoint_attitude/reverse_thrust: False
 * /uav1/mavros/setpoint_attitude/tf/child_frame_id: target_attitude
 * /uav1/mavros/setpoint_attitude/tf/frame_id: map
 * /uav1/mavros/setpoint_attitude/tf/listen: False
 * /uav1/mavros/setpoint_attitude/tf/rate_limit: 50.0
 * /uav1/mavros/setpoint_attitude/use_quaternion: False
 * /uav1/mavros/setpoint_position/tf/child_frame_id: target_position
 * /uav1/mavros/setpoint_position/tf/frame_id: map
 * /uav1/mavros/setpoint_position/tf/listen: False
 * /uav1/mavros/setpoint_position/tf/rate_limit: 50.0
 * /uav1/mavros/startup_px4_usb_quirk: True
 * /uav1/mavros/sys/disable_diag: False
 * /uav1/mavros/sys/min_voltage: 10.0
 * /uav1/mavros/target_component_id: 1
 * /uav1/mavros/target_system_id: 1
 * /uav1/mavros/tdr_radio/low_rssi: 40
 * /uav1/mavros/time/time_ref_source: fcu
 * /uav1/mavros/time/timesync_avg_alpha: 0.6
 * /uav1/mavros/time/timesync_mode: MAVLINK
 * /uav1/mavros/vibration/frame_id: base_link
 * /uav1/mavros/vision_pose/tf/child_frame_id: vision_estimate
 * /uav1/mavros/vision_pose/tf/frame_id: map
 * /uav1/mavros/vision_pose/tf/listen: False
 * /uav1/mavros/vision_pose/tf/rate_limit: 10.0
 * /uav1/mavros/vision_speed/listen_twist: False
 * /uav2/iris_2_sdf: <sdf version='1.6...
 * /uav2/mavros/cmd/use_comp_id_system_control: False
 * /uav2/mavros/conn/heartbeat_rate: 1.0
 * /uav2/mavros/conn/system_time_rate: 1.0
 * /uav2/mavros/conn/timeout: 10.0
 * /uav2/mavros/conn/timesync_rate: 10.0
 * /uav2/mavros/distance_sensor/hrlv_ez4_pub/field_of_view: 0.0
 * /uav2/mavros/distance_sensor/hrlv_ez4_pub/frame_id: hrlv_ez4_sonar
 * /uav2/mavros/distance_sensor/hrlv_ez4_pub/id: 0
 * /uav2/mavros/distance_sensor/hrlv_ez4_pub/orientation: ROLL_180
 * /uav2/mavros/distance_sensor/hrlv_ez4_pub/send_tf: True
 * /uav2/mavros/distance_sensor/hrlv_ez4_pub/sensor_position/x: 0.0
 * /uav2/mavros/distance_sensor/hrlv_ez4_pub/sensor_position/y: 0.0
 * /uav2/mavros/distance_sensor/hrlv_ez4_pub/sensor_position/z: -0.1
 * /uav2/mavros/distance_sensor/laser_1_sub/id: 3
 * /uav2/mavros/distance_sensor/laser_1_sub/orientation: ROLL_180
 * /uav2/mavros/distance_sensor/laser_1_sub/subscriber: True
 * /uav2/mavros/distance_sensor/lidarlite_pub/field_of_view: 0.0
 * /uav2/mavros/distance_sensor/lidarlite_pub/frame_id: lidarlite_laser
 * /uav2/mavros/distance_sensor/lidarlite_pub/id: 1
 * /uav2/mavros/distance_sensor/lidarlite_pub/orientation: ROLL_180
 * /uav2/mavros/distance_sensor/lidarlite_pub/send_tf: True
 * /uav2/mavros/distance_sensor/lidarlite_pub/sensor_position/x: 0.0
 * /uav2/mavros/distance_sensor/lidarlite_pub/sensor_position/y: 0.0
 * /uav2/mavros/distance_sensor/lidarlite_pub/sensor_position/z: -0.1
 * /uav2/mavros/distance_sensor/sonar_1_sub/id: 2
 * /uav2/mavros/distance_sensor/sonar_1_sub/orientation: ROLL_180
 * /uav2/mavros/distance_sensor/sonar_1_sub/subscriber: True
 * /uav2/mavros/fake_gps/eph: 2.0
 * /uav2/mavros/fake_gps/epv: 2.0
 * /uav2/mavros/fake_gps/fix_type: 3
 * /uav2/mavros/fake_gps/geo_origin/alt: 408.0
 * /uav2/mavros/fake_gps/geo_origin/lat: 47.3667
 * /uav2/mavros/fake_gps/geo_origin/lon: 8.55
 * /uav2/mavros/fake_gps/gps_rate: 5.0
 * /uav2/mavros/fake_gps/mocap_transform: True
 * /uav2/mavros/fake_gps/satellites_visible: 5
 * /uav2/mavros/fake_gps/tf/child_frame_id: fix
 * /uav2/mavros/fake_gps/tf/frame_id: map
 * /uav2/mavros/fake_gps/tf/listen: False
 * /uav2/mavros/fake_gps/tf/rate_limit: 10.0
 * /uav2/mavros/fake_gps/tf/send: False
 * /uav2/mavros/fake_gps/use_mocap: True
 * /uav2/mavros/fake_gps/use_vision: False
 * /uav2/mavros/fcu_url: udp://:14541@loca...
 * /uav2/mavros/gcs_url: 
 * /uav2/mavros/global_position/frame_id: map
 * /uav2/mavros/global_position/rot_covariance: 99999.0
 * /uav2/mavros/global_position/tf/child_frame_id: base_link
 * /uav2/mavros/global_position/tf/frame_id: map
 * /uav2/mavros/global_position/tf/global_frame_id: earth
 * /uav2/mavros/global_position/tf/send: False
 * /uav2/mavros/global_position/use_relative_alt: True
 * /uav2/mavros/image/frame_id: px4flow
 * /uav2/mavros/imu/angular_velocity_stdev: 0.000349065850399
 * /uav2/mavros/imu/frame_id: base_link
 * /uav2/mavros/imu/linear_acceleration_stdev: 0.0003
 * /uav2/mavros/imu/magnetic_stdev: 0.0
 * /uav2/mavros/imu/orientation_stdev: 1.0
 * /uav2/mavros/local_position/frame_id: map
 * /uav2/mavros/local_position/tf/child_frame_id: base_link
 * /uav2/mavros/local_position/tf/frame_id: map
 * /uav2/mavros/local_position/tf/send: False
 * /uav2/mavros/local_position/tf/send_fcu: False
 * /uav2/mavros/mission/pull_after_gcs: True
 * /uav2/mavros/mocap/use_pose: True
 * /uav2/mavros/mocap/use_tf: False
 * /uav2/mavros/odometry/estimator_type: 3
 * /uav2/mavros/odometry/frame_tf/desired_frame: ned
 * /uav2/mavros/plugin_blacklist: ['safety_area', '...
 * /uav2/mavros/plugin_whitelist: []
 * /uav2/mavros/px4flow/frame_id: px4flow
 * /uav2/mavros/px4flow/ranger_fov: 0.118682389136
 * /uav2/mavros/px4flow/ranger_max_range: 5.0
 * /uav2/mavros/px4flow/ranger_min_range: 0.3
 * /uav2/mavros/safety_area/p1/x: 1.0
 * /uav2/mavros/safety_area/p1/y: 1.0
 * /uav2/mavros/safety_area/p1/z: 1.0
 * /uav2/mavros/safety_area/p2/x: -1.0
 * /uav2/mavros/safety_area/p2/y: -1.0
 * /uav2/mavros/safety_area/p2/z: -1.0
 * /uav2/mavros/setpoint_accel/send_force: False
 * /uav2/mavros/setpoint_attitude/reverse_thrust: False
 * /uav2/mavros/setpoint_attitude/tf/child_frame_id: target_attitude
 * /uav2/mavros/setpoint_attitude/tf/frame_id: map
 * /uav2/mavros/setpoint_attitude/tf/listen: False
 * /uav2/mavros/setpoint_attitude/tf/rate_limit: 50.0
 * /uav2/mavros/setpoint_attitude/use_quaternion: False
 * /uav2/mavros/setpoint_position/tf/child_frame_id: target_position
 * /uav2/mavros/setpoint_position/tf/frame_id: map
 * /uav2/mavros/setpoint_position/tf/listen: False
 * /uav2/mavros/setpoint_position/tf/rate_limit: 50.0
 * /uav2/mavros/startup_px4_usb_quirk: True
 * /uav2/mavros/sys/disable_diag: False
 * /uav2/mavros/sys/min_voltage: 10.0
 * /uav2/mavros/target_component_id: 2
 * /uav2/mavros/target_system_id: 2
 * /uav2/mavros/tdr_radio/low_rssi: 40
 * /uav2/mavros/time/time_ref_source: fcu
 * /uav2/mavros/time/timesync_avg_alpha: 0.6
 * /uav2/mavros/time/timesync_mode: MAVLINK
 * /uav2/mavros/vibration/frame_id: base_link
 * /uav2/mavros/vision_pose/tf/child_frame_id: vision_estimate
 * /uav2/mavros/vision_pose/tf/frame_id: map
 * /uav2/mavros/vision_pose/tf/listen: False
 * /uav2/mavros/vision_pose/tf/rate_limit: 10.0
 * /uav2/mavros/vision_speed/listen_twist: False
 * /uav3/iris_3_sdf: <sdf version='1.6...
 * /uav3/mavros/cmd/use_comp_id_system_control: False
 * /uav3/mavros/conn/heartbeat_rate: 1.0
 * /uav3/mavros/conn/system_time_rate: 1.0
 * /uav3/mavros/conn/timeout: 10.0
 * /uav3/mavros/conn/timesync_rate: 10.0
 * /uav3/mavros/distance_sensor/hrlv_ez4_pub/field_of_view: 0.0
 * /uav3/mavros/distance_sensor/hrlv_ez4_pub/frame_id: hrlv_ez4_sonar
 * /uav3/mavros/distance_sensor/hrlv_ez4_pub/id: 0
 * /uav3/mavros/distance_sensor/hrlv_ez4_pub/orientation: ROLL_180
 * /uav3/mavros/distance_sensor/hrlv_ez4_pub/send_tf: True
 * /uav3/mavros/distance_sensor/hrlv_ez4_pub/sensor_position/x: 0.0
 * /uav3/mavros/distance_sensor/hrlv_ez4_pub/sensor_position/y: 0.0
 * /uav3/mavros/distance_sensor/hrlv_ez4_pub/sensor_position/z: -0.1
 * /uav3/mavros/distance_sensor/laser_1_sub/id: 3
 * /uav3/mavros/distance_sensor/laser_1_sub/orientation: ROLL_180
 * /uav3/mavros/distance_sensor/laser_1_sub/subscriber: True
 * /uav3/mavros/distance_sensor/lidarlite_pub/field_of_view: 0.0
 * /uav3/mavros/distance_sensor/lidarlite_pub/frame_id: lidarlite_laser
 * /uav3/mavros/distance_sensor/lidarlite_pub/id: 1
 * /uav3/mavros/distance_sensor/lidarlite_pub/orientation: ROLL_180
 * /uav3/mavros/distance_sensor/lidarlite_pub/send_tf: True
 * /uav3/mavros/distance_sensor/lidarlite_pub/sensor_position/x: 0.0
 * /uav3/mavros/distance_sensor/lidarlite_pub/sensor_position/y: 0.0
 * /uav3/mavros/distance_sensor/lidarlite_pub/sensor_position/z: -0.1
 * /uav3/mavros/distance_sensor/sonar_1_sub/id: 2
 * /uav3/mavros/distance_sensor/sonar_1_sub/orientation: ROLL_180
 * /uav3/mavros/distance_sensor/sonar_1_sub/subscriber: True
 * /uav3/mavros/fake_gps/eph: 2.0
 * /uav3/mavros/fake_gps/epv: 2.0
 * /uav3/mavros/fake_gps/fix_type: 3
 * /uav3/mavros/fake_gps/geo_origin/alt: 408.0
 * /uav3/mavros/fake_gps/geo_origin/lat: 47.3667
 * /uav3/mavros/fake_gps/geo_origin/lon: 8.55
 * /uav3/mavros/fake_gps/gps_rate: 5.0
 * /uav3/mavros/fake_gps/mocap_transform: True
 * /uav3/mavros/fake_gps/satellites_visible: 5
 * /uav3/mavros/fake_gps/tf/child_frame_id: fix
 * /uav3/mavros/fake_gps/tf/frame_id: map
 * /uav3/mavros/fake_gps/tf/listen: False
 * /uav3/mavros/fake_gps/tf/rate_limit: 10.0
 * /uav3/mavros/fake_gps/tf/send: False
 * /uav3/mavros/fake_gps/use_mocap: True
 * /uav3/mavros/fake_gps/use_vision: False
 * /uav3/mavros/fcu_url: udp://:14542@loca...
 * /uav3/mavros/gcs_url: 
 * /uav3/mavros/global_position/frame_id: map
 * /uav3/mavros/global_position/rot_covariance: 99999.0
 * /uav3/mavros/global_position/tf/child_frame_id: base_link
 * /uav3/mavros/global_position/tf/frame_id: map
 * /uav3/mavros/global_position/tf/global_frame_id: earth
 * /uav3/mavros/global_position/tf/send: False
 * /uav3/mavros/global_position/use_relative_alt: True
 * /uav3/mavros/image/frame_id: px4flow
 * /uav3/mavros/imu/angular_velocity_stdev: 0.000349065850399
 * /uav3/mavros/imu/frame_id: base_link
 * /uav3/mavros/imu/linear_acceleration_stdev: 0.0003
 * /uav3/mavros/imu/magnetic_stdev: 0.0
 * /uav3/mavros/imu/orientation_stdev: 1.0
 * /uav3/mavros/local_position/frame_id: map
 * /uav3/mavros/local_position/tf/child_frame_id: base_link
 * /uav3/mavros/local_position/tf/frame_id: map
 * /uav3/mavros/local_position/tf/send: False
 * /uav3/mavros/local_position/tf/send_fcu: False
 * /uav3/mavros/mission/pull_after_gcs: True
 * /uav3/mavros/mocap/use_pose: True
 * /uav3/mavros/mocap/use_tf: False
 * /uav3/mavros/odometry/estimator_type: 3
 * /uav3/mavros/odometry/frame_tf/desired_frame: ned
 * /uav3/mavros/plugin_blacklist: ['safety_area', '...
 * /uav3/mavros/plugin_whitelist: []
 * /uav3/mavros/px4flow/frame_id: px4flow
 * /uav3/mavros/px4flow/ranger_fov: 0.118682389136
 * /uav3/mavros/px4flow/ranger_max_range: 5.0
 * /uav3/mavros/px4flow/ranger_min_range: 0.3
 * /uav3/mavros/safety_area/p1/x: 1.0
 * /uav3/mavros/safety_area/p1/y: 1.0
 * /uav3/mavros/safety_area/p1/z: 1.0
 * /uav3/mavros/safety_area/p2/x: -1.0
 * /uav3/mavros/safety_area/p2/y: -1.0
 * /uav3/mavros/safety_area/p2/z: -1.0
 * /uav3/mavros/setpoint_accel/send_force: False
 * /uav3/mavros/setpoint_attitude/reverse_thrust: False
 * /uav3/mavros/setpoint_attitude/tf/child_frame_id: target_attitude
 * /uav3/mavros/setpoint_attitude/tf/frame_id: map
 * /uav3/mavros/setpoint_attitude/tf/listen: False
 * /uav3/mavros/setpoint_attitude/tf/rate_limit: 50.0
 * /uav3/mavros/setpoint_attitude/use_quaternion: False
 * /uav3/mavros/setpoint_position/tf/child_frame_id: target_position
 * /uav3/mavros/setpoint_position/tf/frame_id: map
 * /uav3/mavros/setpoint_position/tf/listen: False
 * /uav3/mavros/setpoint_position/tf/rate_limit: 50.0
 * /uav3/mavros/startup_px4_usb_quirk: True
 * /uav3/mavros/sys/disable_diag: False
 * /uav3/mavros/sys/min_voltage: 10.0
 * /uav3/mavros/target_component_id: 3
 * /uav3/mavros/target_system_id: 3
 * /uav3/mavros/tdr_radio/low_rssi: 40
 * /uav3/mavros/time/time_ref_source: fcu
 * /uav3/mavros/time/timesync_avg_alpha: 0.6
 * /uav3/mavros/time/timesync_mode: MAVLINK
 * /uav3/mavros/vibration/frame_id: base_link
 * /uav3/mavros/vision_pose/tf/child_frame_id: vision_estimate
 * /uav3/mavros/vision_pose/tf/frame_id: map
 * /uav3/mavros/vision_pose/tf/listen: False
 * /uav3/mavros/vision_pose/tf/rate_limit: 10.0
 * /uav3/mavros/vision_speed/lisnode name: sitl_1
data path: /home/aseiwert/src/Firmware
commands file: /home/aseiwert/src/Firmware/posix-configs/SITL/init/ekf2/iris_1
31 WARNING: setRealtimeSched failed (not run as root?)

______  __   __    ___ 
| ___ \ \ \ / /   /   |
| |_/ /  \ V /   / /| |
|  __/   /   \  / /_| |
| |     / /^\ \ \___  |
\_|     \/   \/     |_/

px4 starting.

INFO  [dataman] Unknown restart, data manager file 'rootfs/fs/microsd/dataman' size is 11405140 bytes
+ MAV_SYS_ID: curr: 3 -> new: 1
+ SITL_UDP_PRT: curr: 14564 -> new: 14560
INFO  [platforms__posix__drivers__ledsim] LED::init
INFO  [platforms__posix__drivers__ledsim] LED::init
INFO  [simulator] Waiting for initial data on UDP port 14560. Please start the flight simulator to proceed..
[ INFO] [1512435904.915011087]: FCU URL: udp://:14540@localhost:14557
[ WARN] [1512435904.915703287]: init: message from ASLUAV, MSG-ID 201 ignored! Table has different entry.
[ WARN] [1512435904.915849934]: init: message from autoquad, MSG-ID 150 ignored! Table has different entry.
[ WARN] [1512435904.915870950]: init: message from autoquad, MSG-ID 152 ignored! Table has different entry.
[ WARN] [1512435904.916001777]: init: message from matrixpilot, MSG-ID 150 ignored! Table has different entry.
[ WARN] [1512435904.916008214]: init: message from matrixpilot, MSG-ID 151 ignored! Table has different entry.
[ WARN] [1512435904.916026899]: init: message from matrixpilot, MSG-ID 152 ignored! Table has different entry.
[ WARN] [1512435904.916034484]: init: message from matrixpilot, MSG-ID 153 ignored! Table has different entry.
[ WARN] [1512435904.916040902]: init: message from matrixpilot, MSG-ID 155 ignored! Table has different entry.
[ WARN] [1512435904.916049474]: init: message from matrixpilot, MSG-ID 156 ignored! Table has different entry.
[ WARN] [1512435904.916056296]: init: message from matrixpilot, MSG-ID 157 ignored! Table has different entry.
[ WARN] [1512435904.916063101]: init: message from matrixpilot, MSG-ID 158 ignored! Table has different entry.
[ WARN] [1512435904.916069677]: init: message from matrixpilot, MSG-ID 170 ignored! Table has different entry.
[ WARN] [1512435904.916076737]: init: message from matrixpilot, MSG-ID 171 ignored! Table has different entry.
[ WARN] [1512435904.916083425]: init: message from matrixpilot, MSG-ID 172 ignored! Table has different entry.
[ WARN] [1512435904.916090344]: init: message from matrixpilot, MSG-ID 173 ignored! Table has different entry.
[ WARN] [1512435904.916096999]: init: message from matrixpilot, MSG-ID 174 ignored! Table has different entry.
[ WARN] [1512435904.916103638]: init: message from matrixpilot, MSG-ID 175 ignored! Table has different entry.
[ WARN] [1512435904.916110190]: init: message from matrixpilot, MSG-ID 176 ignored! Table has different entry.
[ WARN] [1512435904.916117108]: init: message from matrixpilot, MSG-ID 177 ignored! Table has different entry.
[ WARN] [1512435904.916123835]: init: message from matrixpilot, MSG-ID 178 ignored! Table has different entry.
[ WARN] [1512435904.916130514]: init: message from matrixpilot, MSG-ID 179 ignored! Table has different entry.
[ WARN] [1512435904.916137187]: init: message from matrixpilot, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1512435904.916143815]: init: message from matrixpilot, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1512435904.916150424]: init: message from matrixpilot, MSG-ID 182 ignored! Table has different entry.
[ WARN] [1512435904.916156937]: init: message from matrixpilot, MSG-ID 183 ignored! Table has different entry.
[ WARN] [1512435904.916163441]: init: message from matrixpilot, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1512435904.916170378]: init: message from matrixpilot, MSG-ID 185 ignored! Table has different entry.
[ WARN] [1512435904.916176994]: init: message from matrixpilot, MSG-ID 186 ignored! Table has different entry.
[ WARN] [1512435904.916300460]: init: message from paparazzi, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1512435904.916307371]: init: message from paparazzi, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1512435904.916313770]: init: message from paparazzi, MSG-ID 182 ignored! Table has different entry.
[ WARN] [1512435904.916320395]: init: message from paparazzi, MSG-ID 183 ignored! Table has different entry.
[ WARN] [1512435904.916326943]: init: message from paparazzi, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1512435904.916445884]: init: message from slugs, MSG-ID 170 ignornode name: sitl_2
data path: /home/aseiwert/src/Firmware
commands file: /home/aseiwert/src/Firmware/posix-configs/SITL/init/ekf2/iris_2
73 WARNING: setRealtimeSched failed (not run as root?)

______  __   __    ___ 
| ___ \ \ \ / /   /   |
| |_/ /  \ V /   / /| |
|  __/   /   \  / /_| |
| |     / /^\ \ \___  |
\_|     \/   \/     |_/

px4 starting.

INFO  [dataman] Unknown restart, data manager file 'rootfs/fs/microsd/dataman' size is 11405140 bytes
+ MAV_SYS_ID: curr: 3 -> new: 2
+ SITL_UDP_PRT: curr: 14564 -> new: 14562
INFO  [platforms__posix__drivers__ledsim] LED::init
INFO  [platforms__posix__drivers__ledsim] LED::init
INFO  [simulator] Waiting for initial data on UDP port 14562. Please start the flight simulator to proceed..
node name: sitl_3
data path: /home/aseiwert/src/Firmware
commands file: /home/aseiwert/src/Firmware/posix-configs/SITL/init/ekf2/iris_3
80 WARNING: setRealtimeSched failed (not run as root?)

______  __   __    ___ 
| ___ \ \ \ / /   /   |
| |_/ /  \ V /   / /| |
|  __/   /   \  / /_| |
| |     / /^\ \ \___  |
\_|     \/   \/     |_/

px4 starting.

INFO  [dataman] Unknown restart, data manager file 'rootfs/fs/microsd/dataman' size is 11405140 bytes
INFO  [platforms__posix__drivers__ledsim] LED::init
INFO  [platforms__posix__drivers__ledsim] LED::init
INFO  [simulator] Waiting for initial data on UDP port 14564. Please start the flight simulator to proceed..
[ INFO] [1512435905.195810356]: FCU URL: udp://:14541@localhost:14559
[ WARN] [1512435905.196579548]: init: message from ASLUAV, MSG-ID 201 ignored! Table has different entry.
[ WARN] [1512435905.196718981]: init: message from autoquad, MSG-ID 150 ignored! Table has different entry.
[ WARN] [1512435905.196726949]: init: message from autoquad, MSG-ID 152 ignored! Table has different entry.
[ WARN] [1512435905.196849324]: init: message from matrixpilot, MSG-ID 150 ignored! Table has different entry.
[ WARN] [1512435905.196856515]: init: message from matrixpilot, MSG-ID 151 ignored! Table has different entry.
[ WARN] [1512435905.196862194]: init: message from matrixpilot, MSG-ID 152 ignored! Table has different entry.
[ WARN] [1512435905.196870466]: init: message from matrixpilot, MSG-ID 153 ignored! Table has different entry.
[ WARN] [1512435905.196876112]: init: message from matrixpilot, MSG-ID 155 ignored! Table has different entry.
[ WARN] [1512435905.196883226]: init: message from matrixpilot, MSG-ID 156 ignored! Table has different entry.
[ WARN] [1512435905.196890201]: init: message from matrixpilot, MSG-ID 157 ignored! Table has different entry.
[ WARN] [1512435905.196900043]: init: message from matrixpilot, MSG-ID 158 ignored! Table has different entry.
[ WARN] [1512435905.196908902]: init: message from matrixpilot, MSG-ID 170 ignored! Table has different entry.
[ WARN] [1512435905.196916489]: init: message from matrixpilot, MSG-ID 171 ignored! Table has different entry.
[ WARN] [1512435905.196922983]: init: message from matrixpilot, MSG-ID 172 ignored! Table has different entry.
[ WARN] [1512435905.196930411]: init: message from matrixpilot, MSG-ID 173 ignored! Table has different entry.
[ WARN] [1512435905.196936906]: init: message from matrixpilot, MSG-ID 174 ignored! Table has different entry.
[ WARN] [1512435905.196945794]: init: message from matrixpilot, MSG-ID 175 ignored! Table has different entry.
[ WARN] [1512435905.196951794]: init: message from matrixpilot, MSG-ID 176 ignored! Table has different entry.
[ WARN] [1512435905.196958465]: init: message from matrixpilot, MSG-ID 177 ignored! Table has different entry.
[ WARN] [1512435905.196965470]: init: message from matrixpilot, MSG-ID 178 ignored! Table has different entry.
[ WARN] [1512435905.196972455]: init: message from matrixpilot, MSG-ID 179 ignored! Table has different entry.
[ WARN] [1512435905.196981297]: init: message from matrixpilot, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1512435905.196987504]: init: message from matrixpilot, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1512435905.196993922]: init: message from matrixpilot, MSG-ID 182 ignored! Table has different entry.
[ WARN] [1512435905.197000721]: init: message from matrixpilot, MSG-ID 183 ignored! Table has different entry.
[ WARN] [1512435905.197007557]: init: message from matrixpilot, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1512435905.197016430]: init: message from matrixpilot, MSG-ID 185 ignored! Table has different entry.
[ WARN] [1512435905.197025803]: init: message from matrixpilot, MSG-ID 186 ignored! Table has different entry.
[ WARN] [1512435905.197156315]: init: message from paparazzi, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1512435905.197163793]: init: message from paparazzi, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1512435905.197170323]: init: message from paparazzi, MSG-ID 182 ignored! Table has different entry.
[ WARN] [1512435905.197177270]: init: message from paparazzi, MSG-ID 183 ignored! Table has different entry.
[ WARN] [1512435905.197183966]: init: message from paparazzi, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1512435905.197305278]: init: message from slugs, MSG-ID 170 ignor[ INFO] [1512435905.433684561]: FCU URL: udp://:14542@localhost:14561
[ WARN] [1512435905.434682011]: init: message from ASLUAV, MSG-ID 201 ignored! Table has different entry.
[ WARN] [1512435905.434904150]: init: message from autoquad, MSG-ID 150 ignored! Table has different entry.
[ WARN] [1512435905.434920248]: init: message from autoquad, MSG-ID 152 ignored! Table has different entry.
[ WARN] [1512435905.435080406]: init: message from matrixpilot, MSG-ID 150 ignored! Table has different entry.
[ WARN] [1512435905.435090036]: init: message from matrixpilot, MSG-ID 151 ignored! Table has different entry.
[ WARN] [1512435905.435097648]: init: message from matrixpilot, MSG-ID 152 ignored! Table has different entry.
[ WARN] [1512435905.435105381]: init: message from matrixpilot, MSG-ID 153 ignored! Table has different entry.
[ WARN] [1512435905.435112638]: init: message from matrixpilot, MSG-ID 155 ignored! Table has different entry.
[ WARN] [1512435905.435121076]: init: message from matrixpilot, MSG-ID 156 ignored! Table has different entry.
[ WARN] [1512435905.435129022]: init: message from matrixpilot, MSG-ID 157 ignored! Table has different entry.
[ WARN] [1512435905.435136871]: init: message from matrixpilot, MSG-ID 158 ignored! Table has different entry.
[ WARN] [1512435905.435144589]: init: message from matrixpilot, MSG-ID 170 ignored! Table has different entry.
[ WARN] [1512435905.435151974]: init: message from matrixpilot, MSG-ID 171 ignored! Table has different entry.
[ WARN] [1512435905.435162654]: init: message from matrixpilot, MSG-ID 172 ignored! Table has different entry.
[ WARN] [1512435905.435170274]: init: message from matrixpilot, MSG-ID 173 ignored! Table has different entry.
[ WARN] [1512435905.435177719]: init: message from matrixpilot, MSG-ID 174 ignored! Table has different entry.
[ WARN] [1512435905.435185234]: init: message from matrixpilot, MSG-ID 175 ignored! Table has different entry.
[ WARN] [1512435905.435197741]: init: message from matrixpilot, MSG-ID 176 ignored! Table has different entry.
[ WARN] [1512435905.435206750]: init: message from matrixpilot, MSG-ID 177 ignored! Table has different entry.
[ WARN] [1512435905.435215177]: init: message from matrixpilot, MSG-ID 178 ignored! Table has different entry.
[ WARN] [1512435905.435225340]: init: message from matrixpilot, MSG-ID 179 ignored! Table has different entry.
[ WARN] [1512435905.435233431]: init: message from matrixpilot, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1512435905.435241572]: init: message from matrixpilot, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1512435905.435249681]: init: message from matrixpilot, MSG-ID 182 ignored! Table has different entry.
[ WARN] [1512435905.435258379]: init: message from matrixpilot, MSG-ID 183 ignored! Table has different entry.
[ WARN] [1512435905.435267496]: init: message from matrixpilot, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1512435905.435277978]: init: message from matrixpilot, MSG-ID 185 ignored! Table has different entry.
[ WARN] [1512435905.435286342]: init: message from matrixpilot, MSG-ID 186 ignored! Table has different entry.
[ WARN] [1512435905.435450731]: init: message from paparazzi, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1512435905.435463104]: init: message from paparazzi, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1512435905.435472266]: init: message from paparazzi, MSG-ID 182 ignored! Table has different entry.
[ WARN] [1512435905.435479579]: init: message from paparazzi, MSG-ID 183 ignored! Table has different entry.
[ WARN] [1512435905.435486772]: init: message from paparazzi, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1512435905.435642920]: init: message from slugs, MSG-ID 170 ignored! Table has different entry.
[ WARN] [1512435904.916476234]: init: message from slugs, MSG-ID 172 ignored! Table has different entry.
[ WARN] [1512435904.916484590]: init: message from slugs, MSG-ID 173 ignored! Table has different entry.
[ WARN] [1512435904.916491934]: init: message from slugs, MSG-ID 176 ignored! Table has different entry.
[ WARN] [1512435904.916498981]: init: message from slugs, MSG-ID 177 ignored! Table has different entry.
[ WARN] [1512435904.916505669]: init: message from slugs, MSG-ID 179 ignored! Table has different entry.
[ WARN] [1512435904.916512281]: init: message from slugs, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1512435904.916519200]: init: message from slugs, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1512435904.916526208]: init: message from slugs, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1512435904.916533433]: init: message from slugs, MSG-ID 185 ignored! Table has different entry.
[ WARN] [1512435904.916540763]: init: message from slugs, MSG-ID 186 ignored! Table has different entry.
[ WARN] [1512435904.916547516]: init: message from slugs, MSG-ID 188 ignored! Table has different entry.
[ WARN] [1512435904.916556978]: init: message from slugs, MSG-ID 191 ignored! Table has different entry.
[ WARN] [1512435904.916563722]: init: message from slugs, MSG-ID 192 ignored! Table has different entry.
[ WARN] [1512435904.916570845]: init: message from slugs, MSG-ID 193 ignored! Table has different entry.
[ WARN] [1512435904.916578333]: init: message from slugs, MSG-ID 194 ignored! Table has different entry.
[ INFO] [1512435904.917192238]: udp0: Bind address: 0.0.0.0:14540
[ INFO] [1512435904.917263989]: udp0: Remote address: 127.0.0.1:14557
[ INFO] [1512435904.917452978]: GCS bridge disabled
[ INFO] [1512435904.949355143]: Plugin 3dr_radio loaded
[ INFO] [1512435904.952708054]: Plugin 3dr_radio initialized
[ INFO] [1512435904.952817313]: Plugin actuator_control loaded
[ INFO] [1512435904.957074450]: Plugin actuator_control initialized
[ INFO] [1512435904.993997560]: Plugin adsb loaded
[ INFO] [1512435905.004145234]: Plugin adsb initialized
[ INFO] [1512435905.004354680]: Plugin altitude loaded
[ INFO] [1512435905.017169255]: Plugin altitude initialized
[ INFO] [1512435905.017341292]: Plugin cam_imu_sync loaded
[ INFO] [1512435905.019545959]: Plugin cam_imu_sync initialized
[ INFO] [1512435905.019812174]: Plugin command loaded
[ INFO] [1512435905.051318777]: Plugin command initialized
[ INFO] [1512435905.051482636]: Plugin debug_value loaded
[ INFO] [1512435905.064079163]: Plugin debug_value initialized
[ INFO] [1512435905.064113558]: Plugin distance_sensor blacklisted
[ INFO] [1512435905.064284095]: Plugin fake_gps loaded
[ INFO] [1512435905.134912834]: Plugin fake_gps initialized
[ INFO] [1512435905.135149313]: Plugin ftp loaded
[ INFO] [1512435905.190771325]: Plugin ftp initialized
[ INFO] [1512435905.190952006]: Plugin global_position loaded
[ INFO] [1512435905.315160459]: Plugin global_position initialized
[ INFO] [1512435905.315359389]: Plugin hil loaded
[ INFO] [1512435905.456885854]: Plugin hil initialized
[ INFO] [1512435905.457108840]: Plugin home_position loaded
[ INFO] [1512435905.480891749]: Plugin home_position initialized
[ INFO] [1512435905.481088474]: Plugin imu loaded
[ INFO] [1512435905.526826535]: Plugin imu initialized
[ INFO] [1512435905.527034408]: Plugin local_position loaded
[ INFO] [1512435905.563462711]: Plugin local_position initialized
[ INFO] [1512435905.563651264]: Plugin manual_control loaded
[ INFO] [1512435905.565842040]: Plugin manual_control initialized
[ INFO] [1512435905.566007852]: Plugin mocap_pose_estimed! Table has different entry.
[ WARN] [1512435905.197339983]: init: message from slugs, MSG-ID 172 ignored! Table has different entry.
[ WARN] [1512435905.197349937]: init: message from slugs, MSG-ID 173 ignored! Table has different entry.
[ WARN] [1512435905.197360085]: init: message from slugs, MSG-ID 176 ignored! Table has different entry.
[ WARN] [1512435905.197369878]: init: message from slugs, MSG-ID 177 ignored! Table has different entry.
[ WARN] [1512435905.197379610]: init: message from slugs, MSG-ID 179 ignored! Table has different entry.
[ WARN] [1512435905.197388531]: init: message from slugs, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1512435905.197397749]: init: message from slugs, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1512435905.197407268]: init: message from slugs, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1512435905.197416868]: init: message from slugs, MSG-ID 185 ignored! Table has different entry.
[ WARN] [1512435905.197427444]: init: message from slugs, MSG-ID 186 ignored! Table has different entry.
[ WARN] [1512435905.197436787]: init: message from slugs, MSG-ID 188 ignored! Table has different entry.
[ WARN] [1512435905.197451306]: init: message from slugs, MSG-ID 191 ignored! Table has different entry.
[ WARN] [1512435905.197461204]: init: message from slugs, MSG-ID 192 ignored! Table has different entry.
[ WARN] [1512435905.197471081]: init: message from slugs, MSG-ID 193 ignored! Table has different entry.
[ WARN] [1512435905.197480656]: init: message from slugs, MSG-ID 194 ignored! Table has different entry.
[ INFO] [1512435905.198294965]: udp0: Bind address: 0.0.0.0:14541
[ INFO] [1512435905.198399153]: udp0: Remote address: 127.0.0.1:14559
[ INFO] [1512435905.198674669]: GCS bridge disabled
[ INFO] [1512435905.283458570]: Plugin 3dr_radio loaded
[ INFO] [1512435905.301622076]: Plugin 3dr_radio initialized
[ INFO] [1512435905.301789858]: Plugin actuator_control loaded
[ INFO] [1512435905.331661081]: Plugin actuator_control initialized
[ INFO] [1512435905.382040133]: Plugin adsb loaded
[ INFO] [1512435905.419660477]: Plugin adsb initialized
[ INFO] [1512435905.419854569]: Plugin altitude loaded
[ INFO] [1512435905.424699870]: Plugin altitude initialized
[ INFO] [1512435905.424880907]: Plugin cam_imu_sync loaded
[ INFO] [1512435905.430844498]: Plugin cam_imu_sync initialized
[ INFO] [1512435905.431058964]: Plugin command loaded
[ INFO] [1512435905.453702000]: Plugin command initialized
[ INFO] [1512435905.453885917]: Plugin debug_value loaded
[ INFO] [1512435905.474296721]: Plugin debug_value initialized
[ INFO] [1512435905.474337239]: Plugin distance_sensor blacklisted
[ INFO] [1512435905.474516709]: Plugin fake_gps loaded
[ INFO] [1512435905.573002941]: Plugin fake_gps initialized
[ INFO] [1512435905.573190659]: Plugin ftp loaded
[ INFO] [1512435905.601784648]: Plugin ftp initialized
[ INFO] [1512435905.601973649]: Plugin global_position loaded
[ INFO] [1512435905.655861814]: Plugin global_position initialized
[ INFO] [1512435905.656032742]: Plugin hil loaded
[ INFO] [1512435905.709977386]: Plugin hil initialized
[ INFO] [1512435905.710148492]: Plugin home_position loaded
[ INFO] [1512435905.724575553]: Plugin home_position initialized
[ INFO] [1512435905.724735560]: Plugin imu loaded
[ INFO] [1512435905.748057964]: Plugin imu initialized
[ INFO] [1512435905.748291491]: Plugin local_position loaded
[ INFO] [1512435905.763516469]: Plugin local_position initialized
[ INFO] [1512435905.763678395]: Plugin manual_control loaded
[ INFO] [1512435905.765169152]: Plugin manual_control initialized
[ INFO] [1512435905.765295801]: Plugin mocap_pose_estimed! Table has different entry.
[ WARN] [1512435905.435673623]: init: message from slugs, MSG-ID 172 ignored! Table has different entry.
[ WARN] [1512435905.435681466]: init: message from slugs, MSG-ID 173 ignored! Table has different entry.
[ WARN] [1512435905.435688799]: init: message from slugs, MSG-ID 176 ignored! Table has different entry.
[ WARN] [1512435905.435696090]: init: message from slugs, MSG-ID 177 ignored! Table has different entry.
[ WARN] [1512435905.435707926]: init: message from slugs, MSG-ID 179 ignored! Table has different entry.
[ WARN] [1512435905.435718465]: init: message from slugs, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1512435905.435727117]: init: message from slugs, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1512435905.435734957]: init: message from slugs, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1512435905.435743222]: init: message from slugs, MSG-ID 185 ignored! Table has different entry.
[ WARN] [1512435905.435751999]: init: message from slugs, MSG-ID 186 ignored! Table has different entry.
[ WARN] [1512435905.435760802]: init: message from slugs, MSG-ID 188 ignored! Table has different entry.
[ WARN] [1512435905.435772693]: init: message from slugs, MSG-ID 191 ignored! Table has different entry.
[ WARN] [1512435905.435783319]: init: message from slugs, MSG-ID 192 ignored! Table has different entry.
[ WARN] [1512435905.435792810]: init: message from slugs, MSG-ID 193 ignored! Table has different entry.
[ WARN] [1512435905.435801422]: init: message from slugs, MSG-ID 194 ignored! Table has different entry.
[ INFO] [1512435905.436578699]: udp0: Bind address: 0.0.0.0:14542
[ INFO] [1512435905.436672379]: udp0: Remote address: 127.0.0.1:14561
[ INFO] [1512435905.436912414]: GCS bridge disabled
[ INFO] [1512435905.490389406]: Plugin 3dr_radio loaded
[ INFO] [1512435905.500394890]: Plugin 3dr_radio initialized
[ INFO] [1512435905.500516263]: Plugin actuator_control loaded
[ INFO] [1512435905.523399500]: Plugin actuator_control initialized
[ INFO] [1512435905.556999071]: Plugin adsb loaded
[ INFO] [1512435905.570462448]: Plugin adsb initialized
[ INFO] [1512435905.570636564]: Plugin altitude loaded
[ INFO] [1512435905.574383348]: Plugin altitude initialized
[ INFO] [1512435905.574550052]: Plugin cam_imu_sync loaded
[ INFO] [1512435905.576370659]: Plugin cam_imu_sync initialized
[ INFO] [1512435905.576713229]: Plugin command loaded
[ INFO] [1512435905.599916313]: Plugin command initialized
[ INFO] [1512435905.600067446]: Plugin debug_value loaded
[ INFO] [1512435905.619685069]: Plugin debug_value initialized
[ INFO] [1512435905.619723122]: Plugin distance_sensor blacklisted
[ INFO] [1512435905.619857651]: Plugin fake_gps loaded
[ INFO] [1512435905.668843657]: Plugin fake_gps initialized
[ INFO] [1512435905.669083643]: Plugin ftp loaded
[ INFO] [1512435905.695560076]: Plugin ftp initialized
[ INFO] [1512435905.695749806]: Plugin global_position loaded
[ INFO] [1512435905.748700564]: Plugin global_position initialized
[ INFO] [1512435905.748887917]: Plugin hil loaded
[ INFO] [1512435905.791465862]: Plugin hil initialized
[ INFO] [1512435905.791644029]: Plugin home_position loaded
[ INFO] [1512435905.801042659]: Plugin home_position initialized
[ INFO] [1512435905.801202159]: Plugin imu loaded
[ INFO] [1512435905.820713186]: Plugin imu initialized
[ INFO] [1512435905.820860016]: Plugin local_position loaded
[ INFO] [1512435905.839004682]: Plugin local_position initialized
[ INFO] [1512435905.839179856]: Plugin manual_control loaded
[ INFO] [1512435905.842846970]: Plugin manual_control initialized
[ INFO] [1512435905.843016693]: Plugin mocap_pose_estimSpawnModel script started
[INFO] [1512435905.536106, 0.000000]: Loading model XML from ros parameter
[INFO] [1512435905.543892, 0.000000]: Waiting for service /gazebo/spawn_sdf_model
[INFO] [1512435907.054737, 0.000000]: Calling service /gazebo/spawn_sdf_model
[INFO] [1512435907.225430, 0.166000]: Spawn status: SpawnModel: Successfully spawned entity
SpawnModel script started
[INFO] [1512435905.858301, 0.000000]: Loading model XML from ros parameter
[INFO] [1512435905.863176, 0.000000]: Waiting for service /gazebo/spawn_sdf_model
[INFO] [1512435907.069404, 0.000000]: Calling service /gazebo/spawn_sdf_model
[INFO] [1512435907.493904, 0.366000]: Spawn status: SpawnModel: Successfully spawned entity
SpawnModel script started
[INFO] [1512435905.687138, 0.000000]: Loading model XML from ros parameter
[INFO] [1512435905.692948, 0.000000]: Waiting for service /gazebo/spawn_sdf_model
[INFO] [1512435907.201527, 0.166000]: Calling service /gazebo/spawn_sdf_model
[INFO] [1512435907.737638, 0.568000]: Spawn status: SpawnModel: Successfully spawned entity
INFO  [simulator] Got initial simulation data, running sim..
INFO  [pwm_out_sim] MODE_8PWM
INFO  [tone_alarm] startup
INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 14556 remote port 14550
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14557 remote port 14540
INFO  [mavlink] MAVLink only on localhost (set param MAV_BROADCAST = 1 to enable network)
INFO  [logger] logger started (mode=all)pxh> INFO  [simulator] Got initial simulation data, running sim..
INFO  [pwm_out_sim] MODE_8PWM
INFO  [tone_alarm] startup
INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 14563 remote port 14550
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14561 remote port 14542
INFO  [mavlink] MAVLink only on localhost (set param MAV_BROADCAST = 1 to enable network)
INFO  [logger] logger started (mode=all)
pxh> INFO  [simulator] Got initial simulation data, running sim..
INFO  [pwm_out_sim] MODE_8PWM
INFO  [tone_alarm] startup
INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 14558 remote port 14550
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14559 remote port 14541
INFO  [mavlink] MAVLink only on localhost (set param MAV_BROADCAST = 1 to enable network)
INFO  [logger] logger started (mode=all)
pxh> ate loaded
[ INFO] [1512435905.583828343]: Plugin mocap_pose_estimate initialized
[ INFO] [1512435905.583950875]: Plugin odom loaded
[ INFO] [1512435905.608470850]: Plugin odom initialized
[ INFO] [1512435905.608736193]: Plugin param loaded
[ INFO] [1512435905.615732510]: Plugin param initialized
[ INFO] [1512435905.615859744]: Plugin px4flow loaded
[ INFO] [1512435905.634915872]: Plugin px4flow initialized
[ INFO] [1512435905.634948694]: Plugin rangefinder blacklisted
[ INFO] [1512435905.635180063]: Plugin rc_io loaded
[ INFO] [1512435905.648772783]: Plugin rc_io initialized
[ INFO] [1512435905.648800244]: Plugin safety_area blacklisted
[ INFO] [1512435905.648975199]: Plugin setpoint_accel loaded
[ INFO] [1512435905.657839070]: Plugin setpoint_accel initialized
[ INFO] [1512435905.658090736]: Plugin setpoint_attitude loaded
[ INFO] [1512435905.697520580]: Plugin setpoint_attitude initialized
[ INFO] [1512435905.697699534]: Plugin setpoint_position loaded
[ INFO] [1512435905.718788590]: Plugin setpoint_position initialized
[ INFO] [1512435905.718990798]: Plugin setpoint_raw loaded
[ INFO] [1512435905.747578316]: Plugin setpoint_raw initialized
[ INFO] [1512435905.747794452]: Plugin setpoint_velocity loaded
[ INFO] [1512435905.761702971]: Plugin setpoint_velocity initialized
[ INFO] [1512435905.761947110]: Plugin sys_status loaded
[ INFO] [1512435905.779627312]: Plugin sys_status initialized
[ INFO] [1512435905.779821193]: Plugin sys_time loaded
[ INFO] [1512435905.789126057]: TM: Timesync mode: MAVLINK
[ INFO] [1512435905.790633616]: Plugin sys_time initialized
[ INFO] [1512435905.790804757]: Plugin vfr_hud loaded
[ INFO] [1512435905.794463226]: Plugin vfr_hud initialized
[ INFO] [1512435905.794487391]: Plugin vibration blacklisted
[ INFO] [1512435905.794617053]: Plugin vision_pose_estimate loaded
[ INFO] [1512435905.820460652]: Plugin vision_pose_estimate initialized
[ INFO] [1512435905.820609272]: Plugin vision_speed_estimate loaded
[ INFO] [1512435905.830957134]: Plugin vision_speed_estimate initialized
[ INFO] [1512435905.831140313]: Plugin waypoint loaded
[ INFO] [1512435905.846070481]: Plugin waypoint initialized
[ INFO] [1512435905.846112828]: Autostarting mavlink via USB on PX4
[ INFO] [1512435905.846218489]: Built-in SIMD instructions: SSE, SSE2
[ INFO] [1512435905.846232428]: Built-in MAVLink package version: 2017.11.11
[ INFO] [1512435905.846249038]: Known MAVLink dialects: common ardupilotmega ASLUAV autoquad matrixpilot paparazzi slugs standard uAvionix ualberta
[ INFO] [1512435905.846267674]: MAVROS started. MY ID 1.240, TARGET ID 1.1
[ INFO] [1512435908.381351477, 1.208000000]: udp0: Remote address: 127.0.0.1:14557
[ INFO] [1512435908.547992692, 1.374000000]: IMU: High resolution IMU detected!
[ INFO] [1512435909.284553318, 2.110000000]: CON: Got HEARTBEAT, connected. FCU: PX4 Autopilot
[ INFO] [1512435909.285565627, 2.112000000]: IMU: High resolution IMU detected!
[ INFO] [1512435909.452886367, 2.280000000]: IMU: Attitude quaternion IMU detected!
[ INFO] [1512435910.287086813, 3.112000000]: VER: 1.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435910.287115590, 3.112000000]: VER: 1.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435910.287129334, 3.112000000]: VER: 1.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435910.287141169, 3.112000000]: VER: 1.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435910.287153277, 3.112000000]: VER: 1.1: Board hardware:      00000001
[ INFO] [1512435910.287171769, 3.112000000]: VER: 1.1: VID/PID:             0000:0000
[ INFO] [1512435910.287191213, 3.112000000]: VER: 1.1: UID:                 000000010ate loaded
[ INFO] [1512435905.855995252]: Plugin mocap_pose_estimate initialized
[ INFO] [1512435905.856136419]: Plugin odom loaded
[ INFO] [1512435905.866940164]: Plugin odom initialized
[ INFO] [1512435905.867603444]: Plugin param loaded
[ INFO] [1512435905.872856967]: Plugin param initialized
[ INFO] [1512435905.872992035]: Plugin px4flow loaded
[ INFO] [1512435905.881900379]: Plugin px4flow initialized
[ INFO] [1512435905.881921795]: Plugin rangefinder blacklisted
[ INFO] [1512435905.882085896]: Plugin rc_io loaded
[ INFO] [1512435905.890887767]: Plugin rc_io initialized
[ INFO] [1512435905.890912563]: Plugin safety_area blacklisted
[ INFO] [1512435905.891085145]: Plugin setpoint_accel loaded
[ INFO] [1512435905.898386021]: Plugin setpoint_accel initialized
[ INFO] [1512435905.898675615]: Plugin setpoint_attitude loaded
[ INFO] [1512435905.919324964]: Plugin setpoint_attitude initialized
[ INFO] [1512435905.919524085]: Plugin setpoint_position loaded
[ INFO] [1512435905.931078573]: Plugin setpoint_position initialized
[ INFO] [1512435905.931270560]: Plugin setpoint_raw loaded
[ INFO] [1512435905.949998322]: Plugin setpoint_raw initialized
[ INFO] [1512435905.950185000]: Plugin setpoint_velocity loaded
[ INFO] [1512435905.960553309]: Plugin setpoint_velocity initialized
[ INFO] [1512435905.960802607]: Plugin sys_status loaded
[ INFO] [1512435905.970486352]: Plugin sys_status initialized
[ INFO] [1512435905.970639840]: Plugin sys_time loaded
[ INFO] [1512435905.973948294]: TM: Timesync mode: MAVLINK
[ INFO] [1512435905.974559371]: Plugin sys_time initialized
[ INFO] [1512435905.974684202]: Plugin vfr_hud loaded
[ INFO] [1512435905.975837595]: Plugin vfr_hud initialized
[ INFO] [1512435905.975856616]: Plugin vibration blacklisted
[ INFO] [1512435905.975966948]: Plugin vision_pose_estimate loaded
[ INFO] [1512435905.989916301]: Plugin vision_pose_estimate initialized
[ INFO] [1512435905.990045820]: Plugin vision_speed_estimate loaded
[ INFO] [1512435905.993189068]: Plugin vision_speed_estimate initialized
[ INFO] [1512435905.993333130]: Plugin waypoint loaded
[ INFO] [1512435905.998419053]: Plugin waypoint initialized
[ INFO] [1512435905.998453770]: Autostarting mavlink via USB on PX4
[ INFO] [1512435905.998551331]: Built-in SIMD instructions: SSE, SSE2
[ INFO] [1512435905.998564148]: Built-in MAVLink package version: 2017.11.11
[ INFO] [1512435905.998578150]: Known MAVLink dialects: common ardupilotmega ASLUAV autoquad matrixpilot paparazzi slugs standard uAvionix ualberta
[ INFO] [1512435905.998591936]: MAVROS started. MY ID 1.240, TARGET ID 3.3
[ INFO] [1512435908.688094821, 1.514000000]: udp0: Remote address: 127.0.0.1:14561
[ INFO] [1512435908.797601493, 1.624000000]: IMU: High resolution IMU detected!
[ INFO] [1512435909.605227114, 2.432000000]: CON: Got HEARTBEAT, connected. FCU: PX4 Autopilot
[ INFO] [1512435909.606180373, 2.432000000]: IMU: High resolution IMU detected!
[ INFO] [1512435909.714460840, 2.540000000]: IMU: Attitude quaternion IMU detected!
[ INFO] [1512435910.608638779, 3.434000000]: VER: 3.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435910.608675135, 3.434000000]: VER: 3.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435910.608697270, 3.434000000]: VER: 3.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435910.608715447, 3.434000000]: VER: 3.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435910.608730600, 3.434000000]: VER: 3.1: Board hardware:      00000001
[ INFO] [1512435910.608747319, 3.434000000]: VER: 3.1: VID/PID:             0000:0000
[ INFO] [1512435910.608757484, 3.434000000]: VER: 3.1: UID:                 000000010ate loaded
[ INFO] [1512435905.777519665]: Plugin mocap_pose_estimate initialized
[ INFO] [1512435905.777666364]: Plugin odom loaded
[ INFO] [1512435905.789993072]: Plugin odom initialized
[ INFO] [1512435905.790223221]: Plugin param loaded
[ INFO] [1512435905.796281468]: Plugin param initialized
[ INFO] [1512435905.796414836]: Plugin px4flow loaded
[ INFO] [1512435905.809325227]: Plugin px4flow initialized
[ INFO] [1512435905.809347751]: Plugin rangefinder blacklisted
[ INFO] [1512435905.809524279]: Plugin rc_io loaded
[ INFO] [1512435905.821863157]: Plugin rc_io initialized
[ INFO] [1512435905.821885961]: Plugin safety_area blacklisted
[ INFO] [1512435905.822027231]: Plugin setpoint_accel loaded
[ INFO] [1512435905.832018544]: Plugin setpoint_accel initialized
[ INFO] [1512435905.832315730]: Plugin setpoint_attitude loaded
[ INFO] [1512435905.865944403]: Plugin setpoint_attitude initialized
[ INFO] [1512435905.866394762]: Plugin setpoint_position loaded
[ INFO] [1512435905.880117069]: Plugin setpoint_position initialized
[ INFO] [1512435905.880311111]: Plugin setpoint_raw loaded
[ INFO] [1512435905.903103299]: Plugin setpoint_raw initialized
[ INFO] [1512435905.903270449]: Plugin setpoint_velocity loaded
[ INFO] [1512435905.914101740]: Plugin setpoint_velocity initialized
[ INFO] [1512435905.914335281]: Plugin sys_status loaded
[ INFO] [1512435905.927592096]: Plugin sys_status initialized
[ INFO] [1512435905.927795165]: Plugin sys_time loaded
[ INFO] [1512435905.934377806]: TM: Timesync mode: MAVLINK
[ INFO] [1512435905.935371223]: Plugin sys_time initialized
[ INFO] [1512435905.935505729]: Plugin vfr_hud loaded
[ INFO] [1512435905.938181427]: Plugin vfr_hud initialized
[ INFO] [1512435905.938202957]: Plugin vibration blacklisted
[ INFO] [1512435905.938332415]: Plugin vision_pose_estimate loaded
[ INFO] [1512435905.956590750]: Plugin vision_pose_estimate initialized
[ INFO] [1512435905.956756683]: Plugin vision_speed_estimate loaded
[ INFO] [1512435905.962028597]: Plugin vision_speed_estimate initialized
[ INFO] [1512435905.962224753]: Plugin waypoint loaded
[ INFO] [1512435905.969852617]: Plugin waypoint initialized
[ INFO] [1512435905.969904384]: Autostarting mavlink via USB on PX4
[ INFO] [1512435905.970039202]: Built-in SIMD instructions: SSE, SSE2
[ INFO] [1512435905.970059911]: Built-in MAVLink package version: 2017.11.11
[ INFO] [1512435905.970084003]: Known MAVLink dialects: common ardupilotmega ASLUAV autoquad matrixpilot paparazzi slugs standard uAvionix ualberta
[ INFO] [1512435905.970104067]: MAVROS started. MY ID 1.240, TARGET ID 2.2
[ INFO] [1512435908.943126129, 1.770000000]: udp0: Remote address: 127.0.0.1:14559
[ INFO] [1512435909.043391974, 1.870000000]: IMU: High resolution IMU detected!
[ INFO] [1512435909.858711004, 2.684000000]: CON: Got HEARTBEAT, connected. FCU: PX4 Autopilot
[ INFO] [1512435909.859741834, 2.686000000]: IMU: High resolution IMU detected!
[ INFO] [1512435909.958361885, 2.784000000]: IMU: Attitude quaternion IMU detected!
[ INFO] [1512435910.861100736, 3.684000000]: VER: 2.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435910.861134186, 3.684000000]: VER: 2.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435910.861153928, 3.684000000]: VER: 2.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435910.861168964, 3.684000000]: VER: 2.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435910.861183878, 3.684000000]: VER: 2.1: Board hardware:      00000001
[ INFO] [1512435910.861207905, 3.686000000]: VER: 2.1: VID/PID:             0000:0000
[ INFO] [1512435910.861221417, 3.686000000]: VER: 2.1: UID:                 0000000100000002
[ WARN] [1512435911.610430949, 4.432000000]: VER: broadcast request timeout, retries left 4
[ INFO] [1512435911.610488404, 4.434000000]: VER: 3.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435911.610522913, 4.434000000]: VER: 3.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435911.610538227, 4.434000000]: VER: 3.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435911.610550935, 4.434000000]: VER: 3.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435911.610559125, 4.434000000]: VER: 3.1: Board hardware:      00000001
[ INFO] [1512435911.610567237, 4.434000000]: VER: 3.1: VID/PID:             0000:0000
[ INFO] [1512435911.610575055, 4.434000000]: VER: 3.1: UID:                 0000000100000002
[ WARN] [1512435912.612220611, 5.434000000]: VER: broadcast request timeout, retries left 3
[ INFO] [1512435912.612267538, 5.434000000]: VER: 3.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435912.612294324, 5.434000000]: VER: 3.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435912.612304520, 5.434000000]: VER: 3.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435912.612315531, 5.434000000]: VER: 3.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435912.612338268, 5.434000000]: VER: 3.1: Board hardware:      00000001
[ INFO] [1512435912.612347525, 5.434000000]: VER: 3.1: VID/PID:             0000:0000
[ INFO] [1512435912.612365924, 5.434000000]: VER: 3.1: UID:                 0000000100000002
[ INFO] [1512435913.613256487, 6.432000000]: VER: 3.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435913.613292661, 6.432000000]: VER: 3.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435913.613311087, 6.432000000]: VER: 3.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435913.613325660, 6.432000000]: VER: 3.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435913.613334486, 6.432000000]: VER: 3.1: Board hardware:      00000001
[ INFO] [1512435913.613342664, 6.432000000]: VER: 3.1: VID/PID:             0000:0000
[ INFO] [1512435913.613350698, 6.432000000]: VER: 3.1: UID:                 0000000100000002
[ WARN] [1512435913.614761324, 6.434000000]: VER: unicast request timeout, retries left 2
[ INFO] [1512435914.614856324, 7.432000000]: VER: 3.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435914.614909959, 7.432000000]: VER: 3.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435914.614937565, 7.434000000]: VER: 3.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435914.614956427, 7.434000000]: VER: 3.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435914.614972765, 7.434000000]: VER: 3.1: Board hardware:      00000001
[ INFO] [1512435914.614990069, 7.434000000]: VER: 3.1: VID/PID:             0000:0000
[ INFO] [1512435914.615008358, 7.434000000]: VER: 3.1: UID:                 0000000100000002
[ WARN] [1512435914.616218775, 7.434000000]: VER: unicast request timeout, retries left 1
[ INFO] [1512435915.614572635, 8.432000000]: VER: 3.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435915.614613862, 8.432000000]: VER: 3.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435915.614636895, 8.432000000]: VER: 3.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435915.614655002, 8.432000000]: VER: 3.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435915.614668430, 8.432000000]: VER: 3.1: Board hardware:      00000001
[ INFO] [1512435915.614681228, 8.432000000]: VER: 3.1: VID/PID:             0000:0000
[ INFO] [1512435915.614712440, 8.432000000]: VER: 3.1: UID:                 0000000100000002
[ WARN] [1512435915.616190992, 8.434000000]:0000002
[ WARN] [1512435911.862833959, 4.686000000]: VER: broadcast request timeout, retries left 4
[ INFO] [1512435911.862867724, 4.686000000]: VER: 2.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435911.862896864, 4.686000000]: VER: 2.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435911.862914734, 4.686000000]: VER: 2.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435911.862932437, 4.686000000]: VER: 2.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435911.862947096, 4.686000000]: VER: 2.1: Board hardware:      00000001
[ INFO] [1512435911.862960988, 4.686000000]: VER: 2.1: VID/PID:             0000:0000
[ INFO] [1512435911.862973130, 4.686000000]: VER: 2.1: UID:                 0000000100000002
[ WARN] [1512435912.863204273, 5.684000000]: VER: broadcast request timeout, retries left 3
[ INFO] [1512435912.863252350, 5.684000000]: VER: 2.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435912.863274813, 5.684000000]: VER: 2.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435912.863293629, 5.684000000]: VER: 2.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435912.863307721, 5.684000000]: VER: 2.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435912.863320196, 5.684000000]: VER: 2.1: Board hardware:      00000001
[ INFO] [1512435912.863338106, 5.684000000]: VER: 2.1: VID/PID:             0000:0000
[ INFO] [1512435912.863351933, 5.684000000]: VER: 2.1: UID:                 0000000100000002
[ INFO] [1512435913.866800280, 6.686000000]: VER: 2.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435913.866841609, 6.686000000]: VER: 2.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435913.866862124, 6.686000000]: VER: 2.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435913.866877621, 6.686000000]: VER: 2.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435913.866891415, 6.686000000]: VER: 2.1: Board hardware:      00000001
[ INFO] [1512435913.866902832, 6.686000000]: VER: 2.1: VID/PID:             0000:0000
[ INFO] [1512435913.866911014, 6.686000000]: VER: 2.1: UID:                 0000000100000002
[ WARN] [1512435913.868479110, 6.686000000]: VER: unicast request timeout, retries left 2
[ INFO] [1512435914.867348843, 7.686000000]: VER: 2.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435914.867398446, 7.686000000]: VER: 2.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435914.867427676, 7.686000000]: VER: 2.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435914.867452703, 7.686000000]: VER: 2.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435914.867476514, 7.686000000]: VER: 2.1: Board hardware:      00000001
[ INFO] [1512435914.867498085, 7.686000000]: VER: 2.1: VID/PID:             0000:0000
[ INFO] [1512435914.867520652, 7.686000000]: VER: 2.1: UID:                 0000000100000002
[ WARN] [1512435914.868971145, 7.686000000]: VER: unicast request timeout, retries left 1
[ INFO] [1512435915.867947038, 8.686000000]: VER: 2.1: Capabilities         0x000000000000e4ef
[ INFO] [1512435915.867984820, 8.686000000]: VER: 2.1: Flight software:     01070000 (00000000C4F154E8)
[ INFO] [1512435915.868006419, 8.686000000]: VER: 2.1: Middleware software: 01070000 (00000000C4F154E8)
[ INFO] [1512435915.868031216, 8.686000000]: VER: 2.1: OS software:         040a00ff (0000000000000000)
[ INFO] [1512435915.868049055, 8.686000000]: VER: 2.1: Board hardware:      00000001
[ INFO] [1512435915.868066367, 8.686000000]: VER: 2.1: VID/PID:             0000:0000
[ INFO] [1512435915.868081592, 8.686000000]: VER: 2.1: UID:                 0000000100000002
[ WARN] [1512435915.868615901, 8.686000000]:
INFO  [logger] Start file log
INFO  [logger] Opened log file: rootfs/fs/microsd/log/2017-12-05/01_05_08.ulg
INFO  [mavlink] partner IP: 127.0.0.1
ERROR [mavlink] [timesync] Hard setting offset.
INFO  [lib__ecl] EKF aligned, (pressure height, IMU buf: 22, OBS buf: 14)
WARN  [lib__ecl] EKF stopping navigation
INFO  [mavlink] partner IP: 127.0.0.1
INFO  [lib__ecl] EKF GPS checks passed (WGS-84 origin set)
INFO  [lib__ecl] EKF commencing GPS fusion
INFO  [commander] home: 47.3977420, 8.5455935, 488.08
INFO  [tone_alarm] home_set
ERROR [mavlink] [timesync] Hard setting offset.

pxh> 

Diagnostics

header: 
  seq: 68
  stamp: 
    secs: 63
    nsecs:         0
  frame_id: ''
status: 
  - 
    level: 0
    name: uav3/mavros: FCU connection
    message: connected
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Received packets:
        value: 24487
      - 
        key: Dropped packets:
        value: 0
      - 
        key: Buffer overruns:
        value: 0
      - 
        key: Parse errors:
        value: 0
      - 
        key: Rx sequence number:
        value: 169
      - 
        key: Tx sequence number:
        value: 106
      - 
        key: Rx total bytes:
        value: 1024127
      - 
        key: Tx total bytes:
        value: 32635
      - 
        key: Rx speed:
        value: 16554.000000
      - 
        key: Tx speed:
        value: 517.000000
  - 
    level: 0
    name: uav3/mavros: GPS
    message: 3D fix
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Satellites visible
        value: 10
      - 
        key: Fix type
        value: 3
      - 
        key: EPH (m)
        value: 0.00
      - 
        key: EPV (m)
        value: 0.00
  - 
    level: 0
    name: uav3/mavros: Heartbeat
    message: Normal
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Heartbeats since startup
        value: 61
      - 
        key: Frequency (Hz)
        value: 1.000000
      - 
        key: Vehicle type
        value: Quadrotor
      - 
        key: Autopilot type
        value: PX4 Autopilot
      - 
        key: Mode
        value: AUTO.LOITER
      - 
        key: System status
        value: Standby
  - 
    level: 0
    name: uav3/mavros: System
    message: Normal
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Sensor present
        value: 0x00000000
      - 
        key: Sensor enabled
        value: 0x00000000
      - 
        key: Sensor helth
        value: 0x00000000
      - 
        key: CPU Load (%)
        value: 0.0
      - 
        key: Drop rate (%)
        value: 0.0
      - 
        key: Errors comm
        value: 0
      - 
        key: Errors count #1
        value: 0
      - 
        key: Errors count #2
        value: 0
      - 
        key: Errors count #3
        value: 0
      - 
        key: Errors count #4
        value: 0
  - 
    level: 0
    name: uav3/mavros: Battery
    message: Normal
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Voltage
        value: 12.15
      - 
        key: Current
        value: -1.0
      - 
        key: Remaining
        value: 100.0
  - 
    level: 0
    name: uav3/mavros: Time Sync
    message: Normal
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Timesyncs since startup
        value: 279
      - 
        key: Frequency (Hz)
        value: 10.000000
      - 
        key: Last dt (ms)
        value: -0.492444
      - 
        key: Mean dt (ms)
        value: -0.284761
      - 
        key: Last system time (s)
        value: 61.691606000
      - 
        key: Time offset (s)
        value: 1.208197022
---

Check ID

WARNING: /mavros/target_system_id not set. Used default value: 1
WARNING: /mavros/target_component_id not set. Used default value: 1
NOTE: Target parameters may be unset, but that may be result of incorrect --mavros-ns option.Double check results!
ERROR. I got 0 addresses, but not your target 1:1

---
Received 0 messages, from 0 addresses
sys:comp   list of messages

Additional Details

Here is a snippet of some code I'm running to try to arm a uav. This works perfectly fine with uav1 but does not work with uav2 and uav3. I've also gotten to the point where I can set uav1 to OFFBOARD and command it in software but that same code does not work with uav2 and uav3. I've also modified my launch file to just launch uav2 or uav3 by themselves but that does not work either.

     rospy.wait_for_service('/uav1/mavros/cmd/arming')
    try:
        armService = rospy.ServiceProxy('/uav1/mavros/cmd/arming', mavros_msgs.srv.CommandBool)
        armService(True)
    except rospy.ServiceException, e:
        print "Service arm call failed: %s"%e

I'm at a loss for what's wrong with my setup so any help would be greatly appreciated. Thank you for your time.

vooon commented 6 years ago

Check that you have different udp ports pair used for each autopilot. Mavros do not fully support multipoint comm. Also /diagnostics needed to be for all three nodes. VER responses should be only one per sysid/compid (but fcu may send that message at startup).

Seiwert commented 6 years ago

@vooon I am fairly certain I have separate UDP ports set correctly. Here is my launch file:

<launch>

    <!-- MAVROS posix SITL environment launch script -->

    <arg name="debug" default="false"/>
    <arg name="verbose" default="false"/>
    <arg name="paused" default="false"/>

    <arg name="est" default="ekf2"/>
    <arg name="vehicle" default="iris"/>
    <arg name="world" default="$(find mavlink_sitl_gazebo)/worlds/empty.world"/>

    <arg name="headless" default="false"/>
    <arg name="gui" default="true"/>
    <arg name="ns" default="/"/>

    <arg name="pluginlists_yaml" default="$(find mavros)/launch/px4_pluginlists.yaml" />
    <arg name="config_yaml" default="$(find mavros)/launch/px4_config.yaml" />

    <!-- Load world -->
    <include file="$(find gazebo_ros)/launch/empty_world.launch">
        <arg name="headless" value="$(arg headless)"/>
        <arg name="gui" value="$(arg gui)"/>
        <arg name="world_name" value="$(arg world)" />
        <arg name="debug" value="$(arg debug)" />
        <arg name="verbose" value="$(arg verbose)" />
        <arg name="paused" value="$(arg paused)" />
    </include>

    <!-- UAV1 iris_1-->
    <group ns="uav1">
        <arg name="fcu_url" default="udp://:14540@localhost:14557"/>
        <arg name="gcs_url" value=""/>
        <arg name="tgt_system" value="1"/> 
        <arg name="tgt_component" value="1"/>
        <arg name="rcS1" default="$(find px4)/posix-configs/SITL/init/$(arg est)/$(arg vehicle)_1"/>
        <arg name="ID" value="1"/>

        <include file="$(find px4)/launch/single_vehcile_spawn.launch">
            <arg name="x" value="0"/>
            <arg name="y" value="0"/>
            <arg name="z" value="0"/>
            <arg name="R" value="0"/>
            <arg name="P" value="0"/>
            <arg name="Y" value="0"/>
            <arg name="vehicle" value="$(arg vehicle)"/>
            <arg name="rcS" value="$(arg rcS1)"/>
            <arg name="mavlink_udp_port" value="14560"/>
            <arg name="ID" value="$(arg ID)"/>
        </include>

        <include file="$(find mavros)/launch/node.launch">
            <arg name="pluginlists_yaml" value="$(arg pluginlists_yaml)" />
            <arg name="config_yaml" value="$(arg config_yaml)" />

            <arg name="fcu_url" value="$(arg fcu_url)" />
            <arg name="gcs_url" value="$(arg gcs_url)" />
            <arg name="tgt_system" value="$(arg tgt_system)" />
            <arg name="tgt_component" value="$(arg tgt_component)" />
        </include>
    </group>

    <!-- UAV2 iris_2 -->
    <group ns="uav2">
        <arg name="fcu_url" default="udp://:14541@localhost:14559"/>
        <arg name="gcs_url" value=""/>
        <arg name="tgt_system" value="2"/> 
        <arg name="tgt_component" value="2"/>
        <arg name="rcS2" default="$(find px4)/posix-configs/SITL/init/$(arg est)/$(arg vehicle)_2"/>
        <arg name="ID" value="2"/>

        <include file="$(find px4)/launch/single_vehcile_spawn.launch">
            <arg name="x" value="1"/>
            <arg name="y" value="0"/>
            <arg name="z" value="0"/>
            <arg name="R" value="0"/>
            <arg name="P" value="0"/>
            <arg name="Y" value="0"/>
            <arg name="vehicle" value="$(arg vehicle)"/>
            <arg name="rcS" value="$(arg rcS2)"/>
            <arg name="mavlink_udp_port" value="14562"/>
            <arg name="ID" value="$(arg ID)"/>
        </include>

        <include file="$(find mavros)/launch/node.launch">
            <arg name="pluginlists_yaml" value="$(arg pluginlists_yaml)" />
            <arg name="config_yaml" value="$(arg config_yaml)" />

            <arg name="fcu_url" value="$(arg fcu_url)" />
            <arg name="gcs_url" value="$(arg gcs_url)" />
            <arg name="tgt_system" value="$(arg tgt_system)" />
            <arg name="tgt_component" value="$(arg tgt_component)" />
        </include>
    </group>

    <!-- UAV2 iris_3 -->
    <group ns="uav3">
        <arg name="fcu_url" default="udp://:14542@localhost:14561"/>
        <arg name="gcs_url" value=""/>
        <arg name="tgt_system" value="3"/> 
        <arg name="tgt_component" value="3"/>
        <arg name="rcS3" default="$(find px4)/posix-configs/SITL/init/$(arg est)/$(arg vehicle)_3"/>
        <arg name="ID" value="3"/>

        <include file="$(find px4)/launch/single_vehcile_spawn.launch">
            <arg name="x" value="1"/>
            <arg name="y" value="1"/>
            <arg name="z" value="0"/>
            <arg name="R" value="0"/>
            <arg name="P" value="0"/>
            <arg name="Y" value="0"/>
            <arg name="vehicle" value="$(arg vehicle)"/>
            <arg name="rcS" value="$(arg rcS3)"/>
            <arg name="mavlink_udp_port" value="14564"/>
            <arg name="ID" value="$(arg ID)"/>
        </include>

        <include file="$(find mavros)/launch/node.launch">
            <arg name="pluginlists_yaml" value="$(arg pluginlists_yaml)" />
            <arg name="config_yaml" value="$(arg config_yaml)" />

            <arg name="fcu_url" value="$(arg fcu_url)" />
            <arg name="gcs_url" value="$(arg gcs_url)" />
            <arg name="tgt_system" value="$(arg tgt_system)" />
            <arg name="tgt_component" value="$(arg tgt_component)" />
        </include>
    </group>

</launch>
<!-- vim: set et ft=xml fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : -->

As you can see, the _fcuurl is different for each UAV. If I'm understanding this all correctly, those variables will be passed into the mavros node.launch file and should bring up separate instances of MAVROS looking at those ports.

I've also modified my iris_1 - 3 files to match these UDP ports along with the iris_1-3.urdf files.

Thanks for taking a look at this.

Seiwert commented 6 years ago

Also, I apologize, I forgot to upload diagnostic data from all three. Here is that information:

header: 
  seq: 104
  stamp: 
    secs: 99
    nsecs:         0
  frame_id: ''
status: 
  - 
    level: 0
    name: uav2/mavros: FCU connection
    message: connected
    hardware_id: udp://:14541@localhost:14559
    values: 
      - 
        key: Received packets:
        value: 40730
      - 
        key: Dropped packets:
        value: 0
      - 
        key: Buffer overruns:
        value: 0
      - 
        key: Parse errors:
        value: 0
      - 
        key: Rx sequence number:
        value: 28
      - 
        key: Tx sequence number:
        value: 130
      - 
        key: Rx total bytes:
        value: 1693902
      - 
        key: Tx total bytes:
        value: 51247
      - 
        key: Rx speed:
        value: 17294.000000
      - 
        key: Tx speed:
        value: 517.000000
  - 
    level: 0
    name: uav2/mavros: GPS
    message: 3D fix
    hardware_id: udp://:14541@localhost:14559
    values: 
      - 
        key: Satellites visible
        value: 10
      - 
        key: Fix type
        value: 3
      - 
        key: EPH (m)
        value: 0.00
      - 
        key: EPV (m)
        value: 0.00
  - 
    level: 0
    name: uav2/mavros: Heartbeat
    message: Normal
    hardware_id: udp://:14541@localhost:14559
    values: 
      - 
        key: Heartbeats since startup
        value: 97
      - 
        key: Frequency (Hz)
        value: 1.000000
      - 
        key: Vehicle type
        value: Quadrotor
      - 
        key: Autopilot type
        value: PX4 Autopilot
      - 
        key: Mode
        value: AUTO.TAKEOFF
      - 
        key: System status
        value: Active
  - 
    level: 0
    name: uav2/mavros: System
    message: Normal
    hardware_id: udp://:14541@localhost:14559
    values: 
      - 
        key: Sensor present
        value: 0x00000000
      - 
        key: Sensor enabled
        value: 0x00000000
      - 
        key: Sensor helth
        value: 0x00000000
      - 
        key: CPU Load (%)
        value: 0.0
      - 
        key: Drop rate (%)
        value: 0.0
      - 
        key: Errors comm
        value: 0
      - 
        key: Errors count #1
        value: 0
      - 
        key: Errors count #2
        value: 0
      - 
        key: Errors count #3
        value: 0
      - 
        key: Errors count #4
        value: 0
  - 
    level: 0
    name: uav2/mavros: Battery
    message: Normal
    hardware_id: udp://:14541@localhost:14559
    values: 
      - 
        key: Voltage
        value: 10.05
      - 
        key: Current
        value: -1.0
      - 
        key: Remaining
        value: 17.0
  - 
    level: 0
    name: uav2/mavros: Time Sync
    message: Normal
    hardware_id: udp://:14541@localhost:14559
    values: 
      - 
        key: Timesyncs since startup
        value: 829
      - 
        key: Frequency (Hz)
        value: 10.000000
      - 
        key: Last dt (ms)
        value: -0.038142
      - 
        key: Mean dt (ms)
        value: -0.137742
      - 
        key: Last system time (s)
        value: 97.724807000
      - 
        key: Time offset (s)
        value: 1.175177743
---
header: 
  seq: 104
  stamp: 
    secs: 99
    nsecs:         0
  frame_id: ''
status: 
  - 
    level: 0
    name: uav3/mavros: FCU connection
    message: connected
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Received packets:
        value: 40522
      - 
        key: Dropped packets:
        value: 0
      - 
        key: Buffer overruns:
        value: 0
      - 
        key: Parse errors:
        value: 0
      - 
        key: Rx sequence number:
        value: 76
      - 
        key: Tx sequence number:
        value: 125
      - 
        key: Rx total bytes:
        value: 1685315
      - 
        key: Tx total bytes:
        value: 51127
      - 
        key: Rx speed:
        value: 17294.000000
      - 
        key: Tx speed:
        value: 517.000000
  - 
    level: 0
    name: uav3/mavros: GPS
    message: 3D fix
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Satellites visible
        value: 10
      - 
        key: Fix type
        value: 3
      - 
        key: EPH (m)
        value: 0.00
      - 
        key: EPV (m)
        value: 0.00
  - 
    level: 0
    name: uav3/mavros: Heartbeat
    message: Normal
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Heartbeats since startup
        value: 97
      - 
        key: Frequency (Hz)
        value: 1.000000
      - 
        key: Vehicle type
        value: Quadrotor
      - 
        key: Autopilot type
        value: PX4 Autopilot
      - 
        key: Mode
        value: AUTO.TAKEOFF
      - 
        key: System status
        value: Active
  - 
    level: 0
    name: uav3/mavros: System
    message: Normal
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Sensor present
        value: 0x00000000
      - 
        key: Sensor enabled
        value: 0x00000000
      - 
        key: Sensor helth
        value: 0x00000000
      - 
        key: CPU Load (%)
        value: 0.0
      - 
        key: Drop rate (%)
        value: 0.0
      - 
        key: Errors comm
        value: 0
      - 
        key: Errors count #1
        value: 0
      - 
        key: Errors count #2
        value: 0
      - 
        key: Errors count #3
        value: 0
      - 
        key: Errors count #4
        value: 0
  - 
    level: 0
    name: uav3/mavros: Battery
    message: Normal
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Voltage
        value: 10.56
      - 
        key: Current
        value: -1.0
      - 
        key: Remaining
        value: 43.0
  - 
    level: 0
    name: uav3/mavros: Time Sync
    message: Normal
    hardware_id: udp://:14542@localhost:14561
    values: 
      - 
        key: Timesyncs since startup
        value: 829
      - 
        key: Frequency (Hz)
        value: 10.000000
      - 
        key: Last dt (ms)
        value: -0.195105
      - 
        key: Mean dt (ms)
        value: -0.062807
      - 
        key: Last system time (s)
        value: 97.279937000
      - 
        key: Time offset (s)
        value: 1.619984958
---
header: 
  seq: 104
  stamp: 
    secs: 99
    nsecs:         0
  frame_id: ''
status: 
  - 
    level: 0
    name: uav1/mavros: FCU connection
    message: connected
    hardware_id: udp://:14540@localhost:14557
    values: 
      - 
        key: Received packets:
        value: 41327
      - 
        key: Dropped packets:
        value: 0
      - 
        key: Buffer overruns:
        value: 0
      - 
        key: Parse errors:
        value: 0
      - 
        key: Rx sequence number:
        value: 113
      - 
        key: Tx sequence number:
        value: 117
      - 
        key: Rx total bytes:
        value: 1712725
      - 
        key: Tx total bytes:
        value: 50904
      - 
        key: Rx speed:
        value: 17294.000000
      - 
        key: Tx speed:
        value: 517.000000
  - 
    level: 0
    name: uav1/mavros: GPS
    message: 3D fix
    hardware_id: udp://:14540@localhost:14557
    values: 
      - 
        key: Satellites visible
        value: 10
      - 
        key: Fix type
        value: 3
      - 
        key: EPH (m)
        value: 0.00
      - 
        key: EPV (m)
        value: 0.00
  - 
    level: 0
    name: uav1/mavros: Heartbeat
    message: Normal
    hardware_id: udp://:14540@localhost:14557
    values: 
      - 
        key: Heartbeats since startup
        value: 97
      - 
        key: Frequency (Hz)
        value: 1.000000
      - 
        key: Vehicle type
        value: Quadrotor
      - 
        key: Autopilot type
        value: PX4 Autopilot
      - 
        key: Mode
        value: AUTO.TAKEOFF
      - 
        key: System status
        value: Active
  - 
    level: 0
    name: uav1/mavros: System
    message: Normal
    hardware_id: udp://:14540@localhost:14557
    values: 
      - 
        key: Sensor present
        value: 0x00000000
      - 
        key: Sensor enabled
        value: 0x00000000
      - 
        key: Sensor helth
        value: 0x00000000
      - 
        key: CPU Load (%)
        value: 0.0
      - 
        key: Drop rate (%)
        value: 0.0
      - 
        key: Errors comm
        value: 0
      - 
        key: Errors count #1
        value: 0
      - 
        key: Errors count #2
        value: 0
      - 
        key: Errors count #3
        value: 0
      - 
        key: Errors count #4
        value: 0
  - 
    level: 0
    name: uav1/mavros: Battery
    message: Normal
    hardware_id: udp://:14540@localhost:14557
    values: 
      - 
        key: Voltage
        value: 10.17
      - 
        key: Current
        value: -1.0
      - 
        key: Remaining
        value: 23.0
  - 
    level: 0
    name: uav1/mavros: Time Sync
    message: Normal
    hardware_id: udp://:14540@localhost:14557
    values: 
      - 
        key: Timesyncs since startup
        value: 829
      - 
        key: Frequency (Hz)
        value: 10.000000
      - 
        key: Last dt (ms)
        value: 0.275454
      - 
        key: Mean dt (ms)
        value: -0.096912
      - 
        key: Last system time (s)
        value: 97.498780000
      - 
        key: Time offset (s)
        value: 1.401330181
lamping7 commented 6 years ago

So it looks like you took the launch offered by PX4 and tried to add a third UAV without understanding the port configuration.

Looking at this chuck of output you have port overlap:

INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 14556 remote port 14550
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14557 remote port 14540
INFO  [mavlink] MAVLink only on localhost (set param MAV_BROADCAST = 1 to enable network)
INFO  [logger] logger started (mode=all)pxh> INFO  [simulator] Got initial simulation data, running sim..
INFO  [pwm_out_sim] MODE_8PWM
INFO  [tone_alarm] startup
INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 14563 remote port 14550
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14561 remote port 14542
INFO  [mavlink] MAVLink only on localhost (set param MAV_BROADCAST = 1 to enable network)
INFO  [logger] logger started (mode=all)
pxh> INFO  [simulator] Got initial simulation data, running sim..
INFO  [pwm_out_sim] MODE_8PWM
INFO  [tone_alarm] startup
INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 14558 remote port 14550
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14559 remote port 14541

I'd reconfigure these ports (both in the launch and gazebo files). To make this less confusing: use the default for iris_1. For iris_2 increase each port value by 10, and for iris_3 increase each by another 10.

Good luck.

EDIT: For example when I launch 3 UAVs I have:

INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 14421 remote port 14427
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14422 remote port 14423
INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 14411 remote port 14417
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14412 remote port 14413
INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 14401 remote port 14407
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14402 remote port 14403
vooon commented 6 years ago

Why you also change tgt_component? You only change system-id of FCU, so you should have: 1.1, 2.1, 3.1.

lamping7 commented 6 years ago

good point @vooon... @Seiwert look over these again: https://github.com/PX4/Firmware/tree/master/posix-configs/SITL https://github.com/PX4/Firmware/blob/master/launch/multi_uav_mavros_sitl.launch https://github.com/PX4/Firmware/blob/master/launch/single_vehcile_spawn.launch https://github.com/PX4/Firmware/blob/master/posix-configs/SITL/init/ekf2/multiple_iris

Seiwert commented 6 years ago

@vooon @lamping7 The issue was the tgt_component I changed them back to one and that worked. Thank you both so much for all your help. And @lamping7 , thanks for those resources. I'm new to this so that's why I changed that variable. I'll read up on what you sent and hopefully not make similar mistakes in the future.

TSC21 commented 6 years ago

@Seiwert can you please update the docs on the PX4 devguide so it reflects what was done here? Cause currently there's a lot of people struggling to get this running. Thanks in advance

vooon commented 6 years ago

Also note: checkid may help with ID problems. By default it subscribe to mavlink/from, so for your launch only what needed to do is select namespace.

rosrun mavros checkid __ns:=/uav1
Seiwert commented 6 years ago

@TSC21 I'd be happy to. From my experience though, the docs aren't too far off. The main issue I had was with the single_vehcile_spawn.launch (yes that typo is what it's actually named). The issue in that file dealt with a bug in xacro.py . It appears as though that program is incorrectly traversing subdirectories and never finds iris_base.xacro

The way I got around that is by manually running xacro.py and changing the arguments passed into it so it finds the .xacro file. I also ended up modifying single_vehcile_spawn.launch like so:

<launch>

    <!-- Posix SITL environment launch script -->
    <arg name="x" default="0"/>
    <arg name="y" default="0"/>
    <arg name="z" default="0"/>
    <arg name="R" default="0"/>
    <arg name="P" default="0"/>
    <arg name="Y" default="0"/>
    <arg name="est" default="lpe"/>
    <arg name="vehicle" default="iris"/>
    <arg name="ID" default="1"/>
    <arg name="rcS" default="$(find px4)/posix-configs/SITL/init/$(arg est)/$(arg vehicle)_$(arg ID)"/>
    <arg name="mavlink_udp_port" default="14560" />

<!--
    <arg name="cmd" default="$(find xacro)/xacro.py $(find px4)/Tools/sitl_gazebo/models/rotors_description/urdf/$(arg vehicle)_base.xacro rotors_description_dir:=$(find px4)/Tools/sitl_gazebo/models/rotors_description mavlink_udp_port:=$(arg mavlink_udp_port) > $(arg vehicle)_$(arg ID).urdf ; 'gz sdf -p $(arg vehicle)_$(arg ID).urdf'" />
-->
    <arg name="cmd" default="gz sdf -p $(arg vehicle)_$(arg ID).urdf"/>

    <param command="$(arg cmd)" name="$(arg vehicle)_$(arg ID)_sdf" />

    <node name="sitl_$(arg ID)" pkg="px4" type="px4" output="screen"
        args="$(find px4) $(arg rcS)">
    </node>

    <node name="$(arg vehicle)_$(arg ID)_spawn" output="screen" pkg="gazebo_ros" type="spawn_model"
        args="-sdf -param $(arg vehicle)_$(arg ID)_sdf -model $(arg vehicle)_$(arg ID) -x $(arg x) -y $(arg y) -z $(arg z) -R $(arg R) -P $(arg P) -Y $(arg Y)" respawn="false"/>

</launch>

<!-- vim: set et ft=xml fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : -->

Then, I just made copies of the original urdf file and modified them manually as needed. As you can see, this isn't an ideal method to document. So, my question for you, @TSC21 , is xacro.py maintained by PX4 (or does a certain version ship with PX4)? If that's the case, it seems as though that needs updated and not the docs.

I can provide more details later and perhaps do a pull request but I thought I'd let you know in case you know more about xacro.

TSC21 commented 6 years ago

It actually is used here: https://github.com/PX4/sitl_gazebo/blob/master/CMakeLists.txt#L174-L184, to generate the Iris model.

TSC21 commented 6 years ago

Maybe you can add a way of generating those the same way using the CMakeLists.txt capabilities.

Seiwert commented 6 years ago

@TSC21 I'll take a look at that. For clarification, here is the original error:

Usage: xacro.py [options] <input>

xacro.py: error: expected exactly one input file as argument
while processing /home/aseiwert/src/Firmware/launch/ORIGINAL_single_vehcile_spawn.launch:
Invalid <param> tag: Cannot load command parameter [iris_1_sdf]: command [/opt/ros/kinetic/share/xacro/xacro.py /home/aseiwert/src/Firmware/Tools/sitl_gazebo/models/rotors_description/urdf/iris_base.xacro rotors_description_dir:=/home/aseiwert/src/Firmware/Tools/sitl_gazebo/models/rotors_description mavlink_udp_port:=14560 > iris_1.urdf ; 'gz sdf -p iris_1.urdf'] returned with code [2]. 

Param xml is <param command="$(arg cmd)" name="$(arg vehicle)_$(arg ID)_sdf"/>
The traceback for the exception was written to the log file

Reviewing this again though I don't think the error is with xacro after all. It looks like it's an issue with the concatenation on the 'cmd' argument in the launch file.

Seiwert commented 6 years ago

@TSC21 Okay... I kind of fixed it...

Turns out xacro is fine, so you were right about that. It's something wrong with the launch file incorrectly parsing the command and it's given arguments. If you copy what it tries to run and run it in a separate terminal it works fine. I don't know enough about launch files to say why that is the case.

Anyway, here is what I did:

  1. Create a bash script that runs xacro. Here is my workaround.sh (put it in /src/Firmware/):
    
    # $1 = find px4
    # $2 = vehicle
    # $3 = mavlink_udp_port
    # $4 = ID

rosrun xacro xacro $1/Tools/sitl_gazebo/models/rotors_description/urdf/$2_base.xacro rotors_description_dir:=$1/Tools/sitl_gazebo/models/rotors_description mavlink_udpport:=$3 > $2$4.urdf


2. Then change the `single_vehcile_spawn.launch` to be this:
```xml
<launch>

    <!-- Posix SITL environment launch script -->
    <arg name="x" default="0"/>
    <arg name="y" default="0"/>
    <arg name="z" default="0"/>
    <arg name="R" default="0"/>
    <arg name="P" default="0"/>
    <arg name="Y" default="0"/>
    <arg name="est" default="lpe"/>
    <arg name="vehicle" default="iris"/>
    <arg name="ID" default="1"/>
    <arg name="rcS" default="$(find px4)/posix-configs/SITL/init/$(arg est)/$(arg vehicle)_$(arg ID)"/>
    <arg name="mavlink_udp_port" default="14560" />

    <param name="launchWorkAround" command="rosrun px4 workaround.sh $(find px4) $(arg vehicle) $(arg mavlink_udp_port) $(arg ID)" />

    <arg name="cmd" default="gz sdf -p $(arg vehicle)_$(arg ID).urdf" />

    <param command="$(arg cmd)" name="$(arg vehicle)_$(arg ID)_sdf" />

    <node name="sitl_$(arg ID)" pkg="px4" type="px4" output="screen"
        args="$(find px4) $(arg rcS)">
    </node>

    <node name="$(arg vehicle)_$(arg ID)_spawn" output="screen" pkg="gazebo_ros" type="spawn_model"
        args="-sdf -param $(arg vehicle)_$(arg ID)_sdf -model $(arg vehicle)_$(arg ID) -x $(arg x) -y $(arg y) -z $(arg z) -R $(arg R) -P $(arg P) -Y $(arg Y)" respawn="false"/>

</launch>

<!-- vim: set et ft=xml fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : -->

This is definitely not the right answer but it is something I suppose...

I doubt it is pull worthy for PX4 but let me know what you think.