HyphaROS TEB planner for autonomous reversing control