Fixed bug in whitening
Polished matlab wrapper, example and CMakeList
Cleaned restartand changed default optimization values