Fast Model Predictive Control Combining Offline Method and Online Optimization with K-D Tree

Figure 9

Failure in searching the corresponding CR around the boundary.