optimal rigid tranformation estimation works too