Linear prediction based uniform state sampling for sampling based motion planning systems

We discuss the optimality and computational efficiency of sampling based motion planning (SBMP), which calculates dynamically precise and approximately optimal state transitions using arbitrarily selected nonlinear control system models. To ensure high optimality and computational efficiency, SBMP requires an approximately uniform state sampling function, though the non-linearity of the system models does not allow a perfect function. We propose linear prediction-based uniform state sampling (LPUSS) that samples approximately uniform state points while ensuring a dynamically correct state transition profile with a small calculation cost. LPUSS samples a state by using the given non-linear control system model after determining the input values by using a local linear transition model. We developed a mechanical motion planning system using LPUSS, articulated body algorithm, and parallel computing techniques. To validate LPUSS, we conducted experiments on double, triple, and sixtuple inverted pendulum models. LPUSS showed better optimality and computational efficiency with the double and triple inverted pendulum models, compared with randomized kinodynamic planning (RKP), which is based on rapid random tree (RRT), and our previously proposed rapid semi-optimal motion-planning method in which state sampling is based on uniform inputs. In particular, compared with our previous method, LPUSS was respectively 130 times and 3,000 times faster on double and triple inverted pendulum models under the condition of the same optimality. LPUSS found an approximately optimal swing up motion for the sixtuple inverted pendulum model within 40 minutes. According to our survey, there is no other optimization method that is applicable to higher than quadruple inverted pendulum models with standard constraints.