IMP SIGN CORRECTION & added estimateRigidTransform