Alternative to move_base (navigation stack ROS) which can handle end position constraints.