A Global Steering Method for Nonholonomic Systems

In this paper, we present an iterative steering algorithm for nonholonomic systems (also called driftless control-affine systems) and we prove its global convergence under the sole assumption that the Lie Algebraic Rank Condition (LARC) holds true everywhere. That algorithm is an extension of the one introduced in [21] for regular systems. The first novelty here consists in the explicit algebraic construction, starting from the original control system, of a lifted control system which is regular. The second contribution of the paper is an exact motion planning method for nilpotent systems, which makes use of sinusoidal control laws and which is a generalization of the algorithm described in [29] for chained-form systems

Combining Homotopy Methods and Numerical Optimal Control to Solve Motion Planning Problems

This paper presents a systematic approach for computing local solutions to motion planning problems in non-convex environments using numerical optimal control techniques. It extends the range of use of state-of-the-art numerical optimal control tools to problem classes where these tools have previously not been applicable. Today these problems are typically solved using motion planners based on randomized or graph search. The general principle is to define a homotopy that perturbs, or preferably relaxes, the original problem to an easily solved problem. By combining a Sequential Quadratic Programming (SQP) method with a homotopy approach that gradually transforms the problem from a relaxed one to the original one, practically relevant locally optimal solutions to the motion planning problem can be computed. The approach is demonstrated in motion planning problems in challenging 2D and 3D environments, where the presented method significantly outperforms a state-of-the-art open-source optimizing sampled-based planner commonly used as benchmark

Exponential stabilization of driftless nonlinear control systems using homogeneous feedback

This paper focuses on the problem of exponential stabilization of controllable, driftless systems using time-varying, homogeneous feedback. The analysis is performed with respect to a homogeneous norm in a nonstandard dilation that is compatible with the algebraic structure of the control Lie algebra. It can be shown that any continuous, time-varying controller that achieves exponential stability relative to the Euclidean norm is necessarily non-Lipschitz. Despite these restrictions, we provide a set of constructive, sufficient conditions for extending smooth, asymptotic stabilizers to homogeneous, exponential stabilizers. The modified feedbacks are everywhere continuous, smooth away from the origin, and can be extended to a large class of systems with torque inputs. The feedback laws are applied to an experimental mobile robot and show significant improvement in convergence rate over smooth stabilizers

Nonholonomic motion planning: steering using sinusoids

Methods for steering systems with nonholonomic constraints between arbitrary configurations are investigated. Suboptimal trajectories are derived for systems that are not in canonical form. Systems in which it takes more than one level of bracketing to achieve controllability are considered. The trajectories use sinusoids at integrally related frequencies to achieve motion at a given bracketing level. A class of systems that can be steered using sinusoids (claimed systems) is defined. Conditions under which a class of two-input systems can be converted into this form are given

Towards a Hamilton-Jacobi Theory for Nonholonomic Mechanical Systems

In this paper we obtain a Hamilton-Jacobi theory for nonholonomic mechanical systems. The results are applied to a large class of nonholonomic mechanical systems, the so-called \v{C}aplygin systems.Comment: 13 pages, added references, fixed typos, comparison with previous approaches and some explanations added. To appear in J. Phys.

Path planning for simple wheeled robots : sub-Riemannian and elastic curves on SE(2)

This paper presents a motion planning method for a simple wheeled robot in two cases: (i) where translational and rotational speeds are arbitrary and (ii) where the robot is constrained to move forwards at unit speed. The motions are generated by formulating a constrained optimal control problem on the Special Euclidean group SE(2). An application of Pontryagin’s maximum principle for arbitrary speeds yields an optimal Hamiltonian which is completely integrable in terms of Jacobi elliptic functions. In the unit speed case, the rotational velocity is described in terms of elliptic integrals and the expression for the position reduced to quadratures. Reachable sets are defined in the arbitrary speed case and a numerical plot of the time-limited reachable sets presented for the unit speed case. The resulting analytical functions for the position and orientation of the robot can be parametrically optimised to match prescribed target states within the reachable sets. The method is shown to be easily adapted to obstacle avoidance for static obstacles in a known environment

Trajectory generation for the N-trailer problem using Goursat normal form

Develops the machinery of exterior differential forms, more particularly the Goursat normal form for a Pfaffian system, for solving nonholonomic motion planning problems, i.e., motion planning for systems with nonintegrable velocity constraints. The authors use this technique to solve the problem of steering a mobile robot with n trailers. The authors present an algorithm for finding a family of transformations which will convert the system of rolling constraints on the wheels of the robot with n trailers into the Goursat canonical form. Two of these transformations are studied in detail. The Goursat normal form for exterior differential systems is dual to the so-called chained-form for vector fields that has been studied previously. Consequently, the authors are able to give the state feedback law and change of coordinates to convert the N-trailer system into chained-form. Three methods for planning trajectories for chained-form systems using sinusoids, piecewise constants, and polynomials as inputs are presented. The motion planning strategy is therefore to first convert the N-trailer system into Goursat form, use this to find the chained-form coordinates, plan a path for the corresponding chained-form system, and then transform the resulting trajectory back into the original coordinates. Simulations and frames of movie animations of the N-trailer system for parallel parking and backing into a loading dock using this strategy are included

The Hamiltonian and Lagrangian Approaches to the Dynamics of Nonholonomic Systems

This paper compares the Hamiltonian approach to systems with nonholonomic constraints (see Weber [1982], Arnold [1988], and Bates and Sniatycki [1993], van der Schaft and Maschke [1994] and references therein) with the Lagrangian approach (see Koiller [1992], Ostrowski [1996] and Bloch, Krishnaprasad, Marsden and Murray [1996]). There are many differences in the approaches and each has its own advantages; some structures have been discovered on one side and their analogues on the other side are interesting to clarify. For example, the momentum equation and the reconstruction equation were first found on the Lagrangian side and are useful for the control theory of these systems, while the failure of the reduced two form to be closed (i.e., the failure of the Poisson bracket to satisfy the Jacobi identity) was first noticed on the Hamiltonian side. Clarifying the relation between these approaches is important for the future development of the control theory and stability and bifurcation theory for such systems. In addition to this work, we treat, in this unified framework, a simplified model of the bicycle (see Getz [1994] and Getz and Marsden [1995]), which is an important underactuated (nonminimum phase) control system