Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Posix Sitl vehicles don't work correctly #18299

Closed
eldewany opened this issue Sep 27, 2021 · 13 comments
Closed

Posix Sitl vehicles don't work correctly #18299

eldewany opened this issue Sep 27, 2021 · 13 comments
Labels
question 🤖 ROS Sim: SITL software in the loop simulation

Comments

@eldewany
Copy link

Describe the bug
Hello, whenever i use a launch file that is based on posix_sitl.launch to start a SITL instance an uncalibrated sensors error occur in QGC although the normal make px3_sitl gazebo command launches SITL and everything works fine.

To Reproduce
Steps to reproduce the behavior:
1- Source everything needed (PX4, build path and everything)
2- roslaunch px4 mavros_posix_sitl.launch

Expected behavior
Everything should work fine but it isn't, and I verified it's not a mavros problem

Additional context
I Tried to replicate the same method to spawn the sdf file as in spawn_single_vehicle_sdf.launch but something about the xmlstartlet command didn't work

@Jaeyoung-Lim
Copy link
Member

Jaeyoung-Lim commented Sep 30, 2021

Unfortunately, I cannot replicate your problem (see the log below)

Could you share exactly which setup (ROS version, system setup) and the log where the problem occurs?

$ roslaunch px4 mavros_posix_sitl.launch... logging to /home/jaeyoung/.ros/log/0ed483d0-2222-11ec-8325-a4bb6d5c3360/roslaunch-jaeyoung-Precision-3640-Tower-21090.log
Checking log directory for disk usage. This may take a while.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.

started roslaunch server http://jaeyoung-Precision-3640-Tower:35533/

SUMMARY
========

CLEAR PARAMETERS
 * /mavros/

PARAMETERS
 * /gazebo/enable_ros_network: True
 * /mavros/cmd/use_comp_id_system_control: False
 * /mavros/conn/heartbeat_rate: 1.0
 * /mavros/conn/system_time_rate: 1.0
 * /mavros/conn/timeout: 10.0
 * /mavros/conn/timesync_rate: 10.0
 * /mavros/distance_sensor/hrlv_ez4_pub/field_of_view: 0.0
 * /mavros/distance_sensor/hrlv_ez4_pub/frame_id: hrlv_ez4_sonar
 * /mavros/distance_sensor/hrlv_ez4_pub/id: 0
 * /mavros/distance_sensor/hrlv_ez4_pub/orientation: PITCH_270
 * /mavros/distance_sensor/hrlv_ez4_pub/send_tf: True
 * /mavros/distance_sensor/hrlv_ez4_pub/sensor_position/x: 0.0
 * /mavros/distance_sensor/hrlv_ez4_pub/sensor_position/y: 0.0
 * /mavros/distance_sensor/hrlv_ez4_pub/sensor_position/z: -0.1
 * /mavros/distance_sensor/laser_1_sub/id: 3
 * /mavros/distance_sensor/laser_1_sub/orientation: PITCH_270
 * /mavros/distance_sensor/laser_1_sub/subscriber: True
 * /mavros/distance_sensor/lidarlite_pub/field_of_view: 0.0
 * /mavros/distance_sensor/lidarlite_pub/frame_id: lidarlite_laser
 * /mavros/distance_sensor/lidarlite_pub/id: 1
 * /mavros/distance_sensor/lidarlite_pub/orientation: PITCH_270
 * /mavros/distance_sensor/lidarlite_pub/send_tf: True
 * /mavros/distance_sensor/lidarlite_pub/sensor_position/x: 0.0
 * /mavros/distance_sensor/lidarlite_pub/sensor_position/y: 0.0
 * /mavros/distance_sensor/lidarlite_pub/sensor_position/z: -0.1
 * /mavros/distance_sensor/sonar_1_sub/horizontal_fov_ratio: 1.0
 * /mavros/distance_sensor/sonar_1_sub/id: 2
 * /mavros/distance_sensor/sonar_1_sub/orientation: PITCH_270
 * /mavros/distance_sensor/sonar_1_sub/subscriber: True
 * /mavros/distance_sensor/sonar_1_sub/vertical_fov_ratio: 1.0
 * /mavros/fake_gps/eph: 2.0
 * /mavros/fake_gps/epv: 2.0
 * /mavros/fake_gps/fix_type: 3
 * /mavros/fake_gps/geo_origin/alt: 408.0
 * /mavros/fake_gps/geo_origin/lat: 47.3667
 * /mavros/fake_gps/geo_origin/lon: 8.55
 * /mavros/fake_gps/gps_rate: 5.0
 * /mavros/fake_gps/mocap_transform: True
 * /mavros/fake_gps/satellites_visible: 5
 * /mavros/fake_gps/tf/child_frame_id: fix
 * /mavros/fake_gps/tf/frame_id: map
 * /mavros/fake_gps/tf/listen: False
 * /mavros/fake_gps/tf/rate_limit: 10.0
 * /mavros/fake_gps/tf/send: False
 * /mavros/fake_gps/use_mocap: True
 * /mavros/fake_gps/use_vision: False
 * /mavros/fcu_protocol: v2.0
 * /mavros/fcu_url: udp://:14540@loca...
 * /mavros/gcs_url: 
 * /mavros/global_position/child_frame_id: base_link
 * /mavros/global_position/frame_id: map
 * /mavros/global_position/gps_uere: 1.0
 * /mavros/global_position/rot_covariance: 99999.0
 * /mavros/global_position/tf/child_frame_id: base_link
 * /mavros/global_position/tf/frame_id: map
 * /mavros/global_position/tf/global_frame_id: earth
 * /mavros/global_position/tf/send: False
 * /mavros/global_position/use_relative_alt: True
 * /mavros/image/frame_id: px4flow
 * /mavros/imu/angular_velocity_stdev: 0.0003490659 // 0...
 * /mavros/imu/frame_id: base_link
 * /mavros/imu/linear_acceleration_stdev: 0.0003
 * /mavros/imu/magnetic_stdev: 0.0
 * /mavros/imu/orientation_stdev: 1.0
 * /mavros/landing_target/camera/fov_x: 2.0071286398
 * /mavros/landing_target/camera/fov_y: 2.0071286398
 * /mavros/landing_target/image/height: 480
 * /mavros/landing_target/image/width: 640
 * /mavros/landing_target/land_target_type: VISION_FIDUCIAL
 * /mavros/landing_target/listen_lt: False
 * /mavros/landing_target/mav_frame: LOCAL_NED
 * /mavros/landing_target/target_size/x: 0.3
 * /mavros/landing_target/target_size/y: 0.3
 * /mavros/landing_target/tf/child_frame_id: camera_center
 * /mavros/landing_target/tf/frame_id: landing_target
 * /mavros/landing_target/tf/listen: False
 * /mavros/landing_target/tf/rate_limit: 10.0
 * /mavros/landing_target/tf/send: True
 * /mavros/local_position/frame_id: map
 * /mavros/local_position/tf/child_frame_id: base_link
 * /mavros/local_position/tf/frame_id: map
 * /mavros/local_position/tf/send: True
 * /mavros/local_position/tf/send_fcu: False
 * /mavros/mission/pull_after_gcs: True
 * /mavros/mission/use_mission_item_int: True
 * /mavros/mocap/use_pose: True
 * /mavros/mocap/use_tf: False
 * /mavros/odometry/fcu/odom_child_id_des: base_link
 * /mavros/odometry/fcu/odom_parent_id_des: map
 * /mavros/plugin_blacklist: ['safety_area', '...
 * /mavros/plugin_whitelist: []
 * /mavros/px4flow/frame_id: px4flow
 * /mavros/px4flow/ranger_fov: 0.118682
 * /mavros/px4flow/ranger_max_range: 5.0
 * /mavros/px4flow/ranger_min_range: 0.3
 * /mavros/safety_area/p1/x: 1.0
 * /mavros/safety_area/p1/y: 1.0
 * /mavros/safety_area/p1/z: 1.0
 * /mavros/safety_area/p2/x: -1.0
 * /mavros/safety_area/p2/y: -1.0
 * /mavros/safety_area/p2/z: -1.0
 * /mavros/setpoint_accel/send_force: False
 * /mavros/setpoint_attitude/reverse_thrust: False
 * /mavros/setpoint_attitude/tf/child_frame_id: target_attitude
 * /mavros/setpoint_attitude/tf/frame_id: map
 * /mavros/setpoint_attitude/tf/listen: False
 * /mavros/setpoint_attitude/tf/rate_limit: 50.0
 * /mavros/setpoint_attitude/use_quaternion: False
 * /mavros/setpoint_position/mav_frame: LOCAL_NED
 * /mavros/setpoint_position/tf/child_frame_id: target_position
 * /mavros/setpoint_position/tf/frame_id: map
 * /mavros/setpoint_position/tf/listen: False
 * /mavros/setpoint_position/tf/rate_limit: 50.0
 * /mavros/setpoint_raw/thrust_scaling: 1.0
 * /mavros/setpoint_velocity/mav_frame: LOCAL_NED
 * /mavros/startup_px4_usb_quirk: True
 * /mavros/sys/disable_diag: False
 * /mavros/sys/min_voltage: 10.0
 * /mavros/target_component_id: 1
 * /mavros/target_system_id: 1
 * /mavros/tdr_radio/low_rssi: 40
 * /mavros/time/time_ref_source: fcu
 * /mavros/time/timesync_avg_alpha: 0.6
 * /mavros/time/timesync_mode: MAVLINK
 * /mavros/vibration/frame_id: base_link
 * /mavros/vision_pose/tf/child_frame_id: vision_estimate
 * /mavros/vision_pose/tf/frame_id: odom
 * /mavros/vision_pose/tf/listen: False
 * /mavros/vision_pose/tf/rate_limit: 10.0
 * /mavros/vision_speed/listen_twist: True
 * /mavros/vision_speed/twist_cov: True
 * /mavros/wheel_odometry/child_frame_id: base_link
 * /mavros/wheel_odometry/count: 2
 * /mavros/wheel_odometry/frame_id: odom
 * /mavros/wheel_odometry/send_raw: True
 * /mavros/wheel_odometry/send_twist: False
 * /mavros/wheel_odometry/tf/child_frame_id: base_link
 * /mavros/wheel_odometry/tf/frame_id: odom
 * /mavros/wheel_odometry/tf/send: False
 * /mavros/wheel_odometry/use_rpm: False
 * /mavros/wheel_odometry/vel_error: 0.1
 * /mavros/wheel_odometry/wheel0/radius: 0.05
 * /mavros/wheel_odometry/wheel0/x: 0.0
 * /mavros/wheel_odometry/wheel0/y: -0.15
 * /mavros/wheel_odometry/wheel1/radius: 0.05
 * /mavros/wheel_odometry/wheel1/x: 0.0
 * /mavros/wheel_odometry/wheel1/y: 0.15
 * /rosdistro: melodic
 * /rosversion: 1.14.11
 * /use_sim_time: True

NODES
  /
    gazebo (gazebo_ros/gzserver)
    gazebo_gui (gazebo_ros/gzclient)
    mavros (mavros/mavros_node)
    sitl (px4/px4)
    vehicle_spawn_jaeyoung_Precision_3640_Tower_21090_2539799710739276773 (gazebo_ros/spawn_model)

auto-starting new master
process[master]: started with pid [21101]
ROS_MASTER_URI=http://localhost:11311

setting /run_id to 0ed483d0-2222-11ec-8325-a4bb6d5c3360
process[rosout-1]: started with pid [21114]
started core service [/rosout]
process[sitl-2]: started with pid [21122]
Creating symlink /home/jaeyoung/src/PX4-Autopilot/build/px4_sitl_default/etc -> /home/jaeyoung/.ros/etc

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

px4 starting.

INFO  [px4] Calling startup script: /bin/sh etc/init.d-posix/rcS 0
INFO  [init] found model autostart file as SYS_AUTOSTART=10016
process[gazebo-3]: started with pid [21138]
INFO  [param] selected parameter default file eeprom/parameters_10016
INFO  [parameters] BSON document size 470 bytes, decoded 470 bytes
[param] Loaded: eeprom/parameters_10016
process[gazebo_gui-4]: started with pid [21148]
process[vehicle_spawn_jaeyoung_Precision_3640_Tower_21090_2539799710739276773-5]: started with pid [21159]
process[mavros-6]: started with pid [21170]
INFO  [dataman] data manager file './dataman' size is 11798680 bytes
PX4 SIM HOST: localhost
INFO  [simulator] Waiting for simulator to accept connection on TCP port 4560
[ INFO] [1633029022.307944355]: FCU URL: udp://:14540@localhost:14557
[ INFO] [1633029022.309463487]: udp0: Bind address: 0.0.0.0:14540
[ INFO] [1633029022.309528552]: udp0: Remote address: 127.0.0.1:14557
[ INFO] [1633029022.309608664]: GCS bridge disabled
[ INFO] [1633029022.322977425]: Plugin 3dr_radio loaded
[ INFO] [1633029022.323769114]: Plugin 3dr_radio initialized
[ INFO] [1633029022.323818696]: Plugin actuator_control loaded
[ INFO] [1633029022.325263651]: Plugin actuator_control initialized
[ INFO] [1633029022.325308780]: Plugin altitude loaded
[ INFO] [1633029022.325693912]: Plugin altitude initialized
[ INFO] [1633029022.325742468]: Plugin command loaded
[ INFO] [1633029022.328127018]: Plugin command initialized
[ INFO] [1633029022.328181423]: Plugin ftp loaded
[ INFO] [1633029022.330808371]: Plugin ftp initialized
[ INFO] [1633029022.330859885]: Plugin geofence loaded
[ INFO] [1633029022.332125977]: Plugin geofence initialized
[ INFO] [1633029022.332178849]: Plugin global_position loaded
[ INFO] [1633029022.338494247]: Plugin global_position initialized
[ INFO] [1633029022.338544507]: Plugin hil loaded
[ INFO] [1633029022.343569191]: Plugin hil initialized
[ INFO] [1633029022.343624239]: Plugin home_position loaded
[ INFO] [1633029022.345006475]: Plugin home_position initialized
[ INFO] [1633029022.345058038]: Plugin imu loaded
[ INFO] [1633029022.348031796]: Plugin imu initialized
[ INFO] [1633029022.348086053]: Plugin local_position loaded
[ INFO] [1633029022.351012451]: Plugin local_position initialized
[ INFO] [1633029022.351080142]: Plugin manual_control loaded
[ INFO] [1633029022.352252718]: Plugin manual_control initialized
[ INFO] [1633029022.352313111]: Plugin param loaded
[ INFO] [1633029022.353423731]: Plugin param initialized
[ INFO] [1633029022.353474068]: Plugin rallypoint loaded
[ INFO] [1633029022.354640724]: Plugin rallypoint initialized
[ INFO] [1633029022.354692925]: Plugin rc_io loaded
[ INFO] [1633029022.356078239]: Plugin rc_io initialized
[ INFO] [1633029022.356101455]: Plugin safety_area blacklisted
[ INFO] [1633029022.356147065]: Plugin setpoint_accel loaded
[ INFO] [1633029022.357365898]: Plugin setpoint_accel initialized
[ INFO] [1633029022.357427306]: Plugin setpoint_attitude loaded
[ INFO] [1633029022.361231700]: Plugin setpoint_attitude initialized
[ INFO] [1633029022.361292761]: Plugin setpoint_position loaded
[ INFO] [1633029022.367481422]: Plugin setpoint_position initialized
[ INFO] [1633029022.367543701]: Plugin setpoint_raw loaded
[ INFO] [1633029022.371677902]: Plugin setpoint_raw initialized
[ INFO] [1633029022.371735974]: Plugin setpoint_trajectory loaded
[ INFO] [1633029022.373633559]: Plugin setpoint_trajectory initialized
[ INFO] [1633029022.373693618]: Plugin setpoint_velocity loaded
[ INFO] [1633029022.375913593]: Plugin setpoint_velocity initialized
[ INFO] [1633029022.375981646]: Plugin sys_status loaded
[ INFO] [1633029022.380012271]: Plugin sys_status initialized
[ INFO] [1633029022.380060909]: Plugin sys_time loaded
[ INFO] [1633029022.382176375]: TM: Timesync mode: MAVLINK
[ INFO] [1633029022.382663851]: Plugin sys_time initialized
[ INFO] [1633029022.382716560]: Plugin vfr_hud loaded
[ INFO] [1633029022.382959137]: Plugin vfr_hud initialized
[ INFO] [1633029022.383010366]: Plugin waypoint loaded
[ INFO] [1633029022.384902154]: Plugin waypoint initialized
[ INFO] [1633029022.384948650]: Plugin wind_estimation loaded
[ INFO] [1633029022.385187225]: Plugin wind_estimation initialized
[ INFO] [1633029022.385213233]: Autostarting mavlink via USB on PX4
[ INFO] [1633029022.385243110]: Built-in SIMD instructions: SSE, SSE2
[ INFO] [1633029022.385258939]: Built-in MAVLink package version: 2021.3.3
[ INFO] [1633029022.385276996]: Known MAVLink dialects: common ardupilotmega ASLUAV all autoquad icarous matrixpilot paparazzi standard uAvionix ualberta
[ INFO] [1633029022.385293050]: MAVROS started. MY ID 1.240, TARGET ID 1.1
[ INFO] [1633029022.462993709]: Finished loading Gazebo ROS API Plugin.
[ INFO] [1633029022.463855322]: waitForService: Service [/gazebo/set_physics_properties] has not been advertised, waiting...
[ INFO] [1633029022.494966614]: Finished loading Gazebo ROS API Plugin.
[ INFO] [1633029022.496309712]: waitForService: Service [/gazebo_gui/set_physics_properties] has not been advertised, waiting...
[INFO] [1633029022.825004, 0.000000]: Loading model XML from file /home/jaeyoung/src/PX4-Autopilot/Tools/sitl_gazebo/models/iris/iris.sdf
[INFO] [1633029022.830036, 0.000000]: Waiting for service /gazebo/spawn_sdf_model
[ INFO] [1633029023.214151210]: waitForService: Service [/gazebo/set_physics_properties] is now available.
[ INFO] [1633029023.225399308, 0.012000000]: Physics dynamic reconfigure ready.
[INFO] [1633029023.435201, 0.220000]: Calling service /gazebo/spawn_sdf_model
[INFO] [1633029023.639098, 0.380000]: Spawn status: SpawnModel: Successfully spawned entity
INFO  [simulator] Simulator connected on TCP port 4560.
INFO  [commander] LED: open /dev/led0 failed (22)
[vehicle_spawn_jaeyoung_Precision_3640_Tower_21090_2539799710739276773-5] process has finished cleanly
log file: /home/jaeyoung/.ros/log/0ed483d0-2222-11ec-8325-a4bb6d5c3360/vehicle_spawn_jaeyoung_Precision_3640_Tower_21090_2539799710739276773-5*.log
INFO  [init] Mixer: etc/mixers/quad_w.main.mix on /dev/pwm_output0
INFO  [init] setting PWM_AUX_OUT none
INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 18570 remote port 14550
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14580 remote port 14540
INFO  [mavlink] mode: Onboard, data rate: 4000 B/s on udp port 14280 remote port 14030
INFO  [mavlink] mode: Gimbal, data rate: 400000 B/s on udp port 13030 remote port 13280
INFO  [logger] logger started (mode=all)
INFO  [logger] removing log directory ./log/2021-09-24 to get more space (left=11270 MiB)
INFO  [mavlink] MAVLink only on localhost (set param MAV_{i}_BROADCAST = 1 to enable network)
INFO  [mavlink] MAVLink only on localhost (set param MAV_{i}_BROADCAST = 1 to enable network)
[ INFO] [1633029023.933143108, 0.548000000]: udp0: Remote address: 127.0.0.1:14580
[ INFO] [1633029023.933228715, 0.548000000]: IMU: High resolution IMU detected!
INFO  [logger] removing log directory ./log/10000-99-99 to get more space (left=11306 MiB)
ERROR [logger] Failed to delete directory
INFO  [logger] Start file log (type: full)
INFO  [logger] [logger] ./log/2021-09-30/19_10_23.ulg	
INFO  [logger] Opened full log file: ./log/2021-09-30/19_10_23.ulg
INFO  [px4] Startup script returned successfully
pxh> INFO  [mavlink] partner IP: 127.0.0.1
[ INFO] [1633029024.915576115, 1.528000000]: CON: Got HEARTBEAT, connected. FCU: PX4 Autopilot
[ INFO] [1633029024.916472384, 1.528000000]: IMU: High resolution IMU detected!
[ INFO] [1633029025.926228219, 2.536000000]: GF: Using MISSION_ITEM_INT
[ INFO] [1633029025.926258023, 2.536000000]: RP: Using MISSION_ITEM_INT
[ INFO] [1633029025.926272803, 2.536000000]: WP: Using MISSION_ITEM_INT
[ INFO] [1633029025.926288402, 2.536000000]: VER: 1.1: Capabilities         0x000000000000e4ef
[ INFO] [1633029025.926301576, 2.536000000]: VER: 1.1: Flight software:     010d0040 (86da9893e8000000)
[ INFO] [1633029025.926310491, 2.536000000]: VER: 1.1: Middleware software: 010d0040 (86da9893e8000000)
[ INFO] [1633029025.926321248, 2.536000000]: VER: 1.1: OS software:         050400ff (ca1938fbcccc1a0a)
[ INFO] [1633029025.926331061, 2.536000000]: VER: 1.1: Board hardware:      00000001
[ INFO] [1633029025.926343427, 2.536000000]: VER: 1.1: VID/PID:             0000:0000
[ INFO] [1633029025.926353879, 2.536000000]: VER: 1.1: UID:                 4954414c44494e4f
[ INFO] [1633029028.467661909, 5.076000000]: IMU: Attitude quaternion IMU detected!
INFO  [tone_alarm] home set
INFO  [tone_alarm] notify negative
[ INFO] [1633029039.934814344, 16.528000000]: RP: mission received
[ INFO] [1633029039.934865972, 16.528000000]: WP: mission received
[ INFO] [1633029039.934901095, 16.528000000]: GF: mission received

@eldewany
Copy link
Author

eldewany commented Oct 3, 2021

@Jaeyoung-Lim sorry for the delay, here's my log

eldewany@eldewany-Alienware-17-R3:~$ ./launch-2.sh 
[0/4] Performing build step for 'sitl_gazebo'
ninja: no work to do.
[3/4] cd /home/eldewany/PX4-Autopilot/...y/PX4-Autopilot/build/px4_sitl_default
Not running simulation (DONT_RUN is set).
GAZEBO_PLUGIN_PATH :/home/eldewany/Desktop/PX4-Autopilot/build/px4_sitl_default/build_gazebo:/home/eldewany/Desktop/PX4-Autopilot/build/px4_sitl_default/build_gazebo
GAZEBO_MODEL_PATH /home/eldewany/Desktop/PX4-Autopilot/Tools/sitl_gazebo/models::/home/eldewany/Desktop/PX4-Autopilot/Tools/sitl_gazebo/models
LD_LIBRARY_PATH /home/eldewany/catkin_ws2/devel/lib:/home/eldewany/catkin_ws/devel/lib:/opt/ros/melodic/lib:/home/eldewany/Desktop/PX4-Autopilot/build/px4_sitl_default/build_gazebo
... logging to /home/eldewany/.ros/log/ed5626aa-245b-11ec-be8e-9cb6d00dd7bf/roslaunch-eldewany-Alienware-17-R3-20435.log
Checking log directory for disk usage. This may take a while.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.

started roslaunch server http://eldewany-Alienware-17-R3:34211/

SUMMARY
========

CLEAR PARAMETERS
 * /mavros/

PARAMETERS
 * /gazebo/enable_ros_network: True
 * /mavros/cmd/use_comp_id_system_control: False
 * /mavros/conn/heartbeat_rate: 1.0
 * /mavros/conn/system_time_rate: 1.0
 * /mavros/conn/timeout: 10.0
 * /mavros/conn/timesync_rate: 10.0
 * /mavros/distance_sensor/hrlv_ez4_pub/field_of_view: 0.0
 * /mavros/distance_sensor/hrlv_ez4_pub/frame_id: hrlv_ez4_sonar
 * /mavros/distance_sensor/hrlv_ez4_pub/id: 0
 * /mavros/distance_sensor/hrlv_ez4_pub/orientation: PITCH_270
 * /mavros/distance_sensor/hrlv_ez4_pub/send_tf: True
 * /mavros/distance_sensor/hrlv_ez4_pub/sensor_position/x: 0.0
 * /mavros/distance_sensor/hrlv_ez4_pub/sensor_position/y: 0.0
 * /mavros/distance_sensor/hrlv_ez4_pub/sensor_position/z: -0.1
 * /mavros/distance_sensor/laser_1_sub/id: 3
 * /mavros/distance_sensor/laser_1_sub/orientation: PITCH_270
 * /mavros/distance_sensor/laser_1_sub/subscriber: True
 * /mavros/distance_sensor/lidarlite_pub/field_of_view: 0.0
 * /mavros/distance_sensor/lidarlite_pub/frame_id: lidarlite_laser
 * /mavros/distance_sensor/lidarlite_pub/id: 1
 * /mavros/distance_sensor/lidarlite_pub/orientation: PITCH_270
 * /mavros/distance_sensor/lidarlite_pub/send_tf: True
 * /mavros/distance_sensor/lidarlite_pub/sensor_position/x: 0.0
 * /mavros/distance_sensor/lidarlite_pub/sensor_position/y: 0.0
 * /mavros/distance_sensor/lidarlite_pub/sensor_position/z: -0.1
 * /mavros/distance_sensor/sonar_1_sub/horizontal_fov_ratio: 1.0
 * /mavros/distance_sensor/sonar_1_sub/id: 2
 * /mavros/distance_sensor/sonar_1_sub/orientation: PITCH_270
 * /mavros/distance_sensor/sonar_1_sub/subscriber: True
 * /mavros/distance_sensor/sonar_1_sub/vertical_fov_ratio: 1.0
 * /mavros/fake_gps/eph: 2.0
 * /mavros/fake_gps/epv: 2.0
 * /mavros/fake_gps/fix_type: 3
 * /mavros/fake_gps/geo_origin/alt: 408.0
 * /mavros/fake_gps/geo_origin/lat: 47.3667
 * /mavros/fake_gps/geo_origin/lon: 8.55
 * /mavros/fake_gps/gps_rate: 5.0
 * /mavros/fake_gps/mocap_transform: True
 * /mavros/fake_gps/satellites_visible: 5
 * /mavros/fake_gps/tf/child_frame_id: fix
 * /mavros/fake_gps/tf/frame_id: map
 * /mavros/fake_gps/tf/listen: False
 * /mavros/fake_gps/tf/rate_limit: 10.0
 * /mavros/fake_gps/tf/send: False
 * /mavros/fake_gps/use_mocap: True
 * /mavros/fake_gps/use_vision: False
 * /mavros/fcu_protocol: v2.0
 * /mavros/fcu_url: udp://:14540@loca...
 * /mavros/gcs_url: 
 * /mavros/global_position/child_frame_id: base_link
 * /mavros/global_position/frame_id: map
 * /mavros/global_position/gps_uere: 1.0
 * /mavros/global_position/rot_covariance: 99999.0
 * /mavros/global_position/tf/child_frame_id: base_link
 * /mavros/global_position/tf/frame_id: map
 * /mavros/global_position/tf/global_frame_id: earth
 * /mavros/global_position/tf/send: True
 * /mavros/global_position/use_relative_alt: True
 * /mavros/image/frame_id: px4flow
 * /mavros/imu/angular_velocity_stdev: 0.0003490659 // 0...
 * /mavros/imu/frame_id: base_link
 * /mavros/imu/linear_acceleration_stdev: 0.0003
 * /mavros/imu/magnetic_stdev: 0.0
 * /mavros/imu/orientation_stdev: 1.0
 * /mavros/landing_target/camera/fov_x: 2.0071286398
 * /mavros/landing_target/camera/fov_y: 2.0071286398
 * /mavros/landing_target/image/height: 480
 * /mavros/landing_target/image/width: 640
 * /mavros/landing_target/land_target_type: VISION_FIDUCIAL
 * /mavros/landing_target/listen_lt: False
 * /mavros/landing_target/mav_frame: LOCAL_NED
 * /mavros/landing_target/target_size/x: 0.3
 * /mavros/landing_target/target_size/y: 0.3
 * /mavros/landing_target/tf/child_frame_id: camera_center
 * /mavros/landing_target/tf/frame_id: landing_target
 * /mavros/landing_target/tf/listen: False
 * /mavros/landing_target/tf/rate_limit: 10.0
 * /mavros/landing_target/tf/send: True
 * /mavros/local_position/frame_id: map
 * /mavros/local_position/tf/child_frame_id: base_link
 * /mavros/local_position/tf/frame_id: map
 * /mavros/local_position/tf/send: False
 * /mavros/local_position/tf/send_fcu: False
 * /mavros/mission/pull_after_gcs: True
 * /mavros/mission/use_mission_item_int: True
 * /mavros/mocap/use_pose: True
 * /mavros/mocap/use_tf: False
 * /mavros/odometry/fcu/odom_child_id_des: base_link
 * /mavros/odometry/fcu/odom_parent_id_des: map
 * /mavros/plugin_blacklist: ['safety_area', '...
 * /mavros/plugin_whitelist: []
 * /mavros/px4flow/frame_id: px4flow
 * /mavros/px4flow/ranger_fov: 0.118682
 * /mavros/px4flow/ranger_max_range: 5.0
 * /mavros/px4flow/ranger_min_range: 0.3
 * /mavros/safety_area/p1/x: 1.0
 * /mavros/safety_area/p1/y: 1.0
 * /mavros/safety_area/p1/z: 1.0
 * /mavros/safety_area/p2/x: -1.0
 * /mavros/safety_area/p2/y: -1.0
 * /mavros/safety_area/p2/z: -1.0
 * /mavros/setpoint_accel/send_force: False
 * /mavros/setpoint_attitude/reverse_thrust: False
 * /mavros/setpoint_attitude/tf/child_frame_id: target_attitude
 * /mavros/setpoint_attitude/tf/frame_id: map
 * /mavros/setpoint_attitude/tf/listen: False
 * /mavros/setpoint_attitude/tf/rate_limit: 50.0
 * /mavros/setpoint_attitude/use_quaternion: False
 * /mavros/setpoint_position/mav_frame: LOCAL_NED
 * /mavros/setpoint_position/tf/child_frame_id: target_position
 * /mavros/setpoint_position/tf/frame_id: map
 * /mavros/setpoint_position/tf/listen: False
 * /mavros/setpoint_position/tf/rate_limit: 50.0
 * /mavros/setpoint_raw/thrust_scaling: 1.0
 * /mavros/setpoint_velocity/mav_frame: LOCAL_NED
 * /mavros/startup_px4_usb_quirk: True
 * /mavros/sys/disable_diag: False
 * /mavros/sys/min_voltage: 10.0
 * /mavros/target_component_id: 1
 * /mavros/target_system_id: 1
 * /mavros/tdr_radio/low_rssi: 40
 * /mavros/time/time_ref_source: fcu
 * /mavros/time/timesync_avg_alpha: 0.6
 * /mavros/time/timesync_mode: MAVLINK
 * /mavros/vibration/frame_id: base_link
 * /mavros/vision_pose/tf/child_frame_id: vision_estimate
 * /mavros/vision_pose/tf/frame_id: odom
 * /mavros/vision_pose/tf/listen: False
 * /mavros/vision_pose/tf/rate_limit: 10.0
 * /mavros/vision_speed/listen_twist: True
 * /mavros/vision_speed/twist_cov: True
 * /mavros/wheel_odometry/child_frame_id: base_link
 * /mavros/wheel_odometry/count: 2
 * /mavros/wheel_odometry/frame_id: odom
 * /mavros/wheel_odometry/send_raw: True
 * /mavros/wheel_odometry/send_twist: False
 * /mavros/wheel_odometry/tf/child_frame_id: base_link
 * /mavros/wheel_odometry/tf/frame_id: odom
 * /mavros/wheel_odometry/tf/send: False
 * /mavros/wheel_odometry/use_rpm: False
 * /mavros/wheel_odometry/vel_error: 0.1
 * /mavros/wheel_odometry/wheel0/radius: 0.05
 * /mavros/wheel_odometry/wheel0/x: 0.0
 * /mavros/wheel_odometry/wheel0/y: -0.15
 * /mavros/wheel_odometry/wheel1/radius: 0.05
 * /mavros/wheel_odometry/wheel1/x: 0.0
 * /mavros/wheel_odometry/wheel1/y: 0.15
 * /rosdistro: melodic
 * /rosversion: 1.14.11
 * /use_sim_time: True

NODES
  /
    gazebo (gazebo_ros/gzserver)
    gazebo_gui (gazebo_ros/gzclient)
    mavros (mavros/mavros_node)
    sitl (px4/px4)
    vehicle_spawn_eldewany_Alienware_17_R3_20435_7047533285771512973 (gazebo_ros/spawn_model)

auto-starting new master
process[master]: started with pid [20452]
ROS_MASTER_URI=http://localhost:11311

setting /run_id to ed5626aa-245b-11ec-be8e-9cb6d00dd7bf
process[rosout-1]: started with pid [20470]
started core service [/rosout]
process[sitl-2]: started with pid [20478]
Creating symlink /home/eldewany/Desktop/PX4-Autopilot/build/px4_sitl_default/etc -> /home/eldewany/.ros/etc
process[gazebo-3]: started with pid [20479]
process[gazebo_gui-4]: started with pid [20484]

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

px4 starting.

INFO  [px4] Calling startup script: /bin/sh etc/init.d-posix/rcS 0
process[vehicle_spawn_eldewany_Alienware_17_R3_20435_7047533285771512973-5]: started with pid [20489]
INFO  [init] found model autostart file as SYS_AUTOSTART=10016
INFO  [param] selected parameter default file eeprom/parameters_10016
process[mavros-6]: started with pid [20506]
WARN  [parameters] ignoring unrecognised parameter 'EKF2_MAGBIAS_ID'
WARN  [parameters] ignoring unrecognised parameter 'EKF2_MAGBIAS_X'
WARN  [parameters] ignoring unrecognised parameter 'EKF2_MAGBIAS_Y'
WARN  [parameters] ignoring unrecognised parameter 'EKF2_MAGBIAS_Z'
INFO  [parameters] BSON document size 0 bytes, decoded 1312 bytes
[param] Loaded: eeprom/parameters_10016
[ INFO] [1633273779.425374275]: FCU URL: udp://:14540@localhost:14557
[ INFO] [1633273779.428927241]: udp0: Bind address: 0.0.0.0:14540
[ INFO] [1633273779.429046218]: udp0: Remote address: 127.0.0.1:14557
[ INFO] [1633273779.429326748]: GCS bridge disabled
[ INFO] [1633273779.443702682]: Plugin 3dr_radio loaded
[ INFO] [1633273779.445574754]: Plugin 3dr_radio initialized
[ INFO] [1633273779.445720277]: Plugin actuator_control loaded
[ INFO] [1633273779.448736838]: Plugin actuator_control initialized
INFO  [dataman] data manager file './dataman' size is 11798680 bytes
[ INFO] [1633273779.454937963]: Plugin adsb loaded
PX4 SIM HOST: localhost
[ INFO] [1633273779.458276207]: Plugin adsb initialized
[ INFO] [1633273779.458560476]: Plugin altitude loaded
[ INFO] [1633273779.459987061]: Plugin altitude initialized
[ INFO] [1633273779.460202004]: Plugin cam_imu_sync loaded
[ INFO] [1633273779.460922090]: Plugin cam_imu_sync initialized
[ INFO] [1633273779.461141023]: Plugin command loaded
INFO  [simulator] Waiting for simulator to accept connection on TCP port 4560
[ INFO] [1633273779.468526073]: Plugin command initialized
[ INFO] [1633273779.468753420]: Plugin companion_process_status loaded
[ INFO] [1633273779.471083377]: Plugin companion_process_status initialized
[ INFO] [1633273779.471277554]: Plugin debug_value loaded
[ INFO] [1633273779.477293329]: Plugin debug_value initialized
[ INFO] [1633273779.477417102]: Plugin distance_sensor blacklisted
[ INFO] [1633273779.477647809]: Plugin esc_status loaded
[ INFO] [1633273779.479001930]: Plugin esc_status initialized
[ INFO] [1633273779.479223074]: Plugin esc_telemetry loaded
[ INFO] [1633273779.480049182]: Plugin esc_telemetry initialized
[ INFO] [1633273779.480260969]: Plugin fake_gps loaded
[ INFO] [1633273779.495679520]: Plugin fake_gps initialized
[ INFO] [1633273779.495945874]: Plugin ftp loaded
[ INFO] [1633273779.504197746]: Plugin ftp initialized
[ INFO] [1633273779.504460566]: Plugin geofence loaded
[ INFO] [1633273779.508529427]: Plugin geofence initialized
[ INFO] [1633273779.508834526]: Plugin global_position loaded
[ INFO] [1633273779.525613191]: Plugin global_position initialized
[ INFO] [1633273779.525821081]: Plugin gps_input loaded
[ INFO] [1633273779.528406593]: Plugin gps_input initialized
[ INFO] [1633273779.528574798]: Plugin gps_rtk loaded
[ INFO] [1633273779.531660172]: Plugin gps_rtk initialized
[ INFO] [1633273779.531784095]: Plugin gps_status loaded
[ INFO] [1633273779.534134927]: Plugin gps_status initialized
[ INFO] [1633273779.534267349]: Plugin hil loaded
[ INFO] [1633273779.547136717]: Plugin hil initialized
[ INFO] [1633273779.547371744]: Plugin home_position loaded
[ INFO] [1633273779.550973494]: Plugin home_position initialized
[ INFO] [1633273779.551192912]: Plugin imu loaded
[ INFO] [1633273779.559216255]: Plugin imu initialized
[ INFO] [1633273779.559369666]: Plugin landing_target loaded
[ INFO] [1633273779.573336840]: Plugin landing_target initialized
[ INFO] [1633273779.573499826]: Plugin local_position loaded
[ INFO] [1633273779.581588825]: Plugin local_position initialized
[ INFO] [1633273779.581816775]: Plugin log_transfer loaded
[ INFO] [1633273779.585534541]: Plugin log_transfer initialized
[ INFO] [1633273779.585763045]: Plugin mag_calibration_status loaded
[ INFO] [1633273779.587103418]: Plugin mag_calibration_status initialized
[ INFO] [1633273779.587333402]: Plugin manual_control loaded
[ INFO] [1633273779.590231937]: Plugin manual_control initialized
[ INFO] [1633273779.590444516]: Plugin mocap_pose_estimate loaded
[ INFO] [1633273779.594585094]: Plugin mocap_pose_estimate initialized
[ INFO] [1633273779.594845282]: Plugin mount_control loaded
[ INFO] [1633273779.599225849]: Plugin mount_control initialized
[ INFO] [1633273779.599481879]: Plugin nav_controller_output loaded
[ INFO] [1633273779.600283349]: Plugin nav_controller_output initialized
[ INFO] [1633273779.600476781]: Plugin obstacle_distance loaded
[ INFO] [1633273779.602682282]: Plugin obstacle_distance initialized
[ INFO] [1633273779.602902010]: Plugin odom loaded
[ INFO] [1633273779.606396804]: Plugin odom initialized
[ INFO] [1633273779.606602491]: Plugin onboard_computer_status loaded
[ INFO] [1633273779.608740551]: Plugin onboard_computer_status initialized
[ INFO] [1633273779.609130960]: Plugin param loaded
[ INFO] [1633273779.612387044]: Plugin param initialized
[ INFO] [1633273779.612593821]: Plugin play_tune loaded
[ INFO] [1633273779.614295030]: Plugin play_tune initialized
[ INFO] [1633273779.614469020]: Plugin px4flow loaded
[ INFO] [1633273779.619068135]: Plugin px4flow initialized
[ INFO] [1633273779.619228161]: Plugin rallypoint loaded
[ INFO] [1633273779.621360377]: Plugin rallypoint initialized
[ INFO] [1633273779.621400053]: Plugin rangefinder blacklisted
[ INFO] [1633273779.621592303]: Plugin rc_io loaded
[ INFO] [1633273779.624121775]: Plugin rc_io initialized
[ INFO] [1633273779.624165839]: Plugin safety_area blacklisted
[ INFO] [1633273779.624315667]: Plugin setpoint_accel loaded
[ INFO] [1633273779.627167550]: Plugin setpoint_accel initialized
[ INFO] [1633273779.627512716]: Plugin setpoint_attitude loaded
[ INFO] [1633273779.638328659]: Plugin setpoint_attitude initialized
[ INFO] [1633273779.638535001]: Plugin setpoint_position loaded
[ INFO] [1633273779.649840751]: Plugin setpoint_position initialized
[ INFO] [1633273779.650085816]: Plugin setpoint_raw loaded
[ INFO] [1633273779.657570094]: Plugin setpoint_raw initialized
[ INFO] [1633273779.657750191]: Plugin setpoint_trajectory loaded
[ INFO] [1633273779.664485172]: Plugin setpoint_trajectory initialized
[ INFO] [1633273779.664689847]: Plugin setpoint_velocity loaded
[ INFO] [1633273779.670744464]: Plugin setpoint_velocity initialized
[ INFO] [1633273779.670948988]: Plugin swing_angles loaded
[ INFO] [1633273779.673441560]: Plugin swing_angles initialized
[ INFO] [1633273779.673788794]: Plugin sys_status loaded
[ INFO] [1633273779.682239212]: Plugin sys_status initialized
[ INFO] [1633273779.682410686]: Plugin sys_time loaded
[ INFO] [1633273779.685758147]: TM: Timesync mode: MAVLINK
[ INFO] [1633273779.686643318]: Plugin sys_time initialized
[ INFO] [1633273779.686779281]: Plugin trajectory loaded
[ INFO] [1633273779.690474303]: Plugin trajectory initialized
[ INFO] [1633273779.690648761]: Plugin vfr_hud loaded
[ INFO] [1633273779.691164006]: Plugin vfr_hud initialized
[ INFO] [1633273779.691199519]: Plugin vibration blacklisted
[ INFO] [1633273779.691324996]: Plugin vision_pose_estimate loaded
[ INFO] [1633273779.696019222]: Plugin vision_pose_estimate initialized
[ INFO] [1633273779.696175069]: Plugin vision_speed_estimate loaded
[ INFO] [1633273779.699743788]: Plugin vision_speed_estimate initialized
[ INFO] [1633273779.699941646]: Plugin waypoint loaded
[ INFO] [1633273779.705221955]: Plugin waypoint initialized
[ INFO] [1633273779.705275209]: Plugin wheel_odometry blacklisted
[ INFO] [1633273779.705412882]: Plugin wind_estimation loaded
[ INFO] [1633273779.706187382]: Plugin wind_estimation initialized
[ INFO] [1633273779.706228229]: Autostarting mavlink via USB on PX4
[ INFO] [1633273779.706375414]: Built-in SIMD instructions: SSE, SSE2
[ INFO] [1633273779.706398385]: Built-in MAVLink package version: 2021.3.3
[ INFO] [1633273779.706423512]: Known MAVLink dialects: common ardupilotmega ASLUAV all autoquad icarous matrixpilot paparazzi standard uAvionix ualberta
[ INFO] [1633273779.706450330]: MAVROS started. MY ID 1.240, TARGET ID 1.1
[ INFO] [1633273779.916497684]: Finished loading Gazebo ROS API Plugin.
[ INFO] [1633273779.917854129]: waitForService: Service [/gazebo/set_physics_properties] has not been advertised, waiting...
[ INFO] [1633273779.941034495]: Finished loading Gazebo ROS API Plugin.
[ INFO] [1633273779.943929422]: waitForService: Service [/gazebo_gui/set_physics_properties] has not been advertised, waiting...
[INFO] [1633273780.244806, 0.000000]: Loading model XML from file /home/eldewany/Desktop/PX4-Autopilot/Tools/sitl_gazebo/models/iris/iris.sdf
[INFO] [1633273780.251222, 0.000000]: Waiting for service /gazebo/spawn_sdf_model
[ INFO] [1633273780.296436449]: waitForService: Service [/gazebo/set_physics_properties] is now available.
[ INFO] [1633273780.314417736, 0.016000000]: Physics dynamic reconfigure ready.
[INFO] [1633273780.554146, 0.248000]: Calling service /gazebo/spawn_sdf_model
[INFO] [1633273780.828701, 0.360000]: Spawn status: SpawnModel: Successfully spawned entity
INFO  [simulator] Simulator connected on TCP port 4560.
INFO  [commander] Mission #2 loaded, 5 WPs, curr: 4
INFO  [commander] LED: open /dev/led0 failed (22)
  PWM_AUX_OUT: curr: 0 -> new: 1234
INFO  [init] Mixer: etc/mixers/quad_w.main.mix on /dev/pwm_output0
INFO  [init] setting PWM_AUX_OUT none
INFO  [mavlink] mode: Normal, data rate: 4000000 B/s on udp port 18570 remote port 14550
[vehicle_spawn_eldewany_Alienware_17_R3_20435_7047533285771512973-5] process has finished cleanly
log file: /home/eldewany/.ros/log/ed5626aa-245b-11ec-be8e-9cb6d00dd7bf/vehicle_spawn_eldewany_Alienware_17_R3_20435_7047533285771512973-5*.log
INFO  [mavlink] mode: Onboard, data rate: 4000000 B/s on udp port 14580 remote port 14540
INFO  [mavlink] mode: Onboard, data rate: 4000 B/s on udp port 14280 remote port 14030
INFO  [mavlink] mode: Gimbal, data rate: 400000 B/s on udp port 13030 remote port 13280
[ INFO] [1633273781.061270892, 0.548000000]: udp0: Remote address: 127.0.0.1:14580
[ INFO] [1633273781.069503224, 0.556000000]: IMU: High resolution IMU detected!
INFO  [logger] logger started (mode=all)
INFO  [logger] removing log directory ./log/2021-09-20 to get more space (left=134682 MiB)
INFO  [mavlink] MAVLink only on localhost (set param MAV_{i}_BROADCAST = 1 to enable network)
INFO  [mavlink] MAVLink only on localhost (set param MAV_{i}_BROADCAST = 1 to enable network)
INFO  [px4] Startup script returned successfully
pxh> INFO  [mavlink] partner IP: 127.0.0.1
INFO  [logger] removing log directory ./log/2021-09-23 to get more space (left=134828 MiB)
WARN  [logger] Too many subscriptions, failed to add: vehicle_trajectory_waypoint_desired 0
INFO  [logger] Start file log (type: full)
INFO  [logger] [logger] ./log/2021-10-03/15_09_40.ulg	
INFO  [logger] Opened full log file: ./log/2021-10-03/15_09_40.ulg
[ INFO] [1633273781.619404675, 1.100000000]: IMU: Attitude quaternion IMU detected!
[ INFO] [1633273782.064185399, 1.536000000]: CON: Got HEARTBEAT, connected. FCU: PX4 Autopilot
[ INFO] [1633273782.067542362, 1.540000000]: IMU: High resolution IMU detected!
[ INFO] [1633273782.068323036, 1.540000000]: IMU: Attitude quaternion IMU detected!
[ INFO] [1633273783.083637388, 2.552000000]: GF: Using MISSION_ITEM_INT
[ INFO] [1633273783.083820881, 2.552000000]: RP: Using MISSION_ITEM_INT
[ INFO] [1633273783.083938518, 2.552000000]: WP: Using MISSION_ITEM_INT
[ INFO] [1633273783.084121779, 2.552000000]: VER: 1.1: Capabilities         0x000000000000e4ef
[ INFO] [1633273783.084248840, 2.552000000]: VER: 1.1: Flight software:     010d0040 (07e307b074000000)
[ INFO] [1633273783.084350596, 2.552000000]: VER: 1.1: Middleware software: 010d0040 (07e307b074000000)
[ INFO] [1633273783.084447446, 2.552000000]: VER: 1.1: OS software:         050400ff (ca1938fbcccc1a0a)
[ INFO] [1633273783.084563360, 2.552000000]: VER: 1.1: Board hardware:      00000001
[ INFO] [1633273783.084674952, 2.552000000]: VER: 1.1: VID/PID:             0000:0000
[ INFO] [1633273783.084784643, 2.552000000]: VER: 1.1: UID:                 4954414c44494e4f
INFO  [tone_alarm] home set
INFO  [tone_alarm] notify positive
pxh> commander trINFO  [mavlink] Mission download request ignored, already active	
[ INFO] [1633273797.103699627, 16.536000000]: RP: mission received
[ INFO] [1633273797.105367652, 16.540000000]: WP: item #0  F:� C:178 p: 1 5 -1 0 x: 0 y: 0 z: 0
[ INFO] [1633273797.106237286, 16.540000000]: WP: item #1  F:� C: 22 p: 0 0 0 nan x: 473977419 y: 85455945 z: 3
[ INFO] [1633273797.106930277, 16.540000000]: WP: item #2  F:� C: 16 p: 0 0 0 nan x: 473977530 y: 85467099 z: 3
[ INFO] [1633273797.107592057, 16.540000000]: WP: item #3  F:� C:178 p: 1 5 -1 0 x: 0 y: 0 z: 0
[ INFO] [1633273797.108672476, 16.544000000]: WP: item #4* F:� C: 20 p: 0 0 0 0 x: 0 y: 0 z: 0
[ INFO] [1633273797.108888121, 16.544000000]: WP: mission received
pxh> commander ta[ WARN] [1633273798.103535036, 17.536000000]: GF: timeout, retries left 2
[ INFO] [1633273798.106601411, 17.536000000]: GF: mission received
pxh> commander takeoff
pxh> WARN  [PreFlightCheck] Preflight Fail: Compass 1 uncalibrated
WARN  [PreFlightCheck] Preflight Fail: Accel 0 uncalibrated
WARN  [PreFlightCheck] Preflight Fail: Accel 1 uncalibrated
WARN  [PreFlightCheck] Preflight Fail: Accel 2 uncalibrated
WARN  [PreFlightCheck] Preflight Fail: Gyro 0 uncalibrated
WARN  [PreFlightCheck] Preflight Fail: Gyro 1 uncalibrated
[ WARN] [1633273799.392594654, 18.824000000]: CMD: Unexpected command 22, result 0
WARN  [PreFlightCheck] Preflight Fail: Gyro 2 uncalibrated
INFO  [tone_alarm] notify negative

@Jaeyoung-Lim
Copy link
Member

@eldewany It doesn't seem like you are using the default launch file: ./launch-2.sh

@Jaeyoung-Lim Jaeyoung-Lim added question 🤖 ROS Sim: SITL software in the loop simulation labels Oct 3, 2021
@eldewany
Copy link
Author

eldewany commented Oct 3, 2021

@Jaeyoung-Lim it's just a launch file that has the source lines


cd ~/Desktop/PX4-Autopilot/
DONT_RUN=1 make px4_sitl gazebo
source ~/catkin_ws/devel/setup.bash    # (optional)
source ~/catkin_ws2/devel/setup.bash
source Tools/setup_gazebo.bash $(pwd) $(pwd)/build/px4_sitl_default
export ROS_PACKAGE_PATH=$ROS_PACKAGE_PATH:$(pwd)
export ROS_PACKAGE_PATH=$ROS_PACKAGE_PATH:$(pwd)/Tools/sitl_gazebo
roslaunch px4 mavros_posix_sitl.launch

@Jaeyoung-Lim
Copy link
Member

Jaeyoung-Lim commented Oct 3, 2021

@eldewany Since I do not have the launchfile you are using, and given that the default launch file works in my environment I am not sure how to help you. The only conclusion I can draw is that there is something wrong the way you are running your custom launch file.

Can you try with the default launchfile and still see if there is a problem? Also please clarify what environment you are using

@eldewany
Copy link
Author

eldewany commented Oct 3, 2021

@Jaeyoung-Lim I'm indeed using the default launch file, the file ./launch-2.launch only contains the lines that source the PX4 folder and then launches the default command, again this is the contents of ./launch-2.launch

cd ~/Desktop/PX4-Autopilot/
DONT_RUN=1 make px4_sitl gazebo
source ~/catkin_ws/devel/setup.bash    # (optional)
source ~/catkin_ws2/devel/setup.bash
source Tools/setup_gazebo.bash $(pwd) $(pwd)/build/px4_sitl_default
export ROS_PACKAGE_PATH=$ROS_PACKAGE_PATH:$(pwd)
export ROS_PACKAGE_PATH=$ROS_PACKAGE_PATH:$(pwd)/Tools/sitl_gazebo
roslaunch px4 mavros_posix_sitl.launch

I'm running an Ubuntu 18.04 , ROS Melodic and a fresh PX4 repo that i cloned just now. I would also like to note that the issue doesn't appear unless you command the vehicle to takeoff or if you open QGC, it always shows Gyro not calibrated

Screenshot from 2021-10-03 17-26-28

@Jaeyoung-Lim
Copy link
Member

Jaeyoung-Lim commented Oct 3, 2021

@eldewany Okay, but could you confirm what the results are with the default launch file?

I also don't understand how you can run a launchfile with the commands that you specified included. a launch file is a xml format file(http://wiki.ros.org/roslaunch/XML) while the launch-2.launch you are presenting is clearly not a xml format file.

Again, the launchfile works fine on my system as well as the MAVROS CI tests that check this automatically.

Therefore the only difference is your launch file, and with the default launch file the results should be the same since I am also testing with ROS melodic Ubuntu 18.04. If this is not the case we can start looking at the logs from there on.

@eldewany
Copy link
Author

eldewany commented Oct 3, 2021

@Jaeyoung-Lim It's a typo mistake, i apologize.. i meant ./launch-2.sh , it's a shell script that sources the PX4 requirements.

@Jaeyoung-Lim
Copy link
Member

Jaeyoung-Lim commented Oct 3, 2021

@eldewany Ah, right now it makes more sense.

I am still convinced that the problem is not from this repo and something from the script you have created. However, I don't see anything that could have gone wrong from your log file.

  • If you want to have more debug outputs, you can add a environment variable VERBOSE_SIM=1
  • Could you also try removing the second workspace? source ~/catkin_ws2/devel/setup.bash

@eldewany
Copy link
Author

eldewany commented Oct 8, 2021

Issue was that the cached data from previous version of SITL was being used, the solution was to empty ~/.ros and everything worked fine. @Jaeyoung-Lim Thanks for your time man, i really appreciate it.

@eldewany eldewany closed this as completed Oct 8, 2021
@Jaeyoung-Lim
Copy link
Member

@eldewany Glad to hear that you found a way to fix the problem!

@AlexWUrobot
Copy link

AlexWUrobot commented Feb 7, 2023

Thanks a lot for your help. it is helpful to clean the ~/.ros
I have the same issue and then solve it by your solution
https://discuss.px4.io/t/simulation-take-off-motion-not-vertical/30705/4

but the battery issue still sometimes happens
image

@bb6698
Copy link

bb6698 commented Feb 3, 2024

The same thing happens to me too, it doesn't work to clean the directory ~/.ros . How can I disable this action? I need to do reinforcement learning and with "battery unhealthy" I can't continue with the training.

The parameters SIM_BAT_MIN_PCT are set 50.0 and SIM_BAT_DRAIN are set 86400

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
question 🤖 ROS Sim: SITL software in the loop simulation
Projects
None yet
Development

No branches or pull requests

4 participants