Barrier and penalty function example