Update on matlab files.

Something is still wrong: fails the optimization because the system is ill-posed