5.1.2 线性罚函数接触算法