teb_local_planner outdated

teb_local_planner::HomotopyPlanner does not respect the free_goal_vel for its plan method.

The upstream repository has this fixed. Maybe we want to merge upstream into our fork?