penalty method ISPC/Serial and Matlab

Also Augmented Lagrange method