Could you please give me a bit more details, like where can I find the information about SCARA kinematics, as well as the notations? I also don’t understand the meaning of the variables like SCARA_C2, SCARA_S2, SCARA_K1, SCARA_K2, SCARA_theta, SCARA_psi, dCal_X = 0, dCal_Y = 0;