Unable to get data on mavros side after upgrading the system from sdk-0.9 to staging version
-
Hi, I have upgraded the voxl2 from sdk-0.9 to staging version from. Now I am trying to run some ros scripts, I am getting some error. It is showing waiting for FCU connections after launching the scripts. I run the same scripts with sdk-0.9 packages, it works well in that.
Here I am getting data on ros side with fcu_url:=/dev/ttyHS1:921600voxl2:/etc/modalai$ roslaunch voxl_autonomy px4.launch fcu_url:=/dev/ttyHS1:921600 ... logging to /home/root/.ros/log/0a864ff8-b8fc-11ed-b6c5-54af97be95ca/roslaunch-m0054-5768.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://m0054:39499/ SUMMARY ======== CLEAR PARAMETERS * /mavros/ PARAMETERS * /mav_viz/arm_len: 0.25 * /mav_viz/body_height: 0.075 * /mav_viz/body_width: 0.075 * /mav_viz/child_frame_id: base_link * /mav_viz/fixed_frame_id: map_offset * /mav_viz/marker_scale: 0.75 * /mav_viz/num_rotors: 4 * /mav_viz/prop_direction: 1 * /mavros/camera/frame_id: base_link * /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: /dev/ttyHS1:921600 * /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.13 NODES / map_offset_tf (tf/static_transform_publisher) mav_viz (mavros_extras/visualization) mavros (mavros/mavros_node) voxl_mavros_tf (tf/static_transform_publisher) voxl_tf_publisher (voxl_ros_utils/tf_publisher.py) voxl_voa_reader (voxl_ros_utils/mavros_voa_reader.py) ROS_MASTER_URI=http://localhost:11311 process[mavros-1]: started with pid [5791] [ INFO] [1677763430.831607377]: FCU URL: /dev/ttyHS1:921600 [ INFO] [1677763430.833271075]: serial0: device: /dev/ttyHS1 @ 921600 bps [ INFO] [1677763430.833363315]: GCS bridge disabled [ INFO] [1677763430.845173107]: Plugin 3dr_radio loaded [ INFO] [1677763430.846926284]: Plugin 3dr_radio initialized [ INFO] [1677763430.847032169]: Plugin actuator_control loaded [ INFO] [1677763430.849088419]: Plugin actuator_control initialized [ INFO] [1677763430.852417846]: Plugin adsb loaded [ INFO] [1677763430.855140242]: Plugin adsb initialized [ INFO] [1677763430.855253627]: Plugin altitude loaded [ INFO] [1677763430.855810867]: Plugin altitude initialized [ INFO] [1677763430.855887742]: Plugin cam_imu_sync loaded [ INFO] [1677763430.856262742]: Plugin cam_imu_sync initialized [ INFO] [1677763430.856336336]: Plugin camera loaded [ INFO] [1677763430.856703732]: Plugin camera initialized [ INFO] [1677763430.856779044]: Plugin cellular_status loaded [ INFO] [1677763430.858719721]: Plugin cellular_status initialized [ INFO] [1677763430.858813471]: Plugin command loaded [ INFO] [1677763430.866482013]: Plugin command initialized [ INFO] [1677763430.866609096]: Plugin companion_process_status loaded [ INFO] [1677763430.868946440]: Plugin companion_process_status initialized [ INFO] [1677763430.869058888]: Plugin debug_value loaded [ INFO] [1677763430.874093784]: Plugin debug_value initialized [ INFO] [1677763430.874144721]: Plugin distance_sensor blacklisted [ INFO] [1677763430.874250867]: Plugin esc_status loaded [ INFO] [1677763430.875261284]: Plugin esc_status initialized [ INFO] [1677763430.875350398]: Plugin esc_telemetry loaded [ INFO] [1677763430.875799044]: Plugin esc_telemetry initialized [ INFO] [1677763430.875911909]: Plugin fake_gps loaded [ INFO] [1677763430.887176232]: Plugin fake_gps initialized [ INFO] [1677763430.887350971]: Plugin ftp loaded [ INFO] [1677763430.891942586]: Plugin ftp initialized [ INFO] [1677763430.892094513]: Plugin geofence loaded [ INFO] [1677763430.894750763]: Plugin geofence initialized [ INFO] [1677763430.894882065]: Plugin global_position loaded [ INFO] [1677763430.906174929]: Plugin global_position initialized [ INFO] [1677763430.906308263]: Plugin gps_input loaded [ INFO] [1677763430.908028419]: Plugin gps_input initialized [ INFO] [1677763430.908118627]: Plugin gps_rtk loaded [ INFO] [1677763430.909979565]: Plugin gps_rtk initialized [ INFO] [1677763430.910101388]: Plugin gps_status loaded [ INFO] [1677763430.911614721]: Plugin gps_status initialized [ INFO] [1677763430.911758679]: Plugin guided_target loaded process[voxl_mavros_tf-2]: started with pid [5792] [ INFO] [1677763430.915063523]: Plugin guided_target initialized [ INFO] [1677763430.915229669]: Plugin hil loaded [ INFO] [1677763430.936170346]: Plugin hil initialized [ INFO] [1677763430.936353888]: Plugin home_position loaded [ INFO] [1677763430.939015346]: Plugin home_position initialized [ INFO] [1677763430.939115346]: Plugin imu loaded [ INFO] [1677763430.946994617]: Plugin imu initialized [ INFO] [1677763430.947121284]: Plugin landing_target loaded [ INFO] [1677763430.955133211]: Plugin landing_target initialized [ INFO] [1677763430.955238523]: Plugin local_position loaded [ INFO] [1677763430.959009929]: Plugin local_position initialized [ INFO] [1677763430.959146544]: Plugin log_transfer loaded [ INFO] [1677763430.960863107]: Plugin log_transfer initialized [ INFO] [1677763430.960949513]: Plugin mag_calibration_status loaded [ INFO] [1677763430.962537273]: Plugin mag_calibration_status initialized [ INFO] [1677763430.962659982]: Plugin manual_control loaded [ INFO] [1677763430.978493784]: Plugin manual_control initialized [ INFO] [1677763430.978704825]: Plugin mocap_pose_estimate loaded [ INFO] [1677763430.985256648]: Plugin mocap_pose_estimate initialized [ INFO] [1677763430.985474721]: Plugin mount_control loaded [ WARN] [1677763430.992198784]: Could not retrive negate_measured_roll parameter value, using default (0) [ WARN] [1677763430.992617325]: Could not retrive negate_measured_pitch parameter value, using default (0) [ WARN] [1677763430.993028627]: Could not retrive negate_measured_yaw parameter value, using default (0) [ WARN] [1677763430.994378367]: Could not retrive debounce_s parameter value, using default (4.000000) [ WARN] [1677763430.994773315]: Could not retrive err_threshold_deg parameter value, using default (10.000000) [ INFO] [1677763430.994946492]: Plugin mount_control initialized [ INFO] [1677763430.995337638]: Plugin nav_controller_output loaded [ INFO] [1677763430.996280086]: Plugin nav_controller_output initialized [ INFO] [1677763430.996427690]: Plugin obstacle_distance loaded [ INFO] [1677763430.998864044]: Plugin obstacle_distance initialized [ INFO] [1677763430.999005398]: Plugin odom loaded [ INFO] [1677763431.003775815]: Plugin odom initialized [ INFO] [1677763431.003969096]: Plugin onboard_computer_status loaded [ INFO] [1677763431.006179982]: Plugin onboard_computer_status initialized [ INFO] [1677763431.006315971]: Plugin param loaded [ INFO] [1677763431.009515554]: Plugin param initialized [ INFO] [1677763431.009629304]: Plugin play_tune loaded [ INFO] [1677763431.011194096]: Plugin play_tune initialized [ INFO] [1677763431.011293784]: Plugin px4flow loaded [ INFO] [1677763431.015689044]: Plugin px4flow initialized [ INFO] [1677763431.015837325]: Plugin rallypoint loaded [ INFO] [1677763431.017841440]: Plugin rallypoint initialized [ INFO] [1677763431.017934721]: Plugin rangefinder blacklisted [ INFO] [1677763431.018055919]: Plugin rc_io loaded [ INFO] [1677763431.020993679]: Plugin rc_io initialized [ INFO] [1677763431.021092950]: Plugin safety_area blacklisted [ INFO] [1677763431.021259304]: Plugin setpoint_accel loaded [ INFO] [1677763431.024591388]: Plugin setpoint_accel initialized [ INFO] [1677763431.024814461]: Plugin setpoint_attitude loaded [ INFO] [1677763431.031614877]: Plugin setpoint_attitude initialized [ INFO] [1677763431.031793575]: Plugin setpoint_position loaded process[voxl_voa_reader-3]: started with pid [5809] [ INFO] [1677763431.044507742]: Plugin setpoint_position initialized [ INFO] [1677763431.044661075]: Plugin setpoint_raw loaded [ INFO] [1677763431.050578107]: Plugin setpoint_raw initialized [ INFO] [1677763431.050731127]: Plugin setpoint_trajectory loaded [ INFO] [1677763431.053871804]: Plugin setpoint_trajectory initialized [ INFO] [1677763431.054018263]: Plugin setpoint_velocity loaded [ INFO] [1677763431.057861440]: Plugin setpoint_velocity initialized [ INFO] [1677763431.058059513]: Plugin sys_status loaded [ INFO] [1677763431.065617429]: Plugin sys_status initialized [ INFO] [1677763431.065825242]: Plugin sys_time loaded [ INFO] [1677763431.069884981]: TM: Timesync mode: MAVLINK [ INFO] [1677763431.070426752]: TM: Not publishing sim time [ INFO] [1677763431.071475190]: Plugin sys_time initialized [ INFO] [1677763431.071613002]: Plugin terrain loaded [ INFO] [1677763431.072069981]: Plugin terrain initialized [ INFO] [1677763431.072173836]: Plugin trajectory loaded [ INFO] [1677763431.076089877]: Plugin trajectory initialized [ INFO] [1677763431.076278211]: Plugin tunnel loaded [ INFO] [1677763431.078533784]: Plugin tunnel initialized [ INFO] [1677763431.078687013]: Plugin vfr_hud loaded [ INFO] [1677763431.079045763]: Plugin vfr_hud initialized [ INFO] [1677763431.079083575]: Plugin vibration blacklisted [ INFO] [1677763431.079147690]: Plugin vision_pose_estimate loaded [ INFO] [1677763431.084122742]: Plugin vision_pose_estimate initialized [ INFO] [1677763431.084324929]: Plugin vision_speed_estimate loaded [ INFO] [1677763431.086926752]: Plugin vision_speed_estimate initialized [ INFO] [1677763431.087115867]: Plugin waypoint loaded [ INFO] [1677763431.090351440]: Plugin waypoint initialized [ INFO] [1677763431.090434565]: Plugin wheel_odometry blacklisted [ INFO] [1677763431.090557273]: Plugin wind_estimation loaded [ INFO] [1677763431.091855971]: Plugin wind_estimation initialized [ INFO] [1677763431.092137638]: Autostarting mavlink via USB on PX4 [ INFO] [1677763431.092195242]: Built-in SIMD instructions: ARM NEON [ INFO] [1677763431.092218784]: Built-in MAVLink package version: 2022.12.30 [ INFO] [1677763431.092264200]: Known MAVLink dialects: common ardupilotmega ASLUAV AVSSUAS all cubepilot development icarous matrixpilot paparazzi standard storm32 uAvionix ualberta [ INFO] [1677763431.092303211]: MAVROS started. MY ID 1.240, TARGET ID 1.1 process[map_offset_tf-4]: started with pid [5815] [ INFO] [1677763431.158911856]: IMU: Attitude quaternion IMU detected! [ INFO] [1677763431.229495138]: IMU: High resolution IMU detected! process[voxl_tf_publisher-5]: started with pid [5828] [INFO] [1677763431.384036]: Starting MavrosObstacleDistanceInterface as obstacle_distance_interface. process[mav_viz-6]: started with pid [5832] [ INFO] [1677763431.433142221]: RC_CHANNELS message detected! [INFO] [1677763431.787763]: [VoxlTFPublisher] Starting VoxlTFPublisher as voxl_tf_publisher. [INFO] [1677763431.790942]: [VoxlTFPublisher] Reading TF data from file... [INFO] [1677763431.793057]: [VoxlTFPublisher] Loaded extrinsics for Sentinel_V1 airframe [INFO] [1677763431.793786]: [VoxlTFPublisher] Added TF from parent: imu_px4 to child: imu_apps [INFO] [1677763431.794566]: [VoxlTFPublisher] Added TF from parent: imu_apps to child: tracking [INFO] [1677763431.795270]: [VoxlTFPublisher] Added TF from parent: imu_px4 to child: tracking [INFO] [1677763431.795951]: [VoxlTFPublisher] Added TF from parent: body to child: imu_apps [INFO] [1677763431.796639]: [VoxlTFPublisher] Added TF from parent: body to child: imu_px4 [INFO] [1677763431.797443]: [VoxlTFPublisher] Added TF from parent: body to child: stereo_front_l [INFO] [1677763431.798124]: [VoxlTFPublisher] Added TF from parent: body to child: stereo_rear_l [INFO] [1677763431.798811]: [VoxlTFPublisher] Added TF from parent: body to child: tof [INFO] [1677763431.799492]: [VoxlTFPublisher] Added TF from parent: body to child: ground [ INFO] [1677763434.558550501]: CON: Got HEARTBEAT, connected. FCU: PX4 Autopilot [ INFO] [1677763434.564239824]: IMU: High resolution IMU detected! [ INFO] [1677763434.791885449]: IMU: Attitude quaternion IMU detected! [ INFO] [1677763434.833896595]: RC_CHANNELS message detected! [ INFO] [1677763436.573897531]: GF: Using MISSION_ITEM_INT [ INFO] [1677763436.574198052]: RP: Using MISSION_ITEM_INT [ INFO] [1677763436.574439406]: WP: Using MISSION_ITEM_INT [ INFO] [1677763436.574704563]: VER: 1.1: Capabilities 0x000000000000e4ff [ INFO] [1677763436.574910500]: VER: 1.1: Flight software: 010d03ff (1c8ab2a0d7000000) [ INFO] [1677763436.575072479]: VER: 1.1: Middleware software: 010d03ff (1c8ab2a0d7000000) [ INFO] [1677763436.575226386]: VER: 1.1: OS software: 0b0000ff (4a1dd8680cd29f51) [ INFO] [1677763436.575387427]: VER: 1.1: Board hardware: 0000a32f [ INFO] [1677763436.575509667]: VER: 1.1: VID/PID: 0483:a32f [ INFO] [1677763436.575674042]: VER: 1.1: UID: 4b56500220393553 [ WARN] [1677763436.576565552]: VER: broadcast request timeout, retries left 4 [ WARN] [1677763436.577700552]: CMD: Unexpected command 520, result 0 [ INFO] [1677763444.562305862]: HP: requesting home position [ INFO] [1677763446.236356538]: FCU: Armed by RC (switch) [ WARN] [1677763448.990843308]: PR: request param #0 timeout, retries left 2, and 639 params still missing [ WARN] [1677763449.570385443]: CMD: Command 410 -- wait ack timeout [ WARN] [1677763449.991487943]: PR: request param #0 timeout, retries left 1, and 639 params still missing [ WARN] [1677763450.561055651]: GF: timeout, retries left 2 [ WARN] [1677763450.562976589]: RP: timeout, retries left 2 [ WARN] [1677763450.564789662]: WP: timeout, retries left 2 [ WARN] [1677763450.992359088]: PR: request param #0 timeout, retries left 0, and 639 params still missing [ WARN] [1677763451.561796015]: GF: timeout, retries left 1 [ WARN] [1677763451.565450963]: RP: timeout, retries left 1 [ WARN] [1677763451.566457942]: WP: timeout, retries left 1 [ERROR] [1677763451.993137057]: PR: request param #0 completely missing. [ WARN] [1677763451.993528307]: PR: 638 params still missing, trying to request next: #1 [ WARN] [1677763452.562561692]: GF: timeout, retries left 0 [ WARN] [1677763452.566823671]: RP: timeout, retries left 0 [ WARN] [1677763452.567351380]: WP: timeout, retries left 0 [ WARN] [1677763452.993801275]: PR: request param #1 timeout, retries left 2, and 638 params still missing [ERROR] [1677763453.563330910]: GF: timed out. [ERROR] [1677763453.567462733]: RP: timed out. [ERROR] [1677763453.567857577]: WP: timed out. [ WARN] [1677763453.994526587]: PR: request param #1 timeout, retries left 1, and 638 params still missing [ INFO] [1677763454.562307420]: HP: requesting home position [ WARN] [1677763454.995094347]: PR: request param #1 timeout, retries left 0, and 638 params still missing [ERROR] [1677763455.997440857]: PR: request param #1 completely missing. [ WARN] [1677763455.997824295]: PR: 637 params still missing, trying to request next: #2 [ WARN] [1677763456.998651065]: PR: request param #2 timeout, retries left 2, and 637 params still missingIn this case it shows the data is received on the ros side.
continue... -
Hi, I have upgraded the voxl2 from sdk-0.9 to staging version from. Now I am trying to run some ros scripts, I am getting some error. It is showing waiting for FCU connections after launching the scripts. I run the same scripts with sdk-0.9 packages, it works well in that.
Here I am getting data on ros side with fcu_url:=/dev/ttyHS1:921600voxl2:/etc/modalai$ roslaunch voxl_autonomy px4.launch fcu_url:=/dev/ttyHS1:921600 ... logging to /home/root/.ros/log/0a864ff8-b8fc-11ed-b6c5-54af97be95ca/roslaunch-m0054-5768.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://m0054:39499/ SUMMARY ======== CLEAR PARAMETERS * /mavros/ PARAMETERS * /mav_viz/arm_len: 0.25 * /mav_viz/body_height: 0.075 * /mav_viz/body_width: 0.075 * /mav_viz/child_frame_id: base_link * /mav_viz/fixed_frame_id: map_offset * /mav_viz/marker_scale: 0.75 * /mav_viz/num_rotors: 4 * /mav_viz/prop_direction: 1 * /mavros/camera/frame_id: base_link * /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: /dev/ttyHS1:921600 * /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.13 NODES / map_offset_tf (tf/static_transform_publisher) mav_viz (mavros_extras/visualization) mavros (mavros/mavros_node) voxl_mavros_tf (tf/static_transform_publisher) voxl_tf_publisher (voxl_ros_utils/tf_publisher.py) voxl_voa_reader (voxl_ros_utils/mavros_voa_reader.py) ROS_MASTER_URI=http://localhost:11311 process[mavros-1]: started with pid [5791] [ INFO] [1677763430.831607377]: FCU URL: /dev/ttyHS1:921600 [ INFO] [1677763430.833271075]: serial0: device: /dev/ttyHS1 @ 921600 bps [ INFO] [1677763430.833363315]: GCS bridge disabled [ INFO] [1677763430.845173107]: Plugin 3dr_radio loaded [ INFO] [1677763430.846926284]: Plugin 3dr_radio initialized [ INFO] [1677763430.847032169]: Plugin actuator_control loaded [ INFO] [1677763430.849088419]: Plugin actuator_control initialized [ INFO] [1677763430.852417846]: Plugin adsb loaded [ INFO] [1677763430.855140242]: Plugin adsb initialized [ INFO] [1677763430.855253627]: Plugin altitude loaded [ INFO] [1677763430.855810867]: Plugin altitude initialized [ INFO] [1677763430.855887742]: Plugin cam_imu_sync loaded [ INFO] [1677763430.856262742]: Plugin cam_imu_sync initialized [ INFO] [1677763430.856336336]: Plugin camera loaded [ INFO] [1677763430.856703732]: Plugin camera initialized [ INFO] [1677763430.856779044]: Plugin cellular_status loaded [ INFO] [1677763430.858719721]: Plugin cellular_status initialized [ INFO] [1677763430.858813471]: Plugin command loaded [ INFO] [1677763430.866482013]: Plugin command initialized [ INFO] [1677763430.866609096]: Plugin companion_process_status loaded [ INFO] [1677763430.868946440]: Plugin companion_process_status initialized [ INFO] [1677763430.869058888]: Plugin debug_value loaded [ INFO] [1677763430.874093784]: Plugin debug_value initialized [ INFO] [1677763430.874144721]: Plugin distance_sensor blacklisted [ INFO] [1677763430.874250867]: Plugin esc_status loaded [ INFO] [1677763430.875261284]: Plugin esc_status initialized [ INFO] [1677763430.875350398]: Plugin esc_telemetry loaded [ INFO] [1677763430.875799044]: Plugin esc_telemetry initialized [ INFO] [1677763430.875911909]: Plugin fake_gps loaded [ INFO] [1677763430.887176232]: Plugin fake_gps initialized [ INFO] [1677763430.887350971]: Plugin ftp loaded [ INFO] [1677763430.891942586]: Plugin ftp initialized [ INFO] [1677763430.892094513]: Plugin geofence loaded [ INFO] [1677763430.894750763]: Plugin geofence initialized [ INFO] [1677763430.894882065]: Plugin global_position loaded [ INFO] [1677763430.906174929]: Plugin global_position initialized [ INFO] [1677763430.906308263]: Plugin gps_input loaded [ INFO] [1677763430.908028419]: Plugin gps_input initialized [ INFO] [1677763430.908118627]: Plugin gps_rtk loaded [ INFO] [1677763430.909979565]: Plugin gps_rtk initialized [ INFO] [1677763430.910101388]: Plugin gps_status loaded [ INFO] [1677763430.911614721]: Plugin gps_status initialized [ INFO] [1677763430.911758679]: Plugin guided_target loaded process[voxl_mavros_tf-2]: started with pid [5792] [ INFO] [1677763430.915063523]: Plugin guided_target initialized [ INFO] [1677763430.915229669]: Plugin hil loaded [ INFO] [1677763430.936170346]: Plugin hil initialized [ INFO] [1677763430.936353888]: Plugin home_position loaded [ INFO] [1677763430.939015346]: Plugin home_position initialized [ INFO] [1677763430.939115346]: Plugin imu loaded [ INFO] [1677763430.946994617]: Plugin imu initialized [ INFO] [1677763430.947121284]: Plugin landing_target loaded [ INFO] [1677763430.955133211]: Plugin landing_target initialized [ INFO] [1677763430.955238523]: Plugin local_position loaded [ INFO] [1677763430.959009929]: Plugin local_position initialized [ INFO] [1677763430.959146544]: Plugin log_transfer loaded [ INFO] [1677763430.960863107]: Plugin log_transfer initialized [ INFO] [1677763430.960949513]: Plugin mag_calibration_status loaded [ INFO] [1677763430.962537273]: Plugin mag_calibration_status initialized [ INFO] [1677763430.962659982]: Plugin manual_control loaded [ INFO] [1677763430.978493784]: Plugin manual_control initialized [ INFO] [1677763430.978704825]: Plugin mocap_pose_estimate loaded [ INFO] [1677763430.985256648]: Plugin mocap_pose_estimate initialized [ INFO] [1677763430.985474721]: Plugin mount_control loaded [ WARN] [1677763430.992198784]: Could not retrive negate_measured_roll parameter value, using default (0) [ WARN] [1677763430.992617325]: Could not retrive negate_measured_pitch parameter value, using default (0) [ WARN] [1677763430.993028627]: Could not retrive negate_measured_yaw parameter value, using default (0) [ WARN] [1677763430.994378367]: Could not retrive debounce_s parameter value, using default (4.000000) [ WARN] [1677763430.994773315]: Could not retrive err_threshold_deg parameter value, using default (10.000000) [ INFO] [1677763430.994946492]: Plugin mount_control initialized [ INFO] [1677763430.995337638]: Plugin nav_controller_output loaded [ INFO] [1677763430.996280086]: Plugin nav_controller_output initialized [ INFO] [1677763430.996427690]: Plugin obstacle_distance loaded [ INFO] [1677763430.998864044]: Plugin obstacle_distance initialized [ INFO] [1677763430.999005398]: Plugin odom loaded [ INFO] [1677763431.003775815]: Plugin odom initialized [ INFO] [1677763431.003969096]: Plugin onboard_computer_status loaded [ INFO] [1677763431.006179982]: Plugin onboard_computer_status initialized [ INFO] [1677763431.006315971]: Plugin param loaded [ INFO] [1677763431.009515554]: Plugin param initialized [ INFO] [1677763431.009629304]: Plugin play_tune loaded [ INFO] [1677763431.011194096]: Plugin play_tune initialized [ INFO] [1677763431.011293784]: Plugin px4flow loaded [ INFO] [1677763431.015689044]: Plugin px4flow initialized [ INFO] [1677763431.015837325]: Plugin rallypoint loaded [ INFO] [1677763431.017841440]: Plugin rallypoint initialized [ INFO] [1677763431.017934721]: Plugin rangefinder blacklisted [ INFO] [1677763431.018055919]: Plugin rc_io loaded [ INFO] [1677763431.020993679]: Plugin rc_io initialized [ INFO] [1677763431.021092950]: Plugin safety_area blacklisted [ INFO] [1677763431.021259304]: Plugin setpoint_accel loaded [ INFO] [1677763431.024591388]: Plugin setpoint_accel initialized [ INFO] [1677763431.024814461]: Plugin setpoint_attitude loaded [ INFO] [1677763431.031614877]: Plugin setpoint_attitude initialized [ INFO] [1677763431.031793575]: Plugin setpoint_position loaded process[voxl_voa_reader-3]: started with pid [5809] [ INFO] [1677763431.044507742]: Plugin setpoint_position initialized [ INFO] [1677763431.044661075]: Plugin setpoint_raw loaded [ INFO] [1677763431.050578107]: Plugin setpoint_raw initialized [ INFO] [1677763431.050731127]: Plugin setpoint_trajectory loaded [ INFO] [1677763431.053871804]: Plugin setpoint_trajectory initialized [ INFO] [1677763431.054018263]: Plugin setpoint_velocity loaded [ INFO] [1677763431.057861440]: Plugin setpoint_velocity initialized [ INFO] [1677763431.058059513]: Plugin sys_status loaded [ INFO] [1677763431.065617429]: Plugin sys_status initialized [ INFO] [1677763431.065825242]: Plugin sys_time loaded [ INFO] [1677763431.069884981]: TM: Timesync mode: MAVLINK [ INFO] [1677763431.070426752]: TM: Not publishing sim time [ INFO] [1677763431.071475190]: Plugin sys_time initialized [ INFO] [1677763431.071613002]: Plugin terrain loaded [ INFO] [1677763431.072069981]: Plugin terrain initialized [ INFO] [1677763431.072173836]: Plugin trajectory loaded [ INFO] [1677763431.076089877]: Plugin trajectory initialized [ INFO] [1677763431.076278211]: Plugin tunnel loaded [ INFO] [1677763431.078533784]: Plugin tunnel initialized [ INFO] [1677763431.078687013]: Plugin vfr_hud loaded [ INFO] [1677763431.079045763]: Plugin vfr_hud initialized [ INFO] [1677763431.079083575]: Plugin vibration blacklisted [ INFO] [1677763431.079147690]: Plugin vision_pose_estimate loaded [ INFO] [1677763431.084122742]: Plugin vision_pose_estimate initialized [ INFO] [1677763431.084324929]: Plugin vision_speed_estimate loaded [ INFO] [1677763431.086926752]: Plugin vision_speed_estimate initialized [ INFO] [1677763431.087115867]: Plugin waypoint loaded [ INFO] [1677763431.090351440]: Plugin waypoint initialized [ INFO] [1677763431.090434565]: Plugin wheel_odometry blacklisted [ INFO] [1677763431.090557273]: Plugin wind_estimation loaded [ INFO] [1677763431.091855971]: Plugin wind_estimation initialized [ INFO] [1677763431.092137638]: Autostarting mavlink via USB on PX4 [ INFO] [1677763431.092195242]: Built-in SIMD instructions: ARM NEON [ INFO] [1677763431.092218784]: Built-in MAVLink package version: 2022.12.30 [ INFO] [1677763431.092264200]: Known MAVLink dialects: common ardupilotmega ASLUAV AVSSUAS all cubepilot development icarous matrixpilot paparazzi standard storm32 uAvionix ualberta [ INFO] [1677763431.092303211]: MAVROS started. MY ID 1.240, TARGET ID 1.1 process[map_offset_tf-4]: started with pid [5815] [ INFO] [1677763431.158911856]: IMU: Attitude quaternion IMU detected! [ INFO] [1677763431.229495138]: IMU: High resolution IMU detected! process[voxl_tf_publisher-5]: started with pid [5828] [INFO] [1677763431.384036]: Starting MavrosObstacleDistanceInterface as obstacle_distance_interface. process[mav_viz-6]: started with pid [5832] [ INFO] [1677763431.433142221]: RC_CHANNELS message detected! [INFO] [1677763431.787763]: [VoxlTFPublisher] Starting VoxlTFPublisher as voxl_tf_publisher. [INFO] [1677763431.790942]: [VoxlTFPublisher] Reading TF data from file... [INFO] [1677763431.793057]: [VoxlTFPublisher] Loaded extrinsics for Sentinel_V1 airframe [INFO] [1677763431.793786]: [VoxlTFPublisher] Added TF from parent: imu_px4 to child: imu_apps [INFO] [1677763431.794566]: [VoxlTFPublisher] Added TF from parent: imu_apps to child: tracking [INFO] [1677763431.795270]: [VoxlTFPublisher] Added TF from parent: imu_px4 to child: tracking [INFO] [1677763431.795951]: [VoxlTFPublisher] Added TF from parent: body to child: imu_apps [INFO] [1677763431.796639]: [VoxlTFPublisher] Added TF from parent: body to child: imu_px4 [INFO] [1677763431.797443]: [VoxlTFPublisher] Added TF from parent: body to child: stereo_front_l [INFO] [1677763431.798124]: [VoxlTFPublisher] Added TF from parent: body to child: stereo_rear_l [INFO] [1677763431.798811]: [VoxlTFPublisher] Added TF from parent: body to child: tof [INFO] [1677763431.799492]: [VoxlTFPublisher] Added TF from parent: body to child: ground [ INFO] [1677763434.558550501]: CON: Got HEARTBEAT, connected. FCU: PX4 Autopilot [ INFO] [1677763434.564239824]: IMU: High resolution IMU detected! [ INFO] [1677763434.791885449]: IMU: Attitude quaternion IMU detected! [ INFO] [1677763434.833896595]: RC_CHANNELS message detected! [ INFO] [1677763436.573897531]: GF: Using MISSION_ITEM_INT [ INFO] [1677763436.574198052]: RP: Using MISSION_ITEM_INT [ INFO] [1677763436.574439406]: WP: Using MISSION_ITEM_INT [ INFO] [1677763436.574704563]: VER: 1.1: Capabilities 0x000000000000e4ff [ INFO] [1677763436.574910500]: VER: 1.1: Flight software: 010d03ff (1c8ab2a0d7000000) [ INFO] [1677763436.575072479]: VER: 1.1: Middleware software: 010d03ff (1c8ab2a0d7000000) [ INFO] [1677763436.575226386]: VER: 1.1: OS software: 0b0000ff (4a1dd8680cd29f51) [ INFO] [1677763436.575387427]: VER: 1.1: Board hardware: 0000a32f [ INFO] [1677763436.575509667]: VER: 1.1: VID/PID: 0483:a32f [ INFO] [1677763436.575674042]: VER: 1.1: UID: 4b56500220393553 [ WARN] [1677763436.576565552]: VER: broadcast request timeout, retries left 4 [ WARN] [1677763436.577700552]: CMD: Unexpected command 520, result 0 [ INFO] [1677763444.562305862]: HP: requesting home position [ INFO] [1677763446.236356538]: FCU: Armed by RC (switch) [ WARN] [1677763448.990843308]: PR: request param #0 timeout, retries left 2, and 639 params still missing [ WARN] [1677763449.570385443]: CMD: Command 410 -- wait ack timeout [ WARN] [1677763449.991487943]: PR: request param #0 timeout, retries left 1, and 639 params still missing [ WARN] [1677763450.561055651]: GF: timeout, retries left 2 [ WARN] [1677763450.562976589]: RP: timeout, retries left 2 [ WARN] [1677763450.564789662]: WP: timeout, retries left 2 [ WARN] [1677763450.992359088]: PR: request param #0 timeout, retries left 0, and 639 params still missing [ WARN] [1677763451.561796015]: GF: timeout, retries left 1 [ WARN] [1677763451.565450963]: RP: timeout, retries left 1 [ WARN] [1677763451.566457942]: WP: timeout, retries left 1 [ERROR] [1677763451.993137057]: PR: request param #0 completely missing. [ WARN] [1677763451.993528307]: PR: 638 params still missing, trying to request next: #1 [ WARN] [1677763452.562561692]: GF: timeout, retries left 0 [ WARN] [1677763452.566823671]: RP: timeout, retries left 0 [ WARN] [1677763452.567351380]: WP: timeout, retries left 0 [ WARN] [1677763452.993801275]: PR: request param #1 timeout, retries left 2, and 638 params still missing [ERROR] [1677763453.563330910]: GF: timed out. [ERROR] [1677763453.567462733]: RP: timed out. [ERROR] [1677763453.567857577]: WP: timed out. [ WARN] [1677763453.994526587]: PR: request param #1 timeout, retries left 1, and 638 params still missing [ INFO] [1677763454.562307420]: HP: requesting home position [ WARN] [1677763454.995094347]: PR: request param #1 timeout, retries left 0, and 638 params still missing [ERROR] [1677763455.997440857]: PR: request param #1 completely missing. [ WARN] [1677763455.997824295]: PR: 637 params still missing, trying to request next: #2 [ WARN] [1677763456.998651065]: PR: request param #2 timeout, retries left 2, and 637 params still missingIn this case it shows the data is received on the ros side.
continue...But from udp protocol side, there is no data
voxl2:/etc/modalai$ roslaunch voxl_autonomy px4.launch ... logging to /home/root/.ros/log/0a864ff8-b8fc-11ed-b6c5-54af97be95ca/roslaunch-m0054-6069.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://m0054:45485/ SUMMARY ======== CLEAR PARAMETERS * /mavros/ PARAMETERS * /mav_viz/arm_len: 0.25 * /mav_viz/body_height: 0.075 * /mav_viz/body_width: 0.075 * /mav_viz/child_frame_id: base_link * /mav_viz/fixed_frame_id: map_offset * /mav_viz/marker_scale: 0.75 * /mav_viz/num_rotors: 4 * /mav_viz/prop_direction: 1 * /mavros/camera/frame_id: base_link * /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: fixcontinue...
-
But from udp protocol side, there is no data
voxl2:/etc/modalai$ roslaunch voxl_autonomy px4.launch ... logging to /home/root/.ros/log/0a864ff8-b8fc-11ed-b6c5-54af97be95ca/roslaunch-m0054-6069.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://m0054:45485/ SUMMARY ======== CLEAR PARAMETERS * /mavros/ PARAMETERS * /mav_viz/arm_len: 0.25 * /mav_viz/body_height: 0.075 * /mav_viz/body_width: 0.075 * /mav_viz/child_frame_id: base_link * /mav_viz/fixed_frame_id: map_offset * /mav_viz/marker_scale: 0.75 * /mav_viz/num_rotors: 4 * /mav_viz/prop_direction: 1 * /mavros/camera/frame_id: base_link * /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: fixcontinue...
* /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://127.0.0.1:1... * /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.13 NODES / map_offset_tf (tf/static_transform_publisher) mav_viz (mavros_extras/visualization) mavros (mavros/mavros_node) voxl_mavros_tf (tf/static_transform_publisher) voxl_tf_publisher (voxl_ros_utils/tf_publisher.py) voxl_voa_reader (voxl_ros_utils/mavros_voa_reader.py) ROS_MASTER_URI=http://localhost:11311 process[mavros-1]: started with pid [6089] [ INFO] [1677763594.302371273]: FCU URL: udp://127.0.0.1:14551@:14551 [ INFO] [1677763594.304596586]: udp0: Bind address: 127.0.0.1:14551 [ INFO] [1677763594.304705492]: GCS bridge disabled [ INFO] [1677763594.316001117]: Plugin 3dr_radio loaded [ INFO] [1677763594.317788565]: Plugin 3dr_radio initialized [ INFO] [1677763594.317899659]: Plugin actuator_control loaded [ INFO] [1677763594.322923930]: Plugin actuator_control initialized [ INFO] [1677763594.327214815]: Plugin adsb loaded [ INFO] [1677763594.329652575]: Plugin adsb initialized [ INFO] [1677763594.329773044]: Plugin altitude loaded [ INFO] [1677763594.330462367]: Plugin altitude initialized [ INFO] [1677763594.330551378]: Plugin cam_imu_sync loaded [ INFO] [1677763594.330938669]: Plugin cam_imu_sync initialized [ INFO] [1677763594.331021898]: Plugin camera loaded [ INFO] [1677763594.331399607]: Plugin camera initialized [ INFO] [1677763594.331478617]: Plugin cellular_status loaded [ INFO] [1677763594.333044763]: Plugin cellular_status initialized [ INFO] [1677763594.333180857]: Plugin command loaded [ INFO] [1677763594.337491742]: Plugin command initialized [ INFO] [1677763594.337591013]: Plugin companion_process_status loaded [ INFO] [1677763594.339167523]: Plugin companion_process_status initialized [ INFO] [1677763594.339257680]: Plugin debug_value loaded [ INFO] [1677763594.342772315]: Plugin debug_value initialized [ INFO] [1677763594.342835232]: Plugin distance_sensor blacklisted [ INFO] [1677763594.342923617]: Plugin esc_status loaded [ INFO] [1677763594.344182680]: Plugin esc_status initialized [ INFO] [1677763594.344292159]: Plugin esc_telemetry loaded [ INFO] [1677763594.344753669]: Plugin esc_telemetry initialized [ INFO] [1677763594.344872315]: Plugin fake_gps loaded [ INFO] [1677763594.355347888]: Plugin fake_gps initialized [ INFO] [1677763594.355509711]: Plugin ftp loaded [ INFO] [1677763594.360579503]: Plugin ftp initialized [ INFO] [1677763594.360715805]: Plugin geofence loaded process[voxl_mavros_tf-2]: started with pid [6090] [ INFO] [1677763594.363619242]: Plugin geofence initialized [ INFO] [1677763594.363769867]: Plugin global_position loaded [ INFO] [1677763594.375597107]: Plugin global_position initialized [ INFO] [1677763594.375740128]: Plugin gps_input loaded [ INFO] [1677763594.387234555]: Plugin gps_input initialized [ INFO] [1677763594.387379346]: Plugin gps_rtk loaded [ INFO] [1677763594.392507315]: Plugin gps_rtk initialized [ INFO] [1677763594.392628773]: Plugin gps_status loaded [ INFO] [1677763594.393872523]: Plugin gps_status initialized [ INFO] [1677763594.393956794]: Plugin guided_target loaded [ INFO] [1677763594.396305440]: Plugin guided_target initialized [ INFO] [1677763594.396399086]: Plugin hil loaded [ INFO] [1677763594.409695492]: Plugin hil initialized [ INFO] [1677763594.409840909]: Plugin home_position loaded [ INFO] [1677763594.412537315]: Plugin home_position initialized [ INFO] [1677763594.413229242]: Plugin imu loaded [ INFO] [1677763594.421967055]: Plugin imu initialized [ INFO] [1677763594.422119138]: Plugin landing_target loaded [ INFO] [1677763594.432017784]: Plugin landing_target initialized [ INFO] [1677763594.432172419]: Plugin local_position loaded [ INFO] [1677763594.436771482]: Plugin local_position initialized [ INFO] [1677763594.436986794]: Plugin log_transfer loaded [ INFO] [1677763594.439535596]: Plugin log_transfer initialized [ INFO] [1677763594.439663825]: Plugin mag_calibration_status loaded [ INFO] [1677763594.440381273]: Plugin mag_calibration_status initialized [ INFO] [1677763594.440493930]: Plugin manual_control loaded [ INFO] [1677763594.442869346]: Plugin manual_control initialized [ INFO] [1677763594.443015440]: Plugin mocap_pose_estimate loaded [ INFO] [1677763594.446347055]: Plugin mocap_pose_estimate initialized [ INFO] [1677763594.446559450]: Plugin mount_control loaded [ WARN] [1677763594.450517055]: Could not retrive negate_measured_roll parameter value, using default (0) [ WARN] [1677763594.450822419]: Could not retrive negate_measured_pitch parameter value, using default (0) [ WARN] [1677763594.451102732]: Could not retrive negate_measured_yaw parameter value, using default (0) [ WARN] [1677763594.452057211]: Could not retrive debounce_s parameter value, using default (4.000000) [ WARN] [1677763594.452345336]: Could not retrive err_threshold_deg parameter value, using default (10.000000) [ INFO] [1677763594.452397732]: Plugin mount_control initialized [ INFO] [1677763594.452510909]: Plugin nav_controller_output loaded [ INFO] [1677763594.453355284]: Plugin nav_controller_output initialized [ INFO] [1677763594.453454190]: Plugin obstacle_distance loaded [ INFO] [1677763594.455376325]: Plugin obstacle_distance initialized [ INFO] [1677763594.455496482]: Plugin odom loaded [ INFO] [1677763594.458727002]: Plugin odom initialized [ INFO] [1677763594.458867107]: Plugin onboard_computer_status loaded [ INFO] [1677763594.460823461]: Plugin onboard_computer_status initialized [ INFO] [1677763594.460943825]: Plugin param loaded [ INFO] [1677763594.462820127]: Plugin param initialized [ INFO] [1677763594.462924763]: Plugin play_tune loaded [ INFO] [1677763594.464443409]: Plugin play_tune initialized [ INFO] [1677763594.464535023]: Plugin px4flow loaded [ INFO] [1677763594.468909607]: Plugin px4flow initialized [ INFO] [1677763594.469017107]: Plugin rallypoint loaded [ INFO] [1677763594.470877836]: Plugin rallypoint initialized [ INFO] [1677763594.470928565]: Plugin rangefinder blacklisted [ INFO] [1677763594.471010909]: Plugin rc_io loaded [ INFO] [1677763594.474122732]: Plugin rc_io initialized [ INFO] [1677763594.474175075]: Plugin safety_area blacklisted [ INFO] [1677763594.474270805]: Plugin setpoint_accel loaded [ INFO] [1677763594.476241846]: Plugin setpoint_accel initialized [ INFO] [1677763594.476345596]: Plugin setpoint_attitude loaded [ INFO] [1677763594.482977107]: Plugin setpoint_attitude initialized [ INFO] [1677763594.483139607]: Plugin setpoint_position loaded process[voxl_voa_reader-3]: started with pid [6100] [ INFO] [1677763594.493485388]: Plugin setpoint_position initialized [ INFO] [1677763594.493643096]: Plugin setpoint_raw loaded [ INFO] [1677763594.499962523]: Plugin setpoint_raw initialized [ INFO] [1677763594.500120909]: Plugin setpoint_trajectory loaded [ INFO] [1677763594.503701430]: Plugin setpoint_trajectory initialized [ INFO] [1677763594.503849294]: Plugin setpoint_velocity loaded [ INFO] [1677763594.507733513]: Plugin setpoint_velocity initialized [ INFO] [1677763594.507937992]: Plugin sys_status loaded [ INFO] [1677763594.521397367]: Plugin sys_status initialized [ INFO] [1677763594.521567888]: Plugin sys_time loaded [ INFO] [1677763594.524604815]: TM: Timesync mode: MAVLINK [ INFO] [1677763594.524918096]: TM: Not publishing sim time [ INFO] [1677763594.525942940]: Plugin sys_time initialized [ INFO] [1677763594.526064086]: Plugin terrain loaded [ INFO] [1677763594.526400700]: Plugin terrain initialized [ INFO] [1677763594.526480075]: Plugin trajectory loaded [ INFO] [1677763594.529417419]: Plugin trajectory initialized [ INFO] [1677763594.529524711]: Plugin tunnel loaded [ INFO] [1677763594.531140232]: Plugin tunnel initialized [ INFO] [1677763594.531269190]: Plugin vfr_hud loaded [ INFO] [1677763594.532441534]: Plugin vfr_hud initialized [ INFO] [1677763594.532513982]: Plugin vibration blacklisted [ INFO] [1677763594.532608513]: Plugin vision_pose_estimate loaded [ INFO] [1677763594.537461586]: Plugin vision_pose_estimate initialized [ INFO] [1677763594.537616846]: Plugin vision_speed_estimate loaded [ INFO] [1677763594.539960127]: Plugin vision_speed_estimate initialized [ INFO] [1677763594.540195596]: Plugin waypoint loaded [ INFO] [1677763594.547666117]: Plugin waypoint initialized [ INFO] [1677763594.547743044]: Plugin wheel_odometry blacklisted [ INFO] [1677763594.547857836]: Plugin wind_estimation loaded [ INFO] [1677763594.548209034]: Plugin wind_estimation initialized [ INFO] [1677763594.548361377]: Autostarting mavlink via USB on PX4 [ INFO] [1677763594.548394867]: Built-in SIMD instructions: ARM NEON [ INFO] [1677763594.548407680]: Built-in MAVLink package version: 2022.12.30 [ INFO] [1677763594.548435075]: Known MAVLink dialects: common ardupilotmega ASLUAV AVSSUAS all cubepilot development icarous matrixpilot paparazzi standard storm32 uAvionix ualberta [ INFO] [1677763594.548447523]: MAVROS started. MY ID 1.240, TARGET ID 1.1 process[map_offset_tf-4]: started with pid [6113] process[voxl_tf_publisher-5]: started with pid [6120] [INFO] [1677763594.821898]: Starting MavrosObstacleDistanceInterface as obstacle_distance_interface. process[mav_viz-6]: started with pid [6130] [INFO] [1677763595.246324]: [VoxlTFPublisher] Starting VoxlTFPublisher as voxl_tf_publisher. [INFO] [1677763595.248479]: [VoxlTFPublisher] Reading TF data from file... [INFO] [1677763595.249219]: [VoxlTFPublisher] Loaded extrinsics for Sentinel_V1 airframe [INFO] [1677763595.249844]: [VoxlTFPublisher] Added TF from parent: imu_px4 to child: imu_apps [INFO] [1677763595.250559]: [VoxlTFPublisher] Added TF from parent: imu_apps to child: tracking [INFO] [1677763595.251221]: [VoxlTFPublisher] Added TF from parent: imu_px4 to child: tracking [INFO] [1677763595.251885]: [VoxlTFPublisher] Added TF from parent: body to child: imu_apps [INFO] [1677763595.252552]: [VoxlTFPublisher] Added TF from parent: body to child: imu_px4 [INFO] [1677763595.253233]: [VoxlTFPublisher] Added TF from parent: body to child: stereo_front_l [INFO] [1677763595.253866]: [VoxlTFPublisher] Added TF from parent: body to child: stereo_rear_l [INFO] [1677763595.254480]: [VoxlTFPublisher] Added TF from parent: body to child: tof [INFO] [1677763595.255118]: [VoxlTFPublisher] Added TF from parent: body to child: groundIn this case the data is not received from udp protocol side.
How to fix this ? I am using voxl-vision-hub_1.6.1_arm64.deb and voxl-mavlink_0.1.0_arm64.deb and flight-core as external flight controller.
voxl-mavlink-server.conf file:{ "primary_static_gcs_ip": "192.168.1.102", "secondary_static_gcs_ip": "192.168.1.101", "onboard_port_to_autopilot": 14556, "onboard_port_from_autopilot": 14557, "gcs_port_to_autopilot": 14558, "gcs_port_from_autopilot": 14559, "en_external_uart_fc": true, "autopilot_uart_bus": 1, "autopilot_uart_baudrate": 921600, "en_external_ap_timesync": 1, "udp_mtu": 512 } -
* /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://127.0.0.1:1... * /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.13 NODES / map_offset_tf (tf/static_transform_publisher) mav_viz (mavros_extras/visualization) mavros (mavros/mavros_node) voxl_mavros_tf (tf/static_transform_publisher) voxl_tf_publisher (voxl_ros_utils/tf_publisher.py) voxl_voa_reader (voxl_ros_utils/mavros_voa_reader.py) ROS_MASTER_URI=http://localhost:11311 process[mavros-1]: started with pid [6089] [ INFO] [1677763594.302371273]: FCU URL: udp://127.0.0.1:14551@:14551 [ INFO] [1677763594.304596586]: udp0: Bind address: 127.0.0.1:14551 [ INFO] [1677763594.304705492]: GCS bridge disabled [ INFO] [1677763594.316001117]: Plugin 3dr_radio loaded [ INFO] [1677763594.317788565]: Plugin 3dr_radio initialized [ INFO] [1677763594.317899659]: Plugin actuator_control loaded [ INFO] [1677763594.322923930]: Plugin actuator_control initialized [ INFO] [1677763594.327214815]: Plugin adsb loaded [ INFO] [1677763594.329652575]: Plugin adsb initialized [ INFO] [1677763594.329773044]: Plugin altitude loaded [ INFO] [1677763594.330462367]: Plugin altitude initialized [ INFO] [1677763594.330551378]: Plugin cam_imu_sync loaded [ INFO] [1677763594.330938669]: Plugin cam_imu_sync initialized [ INFO] [1677763594.331021898]: Plugin camera loaded [ INFO] [1677763594.331399607]: Plugin camera initialized [ INFO] [1677763594.331478617]: Plugin cellular_status loaded [ INFO] [1677763594.333044763]: Plugin cellular_status initialized [ INFO] [1677763594.333180857]: Plugin command loaded [ INFO] [1677763594.337491742]: Plugin command initialized [ INFO] [1677763594.337591013]: Plugin companion_process_status loaded [ INFO] [1677763594.339167523]: Plugin companion_process_status initialized [ INFO] [1677763594.339257680]: Plugin debug_value loaded [ INFO] [1677763594.342772315]: Plugin debug_value initialized [ INFO] [1677763594.342835232]: Plugin distance_sensor blacklisted [ INFO] [1677763594.342923617]: Plugin esc_status loaded [ INFO] [1677763594.344182680]: Plugin esc_status initialized [ INFO] [1677763594.344292159]: Plugin esc_telemetry loaded [ INFO] [1677763594.344753669]: Plugin esc_telemetry initialized [ INFO] [1677763594.344872315]: Plugin fake_gps loaded [ INFO] [1677763594.355347888]: Plugin fake_gps initialized [ INFO] [1677763594.355509711]: Plugin ftp loaded [ INFO] [1677763594.360579503]: Plugin ftp initialized [ INFO] [1677763594.360715805]: Plugin geofence loaded process[voxl_mavros_tf-2]: started with pid [6090] [ INFO] [1677763594.363619242]: Plugin geofence initialized [ INFO] [1677763594.363769867]: Plugin global_position loaded [ INFO] [1677763594.375597107]: Plugin global_position initialized [ INFO] [1677763594.375740128]: Plugin gps_input loaded [ INFO] [1677763594.387234555]: Plugin gps_input initialized [ INFO] [1677763594.387379346]: Plugin gps_rtk loaded [ INFO] [1677763594.392507315]: Plugin gps_rtk initialized [ INFO] [1677763594.392628773]: Plugin gps_status loaded [ INFO] [1677763594.393872523]: Plugin gps_status initialized [ INFO] [1677763594.393956794]: Plugin guided_target loaded [ INFO] [1677763594.396305440]: Plugin guided_target initialized [ INFO] [1677763594.396399086]: Plugin hil loaded [ INFO] [1677763594.409695492]: Plugin hil initialized [ INFO] [1677763594.409840909]: Plugin home_position loaded [ INFO] [1677763594.412537315]: Plugin home_position initialized [ INFO] [1677763594.413229242]: Plugin imu loaded [ INFO] [1677763594.421967055]: Plugin imu initialized [ INFO] [1677763594.422119138]: Plugin landing_target loaded [ INFO] [1677763594.432017784]: Plugin landing_target initialized [ INFO] [1677763594.432172419]: Plugin local_position loaded [ INFO] [1677763594.436771482]: Plugin local_position initialized [ INFO] [1677763594.436986794]: Plugin log_transfer loaded [ INFO] [1677763594.439535596]: Plugin log_transfer initialized [ INFO] [1677763594.439663825]: Plugin mag_calibration_status loaded [ INFO] [1677763594.440381273]: Plugin mag_calibration_status initialized [ INFO] [1677763594.440493930]: Plugin manual_control loaded [ INFO] [1677763594.442869346]: Plugin manual_control initialized [ INFO] [1677763594.443015440]: Plugin mocap_pose_estimate loaded [ INFO] [1677763594.446347055]: Plugin mocap_pose_estimate initialized [ INFO] [1677763594.446559450]: Plugin mount_control loaded [ WARN] [1677763594.450517055]: Could not retrive negate_measured_roll parameter value, using default (0) [ WARN] [1677763594.450822419]: Could not retrive negate_measured_pitch parameter value, using default (0) [ WARN] [1677763594.451102732]: Could not retrive negate_measured_yaw parameter value, using default (0) [ WARN] [1677763594.452057211]: Could not retrive debounce_s parameter value, using default (4.000000) [ WARN] [1677763594.452345336]: Could not retrive err_threshold_deg parameter value, using default (10.000000) [ INFO] [1677763594.452397732]: Plugin mount_control initialized [ INFO] [1677763594.452510909]: Plugin nav_controller_output loaded [ INFO] [1677763594.453355284]: Plugin nav_controller_output initialized [ INFO] [1677763594.453454190]: Plugin obstacle_distance loaded [ INFO] [1677763594.455376325]: Plugin obstacle_distance initialized [ INFO] [1677763594.455496482]: Plugin odom loaded [ INFO] [1677763594.458727002]: Plugin odom initialized [ INFO] [1677763594.458867107]: Plugin onboard_computer_status loaded [ INFO] [1677763594.460823461]: Plugin onboard_computer_status initialized [ INFO] [1677763594.460943825]: Plugin param loaded [ INFO] [1677763594.462820127]: Plugin param initialized [ INFO] [1677763594.462924763]: Plugin play_tune loaded [ INFO] [1677763594.464443409]: Plugin play_tune initialized [ INFO] [1677763594.464535023]: Plugin px4flow loaded [ INFO] [1677763594.468909607]: Plugin px4flow initialized [ INFO] [1677763594.469017107]: Plugin rallypoint loaded [ INFO] [1677763594.470877836]: Plugin rallypoint initialized [ INFO] [1677763594.470928565]: Plugin rangefinder blacklisted [ INFO] [1677763594.471010909]: Plugin rc_io loaded [ INFO] [1677763594.474122732]: Plugin rc_io initialized [ INFO] [1677763594.474175075]: Plugin safety_area blacklisted [ INFO] [1677763594.474270805]: Plugin setpoint_accel loaded [ INFO] [1677763594.476241846]: Plugin setpoint_accel initialized [ INFO] [1677763594.476345596]: Plugin setpoint_attitude loaded [ INFO] [1677763594.482977107]: Plugin setpoint_attitude initialized [ INFO] [1677763594.483139607]: Plugin setpoint_position loaded process[voxl_voa_reader-3]: started with pid [6100] [ INFO] [1677763594.493485388]: Plugin setpoint_position initialized [ INFO] [1677763594.493643096]: Plugin setpoint_raw loaded [ INFO] [1677763594.499962523]: Plugin setpoint_raw initialized [ INFO] [1677763594.500120909]: Plugin setpoint_trajectory loaded [ INFO] [1677763594.503701430]: Plugin setpoint_trajectory initialized [ INFO] [1677763594.503849294]: Plugin setpoint_velocity loaded [ INFO] [1677763594.507733513]: Plugin setpoint_velocity initialized [ INFO] [1677763594.507937992]: Plugin sys_status loaded [ INFO] [1677763594.521397367]: Plugin sys_status initialized [ INFO] [1677763594.521567888]: Plugin sys_time loaded [ INFO] [1677763594.524604815]: TM: Timesync mode: MAVLINK [ INFO] [1677763594.524918096]: TM: Not publishing sim time [ INFO] [1677763594.525942940]: Plugin sys_time initialized [ INFO] [1677763594.526064086]: Plugin terrain loaded [ INFO] [1677763594.526400700]: Plugin terrain initialized [ INFO] [1677763594.526480075]: Plugin trajectory loaded [ INFO] [1677763594.529417419]: Plugin trajectory initialized [ INFO] [1677763594.529524711]: Plugin tunnel loaded [ INFO] [1677763594.531140232]: Plugin tunnel initialized [ INFO] [1677763594.531269190]: Plugin vfr_hud loaded [ INFO] [1677763594.532441534]: Plugin vfr_hud initialized [ INFO] [1677763594.532513982]: Plugin vibration blacklisted [ INFO] [1677763594.532608513]: Plugin vision_pose_estimate loaded [ INFO] [1677763594.537461586]: Plugin vision_pose_estimate initialized [ INFO] [1677763594.537616846]: Plugin vision_speed_estimate loaded [ INFO] [1677763594.539960127]: Plugin vision_speed_estimate initialized [ INFO] [1677763594.540195596]: Plugin waypoint loaded [ INFO] [1677763594.547666117]: Plugin waypoint initialized [ INFO] [1677763594.547743044]: Plugin wheel_odometry blacklisted [ INFO] [1677763594.547857836]: Plugin wind_estimation loaded [ INFO] [1677763594.548209034]: Plugin wind_estimation initialized [ INFO] [1677763594.548361377]: Autostarting mavlink via USB on PX4 [ INFO] [1677763594.548394867]: Built-in SIMD instructions: ARM NEON [ INFO] [1677763594.548407680]: Built-in MAVLink package version: 2022.12.30 [ INFO] [1677763594.548435075]: Known MAVLink dialects: common ardupilotmega ASLUAV AVSSUAS all cubepilot development icarous matrixpilot paparazzi standard storm32 uAvionix ualberta [ INFO] [1677763594.548447523]: MAVROS started. MY ID 1.240, TARGET ID 1.1 process[map_offset_tf-4]: started with pid [6113] process[voxl_tf_publisher-5]: started with pid [6120] [INFO] [1677763594.821898]: Starting MavrosObstacleDistanceInterface as obstacle_distance_interface. process[mav_viz-6]: started with pid [6130] [INFO] [1677763595.246324]: [VoxlTFPublisher] Starting VoxlTFPublisher as voxl_tf_publisher. [INFO] [1677763595.248479]: [VoxlTFPublisher] Reading TF data from file... [INFO] [1677763595.249219]: [VoxlTFPublisher] Loaded extrinsics for Sentinel_V1 airframe [INFO] [1677763595.249844]: [VoxlTFPublisher] Added TF from parent: imu_px4 to child: imu_apps [INFO] [1677763595.250559]: [VoxlTFPublisher] Added TF from parent: imu_apps to child: tracking [INFO] [1677763595.251221]: [VoxlTFPublisher] Added TF from parent: imu_px4 to child: tracking [INFO] [1677763595.251885]: [VoxlTFPublisher] Added TF from parent: body to child: imu_apps [INFO] [1677763595.252552]: [VoxlTFPublisher] Added TF from parent: body to child: imu_px4 [INFO] [1677763595.253233]: [VoxlTFPublisher] Added TF from parent: body to child: stereo_front_l [INFO] [1677763595.253866]: [VoxlTFPublisher] Added TF from parent: body to child: stereo_rear_l [INFO] [1677763595.254480]: [VoxlTFPublisher] Added TF from parent: body to child: tof [INFO] [1677763595.255118]: [VoxlTFPublisher] Added TF from parent: body to child: groundIn this case the data is not received from udp protocol side.
How to fix this ? I am using voxl-vision-hub_1.6.1_arm64.deb and voxl-mavlink_0.1.0_arm64.deb and flight-core as external flight controller.
voxl-mavlink-server.conf file:{ "primary_static_gcs_ip": "192.168.1.102", "secondary_static_gcs_ip": "192.168.1.101", "onboard_port_to_autopilot": 14556, "onboard_port_from_autopilot": 14557, "gcs_port_to_autopilot": 14558, "gcs_port_from_autopilot": 14559, "en_external_uart_fc": true, "autopilot_uart_bus": 1, "autopilot_uart_baudrate": 921600, "en_external_ap_timesync": 1, "udp_mtu": 512 }voxl2:~$ voxl-mavlink-server loading our own config file ================================================================= Parameters as loaded from config file: primary_static_gcs_ip: 192.168.1.102 secondary_static_gcs_ip: 192.168.1.101 onboard_port_to_autopilot: 14556 onboard_port_from_autopilot: 14557 gcs_port_to_autopilot: 14558 gcs_port_from_autopilot: 14559 en_external_uart_fc: 1 autopilot_uart_bus: 1 autopilot_uart_baudrate: 921600 udp_mtu: 512 en_external_ap_timesync: 1 ================================================================= existing instance of voxl-mavlink-server found, attempting to stop it Successfully opened /dev/ttyHS1 starting qrb5165 external AP receive thread Adding primary GCS IP address from conf file to list: 192.168.1.102 Added new UDP connection to 192.168.1.102 Adding secondary manual gcs IP address to udp connection list: 192.168.1.101 Added new UDP connection to 192.168.1.101 Init complete, entering main loop Detected Autopilot Mavlink SYSID 1 detected system time has already been set failed to send to uart socket: Resource temporarily unavailable Error, UART write incomplete CONNECTED to GCS at 192.168.1.101 failed to send to uart socket: Resource temporarily unavailable Error, UART write incomplete failed to send to uart socket: Resource temporarily unavailable Error, UART write incomplete -
voxl2:~$ voxl-mavlink-server loading our own config file ================================================================= Parameters as loaded from config file: primary_static_gcs_ip: 192.168.1.102 secondary_static_gcs_ip: 192.168.1.101 onboard_port_to_autopilot: 14556 onboard_port_from_autopilot: 14557 gcs_port_to_autopilot: 14558 gcs_port_from_autopilot: 14559 en_external_uart_fc: 1 autopilot_uart_bus: 1 autopilot_uart_baudrate: 921600 udp_mtu: 512 en_external_ap_timesync: 1 ================================================================= existing instance of voxl-mavlink-server found, attempting to stop it Successfully opened /dev/ttyHS1 starting qrb5165 external AP receive thread Adding primary GCS IP address from conf file to list: 192.168.1.102 Added new UDP connection to 192.168.1.102 Adding secondary manual gcs IP address to udp connection list: 192.168.1.101 Added new UDP connection to 192.168.1.101 Init complete, entering main loop Detected Autopilot Mavlink SYSID 1 detected system time has already been set failed to send to uart socket: Resource temporarily unavailable Error, UART write incomplete CONNECTED to GCS at 192.168.1.101 failed to send to uart socket: Resource temporarily unavailable Error, UART write incomplete failed to send to uart socket: Resource temporarily unavailable Error, UART write incomplete@Chad-Sweet @modaltb what should be the fcu url for the updated mavlink server for mavros connection? Please help me to fix this
Hello! It looks like you're interested in this conversation, but you don't have an account yet.
Getting fed up of having to scroll through the same posts each visit? When you register for an account, you'll always come back to exactly where you were before, and choose to be notified of new replies (either via email, or push notification). You'll also be able to save bookmarks and upvote posts to show your appreciation to other community members.
With your input, this post could be even better 💗
Register Login