Get link's transform matrix instead of pose due to openrave compatibility issue