Finding Optimal Path Using Optimization Toolbox