Research of Robust Disturbance Observer Double-loop Compensation Control for Joint Vibration of Industrial Robotics
-
摘要: 针对工业机器人工作过程中执行机构振动现象,利用现代控制理论对其进行抑振。在对机器人负载侧转速波动机理分析的基础上,建立了RV减速机动态角传动误差和啮合摩擦激励的数学模型;以考虑动态角传动误差和摩擦因素影响的伺服电机-RV减速机-负载所构成的机电耦合系统为控制对象,采用内环鲁棒控制+外环扰动观测器的双环控制策略抑制负载侧的转速波动。结果表明:该方法相比PI控制,不仅使机器人在启动阶段能够快速平稳地对指令做出响应,并且克服了时变刚度所引起的控制系统不确定性,使得稳态工作阶段的转速波动得到了明显削弱,降幅近50%。Abstract: In view of the vibration phenomenon of the actuator in the working process of the industrial robot, the modern control theories were employed to suppress the vibration of the actuator. Based on the analysis of the speed fluctuation mechanism on the load side of the robot, the mathematical model of RV deceleration dynamic angular transmission error and meshing friction excitation were established. The electromechanical coupling system composed of servo motor, RV reducer and load considering the influence of dynamic angular transmission error and friction factors was taken as the control object, and the double loop control strategy of inner loop robust control and outer loop disturbance observer was used to suppress the speed fluctuation on the load side. The results showed that compared with PI control, the instructions could be responded more quickly and smoothly by robots during the start-up phase, and rotational speed fluctuation was significantly reduced during the steady-state working phase, with a drop of nearly 50%, while this method was employed.
-
Key words:
- industrial robot /
- RV reducer /
- robust control /
- disturbance observer
-
表 1 机电耦合系统参数
参数 数值 电机侧转动惯量 Jm $2.744 \times {10^{ - 5}}{\text{ kg}} \cdot {{\text{m}}^2}$ 负载侧转动惯量 JL $5.11{\text{ kg}} \cdot {{\text{m}}^2}$ 扭转刚度 K $5.05 \times {10^5}{\text{ N}} \cdot {\text{m/rad}}$ 电机转矩常数 Kt $4.1{\text{ N}} \cdot {\text{m/A}}$ 减速机传动比 N $121$ 电机转速 ωm 780 r/min -
[1] LUO S M, LIAO L X, WANG J, et al. Study on inspection and avoidance of interferences in five-axis end milling of cycloidal gears[J]. The International Journal of Advanced Manufacturing Technology, 2017, 91(9-12): 3307-3314 doi: 10.1007/s00170-017-0002-1 [2] WANG R Y, GAO F Q, LU M, et al. Meshing efficiency analysis of modified cycloidal gear used in the RV reducer[J]. Tribology Transactions, 2019, 62(3): 337-349 doi: 10.1080/10402004.2018.1549689 [3] CHU X Y, XU H H, WU X M, et al. The method of selective assembly for the RV reducer based on genetic algorithm[J]. Proceedings of the Institution of Mechanical Engineers, Part C:Journal of Mechanical Engineering Science, 2018, 232(6): 921-929 doi: 10.1177/0954406217700179 [4] GU J J, HUANG D S, TAN J, et al. Manufacturing quality assurance for a rotate vector reducer with vibration technology[J]. Journal of Mechanical Science and Technology, 2019, 33(5): 1995-2001 doi: 10.1007/s12206-019-0401-3 [5] TUNGPATARATANAWONG S, CHITBANCHONG S, MIYAZAKI T, et al. Robust position control of end-effector considering gear stiffness and arm stiffness for industrial robot[J]. IEEJ Transactions on Industry Applications, 2007, 127(6): 603-609 doi: 10.1541/ieejias.127.603 [6] YOSHIOKA T, HIRANO Y, OHISHI K, et al. Vibration suppressing control method of angular transmission error of cycloid gear for industrial robots[C]//2014 International Power Electronics Conference. Hiroshima, Japan: IEEE, 2014: 1956-1961 [7] KOSAKA Y, SHIMADA A, VIBOONCHAICHEEP P. Vibration control without estimated disturbance feedback for robot manipulators[C]//IECON'03. 29th Annual Conference of the IEEE Industrial Electronics Society. Roanoke, VA, USA: IEEE, 2003: 848-853 [8] KUMAGAI S, MIYAZAKI T, OHISHI K. Motion control of industrial robot by considering vibration suppression and fast path tracking[J]. IEEJ Transactions on Industry Applications, 2010, 130(3): 375-384 doi: 10.1541/ieejias.130.375 [9] KAMEL A, LANGE F, HIRZINGER G. New aspects of input shaping control to damp oscillations of a compliant force sensor[C]//IEEE International Conference on Robotics & Automation. Pasadena, CA, USA: IEEE, 2008: 2629-2635 [10] YEON J S, PARK J H, SON S W, et al. Model-based iterative learning control for industrial robot manipulators[C]//IEEE International Conference on Automation and Logistics. Shenyang, China: IEEE, 2009: 24-28 [11] MUNOZ-VAZQUEZ A, MARTINEZ-REYES F. Output feedback fractional integral sliding mode control of robotic manipulators[J]. Journal of Computational and Nonlinear Dynamics, 2019, 14(5): 054502 doi: 10.1115/1.4043000 [12] GAMBHIRE S J, KANTH K S S, MALVATKAR G M, et al. Robust fast finite-time sliding mode control for industrial robot manipulators[J]. International Journal of Dynamics and Control, 2019, 7(2): 607-618 doi: 10.1007/s40435-018-0476-1 [13] HENDZEL Z. Hamilton–Jacobi inequality robust neural network control of a mobile wheeled robot[J]. Mathematics and Mechanics of Solids, 2019, 24(3): 723-737 doi: 10.1177/1081286517754246 [14] JIN X L, WANG Y, HUANG Z L. Approximately analytical technique for random response of LuGre friction system[J]. International Journal of Non-Linear Mechanics, 2018, 104: 1-7 doi: 10.1016/j.ijnonlinmec.2017.10.003 [15] 刘占生, 张敏, 张广辉, 等. 基于LuGre摩擦模型的叶片碰撞摩擦特性研究[J]. 振动与冲击, 2012, 31(12): 172-178LIU Z S, ZHANG M, ZHANG G H, et al. Characteristics of impact-contact and friction between tips of blades based on LuGre model[J]. Journal of Vibration and Shock, 2012, 31(12): 172-178 (in Chinese) [16] DAHL P R. Measurement of solid friction parameters of ball bearings[C]//Proceedings of 6th Annual Symposium on Incremental Motion, Control Systems & Devices. Illinois: University of Illinois, 1977 [17] 刘栋, 陶涛, 梅雪松, 等. 伺服系统线性特性和非线性摩擦的解耦辨识方法研究[J]. 仪器仪表学报, 2010, 31(4): 782-788LIU D, TAO T, MEI X S, et al. Study on the decoupling identification method of linear dynamic and nonlinear friction for servo drive system[J]. Chinese Journal of Scientific Instrument, 2010, 31(4): 782-788 (in Chinese) [18] 吴晓敏, 刘暾东, 贺苗, 等. 机器人关节摩擦建模与补偿研究[J]. 仪器仪表学报, 2018, 39(10): 44-50WU X M, LIU T D, HE M, et al. Research on friction modeling and compensation of robot manipulator[J]. Chinese Journal of Scientific Instrument, 2018, 39(10): 44-50 (in Chinese) [19] 吕明帅. RV减速器传动特性的仿真与实验研究[D]. 哈尔滨: 哈尔滨工业大学, 2016LYU M S. Simulation and experimental study of transmission characteristic of RV reducer[D]. Harbin: Harbin Institute of Technology, 2016 (in Chinese) [20] LI M Y, DENG M C. Operator-based external disturbance rejection of perturbed nonlinear systems by using robust right coprime factorization[J]. Transactions of the Institute of Measurement and Control, 2018, 40(10): 3169-3178 doi: 10.1177/0142331217718899 [21] LIU Y, FU Y, HE W, et al. Modeling and observer-based vibration control of a flexible spacecraft with external disturbances[J]. IEEE Transactions on Industrial Electronics, 2019, 66(11): 8648-8658 doi: 10.1109/TIE.2018.2884172