Matlab代码在qpOASES方面进行了详细优化。