Extended Lagrange and penalty functions in optimization

- Rubinov, Alex, Yang, Xiao, Glover, Barney