Simplifying centre-of-mass util funcs and cleaning up rot diff funcs
Adding rotational diffusion tests