Experimental, restructured version of move_base_straight