Give particle name in error message.
Add test case to verify rigid body fix.

Closes salilab/rmf#121.