Fast Model Predictive Control Combining Offline Method and Online Optimization with K-D Tree. (26th August 2015)