Fixes #79 - using position control in gazebo

Fixed the dynamic damping / pids. It is a lot more responsive on my pc. Can you test before merging, gazebo has the bad habit of acting differently on different computers...