Start cleaning up main Matlab folder by moving various functions to subfolders and removing unused ones