A general strategy for solving the motion planning problem for real analytic, controllable systems without drift is proposed. The procedure starts by computing a control that steers the given initial point to the desired target point for an extended system, in which a number of Lie brackets of the system vector fields are added. Using formal calculations with a product expansion relative to P. Hall basis, another control is produced that achieves the desired result on the formal level. This provides an exact solution of the original problem if the given system is nilpotent. For a general system, an iterative algorithm is derived that converges very quickly to a solution. For nonnilpotent systems which are feedback nilpotentizable, the algorithm, in cascade with a precompensator, produces an exact solution. Results of simulations which illustrate the effectiveness of the procedure are presented.<<ETX>>
[1]
Henry Hermes,et al.
Distributions and the Lie algebras their bases can generate
,
1989
.
[2]
M. Fliess.
Réalisation locale des systèmes non linéaires, algèbres de Lie filtrées transitives et séries génératrices non commutatives
,
1983
.
[3]
H. Sussmann.
A general theorem on local controllability
,
1987
.
[4]
P. Kokotovic,et al.
Nonlinear control via approximate input-output linearization: the ball and beam example
,
1992
.
[5]
H. Hermes,et al.
Nilpotent bases for distributions and control systems
,
1984
.
[6]
S. Sastry,et al.
Robot motion planning with nonholonomic constraints
,
1989,
Proceedings of the 28th IEEE Conference on Decision and Control,.