Fix HomogMatrix (Eigen Align)