Writing A Function In Matlab