Writing Function In Matlab