Corrected controller gains and simulation parameters such that we have a perfect kinematic simulation without damping etc.