- About this Journal ·
- Abstracting and Indexing ·
- Aims and Scope ·
- Annual Issues ·
- Article Processing Charges ·
- Articles in Press ·
- Author Guidelines ·
- Bibliographic Information ·
- Citations to this Journal ·
- Contact Information ·
- Editorial Board ·
- Editorial Workflow ·
- Free eTOC Alerts ·
- Publication Ethics ·
- Reviewers Acknowledgment ·
- Submit a Manuscript ·
- Subscription Information ·
- Table of Contents
Advances in Mechanical Engineering
Volume 2013 (2013), Article ID 286074, 14 pages
Dynamic Modeling and Fuzzy Self-Tuning Disturbance Decoupling Control for a 3-DOF Serial-Parallel Hybrid Humanoid Arm
School of Control Science and Engineering, Yanshan University, Qinhuangdao 066004, China
Received 25 June 2013; Accepted 3 October 2013
Academic Editor: Amir H. Alavi
Copyright © 2013 Yueling Wang 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.
A unique fuzzy self-tuning disturbance decoupling controller (FSDDC) is designed for a serial-parallel hybrid humanoid arm (HHA) to implement the throwing trajectory-tracking mission. Firstly, the dynamic model of the HHA is established and the input signal of the throwing process is obtained by studying the throwing process of human’s arm. Secondly, the FSDDC, incorporating the disturbance decoupling controller (DDC) and the fuzzy logic controller (FLC), is designed to ensure trajectory tracking of the HHA in the presence of uncertainties and disturbances. With the FSDDC method, the HHA system can be decoupled by actively estimating and rejecting the effects of both the internal plant dynamics and external disturbances. The self-tuning parameters are adapted online to improve the performance of the FSDDC; thus, it does not require detailed system parameters of the presented FSDDC. Finally, the controller introduced is compared with a PD controller which is commonly used for the robot manipulators control in industry. The effectiveness of the designed FSDDC is illustrated by simulations.
Because of the great advantages of serial robots and parallel robots where the former have simple structures, big workspaces, and easy control, the latter are in high force-to-weight, high stiffness and accuracy, and low inertia; they are widely used in various fields such as industrial production and scientific experiments [1–4]. Since robot is a very complicated multiple-input multiple-output (MIMO) nonlinear system with time-varying, strong-coupling characteristics, the design of robust controllers which is suitable for real-time control of manipulators is one of the most challenging tasks for many control engineers, especially when manipulators are required to maneuver very quickly within external disturbances. Various advanced control strategies, either model-based control or model-free control, have been applied in a variety of robots to improve the control performance [5–13].
The 3-DOF serial-parallel hybrid humanoid arm (HHA) combines the characteristics of series and parallel robot, as shown in Figure 1, and can be used in humanoid robots or automated production lines due to its special serial-parallel hybrid structure and performance, compared with other parallel or serial robots. However, the special structure of the HHA introduces complexity in kinematics, dynamic equations, and coupling of the system, placing greater demands on control methods. Proportional and derivative (PD) controller [14, 15], for its simple and effective properties, does not require any knowledge of the robot dynamics and is widely used in industrial robots, but it cannot follow the desire of accuracy and robustness. The combination of modern control methods and intelligent control technique [5–8] is widely used in various robot control research and brings out better effect. However, model-based controllers  cannot be accurately applied since it is almost impossible to obtain exact dynamic models. Although adaptive control [7, 8, 10] can achieve satisfied control effects and compensate for partially unknown manipulator dynamics and sliding-mode control [6–10] is robust with respect to system uncertainties and external disturbance, they all need prior knowledge of the robot. A robust adaptive trajectory tracking controller based on neural network algorithm is designed for HHA in , but the coupling effects are not taken into account in these control schemes. The coupling effects can limit the performances of HHA, since the dynamic coupling may restrict not only the further improvement of control performances in HHA but also the development of potential of such robot [11–13]. Eliminating or reducing the coupling of 3-DOF serial-parallel hybrid humanoid arm can improve the system control accuracy and the trajectory tracking performance. From the above analysis, it can be concluded that a control approach, suitable for multivariable systems with great disturbance rejection, decoupling ability, and model-free and strong robustness, is urgently needed for the HHA.
In recent years, a dynamic disturbance decoupling control (DDC)  approach can be applied to the manipulators. This disturbance decoupling control method is rooted in a new ground-breaking paradigm of control design: active disturbance rejection control (ADRC). The original concept of active disturbance rejection was proposed for the nonlinear structure by Han [18–20] and was further simplified and parameterized by Gao [21, 22]. The active disturbance rejection control (ADRC) method is a new kind of practical digital control technology which does not depend upon the accurate mathematical model of the plant. The central idea is that both the internal dynamics and external disturbances of the system can be estimated by extended state observe (ESO) [21, 23, 24] and compensated for in real time. Then the system can be reduced to the standard form of linear system, a simple unit gain of integrals, making the control problem much easier. More importantly, with the proposed parameterization of active disturbance rejection control (ADRC), it becomes a viable candidate for robot decoupling control  and practical applications [25–28].
With the continuous development of the fuzzy logic control theory, its application on robots received more and more attentions [5–7]. The main advantage of FLC comes from the applicability to systems when the mathematical model is not known exactly, and another important advance of fuzzy controller is the short rise time and small overshoot [29–31]. The knowledge about system characteristics coming from experts can be expressed by fuzzy logic rules, which makes this control method more attractive than the others.
To enhance the controller performance, in this study, hybridization of these two controller structures comes to one mind immediately to exploit the beneficial sides of both categories, known as a fuzzy self-tuning disturbance decoupling controller (FSDDC). The parameters of the normalization factor of output variable in the fuzzy mechanism and the control gain tuned by fuzzy logic units are adapted online to ensure the performance of the fuzzy self-tuning disturbance decoupling control system. This control algorithm can be applied to manipulator systems with unmodeled dynamics, unstructured uncertainties, decoupling, and external disturbance.
The remainder of the paper is organized as follows. In Section 2, the structure and the throwing process of 3-DOF HHA are analyzed by the means of numerical mathematics and image processing. Mathematical modeling is presented in Section 3. In Section 4, the DDC and FSDDC for HHA are proposed. Computer simulation results of the proposed FSDDC, DDC, and PD algorithms of the HHA are given in Section 5. Finally, Section 6 concludes the paper.
2. 3-DOF Serial-Parallel Hybrid Humanoid Arm
2.1. The Structure of 3-DOF HHA
This 3-DOF serial-parallel hybrid humanoid arm is composed of a 2-DOF parallel mechanism which forms the upper arm of HHA and a 1-DOF serial mechanism which forms the forearm of HHA.
As shown in Figure 1, the 2-DOF parallel mechanism is composed of linear motors 14 and 15 and their movers 16 and 17, upper arm orbits 3 and 5, upper arm slip tubes 1 and 4, elbow handspikes 2, and upper arm pedestal 13. The 1-DOF serial mechanism is composed of linear motor 11 and its mover 12, forearm pedestal 11, wrist handspike 8, wrist 7, forearm orbit 10, and forearm slip tube 9. The motors 14 and 15 and upper arm orbit are fixed on upper arm pedestal. The motor 11 is fixed on forearm pedestal. The movers P1, P2, and P3 move forwards or backwards relatively to its main-body motors M1, M2, and M3, and the movement of motors drives the other components to achieve the desired action through the rotation axes.
The coordinates and are shown in Figure 2. is the fixed reference coordinate system, and is attached to the upper arm of HHA. Referenced to the horizontal, the upward inclination of the upper arm is up about 20°.
The same point is described in and : and have transformation relations as follows: where
Under the assumption of the regular shape, smooth surface, and linear density steady of every components, the sketch of HHA in and is shown in Figure 2. The dot , , is the center of mass of the motors M1, M2, and M3 and their pedestals, respectively. The dot , , is the center of mass of the slip tubes S1, S2, and S3, respectively. The lengths of and are both , and the lengths of , , , , , , , , , and are , , , , , , , , , and , respectively. The lengths of , , and are defined as , , and , respectively.
In coordinates and , the position vectors of dot and are
As shown in Figure 2, is the angle between and the axis . is the angle between and axis . The HHA is on the initial state when .
Define As shown in Figure 2, the angles and can be described as follows:
The angle which is the angle between and and the angle which is the angle between and can be described as follows:
In coordinates , the position vectors of , , , and can be described as follows:
, , , and are arbitrary dots of , , , and . In coordinates , their position vectors are
and are arbitrary dots in and . In coordinates , their position vectors are
, , and are arbitrary dots in , , and . In coordinates , their position vectors are
2.2. Analysis and Reference Trajectory of Throwing Process
A complete throwing process of HHA in a cycle consists of three stages: HHA raising from initial state stage, HHA waiting for the load stage, and HHA throwing the load out stage. Whether the object can be thrown at a certain position and a certain speed is a key part in the complete throwing process, and obtaining the corresponding reference signal is considered as a difficult problem.
To obtain the corresponding reference signal, a method we proposed is shown as follows. Firstly, the changing curve of HHA elbow joint angle, wrist joint angle, and time should be found by analyzing the throwing process of man’s arm, respectively, and then the changing curve of , and time can be found through formula (5) and (6), respectively. By planning the motion of S1 and S2, we can get the changing curve of , , , and time, respectively.
To study the man’s throwing process in detail, a camera is used to get the video image of raising and throwing process. After processing by MATLAB and Photoshop, the video image can be divided into four parts: the raising of forearm, the putting down of forearm, the raising of hand, and the putting down of hand. Define the beginning time of raising process at 0 seconds and the beginning time of throwing process at 1.5 seconds; the video image processing results are shown in Figure 3.
Considering the structure of the elbow joint and energy saving, the can be produced by the following ways: when the forearm is raising, S1 and S2 move close to each other; when the forearm is putting down, S1 and S2 move away from each other. Then, the relationship between variables , , , , and time are shown in Tables 1 and 2; the relationship between variables , , and time are shown in Tables 3 and 4, respectively. Processing the data in Tables 1–4 by MATLAB CFtool, we get the changing curve of , , time in a cycle as shown in Figure 4 and their fragment expressions are given as follows:
3. Dynamic Modeling for HHA
In this section, the dynamic model of the HHA is derived. The Lagrange formalism used for the serial-parallel mechanism can be written as follows: where is the Lagrange function, and are the kinetic and potential energy functions, respectively, , are the vectors of the slip tubes position and velocity is the vector of the corresponding control input forces.
3.1. The Computing for Kinetic and Potential Energy of Every Component
The total kinetic and potential energy of movers P1, P2, and P3 is given, respectively, as where is the linear density of P1, P2, and P3.
The kinetic and potential energy of part and wrist handspike is given, respectively, as where and are the linear density of and wrist handspike, respectively.
The kinetic and potential energy of parts , , , and of forearm pedestal is given, respectively, as where is the linear density of , , , and .
The total kinetic and potential energy of motor and its pedestal is given as where is the mass of and its pedestal.
3.2. The Dynamic Model of the HHA
The dynamics of the HHA can be written as where are the vectors of slip tubes position, velocity, and acceleration, respectively, is a symmetric positive definite inertia matrix, is the matrix of centripetal and coriolis force, is the vector of gravitational force, is the vector of generalized input due to external disturbance with , and is the input force vector. Here , , and are the nominal parts calculated by Lagrange method, where , , and represent the perturbations in the system matrices. Then the dynamic model of HHA can be rewritten as where is the lumped system uncertainty and satisfies 
4. Fuzzy Self-Tuning Disturbance Decoupling Control (FSDDC) for HHA
In this section, the FSDDC for HHA is developed, which combines the advantages of the DDC and the FLC. First, the DDC for HHA is derived. Then, the FSDDC is proposed to establish the FLC for the proposed DDC.
4.1. Disturbance Decoupling Control (DDC) for HHA
DDC is a relatively new control design concept and a natural fit for the purpose of disturbance decoupling in robot systems. As it is applied to the control of the HHA system, the idea is that all the nonlinear, time-varying uncertainties and coupling terms are parts of the total disturbance and can be actively estimated using the extended state observer (ESO) and canceled in the control law, leading to roughly three single-input and single-output plants. In this section, three disturbance decoupling controllers are designed for HHA to do trajectory tracking.
The realistic model (18) can be reformulated as where is the desired trajectory.
The HHA system can be formed by a set of coupled equations with predetermined input-output parings:
Define the total disturbance of each loop as where is the approximate value of , represents the combined effect of internal dynamics and external disturbances in the th loop, including the cross-channel interference. Then (22) can be written as Now, the HHA system has been decoupled to a three-loop system as shown in Figure 5. Then an ADRC based SISO controller can be designed for each loop independently. The task of ADRC comes down to a critical subtask: estimate in real time. The estimation problem of leads us to a unique state observer known as the extended state observer (ESO).
Considering the first loop, the structure of DDC in first loop is given in Figure 6.
Let , , , which is added as an extended state. Assume is differentiable, and . The augmented model of (24) is
Letting , the augmented state space form of (25) is where
The state observer denoted as the linear extended state observer (LESO) of (26) is constructed as where is the observer gain vector:
With the state observer properly designed, , , and closely track , , and , respectively. The controller is given by
Ignoring the estimation error in to , the plant is reduced to a unit gain double integrator, which can be easily controlled by a linear state error feedback (LSEF) controller: where is the desired trajectory of S1. Then the total control law of first loop is found as
In order to simplify the tuning of ADRC parameters, a parameter tuning method of the LESO is proposed in ; with using the pole placement technique, all the observer poles are at , making the only tuning parameter for the LESO. That is where is the bandwidth of the LESO 1. This makes LADRC only have three tuning parameters , , and , compared to traditional ADRC controller.
Theorem 1. Assuming is bounded, the LESO is bounded-input bounded-output (BIBO) stable.
Proof. Let , , 2, 3, and combine (28) and (29) and subtract it from (26); the error equation can be written as
and is defined in (26). The characteristic polynomial of is
Letting , it is obvious the roots of the characteristic polynomial of are all in the left plane and is bounded; we can draw the conclusion that the LESO 1 is bounded-input bounded-output (BIBO) stable.
Proof. From (30) and (33), a state feedback equation can be described as
Then the closed-loop system can be transformed into the following state equation: By applying elementary row and column operations, it is obvious that the closed-loop eigenvalues satisfy Letting , , , it is obvious the roots of and are all in the left plane; since and are bounded, we can draw the conclusion that the DDC 1 is bounded-input bounded-output (BIBO) stable.
Consulting the disturbance decoupling control design strategy and stability analysis in the first loop, it is easy to develop two disturbance decoupling controllers for two other loops, the two other control laws and ,
4.3. Fuzzy Self-Tuning Disturbance Decoupling Control (FSDDC) for HHA
In this section, the fuzzy self-tuning disturbance decoupling control (FSDDC) with varying control gain is presented. The general structure of the proposed controller is given in Figure 7. The control gains of LSEF are changed dynamically by using the fuzzy logic unit in order to improve the performance of the controller; then the parameter regulation rules are given as follows: where and are the initial gains of LSEF, and are the output of fuzzy controllers, and and are the scale factors of FSDDC.
As shown in Figure 8, the membership functions are used for the fuzzification of the inputs, which are error and derivative of error . Here NB, NM, NS, ZO, PS, PM, and PB stand for negative big, negative medium, negative small, zero, positive small, positive medium, and positive big, respectively. The outputs are and ; then the initial control gains will be adjusted by the outputs and scale factors as shown in (43). This gives the ability to make the control gain value of the proposed controller smaller or bigger than the gain of the conventional DDC whenever necessary.
Since and are chosen to guarantee that the control gains are always kept positive during the fuzzy adaptation, the BIBO stability of the controlled system is preserved.
A set of numerical simulations is used here to verify the effectiveness of the proposed DDC and FSDDC. In addition, classical PD controller, which is commonly used for control of robot manipulators in industry because of its simple structure, is also applied to the HHA used for comparison. The numerical values of parameters of the HHA are listed in Table 7.
The reference signals are given in Section 2.2. The initial values of the system are selected as
In order to check the robustness of the proposed controllers, a load is introduced and it will be put on the hand in 1.4 seconds to 1.55 seconds; the variation of the mass of the wrist is given in Figure 9.
Normally, the distributed noise and the parameter uncertainties of the system always exist, which can be thought as disturbing torques acting on the joints, and are assumed to be time varying as
In the following passage, our proposed FSDDC and DDC are used for stabilizing the HHA system in comparison with the PD controller, with the gains of the FSDDC, DDC, and PD controllers being given in Tables 8, 9,and 10.
The dynamic tracking performances of the proposed FSDDC are illustrated in Figure 10, and one can find that the proposed FSDDC provides a reasonable tracking capability in the various disturbances and uncertainties. The mass variation applied after 1.4 seconds almost does not affect the tracking performance.
It is easy to see that the DDC has better tracking performance than the PD controller; the proposed DDC has the smaller tracking error and more convergence to zero than the PD controller; the performance of DDC is further improved by combination with the FLC; the FSDDC has smaller overshoot and shorter setup time than DDC.
The requested input thrust of the proposed FSDDC and DDC is slightly bigger than that of the PD controller, which are all in the range of output thrust of linear motors, and proves the efficiency of the proposed controller.
As a result, we can conclude that the proposed DDC and FSDDC can give a better tracking over the commonly used PD control. In this situation, the HHA can complete the throwing process as requested.
This paper addressed the robust trajectory tracking problem for a serial-parallel hybrid humanoid arm (HHA) throwing process in the presence of uncertainties and disturbances. The FSDDC control, with the advantages of both DDC and FLC, has shown a significant improvement over the PID control under the same conditions. The FSDDC can readily decouple the multi-input and multioutput processes by taking the interactions among different parts of the process as disturbances to be estimated and cancelled; it has strong disturbance rejection ability and robustness to uncertainties, which widely exist in throwing processes. The effectiveness of the designed unique dynamic FSDDC strategy was illustrated by simulation examples. We expect that, as we continue to work with the implementation, we may improve the response even further.
- W. B. J. Hakvoort, R. G. K. M. Aarts, J. van Dijk, and J. B. Jonker, “Lifted system iterative learning control applied to an industrial robot,” Control Engineering Practice, vol. 16, no. 4, pp. 377–391, 2008.
- S. Wei, Y. Wang, and Y. Zuo, “Wavelet neural networks robust control of farm transmission line deicing robot manipulators,” Computer Standards and Interfaces, vol. 34, no. 3, pp. 327–333, 2012.
- J. P. Merlet, Parallel Robots, Kluwer Academic, Dordecht, The Netherlands, 2000.
- Y. Pi and X. Wang, “Trajectory tracking control of a 6-DOF hydraulic parallel robot manipulator with uncertain load disturbances,” Control Engineering Practice, vol. 19, no. 2, pp. 185–193, 2011.
- C. K. Lin, “ reinforcement learning control of robot manipulators using fuzzy wavelet networks,” Fuzzy Sets and Systems, vol. 160, no. 12, pp. 1765–1786, 2009.
- N. Yagiz and Y. Hacioglu, “Robust control of a spatial robot using fuzzy sliding modes,” Mathematical and Computer Modelling, vol. 49, no. 1-2, pp. 114–127, 2009.
- T. H. S. Li and Y. C. Huang, “MIMO adaptive fuzzy terminal sliding-mode controller for robotic manipulators,” Information Sciences, vol. 180, no. 23, pp. 4641–4660, 2010.
- T. Sun, H. Pei, Y. Pan, H. Zhou, and C. Zhang, “Neural network-based sliding mode adaptive control for robot manipulators,” Neurocomputing, vol. 74, no. 14, pp. 2377–2384, 2011.
- S. Yu, X. Yu, B. Shirinzadeh, and Z. Man, “Continuous finite-time control for robotic manipulators with terminal sliding mode,” Automatica, vol. 41, no. 11, pp. 1957–1964, 2005.
- M. B. R. Neila and D. Tarak, “Adaptive terminal sliding mode control for rigid robotic manipulators,” International Journal of Automation and Computing, vol. 8, no. 2, pp. 215–220, 2011.
- Y. Chen and J. E. McInroy, “Decoupled control of flexure-jointed hexapods using estimated joint-space mass-inertia matrix,” IEEE Transactions on Control Systems Technology, vol. 12, no. 3, pp. 413–421, 2004.
- C. Yang, Q. Huang, and J. Han, “Computed force and velocity control for spatial multi-DOF electro-hydraulic parallel manipulator,” Mechatronics, vol. 22, pp. 715–722, 2012.
- C. Yang, Q. Huang, and J. Han, “Decoupling control for spatial six-degree-of-freedom electro-hydraulic parallel robot,” Robotics and Computer-Integrated Manufacturing, vol. 28, no. 1, pp. 14–23, 2012.
- N. Minorsk, “Directional stability of automatically steered bodies,” Journal of ASNE, vol. 42, no. 2, pp. 280–309, 1922.
- K. J. Astrom and H. Tore, Advanced PID Control, The Instrumentation, Systems, and Automation Society, Triangle Park, NC, USA, 2005.
- Y. Wang and Z. Jin, “Dynamics modeling and robust trajectory tracking control for a class of hybrid humanoid arm based on neural network,” Chinese Journal of Mechanical Engineering, vol. 22, no. 3, pp. 355–363, 2009.
- Q. Zheng, Z. Chen, and Z. Gao, “A practical approach to disturbance decoupling control,” Control Engineering Practice, vol. 17, no. 9, pp. 1016–1025, 2009.
- J. Han, “Auto-disturbance rejection control and its applications,” Control and Decision, vol. 13, no. 1, pp. 19–23, 1998 (Chinese).
- J. Han, “Nonlinear design methods for control systems,” in Proceedings of the 14th International Federation of Accountants IFAC World Congress, pp. 521–526, 1999.
- Z. Gao, Y. Huang, and J. Han, “An alternative paradigm for control system design,” in Proceedings of the 40th IEEE Conference on Decision and Control (CDC '01), pp. 4578–4585, Orlando, Fla, USA, December 2001.
- Z. Gao, “Scaling and Bandwidth-parameterization based controller tuning,” in Proceedings of the 2003 American Control Conference, vol. 6, pp. 4989–4996, June 2003.
- G. Tian and Z. Gao, “Frequency response analysis of active disturbance rejection based control system,” in Proceedings of the 16th IEEE International Conference on Control Applications (CCA '07), pp. 1595–1599, October 2007.
- J. Han, “A class of extended state observers for uncertain systems,” Control and Decision, vol. 10, no. 1, pp. 85–88, 1995 (Chinese).
- Q. Zheng, L. Q. Gao, and Z. Gao, “On validation of extended state observer through analysis and experimentation,” Journal of Dynamic Systems, Measurement and Control, vol. 134, no. 2, Article ID 024505, 2012.
- Z. Gao, “Active disturbance rejection control: a paradigm shift in feedback control system design,” in Proceedings of the 2006 American Control Conference, pp. 2399–2405, June 2006.
- J. Han, “From PID to active disturbance rejection control,” IEEE Transactions on Industrial Electronics, vol. 56, no. 3, pp. 900–906, 2009.
- Y. Huang, K. Xu, J. Han, and J. Lam, “Flight control design using extended state observer and non-smooth feedback,” in Proceedings of the 40th IEEE Conference on Decision and Control (CDC '01), pp. 223–228, December 2001.
- J. Vincent, D. Morris, N. Usher et al., “On active disturbance rejection based control design for superconducting RF cavities,” Nuclear Instruments and Methods in Physics Research A, vol. 643, no. 1, pp. 11–16, 2011.
- G. K. I. Mann, B. G. Hu, and R. G. Gosine, “Analysis of direct action fuzzy PID controller structures,” IEEE Transactions on Systems, Man, and Cybernetics B, vol. 29, no. 3, pp. 371–388, 1999.
- J. Carvajal, G. Chen, and H. Ogmen, “Fuzzy PID controller: design, performance evaluation, and stability analysis,” Information Sciences, vol. 123, no. 3, pp. 249–270, 2000.
- H. B. Kazemian, “Comparative study of a learning fuzzy PID controller and a self-tuning controller,” ISA Transactions, vol. 40, no. 3, pp. 245–253, 2001.