Initial commit

Initial upload of matlab code