Motion planning for control-affine systems satisfying low-order controllability conditions

This paper is devoted to the motion planning problem for control-affine systems by using trigonometric polynomials as control functions. The class of systems under consideration satisfies the controllability rank condition with the Lie brackets up to the second order. The approach proposed here allows to reduce a point-to-point control problem to solving a system of algebraic equations. The local solvability of that system is proved, and formulas for the parameters of control functions are presented. Our local and global control design schemes are illustrated by several examples.