Autonomous wrench handling for Emergency Response Robots