search

PX4 / PX4-Avoidance

PX4 avoidance ROS node for obstacle detection and avoidance.
http://px4.io
BSD 3-Clause "New" or "Revised" License
616 stars 321 forks source link

Global planner with lidar benewake (jetson Xavier) #676

Open dmeirap opened 2 years ago

dmeirap commented 2 years ago

Hiii!!! I'm trying to connect my lidar benewake with the global planner node in my jetson Xavier without success. Do you know anything about the error i'm facing up?

SUMMARY

CLEAR PARAMETERS

PARAMETERS

NODES / ce30_cloud (ce30c_driver/ce30_cloud) global_planner_node (global_planner/global_planner_node) lidar_benewake (tf/static_transform_publisher) mavros (mavros/mavros_node) octomap_server (octomap_server/octomap_server_node) rviz (rviz/rviz)

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

setting /run_id to 13cfb3f6-af39-11ec-9de7-565b1a51901d process[rosout-1]: started with pid [9827] started core service [/rosout] process[lidar_benewake-2]: started with pid [9845] process[mavros-3]: started with pid [9846] process[ce30_cloud-4]: started with pid [9854] process[global_planner_node-5]: started with pid [9863] process[octomap_server-6]: started with pid [9872] Init device process[rviz-7]: started with pid [9887] [ INFO] [1648542027.652740059]: Connect to: 192.168.1.80. [ INFO] [1648542027.721372625]: Connection succeeded! [ INFO] [1648542027.927329173]: Start measurement ... [ INFO] [1648542028.406738870]: FCU URL: /dev/ttyUSB0:921600 [ INFO] [1648542028.446078749]: serial0: device: /dev/ttyUSB0 @ 921600 bps [ INFO] [1648542028.451974035]: GCS bridge disabled [ INFO] [1648542028.546095023]: rviz version 1.13.24 [ INFO] [1648542028.546416946]: compiled against Qt version 5.9.5 [ INFO] [1648542028.546520883]: compiled against OGRE version 1.9.0 (Ghadamon) [ INFO] [1648542028.619315788]: Plugin 3dr_radio loaded [ INFO] [1648542028.669899770]: Plugin 3dr_radio initialized [ INFO] [1648542028.670370463]: Plugin actuator_control loaded [ INFO] [1648542028.680100024]: Forcing OpenGl version 0. [ INFO] [1648542028.785630620]: Plugin actuator_control initialized [ INFO] [1648542028.853895148]: Plugin adsb loaded [ INFO] [1648542028.948722542]: Plugin adsb initialized [ INFO] [1648542028.949452117]: Plugin altitude loaded [ INFO] [1648542028.979910443]: Plugin altitude initialized [ INFO] [1648542028.980524465]: Plugin cam_imu_sync loaded [ INFO] [1648542028.999615711]: Plugin cam_imu_sync initialized [ INFO] [1648542029.001312783]: Plugin camera loaded [ INFO] [1648542029.037389399]: Plugin camera initialized [ INFO] [1648542029.038451137]: Plugin command loaded [ INFO] [1648542029.270857250]: Plugin command initialized [ INFO] [1648542029.271903500]: Plugin companion_process_status loaded [ INFO] [1648542029.405037254]: Plugin companion_process_status initialized [ INFO] [1648542029.405684652]: Plugin debug_value loaded [ INFO] [1648542029.576820032]: Plugin debug_value initialized [ INFO] [1648542029.578143020]: Plugin distance_sensor blacklisted [ INFO] [1648542029.578737266]: Plugin esc_status loaded [ INFO] [1648542029.612536581]: Plugin esc_status initialized [ INFO] [1648542029.613231659]: Plugin esc_telemetry loaded [ INFO] [1648542029.628900954]: Plugin esc_telemetry initialized [ INFO] [1648542029.629845730]: Plugin fake_gps loaded [ WARN] [1648542030.200804705]: Nothing to publish, octree is empty [ INFO] [1648542030.204012894]: Plugin fake_gps initialized [ INFO] [1648542030.207228315]: Plugin ftp loaded [ INFO] [1648542030.391739232]: Plugin ftp initialized [ INFO] [1648542030.392431078]: Plugin geofence loaded [ INFO] [1648542030.400122892]: Stereo is NOT SUPPORTED [ INFO] [1648542030.401049172]: OpenGL device: NVIDIA Tegra Xavier (nvgpu)/integrated [ INFO] [1648542030.401252694]: OpenGl version: 4.6 (GLSL 4.6). [ INFO] [1648542030.467403532]: Plugin geofence initialized [ INFO] [1648542030.468877274]: Plugin global_position loaded [ INFO] [1648542030.840051223]: Plugin global_position initialized [ INFO] [1648542030.842129802]: Plugin gps_input loaded [ INFO] [1648542030.924755061]: Plugin gps_input initialized [ INFO] [1648542030.925649053]: Plugin gps_rtk loaded [ INFO] [1648542030.979610821]: Plugin gps_rtk initialized [ INFO] [1648542030.980339276]: Plugin gps_status loaded [ INFO] [1648542031.012677552]: Plugin gps_status initialized [ INFO] [1648542031.014314654]: Plugin hil loaded [ INFO] [1648542031.300076811]: Plugin hil initialized [ INFO] [1648542031.301213270]: Plugin home_position loaded [ INFO] [1648542031.418557046]: Plugin home_position initialized [ INFO] [1648542031.419340285]: Plugin imu loaded [ INFO] [1648542031.708176294]: Plugin imu initialized [ INFO] [1648542031.709089806]: Plugin landing_target loaded [ INFO] [1648542032.188302785]: Plugin landing_target initialized [ INFO] [1648542032.189070536]: Plugin local_position loaded [ INFO] [1648542032.442425830]: Plugin local_position initialized [ INFO] [1648542032.444072180]: Plugin log_transfer loaded [ INFO] [1648542032.556994888]: Plugin log_transfer initialized [ INFO] [1648542032.557913072]: Plugin mag_calibration_status loaded [ INFO] [1648542032.630792605]: Plugin mag_calibration_status initialized [ INFO] [1648542032.632113545]: Plugin manual_control loaded [ INFO] [1648542032.793121899]: Plugin manual_control initialized [ INFO] [1648542032.794135381]: Plugin mocap_pose_estimate loaded [ INFO] [1648542032.940811351]: Plugin mocap_pose_estimate initialized [ INFO] [1648542032.942612167]: Plugin mount_control loaded [ INFO] [1648542033.066301432]: Plugin mount_control initialized [ INFO] [1648542033.067070687]: Plugin nav_controller_output loaded [ INFO] [1648542033.080931579]: Plugin nav_controller_output initialized [ INFO] [1648542033.081631393]: Plugin obstacle_distance loaded [ INFO] [1648542033.168548040]: Plugin obstacle_distance initialized [ INFO] [1648542033.169640818]: Plugin odom loaded [ INFO] [1648542033.322682759]: Plugin odom initialized [ INFO] [1648542033.324724569]: Plugin onboard_computer_status loaded [ INFO] [1648542033.454287901]: Plugin onboard_computer_status initialized [ INFO] [1648542033.456077100]: Plugin param loaded [ INFO] [1648542033.535093005]: Plugin param initialized [ INFO] [1648542033.535987029]: Plugin play_tune loaded [ INFO] [1648542033.671676783]: Plugin play_tune initialized [ INFO] [1648542033.672392982]: Plugin px4flow loaded QObject::connect: Cannot queue arguments of type 'QVector' (Make sure 'QVector' is registered using qRegisterMetaType().) QObject::connect: Cannot queue arguments of type 'QVector' (Make sure 'QVector' is registered using qRegisterMetaType().) [ INFO] [1648542033.961301126]: Plugin px4flow initialized [ INFO] [1648542033.962097613]: Plugin rallypoint loaded [ INFO] [1648542034.030461582]: Plugin rallypoint initialized [ INFO] [1648542034.030764849]: Plugin rangefinder blacklisted [ INFO] [1648542034.031737721]: Plugin rc_io loaded [ INFO] [1648542034.166117187]: Plugin rc_io initialized [ INFO] [1648542034.166369669]: Plugin safety_area blacklisted [ INFO] [1648542034.167314925]: Plugin setpoint_accel loaded [ INFO] [1648542034.354023687]: Plugin setpoint_accel initialized [ INFO] [1648542034.355646550]: Plugin setpoint_attitude loaded [ INFO] [1648542034.821068539]: Plugin setpoint_attitude initialized [ INFO] [1648542034.821897795]: Plugin setpoint_position loaded [ WARN] [1648542035.334394365]: Transformation not available (local_origin to /ce30_cloud) [ INFO] [1648542035.542330283]: Plugin setpoint_position initialized [ INFO] [1648542035.543207635]: Plugin setpoint_raw loaded [ INFO] [1648542035.898259029]: Plugin setpoint_raw initialized [ INFO] [1648542035.899153181]: Plugin setpoint_trajectory loaded [ INFO] [1648542036.012871530]: Plugin setpoint_trajectory initialized [ INFO] [1648542036.013899635]: Plugin setpoint_velocity loaded [ INFO] [1648542036.150807816]: Plugin setpoint_velocity initialized [ INFO] [1648542036.152040147]: Plugin sys_status loaded [ INFO] [1648542036.394297096]: Plugin sys_status initialized [ INFO] [1648542036.395162927]: Plugin sys_time loaded [ INFO] [1648542036.544804340]: TM: Timesync mode: MAVLINK [ INFO] [1648542036.565853998]: TM: Not publishing sim time [ INFO] [1648542036.601760650]: Plugin sys_time initialized [ INFO] [1648542036.602565233]: Plugin terrain loaded [ INFO] [1648542036.633906597]: Plugin terrain initialized [ INFO] [1648542036.634691276]: Plugin trajectory loaded [ INFO] [1648542036.762412464]: Plugin trajectory initialized [ INFO] [1648542036.763122934]: Plugin tunnel loaded [ INFO] [1648542036.842022317]: Plugin tunnel initialized [ INFO] [1648542036.843122102]: Plugin vfr_hud loaded [ INFO] [1648542036.851631905]: Plugin vfr_hud initialized [ INFO] [1648542036.851921636]: Plugin vibration blacklisted [ INFO] [1648542036.852549161]: Plugin vision_pose_estimate loaded [ INFO] [1648542037.030640968]: Plugin vision_pose_estimate initialized [ INFO] [1648542037.031344814]: Plugin vision_speed_estimate loaded [ INFO] [1648542037.115373199]: Plugin vision_speed_estimate initialized [ INFO] [1648542037.116689019]: Plugin waypoint loaded [ INFO] [1648542037.256561061]: Plugin waypoint initialized [ INFO] [1648542037.256889512]: Plugin wheel_odometry blacklisted [ INFO] [1648542037.257611919]: Plugin wind_estimation loaded [ INFO] [1648542037.263950662]: Plugin wind_estimation initialized [ INFO] [1648542037.264745709]: Autostarting mavlink via USB on PX4 [ INFO] [1648542037.265010479]: Built-in SIMD instructions: ARM NEON [ INFO] [1648542037.265279474]: Built-in MAVLink package version: 2022.3.3 [ INFO] [1648542037.265549108]: Known MAVLink dialects: common ardupilotmega ASLUAV AVSSUAS all development icarous matrixpilot paparazzi standard storm32 uAvionix ualberta [ INFO] [1648542037.265777494]: MAVROS started. MY ID 1.240, TARGET ID 1.1 [ERROR] [1648542037.268815281]: PR: Unknown parameter to get: MPC_ACC_HOR [ERROR] [1648542037.298854552]: PR: Unknown parameter to get: MPC_ACC_DOWN_MAX [ERROR] [1648542037.332997316]: PR: Unknown parameter to get: MPC_ACC_UP_MAX [ERROR] [1648542037.367895766]: PR: Unknown parameter to get: MPC_XY_CRUISE [ERROR] [1648542037.409432290]: PR: Unknown parameter to get: MPC_Z_VEL_MAX_DN [ERROR] [1648542037.430657980]: PR: Unknown parameter to get: MPC_Z_VEL_MAX_UP [ERROR] [1648542037.457868139]: PR: Unknown parameter to get: CP_DIST [ERROR] [1648542037.472672876]: PR: Unknown parameter to get: MPC_LAND_SPEED [ERROR] [1648542037.493074111]: PR: Unknown parameter to get: MPC_JERK_MAX [ERROR] [1648542037.513540179]: PR: Unknown parameter to get: NAV_ACC_RAD [ERROR] [1648542037.525071832]: PR: Unknown parameter to get: MPC_YAWRAUTO_MAX terminate called after throwing an instance of 'std::bad_alloc' what(): std::bad_alloc [global_planner_node-5] process has died [pid 9863, exit code -6, cmd /home/nvidia/catkin_ws/devel/lib/global_planner/global_planner_node name:=global_planner_node log:=/home/nvidia/.ros/log/13cfb3f6-af39-11ec-9de7-565b1a51901d/global_planner_node-5.log]. log file: /home/nvidia/.ros/log/13cfb3f6-af39-11ec-9de7-565b1a51901d/global_planner_node-5*.log ^C[rviz-7] killing on exit [octomap_server-6] killing on exit [ce30_cloud-4] killing on exit [mavros-3] killing on exit ERROR: Failed to receive distance data! [lidar_benewake-2] killing on exit Measurement is stopped! LiDAR is disconnected! [rosout-1] killing on exit [master] killing on exit shutting down processing monitor... ... shutting down processing monitor complete done

dmeirap commented 2 years ago

--- real_planner.launch ---

<?xml version="1.0"?>

>
dmeirap commented 2 years ago

--- real_px4.launch ---

<?xml version="1.0"?>

dmeirap commented 2 years ago

--- real_octomap.launch ---

<?xml version="1.0"?>

$(arg pointcloud_topics)
anunarayan13 commented 12 months ago

Have you come across any solutions?