Added matlab scripts
Added doxygen comments