Change some PID vals. It is getting to working.