safety-enhancing energy shaping control. Paper presented at IEEE International Conference on Robotics and Automation, Stockholm