Changed the icp example (pmicp) to accept initial translation/rotation input and allow to output the transformation matrices