What are reasons for TEB planner's feasibility check to fail?

asked 2017-05-16 02:53:12 -0500

Felix Widmaier
382 ●18 ●32 ●40

I am currently experimenting with the TEB local planner and have the problem that the planner constantly fails with the following warning, even if there are no obstacles close to the path.

TebLocalPlannerROS: trajectory is not feasible. Resetting planner...

The costmap-footprint of the robot is correct (at least in Rviz it looks good). The problem does not occur anymore when I decrease the parameter feasibility_check_no_poses to 3 or less. However, since there are no obstacles close to the path, I have the feeling, that something is wrong. Are there more parameters that influence the feasibility check that might cause this behaviour?

answered 2017-05-16 05:00:28 -0500

Felix Widmaier
382 ●18 ●32 ●40

updated 2017-05-16 05:19:30 -0500

After checking the code and adding some debug-output I found the issue: It is not a problem directly in the teb planner but the footprintCost function of the base_local_planner::CostmapModel sometimes fails to convert a footprint point to map coordinates, because it is outside of the local costmap (which silently results in the same cost as if there was an obstacle).

edit flag offensive delete link

Comments

I think I'm having the same problem, is there a solution?

A Smit ( 2018-04-30 08:48:05 -0500 )edit

@A Smit: The problem is the feasibility check looking too far ahead and thus going outside of the costmap (I opened an issue about this, which is still open, though). A quick workaround is to decrease the...

Felix Widmaier ( 2018-05-02 02:03:37 -0500 )edit

... feasibility_check_no_poses parameter but the proper fix would be to improve the feasibility check so it does not try to check outside of the costmap.

Felix Widmaier ( 2018-05-02 02:04:22 -0500 )edit

add a comment

What are reasons for TEB planner's feasibility check to fail?

1 Answer

Comments

Question Tools

Stats

Related questions

What are reasons for TEB planner's feasibility check to fail? edit

1 Answer

Comments

Question Tools

Stats

Related questions

What are reasons for TEB planner's feasibility check to fail?