Inverse and Forward Kinematics System