Inverse Kinematics Help: Math Behind FABRIK

Maybe THIS will help?