adds template matching, extends PoseEstimation srv message