Stabilization of non-admissible curves for a class of nonholonomic systems
Victoria Grushkovskaya, Alexander Zuyev

TL;DR
This paper addresses the problem of stabilizing trajectories of certain nonholonomic systems by proposing an explicit control scheme that ensures exponential convergence to a reference curve, with numerical validation.
Contribution
It introduces a control design for nonholonomic systems with degree of nonholonomy equal to 1, ensuring exponential convergence to reference curves.
Findings
Trajectories converge exponentially to reference curves.
Control scheme is explicitly designed for systems with degree of nonholonomy 1.
Numerical examples validate the theoretical results.
Abstract
The problem of tracking an arbitrary curve in the state space is considered for underactuated driftless control-affine systems. This problem is formulated as the stabilization of a time-varying family of sets associated with a neighborhood of the reference curve. An explicit control design scheme is proposed for the class of controllable systems whose degree of nonholonomy is equal to 1. It is shown that the trajectories of the closed-loop system converge exponentially to any given neighborhood of the reference curve provided that the solutions are defined in the sense of sampling. This convergence property is also illustrated numerically by several examples of nonholonomic systems of degrees 1 and 2.
Peer Reviews
No public reviews on file for this paper yet. If you reviewed it on a platform where reviews are public (OpenReview, ICLR, NeurIPS, ICML), you can paste yours below so the community can read it here.
Videos
No videos yet. Explain this paper in a talk, walkthrough, or lecture? Add one.
Stabilization of non-admissible curves for a class of nonholonomic systems
††thanks: This work was supported in part by the German Research Foundation (GR 5293/1-1), NAS of Ukraine (budget program KPKBK 6541230), and the State Fund for Fundamental Research of Ukraine (F75/27190)
1Institute of Mathematics, University of Würzburg, 97074 Würzburg, Germany [email protected]
2Max Planck Institute for Dynamics of Complex Technical Systems, 39106 Magdeburg, Germany [email protected]
3Institute of Applied Mathematics and Mechanics, National Academy of Sciences of Ukraine, 841116 Sloviansk, Ukraine
Victoria Grushkovskaya1,3 and Alexander Zuyev2,3
Abstract
The problem of tracking an arbitrary curve in the state space is considered for underactuated driftless control-affine systems. This problem is formulated as the stabilization of a time-varying family of sets associated with a neighborhood of the reference curve. An explicit control design scheme is proposed for the class of controllable systems whose degree of nonholonomy is equal to 1. It is shown that the trajectories of the closed-loop system converge exponentially to any given neighborhood of the reference curve provided that the solutions are defined in the sense of sampling. This convergence property is also illustrated numerically by several examples of nonholonomic systems of degrees 1 and 2.
1 INTRODUCTION
In this paper, we consider a class of driftless control systems of the form
[TABLE]
where is the state and is the control. The stabilization of such systems has been the subject of numerous studies over the last few decades, and many important results have been obtained in this area. In particular, it follows from the famous result of R.W. Brockett [7] that the trivial equilibrium of (1) is not stabilizable by a regular time-invariant feedback law if the vectors , , …, are linearly independent. Despite the significant progress in the development of control algorithms to stabilize the solution of system (1) (see, e.g., [4, 6, 8, 17, 23, 21, 25, 26, 30, 31], and references therein), the stabilization of nonholonomic systems to a given curve remains a challenging problem. This issue can be formulated as the trajectory tracking problem. In many papers, this problem has been addressed under the assumption that the trajectory is admissible, i.e. satisfies the system equations with some control inputs [1, 2, 3, 10, 11, 20, 27, 28, 29]. Since the number of controls may be significantly smaller than the dimension of the state space , not every path in the state space is admissible for system (1). However, in many applied problems, it is important to stabilize system (1) along an arbitrary curve, which is not necessarily admissible. As it is mentioned in [22], although it is not possible to asymptotically stabilize nonholonomic systems to non-admissible curves because of the non-vanishing tracking error, the practical stabilization can be achieved. It has to be noted that such problem has been addressed only for particular classes of systems, e.g., for unicycle and car-like systems [22, 13, 24]
This paper deals with rather general formulation of the stabilization problem with non-admissible reference curves. The main contribution of our paper is twofold. First, we introduce a class of control functions for the first degree nonholonomic systems, which allows stabilizing the system in a prescribed neighborhood of an arbitrary (not necessarily admissible) curve. We also show how the obtained results can be extended to higher degree nonholonomic systems. The proposed feedback design scheme is based on the approach introduced in [30, 32, 14] for the stabilization and motion planning of nonholonomic systems. However, it has to be noted that the results of these papers cannot be directly applied for the stabilization of non-admissible curves. Second, we characterize stability properties of system (1) with the proposed controls in terms of families of sets. Note that the concept of stability of families of sets was used previously in [19, 12, 13] for non-autonomous system admitting a Lyapunov function. In the present paper, we do not assume the existence of a control Lyapunov function and define solutions of the closed-loop system in the sense of sampling.
The rest of the paper is organized as follows. In the remainder of this section, we introduce some basic notations, recall the notion of stability of sets, and give a precise problem statement. The main result will be proved in Section II and illustrated with some examples in Section III.
1.1 Notations and definitions
To generate attractive control strategies for system (1) in a neighborhood of a given curve , we will follow the idea of [30] and define solutions of the corresponding closed-loop system in the sense of sampling. With a slight abuse of notation, we will also identify the curve with the map , . For a given , we consider the partition of into intervals
Definition 1
Assume given a curve , a feedback law , and an . A -solution of (1) corresponding to and is an absolutely continuous function , defined for , such that and, for each ,
[TABLE]
For , , we denote the Lie derivative as , and is the Lie bracket. Throughout this paper, stands for the Euclidean norm of a vector , and the norm of an -matrix is defined as .
1.2 Stability of a family of sets
To characterize the asymptotic behavior of trajectories of system (1), we will extend the concept of stability of a family of sets to the case of -solutions. This concept has been developed, e.g., in [19] for non-autonomous differential equations and applied to control problems under the classical definition of solutions in [12, 13]. Let be a one-parameter family of non-empty subsets of . For a , we denote the -neighborhood of the set at time as The distance from a point to a set is denoted as . Assume given a curve , a time-varying feedback law , and a sampling parameter . The basic stability definition that we exploit in this paper is as follows.
Definition 2
A one-parametric family of sets is said to be exponentially stable for the closed-loop system (1) with in the sense of -solutions if there exist such that, for any , the corresponding -solution of (1) satisfies for all with some .If the above exponential decay property holds for every , then the family of sets is called globally exponentially stable in the sense of -solutions.
1.3 Problem statement
Using the notion of stability of a family of sets, it is convenient to formulate the control design problem under consideration as follows:
Problem 1
Given a curve and a constant , the goal is to find a time-varying feedback law such that the family of sets
[TABLE]
is exponentially stable for the closed-loop system (1) with in the sense of Definition 2.
We will propose a solution to the above problem with a -curve for the nonholonomic systems of degree one, i.e., we assume that there is an such that the following rank condition holds in :
[TABLE]
for all , with some sets of indices , such that .
2 MAIN RESULTS
2.1 Control design
To solve Problem 1, we extend the control design approach proposed in [14]. Namely, we use a family of trigonometric polynomials with state-dependent coefficients chosen in such a way that the trajectory of system (1) approximate the gradient flow of a time-invariant Lyapunov function. In this paper, the corresponding Lyapunov function is time-varying, so we allow the above mentioned coefficients to depend on time. We define the control functions in the following way:
[TABLE]
Here is the Kronecker delta, are pairwise distinct, and
[TABLE]
where
[TABLE]
with \mathcal{F}(x){=}\Big{(}\big{(}f_{j}(x)\big{)}_{j\in S_{1}}\ \ \big{(}[f_{j_{1}},f_{j_{2}}](x)\big{)}_{(j_{1},j_{2})\in S_{2}}\Big{)} and . Note that (3) implies that is nonsingular in .
2.2 Stability analysis
The main result of this paper is as follows.
Theorem 1
Let , , , and be such that the matrix is nonsingular in , , , are bounded in (), for all , and for all . Then, for any , there exists an such that the family of sets (2) is exponentially stable for system (1) with the controls defined by (4)–(5) with any and in the sense of Definition 2.***
The proof of this theorem is given in the Appendix.
The next corollary follows from the proof of Theorem 1.
Corollary 1
Let the conditions of Theorem 1 be satisfied, and let as . Then there is a such that as , provided that and the solutions of the closed-loop system (1), (4)–(5) are defined in the sense of Definition 1.
Let us emphasize that, in contrast to many other results on stability of non-autonomous systems (e.g., [16]), we do not require the boundedness of in general.
3 EXAMPLES
In this section, we consider some examples illustrating Theorem 1 and discuss the possibility of extending the above results to systems with a higher degree of nonholonomy.
3.1 Unicycle
As the first example, consider the equations of motion of the unicycle:
[TABLE]
where are the coordinates of the contact point of the unicycle, is the angle between the wheel and the -axis, and control the forward and the angular velocity, respectively. Denote f_{1}(x)=\big{(}\cos(x_{3}),\sin(x_{3}),0\big{)}^{\top}, f_{2}(x)=\big{(}0,0,1\big{)}^{\top}. Then the rank condition (3) is satisfied for all with , , [f_{1},f_{2}](x)=\big{(}\sin(x_{3}),-\cos(x_{3}),0\big{)}^{\top}. Thus, the conditions of Theorem 1 hold with , . For stabilizing system (6) to a given curve , we take controls (4) with :
[TABLE]
[TABLE]
Fig. 1 (left) shows the trajectory plots of system (6) with the curve \gamma^{(1)}(t)=\big{(}2\cos\tfrac{t}{2}\cos t,2\cos\tfrac{t}{2}\sin t,\cos\tfrac{t}{10}\big{)}^{\top}.
To illustrate Corollary 1, consider the curve \gamma^{(2)}(t)=\big{(}3-e^{1-t},\,e^{-t^{2}},0\big{)}^{\top}, for which as . Consequently, as , see Fig. 1 (middle).
Remark 1
The above and are non-admissible for system (6), which yields an oscillatory behavior. Note that the asymptotic stability can be achieved for admissible curves. To illustrate this, consider the trajectory governed by , , The corresponding plot is shown in Fig. 1 (right).
3.2 Underwater vehicle
The next example is given by the equations of motion of an autonomous 3D underwater vehicle (see, e.g., [5]):
[TABLE]
where are the coordinates of the center of mass, , , describe the vehicle orientation (Euler angles), is the translational velocity along the axis, and are the angular velocity components,
[TABLE]
[TABLE]
The rank condition (3) is satisfied in with . Therefore, the matrix
[TABLE]
is nonsingular in . Thus, controls (4) take the form
[TABLE]
with
For the illustration, take The results of numerical simulations are shown in Fig. 2. Note that the curve is non-admissible for system (8), which results in an oscillatory behavior of the trajectories.
3.3 Rear-wheel driving car
The proposed approach can also be extended to nonholonomic systems of higher degrees. For systems of degree two, it is possible to use a control design scheme similar to that introduced in [14, 32]. For example, consider a kinematic model of a rear-wheel driving car proposed in [9]:
[TABLE]
where are the Cartesian coordinates of the rear wheel, is the steering angle, specifies the orientation of the car body with respect to the axis, and are the driving and the steering velocity input, respectively,
[TABLE]
In this case, for all . Following the control design scheme from [14], we take
[TABLE]
with the vector of coefficients and \mathcal{F}(x)=\left(f_{1}(x)\ f_{2}(x)\ [f_{1},f_{2}](x),\ \big{[}[f_{1},f_{2}],f_{1}\big{]}(x)\right).
Fig. 3 presents the trajectory plots of system (10)–(11) for a non-admissible curve
4 CONCLUSIONS AND FUTURE WORK
The above numerical simulations confirm that the proposed controller (4) can be used for approximate tracking of reference curves under an appropriate choice of parameters and . By comparing the left and right plots in Fig. 1, we note that the amplitude of oscillations near non-admissible curve (Fig. 1, left) significantly exceeds the deviation from the admissible curve (Fig. 1, right). This feature underlines the assertion of Corollary 1 and illustrates the essence of our approach for considering the stability of a family of sets. The example in Section III.C shows that our approach can also be extended to nonholonomic systems of higher degrees. We do not study here the stabilization problem under general controllability conditions, leaving this issue for future work.
Appendix A Proof of the main result
A.1 Proof of Theorem 1
To prove Theorem 1, we will use the following result.
Lemma 1** ([30])**
Let be a convex domain, and let , , be a solution of system (1) with some control . Assume that there exist such that for all , . Then
[TABLE]
with .**
Lemma 2** ([18, 15])**
Let the vector fields be Lipschitz continuous in a domain , and , where . Assume, moreover, that , for all . If , , is a solution of system (1) with and , then can be represented by the Volterra series:
[TABLE]
where
[TABLE]
is the remainder of the Volterra series expansion.**
Proof of Theorem 1
Let us take any positive numbers , , and from the inequalities and denote , . It is clear that
[TABLE]
Let . Our first goal is to find an such that the corresponding solution of system (1) with the initial condition and controls (4) is well-defined on and satisfies the property for all , . Let the control functions be defined by (4), and let Using Hölder’s inequality, one can estimate as
[TABLE]
with , C_{2}=4\sqrt{{\pi\mu\alpha}}\Big{(}\sum_{(j_{1},j_{2})\in S_{2}}{\kappa_{j_{1}j_{2}}}^{2/3}\Big{)}^{3/4}. Note also that
[TABLE]
From Lemma 1 and estimate (14),
[TABLE]
Thus, defining and
[TABLE]
we conclude that for any ,
[TABLE]
so that the solutions of system (1) with controls (4) and the initial conditions stay in for all . Moreover, (15) and (16) yield that if , then for each :
[TABLE]
Using Lemma 2 we obtain the following representation of the solutions of system (1) with the controls defined by (4) and the initial conditions :
[TABLE]
where
[TABLE]
Denote
[TABLE]
Then from (14),
[TABLE]
for all , and
[TABLE]
where
[TABLE]
Considering (18) and (15), we obtain
[TABLE]
Recall that \rho^{\prime}\in\Big{(}\frac{\nu}{\alpha},\rho\Big{)}. For any , let \varepsilon_{2}=\frac{1}{\delta^{\prime}}\Big{(}\frac{\alpha-\lambda}{\sigma}-\frac{\nu}{\sigma\rho^{\prime}}\Big{)}^{2},\Big{(}\lambda+\frac{\nu}{\rho^{\prime}}\Big{)}^{-1}. Then, for any , ,
[TABLE]
Consider two cases.
Case 1) If , then it is easy to see from (19) that . From (17), for each .
Case 2) Assume now that . Then
[TABLE]
Iterating the above inequality for , we conclude that there exists an such that for each , and (this can be proved by contradiction). Repeating the argumentation of Case 1) and Case 2), we conclude that for all .
It remains to consider an arbitrary . Denote by t_{in}=\Big{[}\frac{t}{\varepsilon}\Big{]} the integer part of . Since , we have
[TABLE]
where From (14),
[TABLE]
Let \varepsilon_{3}\in\Big{(}0,\frac{1}{\delta^{\prime}}\Big{(}\sqrt{\frac{C_{2}^{2}}{4C_{1}^{2}}+\frac{1}{L}}-\frac{C_{2}}{2C_{1}}\Big{)}^{2}\Big{)}. Then, for any ,
[TABLE]
where ,
[TABLE]
Thus, for any , there exists a such that for all , and for all , which proves Theorem 1.
The reference list from the paper itself. Each links out to its DOI / PubMed record.
- 1[1] A. Ailon, N. Berman, and S. Arogeti, On controllability and trajectory tracking of a kinematic vehicle model, Automatica, Vol. 41, no. 5, pp. 889–896, 2005.
- 2[2] Z.A. Ali, D. Wang, M. Safwan, W. Jiang, and M. Shafiq, Trajectory Tracking of a Nonholonomic Wheeleed Mobile Robot Using Hybrid Controller, International Journal of Modeling and Optimization, Vol. 6, No. 3, pp. 136–141, 2016.
- 3[3] B. d’Andréa-Novel, G. Campion, and G. Bastin, Control of nonholonomic wheeled mobile robots by state feedback linearization, The International Journal of Robotics Research, Vol. 14, No. 6, pp. 543–559, 1995.
- 4[4] A. Astolfi, On the stabilization of nonholonomic systems, in Proc. 33rd IEEE Conf. on Decision and Control, Vol. 4, pp. 3481–3486, 1994.
- 5[5] J. Barraquand and J.-C. Latombe, On non-holonomic mobile robots and optimal maneuvering,Revue d’Intelligence Artificielle, Vol. 13, pp. 77–103, 1989.
- 6[6] A. M. Bloch, M. Reyhanoglu, and N. H. Mc Clamroch, Control and stabilization of nonholonomic dynamic systems, IEEE Transactions on Automatic control, Vol. 37, No. 11, pp. 1746–1757, 1992.
- 7[7] R. W. Brockett, Asymptotic stability and feedback stabilization, in Differential Geometry Control Theory, R.W. Brockett, R.S. Hillman, H.J. Sussmann, Eds. Boston: Birkhäuser, 1983, pp. 181–191.
- 8[8] J.-M. Coron, Global asymptotic stabilization for controllable systems without drift, Math. Control Signals Systems, vol. 5, pp. 295–312, 1992.
