Added the orientation to the triangle centroid pose