Simox: A Robotics Toolbox for Simulation, Motion and Grasp Planning