Abstract
Aiming at the problem of high-precision trajectory tracking of four-cable-driven parallel robot, a dynamic non-singular fast terminal sliding mode surface based on the estimation output of interference observer is proposed. Firstly, based on the combination of traditional fast terminal sliding mode control and non-singular terminal synovial control, the estimation value of interference observer is introduced, and a new nonlinear sliding mode surface is established to suppress the influence of unknown disturbance, and at the same time track the desired trajectory from unstable state to steady state. Based on the Lyapunov stability theory of the controller, the effectiveness of the control scheme is proved. Finally, in the Matlab/Simulink environment, a comparative simulation with the existing linear synovial film and non-singular fast terminal sliding mode is carried out, and the designed control method realizes high-precision fast tracking of the desired trajectory of the end grab under the uncertainty of modeling error, external interference and joint friction, which verifies the effectiveness and feasibility of the proposed control method.
You have full access to this open access chapter, Download conference paper PDF
Keywords
1 Introduction
With the development of construction machinery manufacturing industry, the characteristics of building types becoming more and more complex have become increasingly prominent. For the capture, identification and handling of target building materials in the construction environment, most of them are still carried out manually. As a typical parallel robot that realizes the movement of the end effector through the retracting and releasing control of the flexible cable, the flexible rope parallel drive robot has many advantages such as large working space, small dynamic inertia and fast movement speed [1], and is widely used in many fields such as astronomical observation [2], field video [3], 3D printing [4] and so on. However, the soft rope is also exposed to the external disturbance caused by the flexibility, elasticity, nonlinearity and unidirectional constraint characteristics of the soft cable. Therefore, ensuring the high-precision trajectory tracking of the end effector of the robot driven in parallel has become an urgent problem to be solved.
Many scholars at home and abroad have conducted research on motion control of soft rope parallel robot. Yan-Lin Wang et al. [5] proposed a new controller consisting of an inner loop fuzzy sliding mode controller and an outer loop variable admittance controller to control the cable-driven lower limb rehabilitation robot. Ji, Y.F., et al. [6] established an eight-rope traction robot in a low-speed wind tunnel, and verified the phenomenon of aerodynamic retardation through experiment. The above literature adopts various control strategies for high-precision. Peng Liu et al. [7] proposed a robust adaptive fuzzy control strategy, which proved the reliability of trajectory tracking of the soft-cable-driven picking robot through Simula trajectory tracking of soft cable-driven robots. An, B., et al. [8] proposed an adaptive terminal sliding mode based on interference observer in the aircraft model, which combines the interference signal with the terminal synovial membrane to construct and eliminate the singularity in the system. Zhang, Q. W., et al. [9] proposed a non-singular terminal sliding mode control method for redundant drive parallel mechanism system, which realized high-precision trajectory tracking control. In this paper, based on the combination of traditional fast terminal sliding mode control and non-singular terminal synovial control, the estimation value of interference observer is introduced, a new nonlinear sliding mode surface is established to suppress the influence of unknown disturbance, and enable the system to track the expected trajectory from an unstable state to a stable state.
2 Kinematics and Dynamics Models of Rope-Driven Robots
2.1 Rope-Driven Robot Kinematics
In this paper, the principle of vector closure is used to establish the kinematic model of cable length space and end material grasping space of four-cable robot, and the end grab is regarded as an abstract point P(x, y, z). Establish a Cartesian coordinate system O-XYZ, OX horizontal direction, OY direction determined according to the right-hand rule, OZ perpendicular to the corresponding platform. a, b and h represent the spatial structure dimensions of the four-cable robot, respectively. The center of the pulley set in the coordinate system is represented as \(A_{i} (x_{i} ,y_{i} ,z_{i} )\), i = 1,2,3,4. Then each length of the cord can be expressed as:
The kinematics diagram of the four-cable driven robot was analyzed (see Fig. 1).
Equation (1) describes the mapping relationship between the end grab space and the cable length space of the robot. In robot kinematics, the Jacobi matrix represents the linear mapping of the robot's operational space velocity and joint space velocity. In a cable-driven parallel robot, it can also be expressed between the running speed of the end grab and the speed at which the cord changes, as shown in Eq. (2)
Formula \(\dot{L}_{i}\) = \([\dot{L}_{1} \quad \dot{L}_{2} \quad \dot{L}_{3} \quad \dot{L}_{4} ]^{T}\), V represents the velocity vector of the end grab, V = \([\dot{x}\quad \dot{y}\quad \dot{z}]^{T}\). J represents the Jacobi matrix. J = \([\frac{{\partial L_{i} }}{\partial x}\quad \frac{{\partial L_{i} }}{\partial y}\quad \frac{{\partial L_{i} }}{\partial z}]\) ( i = 1,2,3,4).
2.2 Rope-Driven Robot Dynamics
In this paper, the end grab of the four-cable robot is the research object, and the driving force of each soft cable applied by the facility to the end grab is \(T_{{\text{i}}}\), and the force is shown in Fig. 1. Thus, its dynamic model can be obtained by the Euler–Lagrange method:
Among them, \(q,\dot{q},\ddot{q}, \in R^{n}\) is the motion position, speed and acceleration of the end gripper. \(M({\text{q}}) \in R^{n \times n}\) is the positively definite symmetric mass inertia matrix, \(C\left( {{\text{q}},{\dot{\text{q}}}} \right) \in R^{n \times n}\) is the Coriolis force coupling matrix, \(G({\text{q}}) \in R^{n \times n}\) are the gsravitational vectors, \(\tau_{d} ,\tau_{f} \in R^{n}\) is the external disturbance and the friction force vector, T is the driving force of each rope, and J is the Jacobi structure Considering the modeling error of the Flexo robot, there is \(M(q) = M_{0} (q) + \Delta M(q);\)\(C(q,\dot{q}) = C_{0} (q,\dot{q}) + \Delta C(q,\dot{q});\)\(G(q) = G_{0} (q) + \Delta G(q)\). Corresponding estimate is \(M_{0} (q),C_{0} (q,\dot{q}),G_{0} (q)\). System modeling error is \(\Delta M(q),\Delta C(q,\dot{q}),\Delta G(q)\). Definition \(d = \Delta M(q)\ddot{q} + \Delta C(q,\dot{q})\dot{q} + \Delta G(q) + \tau_{f} + \tau_{d}\).
Therefore, The kinetic model can be simplified to:
3 Controller Design
3.1 Interference Observer Design
Aiming at the problem of composite interference in the control system of the flexible drive robot, a nonlinear interference observer is used to numerically estimate the interference signal, and then use it as a feedback signal to adjust the control torque of the system to reduce the influence of the interference signal on the system.
Definition \(\hat{d}\) is the estimate of d, then the estimated error F of interference is defined as \(F = d - \hat{d}\). The interference observer can be temporarily set to
Formula, \(L(q,\dot{q})\) is the gain matrix to be designed in the interference observer.
Assuming that the disturbance d has a very small or negligible dynamic change rate compared to a nonlinear observer (\(\dot{d} = 0\)).it can be obtained: \(\dot{F} = - L(q,\dot{q})F\). As the estimation error can be exponentially converged by designing a properly designed gain matrix. Since the acceleration signal of the end grab is not easy to obtain in practice, it is also necessary to define new auxiliary variables to build a new observer
Formula, \(z \in R^{2}\); \(p(q,\dot{q})\) is the nonlinear function to be designed. Moreover, The gain matrix \(L(q,\dot{q})\) and nonlinear functions \(p(q,\dot{q})\) need to be satisfied:
The combined formula (3) ~ (7) can obtain a nonlinear interference observer:
3.2 Dynamic Non-Singular Fast Terminal Sliding Mode Surface Constructed Based on the Estimated Output of Interference Observer
When constructing the traditional terminal sliding mode controller, it is faced with the problem of singularity, and in order to overcome the problem of singularity. Presented by References [10]. it is proposed that a dynamic non-singular sliding mode surface be constructed on this basis
Formula, \(\alpha\)、\(\beta\)、\(\gamma > 0\) is a design constant; p、 q is positive odd and satisfied \(1 < p/q < 2\); e is the difference between the desired trajectory and the actual trajectory \(e = q - q_{d}\); \(\hat{d}\) is an estimate of the interference. The synovial control law is proposed:
Formula, \(L > 0\) is the constant to be designed. This is obtained by Eq. (10).
3.3 Lyapunov Proved
Consider the Lyapunov function as follows
Derive the above equation:
Formula, \(\beta ,q,p,L > 0\). Hypothesis \(\dot{\tilde{e}} = \dot{e} + \int {M^{ - 1} \hat{d}}\). when \(\dot{\tilde{e}} \ne 0\), From \(0 < \frac{p}{q} - 1 < 1\) you get \((\dot{e} + \int {M^{ - 1} \hat{d}} )^{{(\frac{p}{q} - 1)}} > 0\). , according to Reference [11], When a sufficiently large \(L > 0\) is satisfied, When \(\dot{\tilde{e}} \le - L\) is then \(s > 0\), The opposite is the same, Therefore, \(\dot{\tilde{e}} = 0\) has little effect on the stability of the sliding surface, and it can also be said that \(\left| {\dot{\tilde{e}}} \right| < \delta\) exists near the \(\dot{\tilde{e}} = 0\) range. So when \(s > 0\) is then \(\tilde{e} \le - L\), The opposite is the same, Therefore, the intersection of dynamic synovial trajectories when \(s > 0\) is \(\tilde{e} = \delta\) from \(\tilde{e} = - \delta\). So it can be launched
4 Simulation Experiments
The simulation of all the examples in this simulation was completed under MATLAB2023aSimulink. The simulation object selects the four-cable parallel drive robot model. The matrix parameters in the kinetic model (3) are: \(M(q) = diag(m,m,m)\); \(C(q,\dot{q}) = diag(0,0,0)\); \(G(q) = [mg;0;0]^{T}\). Four-cable drive parallel robot structure parameters a = 10 m,b = 5 m,h = 5 m,m = 1 kg,g = 9.8N/kg. Take the perturbation item \(d = [0.25\sin (t);0.25\sin (t);0.25\sin (t)]^{T}\). In the interference observer \(p(q,\dot{q}) = \rho \dot{q},\rho = 0.5\). The initial position of the end gripper of the four-cable-driven parallel robot is set q = [0;0;0];The simulated motion trajectory is as follows: \(x = 2\sin (0.5\pi t) + 1;\)\(y = \sin (0.5\pi t) + 1;\)\(z = 0.5\sin (0.5\pi t) + 1\). When the expected trajectory of the end grab of the four-cable parallel drive robot is the above trajectory, the synovial control rate is used to track and control the motion trajectory of the end grab, and it can be seen from the figure that the three-dimensional diagram of the expected spiral trajectory and the actual trajectory is obtained for simulation. Taking values on the sliding surface: p = 7, q = 5, α = 3, β = 1000, γ = 0.5.
From the observation of the above figure (see Fig. 2), it can be found that the dynamic non-singular fast terminal sliding mode control strategy constructed based on the estimated output of the interference observer has a good trajectory tracking effect on the motion trajectory of the four-cable parallel drive robot end grab.
As shown in the figure (see Fig. 3) above, the speed tracking trajectory change diagram of the end gripper in the three directions of x, y, and z can clearly see that the overall fluctuation is not large and is in a stable change. Among them, the speed error in the x direction is absolutely within 3.3%, the velocity error in the y direction is within 2.3%, and the speed error in the z direction is within 2.1%.
As shown in the figure (see Fig. 4) above, the trajectory error of the proposed controller and the fast terminal synovial membrane controller is compared, indicating that the trajectory error of this observer is smaller, stable and faster.
5 Conclusion
Aiming at the interference such as external disturbance and modeling error of the four-cable parallel drive robot, a dynamic model is established based on the Newton–Euler method, and a dynamic non-singular fast terminal sliding mode surface based on the estimated output construction of the interference observer is designed. Lyapunov was used to prove the stability of the design control system, and the trajectory tracking effect was good and the error was within the acceptable range through simulation, and it was compared with the fast terminal synovial controller to prove that it had a better tracking trajectory and tracking error.
References
Cui ZW, Tang XQ, Hou SH, et al. (2018) Controllable stiffness characteristics of cable-driven parallel robot. J Tsinghua Univ (Nat Sci Ed), 58(02):204–211. https://doi.org/10.16511/j.cnki.qhdxxb.2018.26.010.
Sun J, Li H, Zhu W (2014) Practical damping identification of FAST cable Suspen-sion. Adv Mech Eng. https://doi.org/10.1155/2014/813752
Liu P, Qiao XJ (2022) Study on stability sensitivity of 3-DOF soft-cable-driven parallel robot with large span completely confinement space. J Tsinghua Univ (Nat Sci Ed), 62(09):1548–1558.). https://doi.org/10.16511/j.cnki.qhdxxb.2022.26.004
Eric B, Clément G (2015) Large-scale 3D printing with a cable-suspended robot. Addit Manuf, 7, Pages 27–44. https://doi.org/10.1016/j.addma.2015.05.001
Wang YL, Wang KY, Li X, Mo ZJ, Wang KC (2021) Control strategy and experimental research of Cable-Driven lower limb rehabilitation robot. IEEE Access 9:79182–79195. https://doi.org/10.1109/ACCESS.2021.3083810
Ji Y, Peng M, Lin Q, Yin C (2023) Wire-driven parallel robot suspension system for SDM in a low-speed wind tunnel. Adv Mech Eng. 15(4). https://doi.org/10.1177/16878132231170262
Liu P, Gong L, Ma HW, et al. (2023) Research on tracking and control of sorting trajectory of Softrope-driven picking robot. Coal Sci Technol:1–12. https://doi.org/10.13199/j.cnki.cst.2022-1898.
An B, Wang B, Wang Y, Liu L (2019) Adaptive terminal sliding mode control for reentry vehicle based on nonlinear disturbance observer. IEEE Access 7:154502–154514. https://doi.org/10.1109/ACCESS.2019.2948963
Zhang, H., Fang, H., Zou, Q. (2020) Non-singular terminal sliding mode control for redundantly actuated parallel mechanism. International Journal of Advanced Robotic Systems.;17(2). doi:https://doi.org/10.1177/1729881420919548
Stephen H, R.M., Gu, X.H. et al (2022) A novel type of non-singular fast terminal sliding mode control of follower system. China Mech Eng. 33(04):413–420
Yang J, Li S, Yu X (2013) Sliding-mode control for systems with mismatched uncertainties via a disturbance observer. IEEE T Ind Electron 60:160–169
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Open Access This chapter is licensed under the terms of the Creative Commons Attribution 4.0 International License (http://creativecommons.org/licenses/by/4.0/), which permits use, sharing, adaptation, distribution and reproduction in any medium or format, as long as you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons license and indicate if changes were made.
The images or other third party material in this chapter are included in the chapter's Creative Commons license, unless indicated otherwise in a credit line to the material. If material is not included in the chapter's Creative Commons license and your intended use is not permitted by statutory regulation or exceeds the permitted use, you will need to obtain permission directly from the copyright holder.
Copyright information
© 2024 The Author(s)
About this paper
Cite this paper
Zhang, K., Xu, J., Tong, S., Shi, H., Duo, Z., He, C. (2024). Dynamic Synovial Control Method of Four-Cable-Driven Parallel Robot Based on Interference Observer. In: Halgamuge, S.K., Zhang, H., Zhao, D., Bian, Y. (eds) The 8th International Conference on Advances in Construction Machinery and Vehicle Engineering. ICACMVE 2023. Lecture Notes in Mechanical Engineering. Springer, Singapore. https://doi.org/10.1007/978-981-97-1876-4_45
Download citation
DOI: https://doi.org/10.1007/978-981-97-1876-4_45
Published:
Publisher Name: Springer, Singapore
Print ISBN: 978-981-97-1875-7
Online ISBN: 978-981-97-1876-4
eBook Packages: EngineeringEngineering (R0)