Added GetRadius to RigidBodySimulator.hpp

-Added GetRadius definition