Added setGoalWaypoint to ca obj