Add Transform

Add transform and test its performance with Eigen::Affine3f.