Kp: 2.5
Ki: 1.5
Kd: 0.25
Angle
Joystick