9.4.1 约束跟踪问题的稳定值迭代算法推导