Stack Push Function Code Matlab