Rewrite handling of rigid bodies (and everything else atom-related) in IMP.rmf

It is currenty a mess and buggy. So split it up into simpler parts and remove some no longer used paths.

close #541