Adding Kabsch algorithm for comparing xyzs