openPlanner can not avoid obstacles

asked 2022-04-03 00:13:51 -0500

LinkX gravatar image

I set up several obstacles in the simulation environment and completed all preliminary preparations such as maping and locatilizing. The simulation environment is shown in Figure 1. figure 1

I wanted to verify the local path planning function of OP, but the planned local path did not show the obstacle avoidance function, as shown in Figure 2. figure 2

Even though there were obstacles, the path did not turn red. If I start the vehicle at this time, it will run directly into an obstacle. I have checked the topic /tracked_objects published by node /lidar_kf_contour_track. It has the output of obstacles like:

 header: 
  seq: 0
  stamp: 
    secs: 0
    nsecs:         0
  frame_id: ''
id: 0
label: ''
score: 0.0
color: 
  r: 0.0
  g: 0.0
  b: 0.0
  a: 0.0
valid: False
space_frame: ''
pose: 
  position: 
    x: -0.733727872372
    y: 5.61534357071
    z: 1.81427035084
  orientation: 
    x: 0.0
    y: 0.0
    z: 0.0
    w: 1.0
dimensions: 
  x: 1.74335861206
  y: 1.6983089447
  z: 1.46313762665
variance: 
  x: 0.0
  y: 0.0
  z: 0.0
velocity: 
  linear: 
    x: 0.00601311960223
    y: -0.0132639864352
    z: 0.0
  angular: 
    x: 0.0
    y: 0.0
    z: 0.0
acceleration: 
  linear: 
    x: 0.0
    y: 0.0
    z: 0.0
  angular: 
    x: 0.0
    y: 0.0
    z: 0.0
pointcloud: 
  header: 
    seq: 0
    stamp: 
      secs: 0
      nsecs:         0
    frame_id: ''
  height: 0
  width: 0
  fields: []
  is_bigendian: False
  point_step: 0
  row_step: 0
  data: []
  is_dense: False
convex_hull: 
  header: 
    seq: 0
    stamp: 
      secs: 0
      nsecs:         0
    frame_id: ''
  polygon: 
    points: 
      - 
        x: -0.128497362137
        y: 5.73296022415
        z: 1.81427037716
      - 
        x: -0.0418645143509
        y: 6.07044744492
        z: 1.81427037716
      - 
        x: -0.232710003853
        y: 6.43886470795
        z: 1.81427037716
      - 
        x: -0.423555493355
        y: 6.80728244781
        z: 1.81427037716
      - 
        x: -0.752950668335
        y: 6.57465362549
        z: 1.81427037716
      - 
        x: -1.08234596252
        y: 6.34202432632
        z: 1.81427037716
      - 
        x: -1.4117411375
        y: 6.10939502716
        z: 1.81427037716
      - 
        x: -1.74113631248
        y: 5.87676620483
        z: 1.81427037716
      - 
        x: -1.63342428207
        y: 5.50282096863
        z: 1.81427037716
      - 
        x: -1.52571225166
        y: 5.12887525558
        z: 1.81427037716
      - 
        x: -1.11913228035
        y: 5.06570291519
        z: 1.81427037716
      - 
        x: -0.809655547142
        y: 5.15245866776
        z: 1.81427037716
      - 
        x: -0.500178813934
        y: 5.23921442032
        z: 1.81427037716
      - 
        x: -0.215130209923
        y: 5.39547300339
        z: 1.81427037716
candidate_trajectories: 
  id: 0
  lanes: []
pose_reliable: False
velocity_reliable: True
acceleration_reliable: False
image_frame: ''
x: 0
y: 0
width: 0
height: 0
angle: 0.0
roi_image: 
  header: 
    seq: 0
    stamp: 
      secs: 0
      nsecs:         0
    frame_id: ''
  height: 0
  width: 0
  encoding: ''
  is_bigendian: 0
  step: 0
  data: []
indicator_state: 0
behavior_state: 0
user_defined_info: []

I hope someone can help me solve it, thank you!

edit retag flag offensive close merge delete

Comments

which version and branch do you use, also make sure that op_predictor can receive the obstacle list from kf_contour_tracker and publish the obstacle list to op_trajectory_evaluator

Hatem gravatar image Hatem  ( 2022-04-27 10:12:31 -0500 )edit