Adding MATLAB scripts files

All relevant matlab scripts and an updated README