I'm thinking of adding Eigen::Affine3d https://github.com/RLovelett/eigen/blob/master/Eigen/src/Geometry/Transform.h to this, could you advise me on where I'll need to make changes?