If T Is the homogeneous transformation matrix with rotation R and translation p between 2 frames, then: T−1=[RT0−RTp1]