XTDrone
XTDrone copied to clipboard
三维运动规划
我在运行"rviz -d ego_rviz.rviz"是rviz没有出现点云图 这是运行后的rviz 有解决办法吗
我也遇到了这样的问题
同样的问题但我的终端有报错 roslaunch ego_planner single_uav.launch ... logging to /home/kd/.ros/log/dbcd4c9a-d68b-11ed-96c8-d4548bbd70f4/roslaunch-kd-Dell-G15-5511-18187.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://kd-Dell-G15-5511:44667/
SUMMARY
PARAMETERS
- /iris_0_ego_planner_node/bspline/limit_acc: 2.0
- /iris_0_ego_planner_node/bspline/limit_ratio: 1.1
- /iris_0_ego_planner_node/bspline/limit_vel: 1.0
- /iris_0_ego_planner_node/fsm/emergency_time: 1.0
- /iris_0_ego_planner_node/fsm/fail_safe: True
- /iris_0_ego_planner_node/fsm/flight_type: 2
- /iris_0_ego_planner_node/fsm/planning_horizen_time: 3.0
- /iris_0_ego_planner_node/fsm/planning_horizon: 7.5
- /iris_0_ego_planner_node/fsm/realworld_experiment: False
- /iris_0_ego_planner_node/fsm/thresh_no_replan_meter: 1.0
- /iris_0_ego_planner_node/fsm/thresh_replan_time: 1.0
- /iris_0_ego_planner_node/fsm/waypoint0_x: 0.0
- /iris_0_ego_planner_node/fsm/waypoint0_y: -20.0
- /iris_0_ego_planner_node/fsm/waypoint0_z: 1.0
- /iris_0_ego_planner_node/fsm/waypoint1_x: 6.0
- /iris_0_ego_planner_node/fsm/waypoint1_y: 0.0
- /iris_0_ego_planner_node/fsm/waypoint1_z: 1.5
- /iris_0_ego_planner_node/fsm/waypoint2_x: 8.0
- /iris_0_ego_planner_node/fsm/waypoint2_y: -8.0
- /iris_0_ego_planner_node/fsm/waypoint2_z: 1.5
- /iris_0_ego_planner_node/fsm/waypoint3_x: 0.0
- /iris_0_ego_planner_node/fsm/waypoint3_y: -15.0
- /iris_0_ego_planner_node/fsm/waypoint3_z: 1.0
- /iris_0_ego_planner_node/fsm/waypoint4_x: -15.0
- /iris_0_ego_planner_node/fsm/waypoint4_y: 0.0
- /iris_0_ego_planner_node/fsm/waypoint4_z: 1.0
- /iris_0_ego_planner_node/fsm/waypoint_num: 1
- /iris_0_ego_planner_node/grid_map/cx: 320.5
- /iris_0_ego_planner_node/grid_map/cy: 240.5
- /iris_0_ego_planner_node/grid_map/depth_filter_margin: 2
- /iris_0_ego_planner_node/grid_map/depth_filter_maxdist: 5.0
- /iris_0_ego_planner_node/grid_map/depth_filter_mindist: 0.5
- /iris_0_ego_planner_node/grid_map/depth_filter_tolerance: 0.15
- /iris_0_ego_planner_node/grid_map/frame_id: world
- /iris_0_ego_planner_node/grid_map/fx: 554.254691191
- /iris_0_ego_planner_node/grid_map/fy: 554.254691191
- /iris_0_ego_planner_node/grid_map/ground_height: -1
- /iris_0_ego_planner_node/grid_map/k_depth_scaling_factor: 1000.0
- /iris_0_ego_planner_node/grid_map/local_map_margin: 10
- /iris_0_ego_planner_node/grid_map/local_update_range_x: 5.5
- /iris_0_ego_planner_node/grid_map/local_update_range_y: 5.5
- /iris_0_ego_planner_node/grid_map/local_update_range_z: 4.5
- /iris_0_ego_planner_node/grid_map/map_size_x: 100
- /iris_0_ego_planner_node/grid_map/map_size_y: 100
- /iris_0_ego_planner_node/grid_map/map_size_z: 5
- /iris_0_ego_planner_node/grid_map/max_ray_length: 4.5
- /iris_0_ego_planner_node/grid_map/min_ray_length: 0.1
- /iris_0_ego_planner_node/grid_map/obstacles_inflation: 0.2
- /iris_0_ego_planner_node/grid_map/p_hit: 0.65
- /iris_0_ego_planner_node/grid_map/p_max: 0.9
- /iris_0_ego_planner_node/grid_map/p_min: 0.12
- /iris_0_ego_planner_node/grid_map/p_miss: 0.35
- /iris_0_ego_planner_node/grid_map/p_occ: 0.8
- /iris_0_ego_planner_node/grid_map/pose_type: 1
- /iris_0_ego_planner_node/grid_map/resolution: 0.1
- /iris_0_ego_planner_node/grid_map/show_occ_time: False
- /iris_0_ego_planner_node/grid_map/skip_pixel: 2
- /iris_0_ego_planner_node/grid_map/use_depth_filter: True
- /iris_0_ego_planner_node/grid_map/virtual_ceil_height: 3
- /iris_0_ego_planner_node/grid_map/visualization_truncate_height: 2
- /iris_0_ego_planner_node/manager/control_points_distance: 0.4
- /iris_0_ego_planner_node/manager/drone_id: 0
- /iris_0_ego_planner_node/manager/feasibility_tolerance: 0.05
- /iris_0_ego_planner_node/manager/max_acc: 2.0
- /iris_0_ego_planner_node/manager/max_jerk: 4.0
- /iris_0_ego_planner_node/manager/max_vel: 1.0
- /iris_0_ego_planner_node/manager/planning_horizon: 7.5
- /iris_0_ego_planner_node/manager/use_distinctive_trajs: True
- /iris_0_ego_planner_node/optimization/dist0: 0.5
- /iris_0_ego_planner_node/optimization/lambda_collision: 0.5
- /iris_0_ego_planner_node/optimization/lambda_feasibility: 0.1
- /iris_0_ego_planner_node/optimization/lambda_fitness: 1.0
- /iris_0_ego_planner_node/optimization/lambda_smooth: 1.0
- /iris_0_ego_planner_node/optimization/max_acc: 2.0
- /iris_0_ego_planner_node/optimization/max_vel: 1.0
- /iris_0_ego_planner_node/optimization/swarm_clearance: 0.5
- /iris_0_ego_planner_node/prediction/lambda: 1.0
- /iris_0_ego_planner_node/prediction/obj_num: 1
- /iris_0_ego_planner_node/prediction/predict_rate: 1.0
- /iris_0_traj_server/traj_server/time_forward: 1.0
- /rosdistro: melodic
- /rosversion: 1.14.13
NODES / iris_0_ego_planner_node (ego_planner/ego_planner_node) iris_0_map_to_world (tf/static_transform_publisher) iris_0_traj_server (ego_planner/traj_server) iris_0_world_to_ground_plane (tf/static_transform_publisher)
ROS_MASTER_URI=http://localhost:11311
process[iris_0_map_to_world-1]: started with pid [18217] process[iris_0_world_to_ground_plane-2]: started with pid [18218] process[iris_0_ego_planner_node-3]: started with pid [18219] process[iris_0_traj_server-4]: started with pid [18224] hit: 0.619039 miss: -0.619039 min log: -1.99243 max: 2.19722 thresh log: 1.38629 [ INFO] [1681013379.960634810]: Wait for 1 second. [FSM]: from INIT to WAIT_TARGET [iris_0_ego_planner_node-3] process has died [pid 18219, exit code -11, cmd /home/kd/catkin_ws/devel/lib/ego_planner/ego_planner_node ~odom_world:=/vins_estimator/odometry ~planning/bspline:=/xtdrone/iris_0/planning/bspline ~planning/data_display:=/xtdrone/iris_0/planning/data_display ~planning/broadcast_bspline_from_planner:=/broadcast_bspline ~planning/broadcast_bspline_to_planner:=/broadcast_bspline ~grid_map/odom:=/xtdrone/iris_0/vins_estimator/odometry ~grid_map/cloud:=/iris_0/pcl_render_node/points ~grid_map/pose:=/iris_0/camera_pose ~grid_map/depth:=/iris_0/realsense/depth_camera/depth/image_raw __name:=iris_0_ego_planner_node __log:=/home/kd/.ros/log/dbcd4c9a-d68b-11ed-96c8-d4548bbd70f4/iris_0_ego_planner_node-3.log]. log file: /home/kd/.ros/log/dbcd4c9a-d68b-11ed-96c8-d4548bbd70f4/iris_0_ego_planner_node-3*.log [ WARN] [1681013380.988374408, 2024.461000000]: [Traj server]: ready.
我解决了,是通过少写下面这一步: cd ~/XTDrone/motion_planning/3d python ego_transfer.py iris 0 不晓得原理是为啥
三维运动规划,无报错但rviz标注出来方向,无人机没反应