Alright, Looks like I found how to do it. In the solveForwardKinematic() function, I added the equations before solving the forward kinematics. ...

Thank you for your answer Chris, I found how to disable the encoders in the software. I understood how to modify the DH parameters to change the...