added some more tests, added fast registration cost computation