Journal of Robotics

Volume 2011 (2011), Article ID 697309, 8 pages

http://dx.doi.org/10.1155/2011/697309

## Local Exponential Regulation of Nonholonomic Systems in Approximate Chained Form with Applications to Off-Axle Tractor-Trailers

The Seventh Research Division, BeiHang University, Beijing 100191, China

Received 21 January 2011; Revised 29 April 2011; Accepted 2 June 2011

Academic Editor: G. Muscato

Copyright © 2011 Bao-Li Ma. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

#### Abstract

Most of drift-less nonholonomic systems cannot be exactly converted to an nonholonomic chained form, a wealth of design tools developed for the control of nonholonomic chained form are thus not directly applicable to such systems. Nevertheless, there exists a class of systems that may be locally approximated by the nonholonomic chained form around certain equilibrium points. In this work, we propose a discontinuous and a smooth time-varying control laws respectively for the approximated nonholonomic chained form, guaranteeing local exponential convergence of state to the desired equilibrium point. An tractor towing off-axle trailers is taken as an example to illustrate the approaches.

#### 1. Introduction

The so-called *nonholonomic chained form* (NCF) has motivated many research activities for about twenty years [1]. Several features such as flatness [2, 3], homogeneity, and nilpotency make the NCF especially attractive to work with. These properties have been used for designing control laws to achieve several control objects such as point stabilization and trajectory tracking. Concerning the point stabilization problem of NCF, which is difficult due to Brokett's well-known obstruction [4], a number of approaches have been developed, which may be roughly classified into discontinuous time-invariant feedback [5–7], continuous time-varying feedback [8–10], and hybrid feedback [11, 12]. The stabilization problems of NCF with parameter uncertainties and perturbation terms have also been attacked in recent years [13–17]; however, most of these researches require that the perturbation terms satisfy certain cascaded conditions, which may be very restrictive and thus rule out many interesting examples such as the tractor-trailers with off-axle hitching [18] and the ball-plate systems [19]. It is also mentioned that the dynamics of many nonholonomic driftless systems can be approximated by NCF locally around certain equilibrium points. In [18], a time-varying continuous stabilizing scheme was proposed for such approximate NCF, achieving local exponential stability of the closed-loop system around the selected equilibrium point.

In this paper, we consider the local exponential regulation problem of a class of nonholonomic systems convertible to the approximate NCF. By employing a discontinuous and/or a smooth time-varying coordinate transformations, the approximate NCF is converted to linear perturbed ones with the perturbation terms being second or higher orders of the converted states; then a discontinuous time-invariant and/or a smooth time-varying control laws are derived respectively, guaranteeing that the state of the approximate NCF converges to zero exponentially, provided the norm of an initial state is sufficiently small. Compared with the control law presented in [18] which is continuous but not differentiable, the time-varying control law proposed in this paper is smooth and can be easily extended to deal with input dynamics.

The paper is organized as follows. Section 2 defines a class of systems that can be approximated by NCF. In Section 3, a discontinuous time-invariant and a smooth time-varying controllers are developed to stabilize the approximate NCF. In Section 4, a tractor-trailer with off-axle hitching is taken as an example to illustrate the effectiveness of the proposed controllers. Section 5 concludes the paper.

#### 2. A Class of Approximated Chained Forms

Consider the following nonlinear system represented by where are state variables and are control inputs. The control vector fields are supposed to have the following forms: where denotes the first-or higher-order residual term of and the second or higher-order residual term of in the state domain ; or, say more precisely, there exist three positive constants , and such that are bounded by in the compact set .

System (1)-(2) is called the approximate NCF if (3)–(5) are satisfied.

*Remark 1. *Without loss of generality, it is specially assumed in (4) that is in the canonical controllable form. For the controllable pair not in this form, one can always find a linear state transformation to convert it to this form.

*Remark 2. *It is noted that the approximate NCF (1)-(2) is not flat with certain defects [2] and thus difficult to control.

The approximate NCF represents a large class of nonholonomic systems that cannot be converted to NCF in which . The examples of approximate NCF include tractor-trailers with off-axle hitching [18] and the ball-plate systems [19].

#### 3. Local Exponential Regulation of the Approximate NCF

In this section, a discontinuous and a smooth time-varying control laws are derived to solve the local exponential regulation problem of the approximate NCF defined in (1)–(5).

##### 3.1. Local Exponential Regulation of the Approximate NCF for

The control law for the first control input is designed as with , so that .

Substituting (6) into (2) results

Inspired by the well-known -process [5], we introduce the following discontinuous state transformation: with and a positive integer to be determined.

*Remark 3. *The discontinuous coordinate transformation (8)-(9) is a generalization of the ordinary process proposed in [5] with for NCF. It is seen in what follows that the term with is crucial for the controller design of the approximate NCF.

The transformation matrix is clearly nonsingular for .

The dynamics of the transformed state can be derived as

Direct calculation reveals that

Substituting the above identities into (10) results in where

*Remark 4. *As is controllable, so is ; hence, the eigenvalues of can be arbitrarily assigned by selecting the control gain .

The second control input is designed as where is a control gain row vector such that is Hurwitz.

The closed-loop system of (12) and (14) becomes where

System (15) is a linear stable one perturbed by a residual term . If can be shown to be second or higher order of , then (15) is locally exponential stable.

In view of (5), the converted residual term is bounded by with defined as

As , is thus bounded uniformly with provided . In view of the facts that is Hurwitz and , system (15) is thus locally exponential stable by Lyapunov indirect approach [20].

The above analysis is summarized as the following proposition.

Proposition 1. *Suppose that , , , is selected such that is Hurwitz then the following control law
**
guarantees that the states , globally converge to zero and , converge to zero exponentially for a sufficiently small . *

* Proof. *It is obvious that globally converge to zero exponentially. As is Hurwitz and with uniformly bounded with , the closed-loop system (15) is locally exponential stable, implying that and are all convergent to zero exponentially for a sufficiently small .

Proposition 1 is only applicable for . In the case of , the proposed control law fails to work as the transformation matrix becomes singular. This problem may be solved by introducing a switching mechanism that first drives away from zero in finite time and then switches to the control law (19) to achieve local exponential regulation for an arbitrarily and a sufficiently small . However, such switching control law is discontinuous and may cause problems when the velocity input dynamics is included in the model since the discontinuities of velocity inputs lead to infinite accelerations.

In the next subsection, the controller (19) is modified to be smooth and time varying for an arbitrary so that the acceleration signals are bounded.

##### 3.2. Local Exponential Regulation of the Approximate NCF for an Arbitrary

The control law for the first control input is designed as with , , .

Let ; then , so that , , , and are all globally convergent to zero exponentially.

Now we introduce the following smooth time-varying state transformation: with and a positive integer to be determined.

As , the transformation matrix is clearly nonsingular for all .

The dynamics of the transformed state can be derived as

Simple calculation reveals that

Substituting the above identities into (23) results in where is defined in (13).

The second control input is designed as where is a control gain row vector selected such that is Hurwitz.

The closed-loop system of (25) and (26) becomes where

In view of (5), the converted residual term can be shown to be bounded by with defined as

As , are both bounded uniformly with , and is thus uniformly bounded provided . Since is Hurwitz and converges to zero exponentially, system is globally exponential stable, and hence the perturbed system is locally exponential stable by Lyapunov indirect approach [20].

Based on the above analysis, we arrive at the following results.

Proposition 2. *Suppose that , , , , is selected such that is Hurwitz, then the following control law
**
guarantees that the states , globally converge to zero exponentially and , converge to zero exponentially for a sufficiently small .*

* Proof. * It is obvious that globally converge to zero exponentially. As is Hurwitz and with uniformly bounded with , the closed-loop system (27) is locally exponential stable, implying that and are all convergent to zero exponentially for a sufficiently small .

*Remark 5. *Compared with the approach presented in [18] where the control law is continuous but not differentiable, the proposed control law (31) in this paper is smooth time varying and hence can be easily extended to include input dynamics of the approximate NCF (1)-(2) by one-step back-steeping.

#### 4. An Example: Local Exponential Regulation of an Off-Axle Tractor-Trailer

Consider a tractor-trailer with a wheeled mobile tractor towing off-axle wheeled trailers shown in Figure 1, where denote the position and orientation of body , () denote the linear and angular velocities of body , represent the difference of orientation angles between body and body . is the center point on the wheel axle of body and the connection point of body and body . The distance between and is , and the distance between and is .

The kinematic equation of the tractor is

The kinematic relations of trailer can be derived as

Select as the state variables, and as the control inputs, the state equation can be derived from (32)-(33) as where are high-order residual terms satisfying (5) and

The control object can be stated as design control law such that the states of the closed-loop system (34)-(35) converge to zero exponentially.

To apply Propositions 1 and 2 obtained in Section 3, it is required to verify the controllability of .

Lemma 1. *Suppose that and , then is a controllable pair.*

* Proof. *The lemma can be proved by verifying PBH criterion of linear systems and is omitted here for brevity.

*Remark 6. *As is controllable, it can thus be further converted to the canonical controllable form (4) by a linear transformation so that the tractor-trailers system (34)-(35) can be expressed in approximate NCF (1)-(2).

To illustrate the effectiveness of the proposed control approaches, a tractor towing one trailer is taken as a simulation example. The state equation in this special case can be explicitly obtained as where , .

Under the following coordinate and input transformations: the state equation (38) is converted to the following form: where

In the state region , can be shown to be and to be .

The geometric parameters are set to . The controller parameters are selected as , , , , and chosen such that the eigenvalues of are assigned to .

The simulation is implemented for two initial states and . For the first initial state, where , the control law (19) is applied; for the second initial state where , the control law (31) is applied. The time plots of state trajectories and geometric paths of the tractor and the trailer are shown in Figures 2 and 3 in respect to the two initial states. It is observed that the proposed control laws successfully regulate the state to zero from initial states and produce nice geometric paths for both the tractor and the trailer.

#### 5. Conclusion

In this paper, we propose a discontinuous and a smooth time-varying control schemes for a class of nonlinear driftless systems in the approximated nonholonomic chained form, achieving local exponential convergence of state to the desired equilibrium point. The proposed control laws rely on the discontinuous and the smooth time-varying state transformations that convert the system to linear stable one perturbed by two- or higher-order terms of state. An application example of off-axle tractor-trailers is discussed in detail for illustrating the effectiveness of the proposed control approaches.

#### Acknowledgments

The paper is supported by National Science Foundation of China (no. 60874012). The author would like to thank the Editor and the reviewers for their helpful suggestions and careful review of the paper.

#### References

- I. Kolmanovsky and N. H. McClamroch, “Developments in nonholonomic control problems,”
*IEEE Control Systems Magazine*, vol. 15, no. 6, pp. 20–36, 1995. View at Publisher · View at Google Scholar · View at Scopus - M. Fliess, J. Levine, P. Martin, and P. Rouchon, “Flatness and defect of non-linear systems: introductory theory and examples,”
*International Journal of Control*, vol. 61, no. 6, pp. 1327–1361, 1995. View at Google Scholar · View at Scopus - P. Martin and P. Rouchon, “Any (controllable) driftless system with 3 inputs and 5 states is flat,”
*Systems and Control Letters*, vol. 25, no. 3, pp. 167–173, 1995. View at Google Scholar · View at Scopus - R. W. Brockett, “Asymptotic stability and feedback stabilization,” in
*Differential Geometric Control Theory*, R. W. Brockett, R. S. Millman, and H. J. Sussmann, Eds., pp. 181–191, Birkhauser, Boston, Mass, USA, 1983. View at Google Scholar - A. Astolfi, “Discontinuous control of nonholonomic systems,”
*Systems and Control Letters*, vol. 27, no. 1, pp. 37–45, 1996. View at Publisher · View at Google Scholar · View at Scopus - Z. Sun and S. S. Ge, “Nonregular feedback linearization: a nonsmooth approach,”
*IEEE Transactions on Automatic Control*, vol. 48, no. 10, pp. 1772–1776, 2003. View at Publisher · View at Google Scholar · View at Scopus - N. Marchand and M. Alamir, “Discontinuous exponential stabilization of chained form systems,”
*Automatica*, vol. 39, no. 2, pp. 343–348, 2003. View at Publisher · View at Google Scholar · View at Scopus - C. Samson, “Control of chained systems application to path following and time-varying point-stabilization of mobile robots,”
*IEEE Transactions on Automatic Control*, vol. 40, no. 1, pp. 64–77, 1995. View at Publisher · View at Google Scholar · View at Scopus - O. J. Sordalen and O. Egeland, “Exponential stabilization of nonholonomic chained systems,”
*IEEE Transactions on Automatic Control*, vol. 40, no. 1, pp. 35–49, 1995. View at Publisher · View at Google Scholar · View at Scopus - P. Morin and C. Samson, “Control of nonlinear chained systems: from the Routh-Hurwitz stability criterion to time-varying exponential stabilizers,”
*IEEE Transactions on Automatic Control*, vol. 45, no. 1, pp. 141–146, 2000. View at Publisher · View at Google Scholar · View at Scopus - C. Prieur and A. Astolfi, “Robust stabilization of chained systems via hybrid control,”
*IEEE Transactions on Automatic Control*, vol. 48, no. 10, pp. 1768–1772, 2003. View at Publisher · View at Google Scholar · View at Scopus - I. Kolmanovsky, M. Reyhanoglu, and N. H. McClamroch, “Switched mode feedback control laws for nonholonomic systems in extended power form,”
*Systems and Control Letters*, vol. 27, no. 1, pp. 29–36, 1996. View at Publisher · View at Google Scholar · View at Scopus - Z. P. Jiang, “Robust exponential regulation of nonholonomic systems with uncertainties,”
*Automatica*, vol. 36, no. 2, pp. 189–209, 2000. View at Publisher · View at Google Scholar · View at Scopus - K. D. Do and J. Pan, “Adaptive global stabilization of nonholonomic systems with strong nonlinear drifts,”
*Systems and Control Letters*, vol. 46, no. 3, pp. 195–205, 2002. View at Publisher · View at Google Scholar · View at Scopus - Z. Xi, G. Feng, Z. P. Jiang, and D. Cheng, “A switching algorithm for global exponential stabilization of uncertain chained systems,”
*IEEE Transactions on Automatic Control*, vol. 48, no. 10, pp. 1793–1798, 2003. View at Publisher · View at Google Scholar · View at Scopus - T. Floquet, J. P. Barbot, and W. Perruquetti, “Higher-order sliding mode stabilization for a class of nonholonomic perturbed systems,”
*Automatica*, vol. 39, no. 6, pp. 1077–1083, 2003. View at Publisher · View at Google Scholar · View at Scopus - E. Valtolina and A. Astolfi, “Local robust regulation of chained systems,”
*Systems and Control Letters*, vol. 49, no. 3, pp. 231–238, 2003. View at Publisher · View at Google Scholar · View at Scopus - D. A. Lizárraga, P. Morin, and C. Samson, “Chained form approximation of a driftless system. Application to the exponential stabilization of the general N-trailer system,”
*International Journal of Control*, vol. 74, no. 16, pp. 1612–1629, 2001. View at Publisher · View at Google Scholar · View at Scopus - H. Date, M. Sampei, M. Ishikawa, and M. Koga, “Simultaneous control of position and orientation for ball-plate manipulation problem based on time-state control form,”
*IEEE Transactions on Robotics and Automation*, vol. 20, no. 3, pp. 465–479, 2004. View at Publisher · View at Google Scholar · View at Scopus - H. K. Khalil,
*Nonlinear Systems*, Prentice-Hall, Upper Saddle River, NJ, USA, 2nd edition, 1996.