Added Matlab code

Added some matlab code used in the Thesis