Joint 1
Kp
Kd
Ki
Joint 2
Kp
Kd
Ki