Inverse Kinematics class

Uses Inverse Kinematics to convert XYZ values to servo angles