Inverse Kinematics with basic geometry