Update RigidBodySimulator.hpp

+ prototype ClosestPointOnRobotRadius