Code to teste and control 2DOF servo limb using inverse kinematics