Limited speed, removed hard-coded initial condition, changed gain and reference