Fixed RMSD calculation. Thanks Thomas.