First matlab code commit

Needs debugging