Research Article | Open Access
Robust Output Control of an Uncertain Underactuated 2DOF Mass-Spring-Damper System with Backlash Based on Active Disturbance Rejection Control Structure
We propose a strategy to solve the tracking and regulation problem for a 2DOF underactuated mass-spring-damper system with backlash on the underactuated joint, parametric uncertainties, and partial measurement of the state vector. The design of the controller is divided into two stages; in the first stage, it is assumed that the full state vector and all perturbations in the system are available. The model is divided into one actuated subsystem and one underactuated subsystem. The position of the actuated mass is defined as the control input of the underactuated subsystem, which is designed as an ideal controller that solves the tracking and regulation control problems for the underactuated mass. Finally, the control input of the actuated subsystem is designed to solve the tracking problem considering as a reference signal the control signal of the underactuated subsystem. The second stage solves the problem of the implementation of the previously designed ideal controller using the active disturbances rejection control structure (ADRC). Here state observers estimate the nonmeasured state variables and, at the same time, estimate perturbations and auxiliary signals for their compensation. The performance of the closed-loop system is illustrated by numerical simulations and experimental results.
Control of underactuated mechanical systems, mechanisms with fewer number of control inputs than their degrees of freedom, has received much attention in the last decades. This is because of the theoretical challenges as well as practical applicability; robots, aerospace vehicles, underwater vehicles, and surface vessels are some examples of underactuated mechanical systems [1, 2]. While many important techniques and results have been presented for this class of systems, the control of them remains an open problem when we considering several practical situations like disturbances in the plant, partial measurement of the state vector, and the presence of hard nonlinearities like dry friction and backlash; important issues are how control models can be formulated for such systems and how closed-loop control problems can be solved and implemented .
Backlash is a phenomenon that limits the performance of the control systems; it introduces errors in stable state; it even may produce limit cycles. Backlash has been studied since the 1940s and many proposals have appeared to mitigate its effects . Different ways exist to model the backlash phenomenon; in , it is established that backlash and hysteresis are different phenomena; however, many times they are used the same; also dead zone functions , differential equations , and smooth approximations of the dead zone function have been used [8, 9]. However, as far as we know, there is no consensus about a unique backlash model; therefore, many papers use the model that allows solving a specific control problem, as we do in the present work.
Some control algorithms that solve regulation and tracking control objectives for underactuated mechanical systems, without considering practical issues, are proposed in [10–12] and references therein. Also, there are papers that propose control algorithms that produce a closed-loop system with some degree of robustness, for example, [13, 14].
Two works that address the control problem of the underactuated systems with backlash are [15, 16]. In , an control for tracking of a class of nonsmooth systems that include dry friction and backlash is proposed. In this case, a modified version of the control achieves a good performance for tracking on a system called Industrial Emulator, model 220 of Educational Control Products. However, it cannot be applied to solve the regulation problem because a necessary condition is that the derivative of the reference signal must be different from zero for almost all times. In , a controller based on control to solve the regulation problem on a 2DOF underactuated mass-spring-damper system with backlash and dry friction is proposed. In this case, they get satisfactory results but the strategy cannot be applied to tracking control in direct way.
An important strategy to reduce or eliminate the effect produced by disturbances and parametric uncertainties in closed-loop system, for fully actuated mechanical systems, is the active disturbances rejection control (ADRC) shown in Figure 1. This control structure includes a robust observer to estimate the velocity vector, perturbations, and terms generated by parametric uncertainties; the estimated perturbations are included in the controller to eliminate actual perturbation in plant. Ideally, if the estimation is precise, the control structure guarantees, in steady state, a zero error in the control objective using a well-known continuous controller for a plant without disturbances, obtaining a robust closed-loop system. The theoretical framework, stability proofs, and some applications of this control structure can be found in [17–24].
Due to good features of robustness of the ADRC control structure in full actuated systems, we hope that it can solve, under certain conditions, the regulation and tracking control problems on some class of underactuated systems.
In the present paper, we propose a control strategy to solve the tracking and regulation problem on a 2DOF underactuated mass-spring-damper system with backlash on the underactuated joint, parametric uncertainties, and partial measurement of the state vector, applying the basic principle of the active disturbance rejection control (ADRC) structure. Also, based on , we propose a smooth model of the backlash, which is formed by a lineal function and a smooth approximation of the saturation function; this function will be considered as a bounded disturbance.
The proposed control strategy is based on a simple idea: how the mass should be moved so that the mass can follow a reference signal?
The controller design is performed in two stages; in the first stage, we divide the system into one actuated subsystem and one underactuated subsystem; it is assumed that the full state vector and all perturbations in the system are available. The position of the actuated mass is defined as the control input of the underactuated subsystem, which is designed as an ideal controller that solves the tracking and regulation control problems for the underactuated mass. Finally, the control input of the actuated subsystem is designed to solve the tracking problem considering as a reference signal the control signal of the underactuated subsystem. The second stage of controller design solves the problem of the implementation of the previously designed ideal controller using the ADRC control structure. Here state observers estimate the nonmeasured state variables and, at the same time, estimate perturbations and auxiliary signals for their compensation. The performance of the closed-loop system is illustrated by numerical simulations and experimental results.
The paper’s structure is as follows. In Section 2, we define the control problem and establish the model of the backlash that we use in this work. Section 3 shows the ideal control strategy where we assume the knowledge of all disturbances in the system and full measurement of state vector. In Section 4, we present the strategy to implement the ideal control based on ADRC control structure. In Section 5, we illustrate the performance of the proposed control strategy through numerical simulations and experimental results. Finally, in Section 6, we present some conclusions.
2. Problem Statement and Preliminary Definitions
Consider a 2DOF underactuated mass-spring-damper system, shown in Figure 2, whose model is given bywhere and are position and velocity of mass , and are position and velocity of mass , is the control input, and is a function that describes the backlash phenomenon, whose characteristic is shown in Figure 3, where is backlash length and . and are disturbances due to parametric uncertainties, which are bounded if the state of the system is bounded. Finally, the parameters of the plant are the spring constants and and friction constants and , and is a power amplifier constant; all parameters are positive.
Given that the nonlinear term of function is a collection of saturation functions with a displacement, which are bounded, and only one of them is active at a time, a simplified model of (2) iswherewhere , and Function (4) is a smooth version of a saturation function and it is a function. This is the model used in this work.
The control objective is where is a function with sufficiently large .
Now we define the error variables and , whose dynamics are given bywhere is a bounded disturbance and Now, the control objective is to design a control input such that the error variables tend to zero, while and stay bounded.
3. Conceptual Solution of the Control Problem
In this section, we propose the strategy to solve the control problem considering that all states and all disturbances are known; in the next section, we will give a strategy to implement it.
System (12) can be divided into two subsystems: an underactuated subsystem,and an actuated subsystem,
As we can see, the control input does not appear in subsystem (15), so we consider the state variable as a control input for it. Then, if wherethe origin and will be an asymptotically stable equilibrium point. Substituting (17) in (15), we obtainwhere and are positive constants and, given that , and are positive constants, we guaranteed that the origin of subsystem (18) is an exponentially stable equilibrium point.
Now, the control objective to the actuated subsystem (16) is Define the error variables and , whose dynamics are given byand then, to stabilize the origin of (20), we proposewhereis a bounded disturbance.
It is important to note that converges exponentially to independent of behavior of and ; then can be rewritten asSubstituting (24) in (15), we havewhere for some positive constant and . Thus, there exist a set of constants , and such that the origin of system (25) will be an asymptotically stable equilibrium point in a sufficient large region .
4. Control Structure Implementation
In the previous section, we presented a conceptual solution to the control problem; however, in practice, we cannot implement it directly because the disturbances and , as well as signals and , are not available. To solve these problems, in this section, we present the strategy to implement the control input (21) based on the active disturbance rejection control (ADRC) structure, where we use discontinuous state observers to estimate the unknown terms.
To estimate , , , and , we propose two robust state observers based on the observer proposed in .
To demonstrate the observer stability, we define error variables , , , and , whose dynamics are given by where and are the disturbances that we wish to estimate. Now, with the change of variables , we have the systemsAccording to [26, 27], it is possible to find constants , and such that the origin of the error system will be an asymptotically stable equilibrium point in a region of the state space, where disturbances and are bounded, and we guarantee that and are the estimates of and .
Also, systems (30) and (31) present a second-order sliding mode in and , [26, 27], where the equivalent control is given by for system (30), andfor system (31). The equivalent control is the low frequency components of the discontinuous term in the observer when the trajectories are in the sliding surface and we can recover it using a low-pass filter ; for example,
5. Performance of the Controller
This section shows the performance of the proposed control strategy on a mass-spring-damper system, model 210, from the Educational Control Products Company shown in Figure 6. We modified junction between the second spring and the mass to introduce backlash (see Figure 7).
In this analysis, we consider two cases of the backlash length ; and , and the nominal parameters of the system are , , , , , and .
Substituting the nominal parameters, the model of the plant is meanwhile the state observers (27) and (28) take the following form:where , and , and the constants and were adjusted considering To estimate the terms and , we use the second-order Butterworth low-pass filter (34) with
The control signal to underactuated part of the system takes the following form: where and Finally, the control of the actuated part of the system is where and
In the next subsections, we present numerical and experimental results that show the performance of the proposed control strategy. To show the effects of the disturbance compensation in the control system, the simulations and experiments were performed as follows: first, we applied the proposed control in closed loop without compensating the disturbances; in , we added the estimation in the signal to compensate the term ; finally, in , we added the term to control signal to compensate the term
5.1. Numerical Results
For numerical simulations, we only present the performance for tracking objective, where the reference signal is , while in the subsection of experimental results, we show the performance for tracking and regulation control objectives.
5.1.1. Case 1: Backlash with
In Figure 8, we show the performance of the closed-loop system with . In the first graph, black line is the reference signal and the red line is position . Although the tracking error is little without disturbances compensation, when the compensation is applied, the error is smaller; we achieve an error about . It is important to note that control signal has an appropriate range for the experimental implementation of the controller.
5.1.2. Case 2: Backlash with
In Figure 9, we show the performance of the closed-loop system with m. Due to the fact that the backlash is bigger than previous case, the tracking error in closed loop without disturbances compensation is bigger too. When the compensation is made, the error decreases; the tracking error is about The control input has an appropriate range for the experimental implementation of the controller.
5.2. Experimental Results
The experiments were made in a real-time controller dSPACE 1103, using Euler solver with fixed step with sample time The parameters of the observers, filters, and constants of the controller are the same as those used in numerical simulation. In this subsection, we present the performance for tracking and regulation control objectives.
5.2.1. Case 1: Backlash with
In Figure 10, we show the experimental performance of the closed-loop system with m. Unlike the simulations, in experiments, the tracking error is big when we do not make the disturbances compensation, but it decreases when they are compensated. We achieve a tracking error about , similar to numerical simulations. In this case, we can see clearly that amplitude of the control signal increases when we add the term in .
For regulation, we applied a pulsed signal as a reference with an amplitude of and a frequency of , and the results are shown in Figure 11. When we do not compensate any disturbance, the error between the reference and the output is big. After compensating the disturbances, we obtain an error about , similar to the tracking case. The control input stays in an adequate range all time.
5.2.2. Case 2: Backlash with
In this experiment, we change the parameter from to , but the parameters of the observers, filters, and gains of the controller stay without change. For tracking, the results are shown in Figure 12.
In this experiment, we can observe that error is very big when we do not compensate the disturbances; it decreases a little when we add the term in , but it decreases considerately when we compensate the term in the signal control We achieve a tracking error about The control signal stays in the range of
For regulation objective, we applied the same pulsed signal that we used in Case 1 for experimental results and we obtain similar results as we can see in Figure 13. When we do not compensate any disturbance, the error between the reference and the output is big. After compensating the disturbances, we obtain an error about , similar to the tracking case. The control input stays in an adequate range all time.
Based on the results of this paper, we can say that the ADRC structure is an adequate option to solve, both theoretically and experimentally, the regulation and tracking control problems on 2DOF underactuated mass-spring-damper system with backlash, uncertainties, and partial measurement of the state vector. The closed-loop system presents good properties of robustness; when the backlash length is 10% of the maximum amplitude of the reference signal (), we achieve a maximum error about 5% with respect to reference signal; meanwhile when the backlash length is 100% of the maximum amplitude of the reference signal (), we achieve a maximum error about 20%. On the other hand, we can say that the smooth approximation of the backlash, as subtraction of a lineal function and smooth approximation of the saturation function, is a useful model and, therefore, is adequate to solve control problems. A future work is to investigate a broad class of underactuated mechanical systems, where the ADRC structure may solve the regulation and tracking control problems.
Conflicts of Interest
The authors declare that they have no conflicts of interest.
This research was supported in part by CONACyT, Mexico.
- M. W. Spong and D. J. Block, “The Pendubot: A mechatronic system for control research and education,” in Proceedings of 1995 34th IEEE Conference on Decision and Control, vol. 1, pp. 555-556, 1995.
- M. Spong, “Underactuated mechanical systems,” Control problems in robotics and automation, pp. 135–150, 1998.
- Y. Liu and H. Yu, “A survey of underactuated mechanical systems,” IET Control Theory & Applications, vol. 7, no. 7, pp. 921–935, 2013.
- M. Nordin and P.-O. Gutman, “Controlling mechanical systems with backlash—a survey,” Automatica, vol. 38, no. 10, pp. 1633–1649, 2002.
- U. S. Kuruppu, “Hysteresis and backlash—a comparison,” International Journal of Control, vol. 2, no. 1, pp. 1–8, 1965.
- A. T. Shenton and A. Abass, “Non-parametric linear time-invariant extensions of non-invertible and backlash plant,” International Journal of Robust and Nonlinear Control, vol. 24, no. 18, pp. 3092–3105, 2014.
- C.-Y. Su, Y. Stepanenko, J. Svoboda, and T. P. Leung, “Robust adaptive control of a class of nonlinear systems with unknown backlash-like hysteresis,” IEEE Transactions on Automatic Control, vol. 45, no. 12, pp. 2427–2432, 2000.
- R. Merzouki, J. A. Davila, L. Fridman, and J. C. Cadiou, “Backlash phenomenon observation and identification in electromechanical system,” Control Engineering Practice, vol. 15, no. 4, pp. 447–457, 2007.
- L. Walha, T. Fakhfakh, and M. Haddar, “Backlash effect on dynamic analysis of a two-stage spur gear system,” Journal of Failure Analysis and Prevention (JFAP), vol. 6, no. 3, pp. 60–68, 2006.
- O. Begovich, E. N. Sanchez, and M. Maldonado, “Takagi-Sugeno fuzzy scheme for real-time trajectory tracking of an underactuated robot,” IEEE Transactions on Control Systems Technology, vol. 10, no. 1, pp. 14–20, 2002.
- M. W. Spong, D. J. Block, and K. J. Astrom, “The mechatronics control kit for education and research,” in Proceedings of the IEEE International Conference on Control Applications (CCA'01), pp. 105–110, 2001.
- I. Fantoni and R. Lozano, Non-linear control for underactuated mechanical systems, Springer Science & Business Media, 2002.
- K. Lee and V. Coverstone-Carroll, “Control algorithms for stabilizing underactuated robots,” Journal of Robotic Systems, vol. 15, no. 12, pp. 681–697, 1998.
- V. Utkin, J. Guldner, and J. Shi, Sliding mode control in electro-mechanical systems, vol. 34, CRC press, 34, 2009.
- I. U. Ponce, Y. Orlov, L. T. Aguilar, and J. Alvarez, “Sensorless Nonsmooth H∞-Tracking Synthesis of Servosystems with Backlash and Coulomb Friction,” IFAC-PapersOnLine, vol. 48, no. 11, pp. 280–285, 2015.
- R. Rascón, J. Alvarez, and L. T. Aguilar, “Discontinuous H∞ control of underactuated mechanical systems with friction and backlash,” International Journal of Control, Automation and Systems, vol. 14, no. 5, pp. 1213–1222, 2016.
- Z. Gao, “On the centrality of disturbance rejection in automatic control,” ISA Transactions®, vol. 53, no. 4, pp. 850–857, 2014.
- J. Q. Han, “From PID to active disturbance rejection control,” IEEE Transactions on Industrial Electronics, vol. 56, no. 3, pp. 900–906, 2009.
- A. Ferreira, F. J. Bejarano, and L. M. Fridman, “Robust control with exact uncertainties compensation: with or without chattering?” IEEE Transactions on Control Systems Technology, vol. 19, no. 5, pp. 969–975, 2011.
- D. I. R. Almeida, J. Alvarez, and J. Peña, “Control structure with disturbance identification for Lagrangian systems,” International Journal of Non-Linear Mechanics, vol. 46, no. 3, pp. 486–495, 2011.
- Y. Huang and W. Xue, “Active disturbance rejection control: methodology and theoretical analysis,” ISA Transactions®, vol. 53, no. 4, pp. 963–976, 2014.
- R. Madoński and P. Herman, “Survey on methods of increasing the efficiency of extended state disturbance observers,” ISA Transactions®, vol. 56, pp. 18–27, 2015.
- L. Wang and J. Su, “Disturbance rejection control for non-minimum phase systems with optimal disturbance observer,” ISA Transactions®, vol. 57, pp. 1–9, 2015.
- G. A. Ramos, J. Cortés-Romero, and H. Coral-Enriquez, “Spatial observer-based repetitive controller: An active disturbance rejection approach,” Control Engineering Practice, vol. 42, pp. 1–11, 2015.
- S. Oldak, C. Baril, and P. O. Gutman, “Quantitative design of a class of nonlinear systems with parameter uncertainty,” International Journal of Robust and Nonlinear Control, vol. 4, no. 1, pp. 101–117, 1994.
- D. I. R. Almeida, J. Alvarez, and L. Fridman, “Robust observation and identification of nDOF Lagrangian systems,” International Journal of Robust and Nonlinear Control, vol. 17, no. 9, pp. 842–861, 2007.
- W. Perruquetti and J. P. Barbot, Sliding Mode Control in Engineering, CRC Press, Boca Raton, Fla, USA, 2002.
Copyright © 2018 C. Mario Mora 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.