Merge pull request #1 from mlaszko/master

mege
Fix HomogMatrix (Eigen Align)
Merge pull request #1 from jkrasnod/master

Fix HomogMatrix