use pid controller (with a kp of 1) for drive functions