Matlab OOP Nearly finished