基于奇异摄动的刚柔耦合Delta机器人非线性混合控制

doi:10.3901/JME.2024.05.095

机械工程学报 ›› 2024, Vol. 60 ›› Issue (5): 95-106.doi: 10.3901/JME.2024.05.095

扫码分享

基于奇异摄动的刚柔耦合Delta机器人非线性混合控制

商德勇^1,2,3, 黄云山¹, 黄欣怡¹, 潘崭¹

1. 中国矿业大学(北京)机械与电气工程学院北京 100083;
2. 中国矿业大学(北京)智慧矿山与机器人研究院北京 100083;
3. 煤矿智能化与机器人创新应用应急管理部重点实验室北京 100083

收稿日期:2023-05-12 修回日期:2023-09-21 出版日期:2024-03-05 发布日期:2024-05-30
通讯作者: 黄云山，男，2000年出生，硕士。主要研究方向为机器人控制。E-mail：sqt2100401006@student.cumtb.edu.cn
作者简介:商德勇，男，1983年出生，副教授。主要研究方向为矿山设备智能化、并联机器人动力学与控制。E-mail：shangdeyong@cumtb.edu.cn
基金资助:
国家自然科学基金面上项目(52174154)和国家自然基金创新研究群体项目(52121003)资助项目。

Nonlinear Hybrid Control of Rigid Flexible Coupling Delta Robot Based on Singular Perturbation

SHANG Deyong^1,2,3, HUANG Yunshan¹, HUANG Xinyi¹, PAN Zhan¹

1. School of Mechanical and Electronic Engineering, China University of mining and Technology(Beijing), Beijing 100083;
2. Institute of intelligent Mining & Robotics, China University of mining and Technology (Beijing), Beijing 100083;
3. Key Laboratory of Intelligent Mining and Robotics, Ministry of Emergency Management, Beijing 100083

Received:2023-05-12 Revised:2023-09-21 Online:2024-03-05 Published:2024-05-30

摘要/Abstract

摘要： 在高速运动中，Delta并联机器人杆件发生的弹性变形和振动对运动性能的影响不可忽略。针对有限元法离散柔性杆时出现方程维度高且难以适用于主动控制的问题，通过假设模态法和Kane方法，对Delta刚柔耦合并联机器人进行动力学建模。通过添加闭链刚柔耦合系统运动学位置、速度、加速度约束方程，建立了闭链形式的Delta并联机器人的刚柔耦合动力学方程。针对Delta并联机器人刚柔耦合动力学模型复杂度高的问题，利用奇异摄动法，将刚柔耦合动力学模型依据时间尺度分解为快变和慢变两个子系统。为避免扰动的影响并保证收敛性，针对慢变系统设计了非奇异终端滑模控制器；为抑制弹性振动对运动的影响，针对快变系统设计了LQR最优控制器，并将两个子系统的控制器合并为刚柔耦合系统的非线性混合控制器。仿真对比实验证明，所设计的混合控制器不仅保持了更高精度的轨迹跟踪，而且实现了明显的振动抑制效果，为Delta刚柔耦合并联机器人的主动跟踪控制和振动抑制提供了新思路。

关键词: 并联机器人, 刚柔耦合, 假设模态法, Kane方法, 奇异摄动

Abstract: In high-speed motion, the elastic deformation and vibration of the Delta parallel robot cannot be ignored, which have an impact on the motion performance. To address the problem of high equation dimensions and difficulty in being suitable for active control when discretizing flexible rods using finite element method, dynamic modeling of Delta rigid flexible coupled parallel robots was conducted using the assumed mode method and Kane method. By adding the position, velocity and acceleration constraint equations of the closed chain rigid flexible coupling system, the rigid flexible coupling dynamic equations of the closed chain Delta parallel robot are established. In order to solve the problem of high complexity of the rigid flexible coupling dynamic model of Delta parallel robot, the rigid flexible coupling dynamic model is decomposed into fast changing and slow changing subsystems according to the time scale by using the Singular perturbation method. In order to avoid disturbance and ensure convergence, a nonsingular terminal sliding mode controller is designed for slow varying systems. To suppress the influence of elastic vibration on motion, an LQR optimal controller was designed for fast changing systems, and merge the controllers of the two subsystems into a nonlinear hybrid controller of the rigid flexible coupling system. Simulation comparative experiments have shown that the designed hybrid controller maintains higher precision trajectory tracking and achieves significant vibration suppression effects, providing a new approach for active tracking control and vibration suppression of Delta rigid flexible coupled parallel robots.

Key words: parallel robot, rigid flexible coupling, assumed mode method, Kane method, singular perturbation

中图分类号:

TD67

商德勇, 黄云山, 黄欣怡, 潘崭. 基于奇异摄动的刚柔耦合Delta机器人非线性混合控制[J]. 机械工程学报, 2024, 60(5): 95-106.

SHANG Deyong, HUANG Yunshan, HUANG Xinyi, PAN Zhan. Nonlinear Hybrid Control of Rigid Flexible Coupling Delta Robot Based on Singular Perturbation[J]. Journal of Mechanical Engineering, 2024, 60(5): 95-106.

导出引用管理器 EndNote|Reference Manager|ProCite|BibTeX|RefWorks

链接本文: http://www.cjmenet.com.cn/CN/10.3901/JME.2024.05.095

http://www.cjmenet.com.cn/CN/Y2024/V60/I5/95

参考文献

[1] 郑坤明. 轻型并联机器人柔体动力学建模分析及智能控制方法研究[D]. 武汉：华中科技大学，2020. ZHENG Kunming. Research on flexible body dynamics modeling analysis and intelligent control method of lightweight parallel robot[D]. Wuhan：Huazhong University of Science and Technology，2020.
[2] YANG Hualin，CHEN Long，MA Zhibin，et al. Computer vision-based high-quality tea automatic plucking robot using Delta parallel manipulator[J]. Computers and Electronics in Agriculture，2021，181，105946-105955.
[3] ZHENG Kunming，HU Youmin，YU Wenyong. A novel parallel recursive dynamics modeling method for robot with flexible bar-groups[J]. Applied Mathematical Modelling，2020，77：267-288.
[4] HE Wei，GE Weiliang，LI Yunchuan，et al. Model identification and control design for a humanoid robot[J]. IEEE Transactions on Systems Man & Cybernetics Systems，2017，47(1)：45-57.
[5] ZHAO Kai，SONG Yongduan，MA Teidong et al. Prescribed performance control of uncertain Euler-Lagrange systems subject to full-state constraints[J]. IEEE Transactions on Neural Networks and Learning Systems，2018，29(8)：3478-3489.
[6] 齐嘉兴，赵修平. 基于Kane方程的并联平台建模方法[J]. 兵器装备工程学报，2020，41(3)：211-215. QI Jiaxing，ZHAO Xiuping. Modeling method of parallel platform based on Kane equation[J]. Journal of Ordnance Equipment Engineering，2020，41(3)：211-215.
[7] 赵学洋，赵恒华，杨世彬，等. 基于Kane方程的3-TPT并联机构动力学研究[J]. 机械传动，2016，40(1)：36-39. ZHAO Xueyang，ZHAO Henghua，YANG Shibin，et al. Dynamics research of the 3-TPT parallel mechanism based on Kane equation[J]. Journal of Mechanical Transmission，2016，40(1)：36-39.
[8] 王晓明，徐振邦，王兵，等. 基础激励下6-UHP并联平台的动力学建模与仿真[J]. 机器人，2016，38(6)：687-695. WANG Xiaoming，XU Zhenbang，WANG Bing，et al. Dynamic modeling and simulation of a 6-UHP parallel platform under base excitation[J]. Robot，2016，38(6)：687-695.
[9] ZHANG Dongsheng，XU Yundou，YAO Jiantao，et al. Kinematics，dynamics and stiffness analysis of a novel 3-DOF kinematically/actuation redundant planar parallel mechanism[J]. Mechanism and Machine Theory，2017，116：203-219.
[10] 宋轶民，金雪莹，梁栋，等. 两类平面并联机构凯恩动力学建模与比较研究[J]. 天津大学学报，2019，52(2)：173-182. SONG Yimin，JIN Xueying，LIANG Dong，et al. Kane-formulation-based dynamic modeling and comparative study on dynamic performance of two kinds of parallel robots[J]. Journal of Tianjin University，2019，52(2)：173-182.
[11] HUSSAIN Z，AZLAN N Z. KANE's method for dynamic modeling[C]// 2016 IEEE International Conference on Automatic Control and Intelligent Systems，August 11，2017，Shah Alam，Malaysia. New York：I2CACIS，2016：174-179.
[12] ENFERADI J，JAFARI K. A Kane’s based algorithm for closed-form dynamic analysis of a new design of a 3RSS-S spherical parallel manipulator[J]. Multibody System Dynamics，2020，49：377-394.
[13] CHATTERJEE A，CHATTERJEE R，MATSUNO F，et al. Augmented stable fuzzy control for flexible robotic arm using LMI approach and neuro-fuzzy state space modeling[J]. IEEE Transactions on Industrial Electronics，2008，55(3)：1256-1270.
[14] HE Wei，OUYANG Yuncheng，HONG Jie. Vibration control of a flexible robotic manipulator in the presence of input deadzone[J]. IEEE Transactions on Industrial Informatics，2017，13(3)：48-59.
[15] 于潇雁，陈力. 漂浮基柔性两杆空间机械臂基于状态观测器的鲁棒控制及振动控制[J].机械工程学报，2016，52(15)：28-35. YU Xiaoyan，CHEN Li. Observer based robust control and vibration control for a free-floating flexible space manipulator[J]. Journal of Mechanical Engineering，2016，52(15)：28-35.
[16] SPONG M W. Adaptive control of flexible joint manipulators：Comments on two papers[J]. Automatica，1995，31(4)：585-590.
[17] LIANG Dong，SONG Yimin，SUN Tao，et al. Rigid-flexible coupling dynamic modeling and investigation of a redundantly actuated parallel manipulator with multiple actuation modes[J]. Journal of Sound and Vibration，2017，403：129-151.
[18] SUN Tao，LIANG Dong，SONG Yimin. Singular-perturbation- based nonlinear hybrid control of redundant parallel robot[J]. IEEE Transactions on Industrial Electronics，2018，65(4)：3326-3336.
[19] 孔民秀，陈正升，刘明，等. 采用积分流形与观测器的并联机器人轨迹控制[J]. 哈尔滨工业大学学报，2017，49(1)：37-45. KONG Minxiu，CHEN Zhengsheng，LIU Ming，et al. Trajectory tracking control of parallel manipulator with integral manifold and observer[J]. Journal of Harbin Institute of University，2017，49(1)：37-45.
[20] ZHENG Kunming. Research on intelligent vibration suppression control of high-speed lightweight Delta robot[J]. Journal of Vibration and Control，2022，28：3042-3057.
[21] GUO Zhongfeng，ZAHNG Jianqiang，ZAHNG Peisen. Research on the residual vibration suppression of delta robots based on the dual-modal input shaping method[J]. Actuators，2023，12，84.
[22] WANG Yaoyao，GU Linyi，XU Yihong，et al. Practical tracking control of robot manipulators with continuous fractional-order nonsingular terminal sliding mode[J]. IEEE Transactions on Industrial Electronics，2016，63(10)：6194-6204.
[23] 张建宇，高天宇，于潇雁，等. 基于自适应时延估计的空间机械臂连续非奇异终端滑模控制[J]. 机械工程学报，2021，57(11)：177-183. ZHANG Jianyu，GAO Tianyu，YU Xiaoyan，et al. Continuous non-singular terminal sliding mode control of space robot based on adaptive time delay estimation[J]. Journal of Mechanical Engineering，2021，57(11)：177-183.
[24] RAO S S. Vibration of continuous systems[M]. Hoboken：John Wiley & Sons，Inc，2007.

基于奇异摄动的刚柔耦合Delta机器人非线性混合控制

Nonlinear Hybrid Control of Rigid Flexible Coupling Delta Robot Based on Singular Perturbation

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	柴馨雪, 陶奕良, 祖洪飞, 徐灵敏, 李秦川. 基于误差模型与机器学习结合的2PRU-PSR并联机器人误差补偿方法[J]. 机械工程学报, 2025, 61(21): 192-203.
[2]	梁栋, 韩志强, 宋轶民, 畅博彦. 大负载SCARA并联机器人刚度建模及性能预估[J]. 机械工程学报, 2025, 61(21): 213-226.
[3]	王振宇, 孙建伟, 张美玲, 丛明, 褚金奎. 多级可调刚度刚柔耦合仿生机械手设计与验证[J]. 机械工程学报, 2025, 61(21): 237-248.
[4]	龙辉, 陶功权, 梁红琴, 卢纯, 温泽峰, 张楷, 刘奇锋, 肖乾. 地铁扁疤车轮通过钢轨焊缝区的轮轨垂向力特性分析[J]. 机械工程学报, 2025, 61(20): 263-273.
[5]	梁栋, 崔满军, 宋轶民, 石浩昊, 张珺鹏. 新型多驱动模式并联机器人创新设计与建模分析[J]. 机械工程学报, 2025, 61(19): 63-77.
[6]	黄鹏, 路景深, 丁华锋, 陈子明, 赵玉倩. 新型装载机工作装置疲劳寿命预测[J]. 机械工程学报, 2025, 61(17): 27-40.
[7]	宋轶民, 王睿哲, 连宾宾, 李祺, 孙涛. 基于数字孪生技术的并联机器人筒段类部组件装配系统[J]. 机械工程学报, 2025, 61(1): 44-59.
[8]	商德勇, 黄欣怡, 黄云山, 张天佑. 基于Kane方程的Delta并联机器人刚柔耦合动力学研究[J]. 机械工程学报, 2024, 60(7): 124-133.
[9]	訾斌, 赵嘉浩, 王威, 杜敬利, 杨桂林. 大空间刚柔耦合机器人关键技术研究现状及发展趋势[J]. 机械工程学报, 2024, 60(23): 21-42.
[10]	梁栋, 庞书康, 宋轶民, 畅博彦, 金国光, 孙涛. 一类新型末端铰接高速并联机器人建模与动力尺度综合[J]. 机械工程学报, 2024, 60(21): 38-55.
[11]	郑思远, 田俊杰, 王立鹏, 刘世创, 王洪波, 牛建业. 紧凑型刚柔耦合腰部康复机器人设计与分析[J]. 机械工程学报, 2024, 60(17): 156-166.
[12]	褚宏鹏, 祁柏, 王慧奇, 邱雪松, 周玉林. 六自由度轮式并联机器人及其构型方法[J]. 机械工程学报, 2023, 59(3): 46-53.
[13]	魏雪, 任尊松, 曹杰, 吴养民. 短波不平顺对高速动车组ATP天线梁弹性振动特征的影响[J]. 机械工程学报, 2023, 59(16): 223-232.
[14]	徐灵敏, 叶伟, 李秦川. 并联机器人逆动力学建模的几何代数方法[J]. 机械工程学报, 2022, 58(7): 1-11.
[15]	夏纯, 张海峰, 李秦川, 柴馨雪. 基于等效运动链的并联机器人运动学标定方法[J]. 机械工程学报, 2022, 58(14): 71-84.