get.rigid.M function

Transfer matrix between two frames of reference