fix(sim): fix collision detection and improve gripper/robot reset#231

juelg merged 4 commits intomasterRobotControlStack/robot-control-stack:masterfrom

fix/sim-resetRobotControlStack/robot-control-stack:fix/sim-resetCopy head branch name to clipboard