Convert rotation and translation to homogeneous transform
TR = rt2tr(R, t) is a homogeneous transformation matrix (MxM) formed from an orthonormal rotation matrix R (NxN) and a translation vector t (Nx1) where M=N+1.
For a sequence R (NxNxK) and t (NxK) results in a transform sequence (MxMxK).
Robotics Toolbox for MATLAB © 1990-2014 Peter Corke.