5.1.1 非线性罚函数接触算法