Goal Orientation Cost Function