How To Write Optimization Function In Matlab