PointSetRegistration: fast computation of sigma2
demo with easy test cases.
RigidPointSet: Use fast and correct way to calculate sigma2.
Merge pull request #1 from unapiedra/master

My proposed changes.