Moved matlab code to code/matlab for organizational purposes