Kp=3.00
Ki=0.02
Kd=0.05