OpenGRASP: A Toolkit for Robot Grasping Simulation