Research Article | Open Access

# Control Based on Linear Algebra for Trajectory Tracking and Positioning of Second-Order Chained Form System

**Academic Editor:**Yi Qi

#### Abstract

The development of controllers for underactuated systems with nonholonomic constraints has been a topic of significant interest for many researchers in recent years. These systems are hard to control because their linearization transform them into uncontrollable systems. The proposed approaches involve the use of a permanent excitation in the reference trajectory; coordinate transformation; discontinuities; or complex calculations. This paper proposes the design of the controller of the second-order chained form system for trajectory tracking by using a simpler approach based on linear algebra. Up to the present time, no controllers based on this approach have been designed for that system. The control problem is solved by setting two of the three systems variables as a reference, while the remaining variable is calculated imposing the condition that the equations system has an exact solution to ensure that tracking errors go to zero. The stability of the proposed controller is theoretically demonstrated, and simulations results show a suitable control system performance. Also, no coordinate transformation is necessary.

#### 1. Introduction

In recent years, the interest in the control of underactuated systems with nonholonomic constraints has increased [1]. Underactuated systems are mechanical systems with fewer control inputs than degrees of freedom and nonintegrable acceleration constraints [2]. This paper considers the control for trajectory tracking and positioning of second-order chained form systems. These are hard to control because their linearization transform them into uncontrollable systems. The well-known paper of Brockett highlights the difficulty of solving these problems [3].

Several articles addressed the control of underactuated systems with nonholonomic constraints. Aneke et al. [4, 5] resolved the problem of trajectory tracking by using a three-stage method. In the first step, they transformed the original system into an extended chained form system with a cascade arrangement. They applied a linear feedback controller to the first subsystem. After that, the second subsystem is exponentially stabilized by employing a backstepping procedure. In the third step, they showed the closed-loop tracking dynamics stability of the system. More recently, other authors used the backstepping procedure to develop control methodologies for trajectory tracking [6, 7]. A permanent excitation in the reference trajectory is also necessary for system stability. This implies that the signals must not converge to zero, limiting their applications.

Also, in [8], smooth time-varying controllers are proposed to address the exponential tracking of second-order nonholonomic systems. These techniques use coordinate transformation based on time-varying dilation with a cascade-design strategy. In contrast to the previous approach, it does not require the excitation condition in the reference trajectory. This kind of control laws frequently involves complex calculations; their design is not intuitive and only applies for special nonholonomic systems. Another method used a discontinuous coordinate transformation to map the initial system into the space of discontinuous nonholonomic systems. In this new space, the control problem can be solved [9, 10].

An adaptive dynamic sliding mode controller with integrator was also found in the literature to control nonholonomic systems [11]. This scheme uses a modified backstepping kinematic controller for generating the kinematic trajectories and the velocity errors to drive the sliding surface. The normalized least-square mean was used to control the switching of a sliding mode controller in the presence of uncertainties and parameter variations. Also, other authors developed sliding mode control methodologies for trajectory tracking and positioning of nonholonomic second-order chained form systems [12–14]. Sarfraz and ur Rehman [15] addressed the positioning problem of a particular nonholonomic planar underactuated mechanical system using adaptive sliding mode control. The control law assures the derivative of a suitable Lyapunov function becomes strictly negative.

The aforementioned controllers use a permanent excitation in the reference trajectory [4, 5]; coordinate transformation [8]; discontinuities [9, 10]; and high computational load calculations [11–15] to solve the trajectory tracking problem. To overcome these drawbacks, this paper aims to solve the problem of trajectory tracking of a second-order chained form system with nonholonomic constraints by using a novel control law inspired by the design method Linear Algebra-Based Controller (LABC) [16]. This technique computes the control actions by solving a system of linear equations and has been applied to different nonlinear systems [17–23].

Until now, LABC has not been applied to second-order chained form systems with nonholonomic constraints in the space of the original variables. For this reason, the major contribution of this work is to extend the LABC technique to solve the tracking and positioning problem for these systems. The system should follow the reference coordinates of two of three variables while the other one is unknown. The key point of this strategy is to find the conditions for which the system of linear equations has an exact solution, ensuring the calculus of the remaining variable, named sacrificed variable. In this way, the reference trajectories of the selected variables and the sacrificed one form an admissible trajectory of the system and the tracking error goes to zero [16].

This paper is organized as follows. The Materials and Methods section describes the second-order chained form system with nonholonomic constraints and solves the problem of trajectory tracking and positioning using a controller based on linear algebra. The stability of the closed-loop system is demonstrated by applying the Khalil lemma. In the Results and Discussion section, simulation results show the effectiveness of the proposed controllers. Conclusions are given at the end of this manuscript.

#### 2. Materials and Methods

##### 2.1. Problem Formulation

This section presents the special canonical form of an underactuated system with nonholonomic constraints. The control of this system remains a problem under study [1]. One of the most important issues is the transformation to a chained form.

Consider the second-order chained form system, , given by following set of equations:where are the generalized coordinates of the second-order chained form system and represents the inputs such that and . Also, the reference trajectory is .

The tracking errors are the differences between the reference paths and the variables:

This work proposes the design of a controller for trajectory tracking and positioning of a second-order nonholonomic system represented by (1)–(3).

##### 2.2. Problem 1: Trajectory Tracking

Given the system , the trajectory tracking control problem is solvable if it is possible to design an appropriate controller of the formsuch that the closed-loop system constituted by (1)–(3) and the control actions (5) and (6) is globally uniformly asymptotically stable.

##### 2.3. Problem 2: Positioning

Given the system , the positioning control problem is solvable if it is possible to design an appropriate controller of the formsuch that the closed-loop system constituted by (1)–(3) and the control actions (7) and (8) is globally uniformly and asymptotically stable. Here, the reference trajectory is zero.

To the best of our knowledge, LABC technique has not been applied directly to systems of second-order equations without considering a model in state variables; therefore, we extend its use to these systems. The control method is based on determining the conditions for which the system has an exact solution. Knowing the system model, it is only necessary to fix the desired trajectory of and to find the solution [16].

##### 2.4. Controller Design for Trajectory Tracking

Given an initial state , the system represented by (1)–(3), , should follow the desired trajectory with a low tracking error. Therefore, it is necessary to find a control law capable of generating a signal such that it satisfies this objective.

The system is expressed in matrix form as follows:

To calculate the control actions and , (9) should have an exact solution, that is,

If a proportional control approach is assumed, the tracking errors are the differences between the reference and real trajectories. Thus, the second-order derivatives of the variables and , i.e., and , are and , respectively [16].

If the internal variable is set to the value of for which the above system has an exact solution, then (11) is rewritten asand the tracking errors in variables 1 and 3 tend to zero.

Variable is computed according to

*Remark 1. *Variable follows and this one tracks .

The first-order derivatives of the tracking errors are and , and the control action is obtained using the linear least-squares approximation method to (12) isWe can write the second-order derivative of the variable as a function of the sacrificed variable :Furthermore, the first-order derivative of the tracking error of variable 2 is , and the control action is

*Remark 2. *If the numerator and denominator of (13) tend to zero simultaneously, the division is undetermined and cannot be calculated. To avoid this problem, it is necessary to choose adequately the coefficients , , , and forcing the errors and to go to zero more quickly than and . This avoids that tends to infinity following trajectories whose second derivatives are zero (linear and constant reference trajectories).

##### 2.5. Stability of the Tracking Error Dynamics: Trajectory Tracking Case

In this section, the stability of the closed-loop system [(1)–(3), (14)–(16)] is demonstrated.

Theorem 1. *Given the second-order chained form system , expressed in (1)–(3), and the control actions and formulated by (14)–(16), when .*

*Proof. *The following steps are proposed to prove Theorem 1. *Step 1* Variable is substituted in (14), and after performing algebraic manipulations, is obtained: From (1), , also we define the second-order derivative of the tracking error of variable 1 as ; in consequence, (18) is rewritten as follows: *Step 2* Replacing (16) with (10), and defining the second-order derivative of the tracking error of variable 2 as , the following equation arises: *Step 3* Given that , the algebraic manipulation of (3) givesFurthermore, from (13) and (14), the following expression is obtained: . We define the second-order derivative of the tracking error of variable 3 as and rewrite (22) asBy replacing the control action in the above equation, the following second-order equation arises:Then, (19), (21), and (24) are rewritten according to (5.32) and (5.33) on page 221 of [24], where and , being and . By defining ; ; ; ; ; , the following system of equations is obtained:Finally, by applying Lemma 5.6 of Khalil, the system is globally uniformly asymptotically stable and satisfies the condition when .

*Remark 3. *If the controller parameters are adjusted such that the roots of the polynomial (19), , have a negative real part closer to the imaginary axis than the roots of the polynomial (24), , then will go to zero faster than and does not go to infinity.

##### 2.6. Controller Design for Positioning

The positioning problem for the system, , consists in computing the control inputs, and , such that the origin of the system is stable for any initial state . Positioning is a particular case of trajectory tracking, where , , , and are zero, and is the sacrificed variable.

The system is expressed in matrix form as follows:

To calculate the control actions and , (26) should have an exact solution; that is,

If a proportional control approach is assumed, the tracking errors are the differences between the reference (zero) and real trajectories. Thus, the variables and are and .

If is the value of for which the above system has an exact solution, thenand the tracking errors in variables 1 and 3 tend to zero.

Variable is computed according to

*Remark 4. *Variable follows and this one tracks .

The control action obtained using linear least-squares approximation method to (28) isFurthermore, the control action is a function of variables , , and :

*Remark 5. *Equations (30) and (31) for positioning are a particular case of (13) and (14) for trajectory tracking of the system, .

##### 2.7. Stability of the Tracking Error Dynamics: Positioning Case

In this section, the stability of the closed-loop system [(1)–(3) and (29)–(31)] is demonstrated.

Theorem 2. *Given the second-order chained form system (1)–(3), and the control actions and formulated in (29)–(31), the variables , , and , , when .*

*Proof. *The following steps are proposed to prove Theorem 2: *Step 1* Variable is substituted in (30), and after doing algebraic manipulations, is obtained: From (1), . Then, (32) is rewritten as follows: *Step 2* Substituting (31) with (10), and given that , the following equation arises: Equation (34) for positioning is coincident with (21) for trajectory tracking. *Step 3* Given that , the algebraic manipulation of (3) givesFurthermore, from (29) and (30), the following expression is obtained: . We rewrite (35) asThen, (33), (34), and (36) for positioning are rewritten according to (5.32) and (5.33) of [24] where ; ; ; and ; ; ; and , being and . By defining ; ; ; ; ; and , the following equations arise:Finally, according to the stability lemma of Khalil [24], the system is globally uniformly asymptotically stable and verifies the conditions (, , ) and (, , ) when .

*Remark 6. *By adjusting the controller parameters in such a way the roots of the polynomial (33) have a negative real part closer to the imaginary axis than the roots of the polynomial (36), the tracking error will go to zero faster than and will not tend to infinity.

#### 3. Results and Discussion

The closed-loop system (1)–(3) and (13), (14), (16) for trajectory tracking is simulated and analyzed in the first test. In the same way, the closed-loop system (1)–(3) and (29)–(31) for positioning is simulated, and the results are discussed in the second test.

##### 3.1. Trajectory Tracking Test

The aim of this section is to show that given a reference trajectory, the proposed controller can calculate a control law that allows following effectively. The reference trajectories of ; ; and are simulated considering and as the initial state of the system, and and follow a parabolic path, while follows an ascending sine wave. The controller parameters, set by trial and error, are ; ; ; ; ; and . With these values, ; ; and converge satisfactorily to the reference trajectory. Figure 1 shows the trajectory of variable 1. Variable (blue line) initially fluctuates around its reference (red-dashed line) reaching it after 40 seconds.

The trajectories of (blue solid line); (green solid line); and (red dashed line) are shown in Figure 2. Variable follows the sacrificed variable , and after 60 seconds, both variables follow the reference . In this way, the tracking errors and tend to zero. This remarks the performance of the proposed controller.

Figure 3 shows the trajectory of variable 3. Variable (blue line) perfectly follows (red-dashed line) without undesirable oscillations.

Figures 4 and 5 present the control actions and , respectively. Its initial values are , respectively. The first one, , evolves quickly from 0 to 10^{−4} remaining constant. The second one, , follows a sine wave path with mean 0, amplitude 0.8, and frequency 1/8*π*.

##### 3.2. Positioning Test

The closed-loop system (1)–(3) and (29)–(31) is simulated considering ; ; and as the initial state. The controller parameters are ; ; ; ; ; and . Figures 6 and 7 show the trajectories of system variables and (blue solid lines). The red and magenta dashed lines indicate the zero reference. Figure 8 presents the control action , calculated by (30). In Figure 9, variables and are represented by a blue and orange solid lines, respectively. Finally, Figure 10 displays the trajectory of the control action calculated by (31).

#### 4. Conclusion

The major contribution of this paper is to extend the LABC technique for trajectory tracking and positioning of a second-order nonholonomic system. This controller is based on determining the conditions for which the system model has an exact solution. Knowing the model equations, it is necessary only to fix the desired trajectory to find the control action. Variables 1 and 3 were set as references, while variable 2 is the sacrificed one to ensure that the tracking errors go to zero. An important advantage of the proposed controller is the low computational load of the required mathematical operations. The stability of the system is demonstrated by applying the Khalil lemma [24].

Simulation results show the performance of the proposed control algorithm. The controller parameters were empirically tuned. For trajectory tracking, these parameters ensure that the system variables quickly reach the reference and follow it without undesirable oscillations. In the case of the positioning problem, these parameters were tuned in such a way variable goes to zero more quickly than .

#### Data Availability

The data used to support the finding of this study are included within the article.

#### Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.

#### Acknowledgments

The authors thank the Institute of Chemical Engineering of the National University of San Juan, Argentina, Planta Piloto de Ingeniería Química (PLAPIQUI-National University of the South), Argentina, and Consejo Nacional de Investigaciones Científicas y Técnicas (CONICET, National Council for Scientific Research), Argentina. This work was partially funded by Consejo Nacional de Investigaciones Científicas y Técnicas (CONICET), Universidad Nacional de San Juan (UNSJ), and Universidad Nacional del Sur (UNS), Argentina.

#### References

- G. He, C. Zhang, W. Sun, and Z. Geng, “Stabilizing the second-order nonholonomic systems with chained form by finite-time stabilizing controllers,”
*Robotica*, vol. 34, no. 10, pp. 2344–2367, 2016. View at: Publisher Site | Google Scholar - N. P. I. Aneke, “Control of underactuated mechanical systems,” Ph.D. dissertation, Department of Mechanical Engineering, Eindhoven University of Technology, Eindhoven, The Netherlands, 2003. View at: Google Scholar
- R. W. Brockett, R. S. Millman, and H. J. Sussmann, “Asymptotic stability and feedback stabilization,” in
*Differential Geometric Control Theory*, pp. 2961–2963, Birkhäuser, Basel, Switzerland, 1983. View at: Google Scholar - N. P. I. Aneke, H. Nijmeijer, and A. G. de Jager, “Trajectory tracking by cascaded backstepping control for a second-order non-holonomic mechanical system,”,” in
*Nonlinear Control in the Year 2000. Lecture Notes in Control and Information Sciences*, A. Isidori, F. Lamnabhi-Lagarrigue, and W. Respondek, Eds., vol. 258, pp. 35–49, Springer, Paris, France, 2000. View at: Google Scholar - N. P. I. Aneke, H. Nijmeijer, and A. G. de Jager, “Tracking control of second-order chained form systems by cascaded backstepping,”
*International Journal of Robust and Nonlinear Control*, vol. 13, no. 2, pp. 95–115, 2003. View at: Publisher Site | Google Scholar - Z. P. Yuan, Z. P. Wang, and Q. J. Chen, “Trajectory tracking control of a nonholonomic mobile robot,” in
*Proceedings of the IEEE ICCA 2010*, pp. 2207–2211, Xiamen, China, June 2010. View at: Google Scholar - N. Adhikary and C. Mahanta, “Integral backstepping sliding mode control for underactuated systems: swing-up and stabilization of the cart-pendulum system,”
*ISA Transactions*, vol. 52, no. 6, pp. 870–880, 2013. View at: Publisher Site | Google Scholar - Y.-P. Tian and K.-C. Cao, “Time-varying linear controllers for exponential tracking of non-holonomic systems in chained form,”
*International Journal of Robust and Nonlinear Control*, vol. 17, no. 7, pp. 631–647, 2007. View at: Publisher Site | Google Scholar - A. Astolfi, “Discontinuous control of nonholonomic systems,”
*Systems & Control Letters*, vol. 27, no. 1, pp. 37–45, 1996. View at: Publisher Site | Google Scholar - Y. Nakamura and R. Mukherjee, “Nonholonomic path planning of space robots via a bidirectional approach,”
*IEEE Transactions on Robotics and Automation*, vol. 7, no. 4, pp. 500–514, 1991. View at: Publisher Site | Google Scholar - M. Asif, M. J. Khan, and N. Cai, “Adaptive sliding mode dynamic controller with integrator in the loop for nonholonomic wheeled mobile robot trajectory tracking,”
*International Journal of Control*, vol. 87, no. 5, pp. 964–975, 2014. View at: Publisher Site | Google Scholar - L. Yang and J. Y. Yang, “Stabilization for a class of nonholonomic perturbed systems via robust adaptive sliding mode control,” in
*Proceedings of the American Control Conference*, pp. 1178–1183, Baltimore, MD, USA, June 2010. View at: Publisher Site | Google Scholar - N. Chen, F. Song, G. Li, X. Sun, and C. Ai, “An adaptive sliding mode backstepping control for the mobile manipulator with nonholonomic constraints,”
*Communications in Nonlinear Science and Numerical Simulation*, vol. 18, no. 10, pp. 2885–2899, 2013. View at: Publisher Site | Google Scholar - M. A. Fairus, Z. Mohamed, M. N. Ahmad, and W. S. Loi, “LMI-based multi objective integral sliding mode control for rotary inverted pendulum system under load variations,”
*Journal Teknologi*, vol. 73, pp. 125–137, 2015. View at: Publisher Site | Google Scholar - M. Sarfraz and F. ur Rehman, “Adaptive sliding mode control for a second order nonholonomic planar four-link UMS,” in
*Proceedings of the 2017 13th International Conference on Emerging Technologies (ICET)*, pp. 1–6, Islamabad, Pakistan, July 2017. View at: Publisher Site | Google Scholar - S. Gustavo, S. M. Emanuel, and A. Pedro,
*Linear Algebra Based Controller - Design and Applications*, Springer International Publishing, Cham, Switzerland, 2020. - G. Scaglia, E. Serrano, A. Rosales, and P. Albertos, “Tracking control design in nonlinear multivariable systems: robotic applications,”
*Mathematical Problems in Engineering*, vol. 2019, Article ID 8643515, 15 pages, 2019. View at: Publisher Site | Google Scholar - G. Scaglia, V. Mut, A. Rosales, and O. Quintero, “Tracking control of a mobile robot using linear interpolation,”
*IMAACA07*, vol. 1, pp. 11–15, 2007. View at: Google Scholar - A. Rosales, G. Scaglia, V. Mut, and F. Di Sciascio, “Trajectory tracking of mobile robots in dynamic environments-a linear algebra approach,”
*Robotica*, vol. 27, no. 7, pp. 981–997, 2009. View at: Publisher Site | Google Scholar - M. E. Serrano, S. A. Godoy, L. Quintero, and G. J. Scaglia, “Interpolation based controller for trajectory tracking in mobile robots,”
*Journal of Intelligent & Robotic Systems*, vol. 86, no. 3-4, pp. 569–581, 2017. View at: Publisher Site | Google Scholar - M. E. Serrano, G. J. E. Scaglia, S. A. Godoy, V. Mut, and O. A. Ortiz, “Trajectory tracking of underactuated surface vessels: a linear algebra approach,”
*IEEE Transactions on Control Systems Technology*, vol. 22, no. 3, pp. 1103–1111, 2014. View at: Publisher Site | Google Scholar - M. E. Serrano, G. J. E. Scaglia, F. A. Cheein, V. Mut, and O. A. Ortiz, “Trajectory-tracking controller design with constraints in the control signals: a case study in mobile robots,”
*Robotica*, vol. 33, no. 10, pp. 2186–2203, 2015. View at: Publisher Site | Google Scholar - G. Scaglia, P. M. Aballay, M. E. Serrano, O. A. Ortiz, M. Jordan, and M. D. Vallejo, “Linear algebra based controller design applied to a bench-scale oenological alcoholic fermentation,”
*Control Engineering Practice*, vol. 25, pp. 66–74, 2014. View at: Publisher Site | Google Scholar - H. K. Khalil,
*Nonlinear Systems*, Prentice-Hall, Upper Saddle River, NJ, USA, 2nd edition, 1996.

#### Copyright

Copyright © 2020 Leandro Rodriguez et al. 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.