PointSetRegistration: fast computation of sigma2
demo with easy test cases.
RigidPointSet: Use fast and correct way to calculate sigma2.