Updated umeyama similarity transformation because Eigen has a bug in their implementation

Change-Id: I10a938ecfd19f51a523bea26e7fa0bee54eab82c
Merge "Updated umeyama similarity transformation because Eigen has a bug in their implementation"