Update RigidBodySimulator.hpp

-fixed improper indexing in GetRadius