Moved more matlab code to the matlab source directory