Tuned the PD controller a bit.