Augmented Lagrangian Method Matlab Free