Design of Augmented Nonlinear PD Controller of Delta/Par4-Like Robot
This work presents the design of two control schemes for a Delta/Par4-like parallel robot: augmented PD (APD) controller and augmented nonlinear PD (ANPD) controller. The stability of parallel robot based on nonlinear PD controller has been analyzed and proved based on Lyapunov method. A comparison study between APD and ANPD controllers has been made in terms of performance and accuracy improvement of trajectory tracking. Also, another comparison study has been presented between augmented nonlinear PD (ANPD) controller and nonaugmented nonlinear PD (NANPD) controller in order to show the enhancement of introducing the augmented structure on dynamic performance and trajectory tracking accuracy. The effectiveness of augmented PD controllers (APD and ANPD) and nonaugmented nonlinear PD (NANPD) controller for the considered parallel robot are verified via simulation within the MATLAB environment.
The parallel manipulators are defined as mechanisms with closed-loop kinematic chains, in which the end effector is linked to the base through several independent kinematic chains. Parallel manipulator has the advantages of high speed, high precision, and ability to manipulate heavy loads .
In the last two decades, several structures of modified proportional integral derivative (PID) controllers have been presented in the industrial control application. One of these controllers is the nonlinear PID (NPID), which is introduced by HAN . The main idea was to replace the gain scheduling by a nonlinear gain function by introducing a continuous dynamic nonlinear function to achieve better noise rejection and better tracking. This is achieved by synthesizing a function composed of a linear function near the zero error and nonlinear function far from zero error.
Recently, several controllers are proposed to control the parallel manipulator. In , Anoop R Nair and Achu Govind KR designed and verified the performance of adaptive PID control of Delta parallel manipulator. In this work, the controller was able to trace the desired trajectory without any deflection. Zhang et al. studied the problem of dynamic control design for redundantly actuated planer 2-DOF parallel manipulator. The work proposed an augmented PD controller based on forward dynamic compensation control technique, which showed better performance when compared with conventional PD controller . Hussein Saied et al. proposed different model-based (augmented PD and adaptive feed-forward with PD) controllers and nonmodel-based (PD, PID, and nonlinear PD) controllers for a 4-DOF parallel VELOCE robot . The work investigated how well the dynamic performance of the system could be enhanced by including Parallel Kinematic Manipulator (PKM) and employing its varied parameters for further improvement. Wei-Wei Shang et al. proposed an augmented nonlinear PD controller based on conventional dynamic control. This proposed controller replaced linear PD controller in order to improve the tracking accuracy for 2 DOF redundantly actuated parallel manipulator . Wei-Wei Shang and Shuang Cong developed new computed torque (CT) controllers called nonlinear computed torque (NCT), which is applied to real high-speed planer parallel . Su et al. developed a nonlinear proportional integral derivative (N-PID) algorithm in link space to achieve high precision tracking control for a general 6-DOF parallel manipulator. Experimental results indicated that the nonlinear control method can achieve a superior performance . Fatma et al. designed nonlinear PID controller for trajectory tracking of a manipulator robot (SCARA) and developed a PID controller having high performances in terms of controllability and stability of manipulator .
In the present work, design and stability analysis of augmented-based PD control structure is presented in order to control a redundant Delta/Par4-like parallel manipulator.
Delta/Par4-like robot is a redundantly actuated parallel manipulator and it is much known for the application that needs for high speed and high acceleration. The Delta/Par4-like robot is characterized by light-weight mechanical component common with good structural stiffness. Also, it can achieve velocity and acceleration to reach above 10 m/ and 150 m/, respectively, in case of pick and place applications. This redundant actuated parallel manipulator is able to reach 100 G. This parallel robot is 3-DOF (translation along x-y-z) and has four actuators (redundantly actuated), each motor has a maximum torque of 127N.m. The suggested parallel manipulator has a workspace of at least a cylinder of 300 mm radius and 100 mm height . Figure 1 shows an outlook of Delta/Par4-like robot.
The main contribution of the work can be summarized by the following points:(i)Design of augmented-based PD control scheme for controlling a redundant Delta/Par4-like parallel robot.(ii)Performance comparison between augmented-based controllers (APD and ANPD) in terms of dynamic behaviors and accuracy of trajectory tracking.(iii)A Lyapunov-based stability analysis is presented for parallel robot controlled by ANPD controller to prove the asymptotically convergence of both tracking error and error rate to zero as .(iv)A comparison study has been made between augmented-based nonlinear PD (ANPD) controller and nonaugmented-based nonlinear PD (NANPD) controller in terms of tracking accuracy and dynamic performance.
2. Geometric Description of Delta/Par4-Like Robot
The geometric parameters used in describing the dynamic model of Delta/Par4-like robots are depicted in Figure 2, where . In developing the dynamic model of parallel robot, the forearms of Delta/Par4-like parallel robot are replaced by simple rods.
The Cartesian coordinates of joint center locations , , and arewhere and are the radius of traveling plate and base of robot, respectively, and are the lengths of arm and forearm, respectively, and denotes the orientation of actuator axes, described byThere is another frame associated with each actuator designated as , where and are given byThe relation between Cartesian and joint velocity vectors of the traveling plate is described in the following equation :where and are the joint and Cartesian velocity vectors, respectively. Equation (4) can be written as follows:Therefore, the matrix maps the velocity vector of the forearm from joint to Cartesian space. The matrix is square and invertible in case of nonredundant robots, while it is not inverted for redundant robots and the pseudoinverse matrix can be used instead. The derivation of (5) leads to
3. The Simplified Dynamic Model of Delta/Par4-Like Robot
This section presents the simplified direct dynamic model (DDM) of Delta/Par4-like parallel manipulators. To do so, the following assumptions are made [12, 13]:(1)Neglect the joint friction.(2)Neglect the inertia of forearms ().(3)The total mass of each forearm is assumed to be split into two parts located at the ends of the forearm such that each part has half the value of as indicated in Figure 3.(4)Due to very high acceleration, which reaches up to 100 G, the gravity will not be considered and can be neglected.
To start the derivation of simplified dynamic model of Delta/Par4-like robot, the equilibrium analysis of the arm is first presented. The actuator torque vector is related to the acceleration vector by the following equation:where denotes the joint Jacobian of the robot, is the vector of actual joint torques, represents the vector of forces exerted on robot arm at points , and is a diagonal matrix whose diagonal elements is given bywhere and are the inertia of arms and actuator, defines the length of the arm, and is the mass of the forearm.
Secondly, the equilibrium of the traveling plate is analyzed. The motion equation of the traveling plate is given by where is Cartesian Jacobian of the robot and is a diagonal matrix whose elements are given bywhere denotes the number of actuators and is the traveling plate mass. The Cartesian Jacobian of Delta/Par4 like parallel robots is not invertible if there are more actuators than degrees-of-freedom.
Substituting (7) into (9), the dynamic model of Delta/Par4 like robot will be written in Cartesian space asUsing (6), one can obtainorIf one set , then the dynamic model of (13) can be written in the following form:or where is the Jacobian matrix, defines the inertial matrix, while stands for both centrifugal and Coriolis forces. The force matrix expresses the forces required in the Cartesian task space and the following equation relates this force to actual joint torque :Since the Delta/Par4-like manipulator is a redundant robot, the matrix is not a square matrix and cannot be inverted. Hence, the pseudomatrix concept is involved and the pseudo-inverse of can be defined as Therefore, one can have the following expression, which relates the torque to the force matrix :
4. Augmented NPD Control Design for Delta/Par4-Like Robot
The ANPD controller proposed in the present work is synthesized by replacing the linear PD by the structure of APD controller based on NPD algorithm. The structure of the NPD controller can be described by The is a nonlinear function where (Delta) determines the threshold of error (or error derivative), which discriminates between the linear (below or equal ) and nonlinear region (above ). The parameter (alpha) governs the degree of nonlinearity and complexity of the function above the value of . The value of is normally chosen between (0-2) and the function has linear characteristics with as illustrated in Figure 4.
According to general NPD control law of (19) and the dynamic model described by (15), the proposed NPD control law for Delta/Par4-like robot, where and are the desired velocity and desired acceleration of traveling plate, respectively, and is the position error, .
The control law of the ANPD controller of Delta/Par4-like robot consists of two parts: the first part describes the dynamic compensation defined by the desired trajectoryThe second part represents the error elimination given byThe nonlinear gains and are given by where and for are given by where and are positive constant gains.
5. Stability Analysis of Delta/Par4-Like Robot Controlled by ANPD Controller
This section focuses on the proof of the asymptotic stability of the Delta/Par4-like robot system controlled by the ANPD controller (21). Before proceeding, two lemmas are introduced based on [11, 15].
Definition 1. A scalar continuous function , defined for , is said to belong to the class if it is strictly increasing and .
Proof. Since belongs to the class , then , which means that is a real-valued function. Additionally, since , then the area under the curve defined by yields strictly positive real value, which proves Lemma 2.
Lemma 3. The continuous matrix diagonal can be considered as where for , respectively.
Suppose that there exist class function such that To guarantee a positive value of the function , it can be described asIn order to satisfy (31), then is expressed asor Referring to Lemma 2 and since , we have Consequently, andIf we set , then the functionis a positive definite function. Figure 6 illustrates graphically the concept of Lemma 3 proof.
Proof. Let us candidate a Lyapunov function of the following form:Due to the positive definiteness of matrix , the term is a positive definite function. The second term of Lyapunov function can be explained as the potential energy, which is driven by error part of the controller and it is given by (38) and it has been shown that it is unbounded positive definite. Therefore, is a positive definite function.
The time derivative of the Lyapunov function is Using the control law defined by (21) and the dynamic model given by (15), the closed-loop system equation becomesorEquation (42) can be rewritten aswhere is the position error, , and .
Multiplying both sides of (43) by from the left and solving for to have Substituting the result from (44) into (40), we haveSince is a diagonal matrix, the terms and are cancelled out and (45) reduces Since the property is satisfied in the considered robot, (46) becomes Since is a symmetric positive definite matrix, then the function is seminegative definite and hence Delta/Par4-like robot is stable.
However, since and , the asymptotic stability of the origin is not guaranteed and the trajectory may not reach to equilibrium at the origin, but it converges to specified limit instead.
Based on Lyapunov function described by (39), one may conclude that both of error and error derivative is bounded. Since the matrix is symmetric positive definite, therefore its inverse exists and bounded. Then, the closed-loop error dynamic systems can be written asAccording to Barbalat lemma , the second derivative of error is also bounded. Therefore, one can decisively conclude as , which implies that as .
The block diagram of Delta/Par4-like Robot control scheme based on augmented PD controller is shown in Figure 7. As indicated earlier, this controller is composed of two parts: the first part is the PD-based control law and the second part is the feedback signal. Moreover, the PD-based control can be either classical PD controller (APD) or nonlinear PD controller (ANPD). The actuating control input for augmented PD controller can be written as where is pseudoinverse of .
In case of nonaugmented PD controller, the terms and are eliminated from (49), which becomes In addition to performance comparison between the augmented PD structures (APD and ANPD), a comparison is made between augmented nonlinear PD (ANPD) controller and nonaugmented nonlinear PD (NANPD) controller.
6. Simulation Results
Delta/Par4-like robot is redundant parallel manipulator consisting of four motors and 3-DOF, and its actuators are the RTMB140-100 ETEL, which have a maximum torque 127 N. m and maximum speed 550 RPM and workspace (cylinder of 300 mm radius and 100 mm height) . The numeric values of system parameters are listed in Table 1.
In this section, the dynamic model of Delta/par4-like robot and proposed controllers are implemented in Matlab/Simulink (R2017b). The setting of parameters for both ANPD and APD structures is based on the try-and-error procedure and listed in Table 2.
The desired trajectory in Cartesian space can be described byFigure 8 depicts the traces of above desired trajectory.
In performance evaluation of accuracy in most robotic applications, the RMSE is used instead of Integral absolute value of error (IAE) or Integral of the square value of error (ISE). However, the RMSE criteria is strongly related to ISE one, where RMSE=. In the present work, a discrete version of RMSE is adopted to evaluate the accuracy performance, which can be defined bywhere is the number of samples, is the sampling instant, and , , and represent the tracking errors along , , and .
The first part of the simulation establishes a comparison study in performance between augmented PD control structures (APD and ANPD). Figure 9 shows the error behaviors on x, y and z-axes for APD and ANPD controllers. It is clear from the figure that the ANPD controller can provide better tracking performance than the APD controller. Also, it is worthy to notice that the errors in -axis given by both controllers are in order of , which can be regarded as a negligible error. However, this is a reasonable result since there is no desired trajectory on this axis . As such this axis is discarded from the comparison in the next part of simulation.
Table 3 reports the performances of APD and ANPD controllers and gives the percentage of improvement gained with ANPD controller. The better controller is the one which gives less RMSE value. From Table 3, the RMSE value of error given by ANPD is equal to 0.0013, while that resulting from APD is equal to 0.0068 with an improvement of 78.27%. Therefore, one can conclude that ANPD gives better tracking accuracy with an improvement of 78.27%.
The responses of torques generated by the four robot actuators are shown in Figure 10. These control efforts, represented by torque signals have to respond to the requirements of controllers such as to compensate and pay for accuracy improvement.
The second part of simulation results focuses on the evaluation of performance based on augmented and nonaugmented nonlinear PD controllers (ANPD and NANPD). Figure 11 shows the behaviors of error on and -axes for ANPD and NANPD controllers. Table 3 lists the values of RMSE for ANPD and NANPD. It is evident from the table that ANPD results in a value of RMSE equals to 0.0013, while a value of 0.0052 is resulting from NANPD controller. This indicates that ANPD controller achieves 75% improvement and it outperforms NANPD controller in terms of tracking performance.
The torque responses generated from the four actuating motors of the parallel robot is depicted in Figure 12. For a fair comparison, the same set of parameters given to ANPD, which are listed in Table 2, are assigned to the corresponding parameters of NANPD controller.
This paper presented two comparison studies. One study is based on the comparison between augmented PD control structures (APD and NAPD controller). The other comparison study is established between augmented nonlinear PD (ANPD) controller and nonaugmented nonlinear PD (NANPD) controller. The assessment of controllers for comparison is made in terms of tracking performance and accuracy for 3-DOF Delta/Par4-like parallel robot. The measure of improvement is calculated in terms of error variance.
The simulated results showed that ANPD controller gives 78.26% improvement in tracking accuracy as compared to that given by APD as indicated by Table 3. Also, the ANPD controller gives 75% improvement in performance as compared to that given by NANPD as reported by Table 4. Therefore, one can conclude that ANPD outperforms both APD and NANPD controllers.
No data were used to support this study.
Conflicts of Interest
The authors declare that they have no conflicts of interest.
R. Jee-Hwan, Parallel Manipulators-New Development, I-Tech Education and Publishing, Vienna, Austria, 2008.
R. Anoop and K. Achu, “Control technique for parallel manipulator using PID,” International Journal of Engineering Research & Technology, vol. 5, no. 7, pp. 56–59, 2016.View at: Google Scholar
Y.-X. Zhang, S. Cong, W.-W. Shang, Z.-X. Li, and S.-L. Jiang, “Modeling, identification and control of a redundant planar 2-DOF parallel manipulator,” International Journal of Control, Automation, and Systems, vol. 5, no. 5, pp. 559–569, 2007.View at: Google Scholar
H. Saied, A. Chemori, M. El Rafei, C. Francis, and F. Pierrot, “From non-model-based to model-based control of pkms: a comparative study,” in Proceedings of the 1st International Congress for the Advancement of Mechanism, Machine, Robotics and Mechatronics Sciences, pp. 50–64, Beirut, Lebanon, 2017.View at: Publisher Site | Google Scholar
F. Abdelhedi, Y. Bouteraa, A. Chemori, and N. Derbel, “Nonlinear PID and feed-forward control of robot manipulator,” in Proceedings of the 15th International Conference on Sciences and Techniques of Automatic Control and Computer Engineering, STA 2014, pp. 349–354, IEEE, Hammamet, Tunisia, 2014.View at: Google Scholar
D. Corbel, M. Gouttefarde, O. Company, and F. Pierrot, “Toward 100G with PKM: is actuation redundancy a good solution for pick and place?” in Proceedings of the 2010 IEEE International Conference on Robotics and Automation, ICRA 2010, pp. 4675–4682, IEEE, Anchorage, Alaska, USA, May 2010.View at: Google Scholar
G. Sartori Natal, A. Chemori, and F. Pierrot, “Dual-space adaptive control of redundantly actuated parallel manipulator for extremely fast operations with load changes,” in Proceedings of the 2012 IEEE International Conference on Robotics and Automation, ICRA 2012, pp. 253–258, IEEE, Saint Paul, Minn, USA, May 2012.View at: Google Scholar
F. Pierrot, C. Baradat, V. Nabat, O. Company, S. Krut, and M. Gouttefarde, “Above 40g acceleration for pick-and-place with a new 2-DOF PKM,” in Proceedings of the 2009 IEEE International Conference on Robotics and Automation, ICRA '09, pp. 1794–1800, IEEE, Kobe, Japan, May 2009.View at: Google Scholar
V. Nabat, Robots parallèles à nacelle articulée, du concept à la solution industrielle pour le pick-and place [Ph.D. thesis], Montpellier 2 University, Montpellier, France, 2007.
J. Q. Han, “Nonlinear PID controller,” Acta Mathematica Sinica, vol. 20, no. 4, pp. 487–490, 1994.View at: Google Scholar
K. Hassan, Nonlinear Control, Pearson, London, UK, Global Edition edition, 2015.
R. Kelly, V. Santibez, and A. Lora, Control of Robot Manipulators in Joint Space, Springer-Verlag, London, UK, 2005.