Added PoseArray publisher in trajectory server just before Ach call.