TEB local planner oscillates along straight line

asked 2020-09-28 09:39:49 -0500

Shedi gravatar image

Hey,

I am trying to execute a motion along straight line. It suppose to be a motion back and forth, like from (0,0) to (5,0) and then back to (0,0). I modified global planner to provide such plan as a one path, however local planner acts very weird. It moves the robot to point around (2.5, 0) and then local plan end-point starts jumping. It jumps to the front and to the back of the robot (distance between the robot and local planner end-point is equal to max_global_plan_lookahead_dist, changing that parameter doesn't change its behavior). I tried to use viapoints, change weights for that etc. but it doesn't help. Robot moves a little bit forth, and then local planner end-point jumps on the back. It oscillates like that forever. I am using omnidirectional robot but it should not be the case here.

I guess that the easiest way to reproduce it would be to generate global plan like the one below and start execution (some subgoals may be needed). I will appreciate at least some hints which parameters should I change to make it work. Thanks :)

header: 
  seq: 1
  stamp: 
    secs: 0
    nsecs: 425000000

  frame_id: "map"
poses: 
  - 
header: 
  seq: 0
  stamp: 
    secs: 0
    nsecs: 500000000
  frame_id: "map"
pose: 
  position: 
    x: 5.0
    y: 0
    z: 0.0
  orientation: 
    x: 0.0
    y: 0.0
    z: 0
    w: 1.0
  - 
header: 
  seq: 2
  stamp: 
    secs: 0
    nsecs: 600000000
  frame_id: "map"
pose: 
  position: 
    x: 0.0
    y: 0
    z: 0.0
  orientation: 
    x: 0.0
    y: 0.0
    z: 0
    w: 1.0
edit retag flag offensive close merge delete

Comments

Did you solve your problem?

tropic gravatar image tropic  ( 2020-10-13 14:51:01 -0500 )edit

Not yet, sorry

Shedi gravatar image Shedi  ( 2020-10-19 05:44:08 -0500 )edit