### Research on the Trajectory Tracking Control of a 6-DOF Manipulator Based on Fully-Actuated System Models

SUN Hao1, HUANG Ling1, HE Liang2

1. 1. School of Automation, Harbin University of Science and Technology, Harbin 150080, China;
2. School of Software, Northwestern Polytechnical University, Xi’an 710072, China
• Received:2022-01-16 Revised:2022-02-22 Published:2022-04-13
• Supported by:
This research was supported by the Natural Science Foundation of Heilongjiang Province under Grant No. LH2020F035.

SUN Hao, HUANG Ling, HE Liang. Research on the Trajectory Tracking Control of a 6-DOF Manipulator Based on Fully-Actuated System Models[J]. Journal of Systems Science and Complexity, 2022, 35(2): 641-659.

The multi-degree of freedom (muti-DOF) manipulator system is a complex control system with the strong coupling feature and high nonlinearity. In this paper, trajectory tracking control of a six-degree of freedom (6-DOF) manipulator based on fully-actuated system models and a direct parametric method is investigated. The fully-actuated system model of the 6-DOF manipulator is established by using the Denavit Hartenberg (DH) notation and Euler-Lagrange dynamics. A disturbance observer is constructed to solve the nonlinear uncertainties such as unmodeled dynamics and external disturbances. Then, a controller is designed using the direct parametric method to make the 6-DOF manipulator reach the desired position with high accuracy. After that, a switching control strategy is developed to suppress the peak value belonging to the controller. Simulation results reveal the effect of the proposed control approach.
 [1] Craig J J, Introduction to Robotics: Mechanics and Control, Pearson Education, Inc., Upper Saddle River, New Jersey, 2018.[2] Cruz G L, Alazki H, Cortes-Vega D, et al., Application of robust discontinuous control algorithm for a 5-DOF industrial robotic manipulator in real-time, Journal of Intelligent & Robotic Systems, 2021, 101(4): 1–17.[3] Liao J, Huang F, Chen Z, et al., Optimization-based motion planning of mobile manipulator with high degree of kinematic redundancy, International Journal of Intelligent Robotics and Applications, 2019, 3(2): 115–130.[4] Wang H, Li X, Liu X, et al., Fuzzy sliding mode active disturbance rejection control of an autonomous underwater vehicle-manipulator system, Journal of Ocean University of China, 2020, 19(5): 1081–1093.[5] Rybus T, Seweryn K, and Sasiadek J Z, Control system for free-floating space manipulator based on nonlinear model predictive control (NMPC), Journal of Intelligent & Robotic Systems, 2017, 85(3–4): 491–509.[6] Wang Q, Wang Z, and Shuai M, Trajectory planning for a 6-DoF manipulator used for orthopaedic surgery, International Journal of Intelligent Robotics and Applications, 2020, 4(1): 82–94.[7] Sai H, Xu Z, Li Y, et al., Adaptive nonsingular fast terminal sliding mode impedance control for uncertainty robotic manipulators, International Journal of Precision Engineering and Manufacturing, 2021, 22(12): 1947–1961.[8] Pervozvanski A A and Freidovich L B, Robust stabilization of robotic manipulators by PID controllers, Dynamics and Control, 1999, 9(3): 203–222.[9] Aksoy O, Zergeroglu E, and Tatlicioglu E, On adaptive output feedback controf robotic manipulators with online disturbance estimation, Journal of Intelligent & Robotic Systems, 2017, 85(3–4): 633–649.[10] Kolhe J P, Shaheed M, Chandar T S, et al., Robust control of robot manipulators based on uncertainty and disturbance estimation, International Journal of Robust and Nonlinear Control, 2013, 23(1): 104–122.[11] Li C, Ren C, Ding Y, et al., Non-singular terminal sliding mode control of an omnidirectional mobile manipulator based on extended state observer, International Journal of Intelligent Robotics and Applications, 2021, 5(2): 219–234.[12] Wang X, Hairong D, and Qiong W, Research of manipulator trajectory tracking based on adaptive robust iterative learning control, Cluster Computing, 2019, 22(2): 3079–3086.[13] Wang F, Chao Z, Huang L, et al., Trajectory tracking control of robot manipulator based on RBF neural network and fuzzy sliding mode, Cluster Computing, 2019, 22(3): 5799–5809.[14] Zhao Y, Zhang S, and Lee J, Adaptive finite-time backstepping control for a two-wheeled mobile manipulator, Journal of Mechanical Science and Technology, 2018, 32(12): 5897–5906.[15] Loucif F, Kechida S, and Sebbagh A, Whale optimizer algorithm to tune PID controller for the trajectory tracking control of robot manipulator, Journal of the Brazilian Society of Mechanical Sciences and Engineering, 2020, 42(1): 1–11.[16] Kumar J, Kumar V, and K P S, Fractional-order self-tuned fuzzy PID controller for three-link robotic manipulator system, Neural Computing and Applications, 2020, 32(11): 7235–7257.[17] Awan Z S, Ali K, Iqbal J, et al., Adaptive backstepping based sensor and actuator fault tolerant control of a manipulator, Journal of Electrical Engineering & Technology, 2019, 14(6): 2497–2504.[18] Liu A, Zhao H, Song T, et al., Adaptive control of manipulator based on neural network, Neural Computing and Applications, 2021, 33(9): 4077–4085.[19] Yen V T, Nan W Y, Van Cuong P, et al., Robust adaptive sliding mode control for industrial robot manipulator using fuzzy wavelet neural networks, International Journal of Control, Automation and Systems, 2017, 15(6): 2930–2941.[20] Tran D T, Truong H V A, and Ahn K K, Adaptive nonsingular fast terminal sliding mode control of robotic manipulator based neural network approach, International Journal of Precision Engineering and Manufacturing, 2021, 22(3): 417–429.[21] Duan G R, High-order system approaches: I. Fully-actuated systems and parametric designs, Acta Automatica Sinica, 2020, 46(7): 1333–1345.[22] Duan G R, Direct parametric approach for cascaded systems with application in robot control, 201414th International Conference on Control, Automation and Systems, Korea, 2014, 29–35.[23] Chen W H, Ballance D J, Gawthrop P J, et al., A nonlinear disturbance observer for robotic manipulators, IEEE Transactions on industrial Electronics, 2000, 47(4): 932–938.[24] Horn R A and Johnson C R, Matrix Analysis, Cambridge University Press, Cambridge, 2012.
 [1] KONG Xiangyu, XIA Yuanqing, HU Rui, LIN Min, SUN Zhongqi, DAI Li. Trajectory Tracking Control for Under-Actuated Hovercraft Using Differential Flatness and Reinforcement Learning-Based Active Disturbance Rejection Control [J]. Journal of Systems Science and Complexity, 2022, 35(2): 502-521. [2] WU Si, LIU Tengfei. Safety Control of a Class of Fully Actuated Systems Subject to Uncertain Actuation Dynamics [J]. Journal of Systems Science and Complexity, 2022, 35(2): 543-558. [3] DUAN Guangquan, LIU Guo-Ping. Attitude and Orbit Optimal Control of Combined Spacecraft via a Fully-Actuated System Approach [J]. Journal of Systems Science and Complexity, 2022, 35(2): 623-640. [4] SUN Wei,WU Yuqiang. Modeling and Finite-Time Tracking Control for Mobile Manipulators with Affine and Holonomic Constraints [J]. Journal of Systems Science and Complexity, 2016, 29(3): 589-601.
Viewed
Full text

Abstract