ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

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

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

Felix Widmaier gravatar image

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?

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

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

Felix Widmaier gravatar image

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 more


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

A Smit gravatar image 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 gravatar image 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 gravatar image Felix Widmaier  ( 2018-05-02 02:04:22 -0500 )edit

Question Tools



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

Seen: 1,876 times

Last updated: May 16 '17