六自由度平台动力学前馈柔顺控制研究

doi:10.3969/j.issn.1004-132X.2022.06.007

摘要/Abstract

摘要： 与串联机器人相比，六自由度平台具有刚度高、承载能力大等优点，更适合于大型工件的装配。当机器人处于对接和装配状态时，机器人末端受到来自外部环境的力和力矩作用，对机器人的柔顺控制是执行任务的基础。提出了一种基于摩擦补偿的动力学前馈柔顺控制方法，首先建立Stewart平台的动力学模型，利用库仑摩擦模型和黏性摩擦模型对伺服电动缸的摩擦力进行估计，推导出包含摩擦力矩的运动学模型。设计了一种动力学前馈柔顺控制方法，无需在关节末端安装力传感器，平台受到外力时会顺应外力作用移动。最后实验结果表明，所提出的方法是一种经济、有效、可靠的方法，可以实现六自由度平台的柔顺控制。

关键词: Stewart平台, 摩擦补偿, 动力学前馈控制, 柔顺控制

Abstract: Compared with the serial robot， the 6-DOF（degree of freedom） platform had the advantages of high stiffness and large load capacity， which was more suitable for the assembly of large workpieces. When the robot was in the docking and assembly states， the end of the robot was subjected to forces and moments from the external environments， and the compliant control of the robot was the basis for completing the tasks. A compliance control method was proposed based on friction compensation. A dynamics model of the Stewart platform was established. The friction forces of the servo electric cylinder was employed by means of the Coulomb and viscous friction model and the kinematics model including friction torque was derived. A dynamics feedforward compliance control method without using any force sensors at the end of the joints was designed. As the platform is subjected to external force， it will move in the direction of the external force. The experimental results show that the proposed unique methodology achieves an inexpensive and effective yet reliable alternative to be used for compliant control of 6-DOF platforms.

Key words: Stewart platform, friction compensation, dynamics feedforward control, compliant control

中图分类号:

TP242

倪涛, 徐海远, 李东, 张红彦. 六自由度平台动力学前馈柔顺控制研究[J]. 中国机械工程, 2022, 33(06): 683-689.

NI Tao, XU Haiyuan, LI Dong, ZHANG Hongyan. Research on Dynamics Feedforward Compliance Control of 6-DOF Platforms[J]. China Mechanical Engineering, 2022, 33(06): 683-689.

导出引用管理器 EndNote|Ris|BibTeX

链接本文: https://www.cmemo.org.cn/CN/10.3969/j.issn.1004-132X.2022.06.007

https://www.cmemo.org.cn/CN/Y2022/V33/I06/683

参考文献

［1］SUAREZ-RUIZ F， PHAM Q， A Framework for Fine Robotic Assembly［C］∥ IEEE International Conference on Robotics and Automation. Stockholm， 2016：16055854.
［2］ZHU Z， HU H. Robot Learning from Demonstration in Robotic Assembly：a Survey［J］. Robotics， 2018， 7（2）：1-25.
［3］TAKAHASHI J， FUKUKAWA T， FUKUDA T. Passive Alignment Principle for Robotic Assembly between a Ring and a Shaft with Extremely Narrow Clearance［J］. IEEE/ASME Transactions on Mechatronics， 2016， 21（1）：196-204.
［4］SONG J， CHEN Q， LI Z. A Peg-in-hole Robot Assembly System Based on Gauss Mixture Model［J］. Robotics and Computer-integrated Manufacturing， 2021， 67：101996.
［5］SUN T， LIAN B. Stiffness and Mass Optimization of Parallel Kinematic Machine［J］. Mechanism & Machine Theory， 2018， 120：73-88.
［6］WANG C， XIE X， CHEN Y， et al. Investigation on Active Vibration Isolation of a Stewart Platform with Piezoelectric Actuators［J］. Journal of Sound & Vibration， 2016， 383：1-19.
［7］解增辉. 弱撞击空间对接机构及其主动柔顺控制的研究［D］. 哈尔滨：哈尔滨工业大学， 2017.
XIE Zenghui. Research on the Low Impact Space Docking Mechanism and Active Compliant Control［D］. Harbin：Harbin Institute of Technology， 2017.
［8］PARK H， BAE J H， PARK J H， et al. Intuitive Peg-in-hole Assembly Strategy with a Compliant Manipulator［C］∥ IEEE International Symposium on Robotics. Seoul， 2013:14022333.
［9］RAESSA M， CHEN J， WAN W， et al. Human-in-the-loop Robotic Manipulation Planning for Collaborative Assembly［J］. IEEE Transactions on Automation Science and Engineering， 2020， 17（4）：1800-1813.
［10］LIPPIELLO V， FONTANELLI G A， RUGGIERO F. Image-based Visual-impedance Control of a Dual-arm Aerial Manipulator［J］. IEEE Robotics and Automation Letters， 2018， 3（3）：1856-1863.
［11］HANAFUSA T， HUNANG Q. Control of Position， Attitude， Force and Moment of 6-DOF Manipulator by Impedance Control［C］∥ International Conference on Control， Automation， Robotics & Vision. Singapore， 2018：274-279.
［12］JIANG J G， HUANG Z Y， BI Z M， et al. State-of-the-art Control Strategies for Robotic PIH Assembly［J］. Robotics and Computer-integrated Manufacturing， 2020， 65， 101894.
［13］CHEAH C C， KAWAMURA S， ARIMOTO， et al. Stability of Hybrid Position and Force Control for Robotic Manipulator with Kinematics and Dynamics Uncertainties［J］. Automatica， 2003， 39（5）：847-855.
［14］SONG Y X， YANG H J， LYU H B. Intelligent Control for a Robot Belt Grinding System［J］. IEEE Transactions on Control Systems Technology， 2013， 21（3）：716-724.
［15］KRONANDER K， BILLARD A. Stability Considerations for Variable Impedance Control［J］. IEEE Transactions on Robotics， 2016， 32（5）：1298-1305.
［16］LEE S D， SONG J B. Sensorless Collision Detection Based on Friction Model for a Robot Manipulator［J］. International Journal of Precision Engineering and Manufacturing， 2016， 17（1）：11-17.
［17］DUTTA A， SALUNKHE D H， KUMAR S， et al. Sensorless Full Body Active Compliance in a 6 DOF Parallel Manipulator［J］. Robotics and Computer-integrated Manufacturing， 2019， 59：278-290.
［18］赵忠. 基于逆动力学前馈系统的并联机器人控制技术研究［D］. 长春：吉林大学， 2020.
ZHAO Zhong. Research and Control of Parallel Robot Based on Inverse Dynamics Feed-forward System［D］. Changchun：Jilin University， 2020.
［19］HE Z Y， LIAN BB， LI Q， et al. An Error Identification and Compensation Method of a 6-DOF Parallel Kinematic Machine［J］. IEEE Access， 2020， 8：119038-119047.
［20］SRINIVASAN H K. Kinematic and Dynamic Analysis of Stewart Platform-based Machine Tool Structures［J］. Robotica Cambridge， 2003， 21（5）：541.
［21］YANG X L， WU H T， LI Y， et al. Dynamic Isotropic Design and Decentralized Active Control of a Six-axis Vibration Isolator via Stewart Platform［J］. Mechanism and Machine Theory， 2017， 117：244-252.
［22］YUN H， LIU L， LI Q， et al. Development of an Isotropic Stewart Platform for Telescope Secondary Mirror［J］. Mechanical Systems and Signal Processing， 2019， 127：328-344.
［23］YANG C， ZHAO J， LI L， et al. Design and Implementation of a Novel Modal Space Active Force Control Concept for Spatial Multi-DOF Parallel Robotic Manipulators Actuated by Electrical Actuators［J］. ISA Transactions， 2018， 72：273-286.
［24］MARTON L， LANTOS B. Modeling， Identification， and Compensation of Stick-slip Friction［J］. IEEE Transactions on Industrial Electronics， 2007， 54（1）：511-521.
［25］JOHANASTROM K， CANUDAS-DE-WIT C. Revisiting the LuGre Friction Model［J］. Control Systems IEEE， 2008， 28（6）：101-114.
［26］温淑焕. 不确定性机器人力/位置智能控制及轨迹跟踪实验的研究［D］. 秦皇岛：燕山大学， 2005.
WEN Shuhuan. The Study of Uncertain Robot Force/Position Intelligent Control and Trajectory Tracking Experiment［D］. Qinhuangdao：Yanshan University， 2005.
［27］CHERUBINI A， PASSAMA R， CROSNIER A， et al. Collaborative Manufacturing with Physical Human-robot Interaction［J］. Robotics & Compu-ter Integrated Manufacturing， 2016， 40：1-13.

[1]	魏琼, 白林勇, 陈子超, 张道德, 李奕. 基于扰动观测和摩擦补偿的气动摆角伺服系统滑模控制[J]. 中国机械工程, 2025, 36(11): 2563-2573.
[2]	李浩, 刘欣荣, 刘仪沁, 范狄庆. 基于改进自抗扰控制的高空风机叶片打磨机器人被动柔顺控制方法研究[J]. 中国机械工程, 2025, 36(08): 1832-1841.
[3]	倪涛1, 2, 张泮虹1, 2, 赵泽仁1, 2. 无力传感器的操纵手柄自适应变阻抗控制[J]. 中国机械工程, 2024, 35(06): 1034-1043，1051.
[4]	金鸿雁, 王磊, 赵希梅. 基于摩擦补偿的两轴直驱伺服进给系统自适应非线性滑模轮廓控制[J]. 中国机械工程, 2023, 34(11): 1335-1342.
[5]	朱雅光, 朱建伟, 李茹月, 宋志鹏. 基于神经-肌肉架构的仿生并联躯干柔顺控制[J]. 中国机械工程, 2022, 33(13): 1576-1585,1637.
[6]	葛吉民, 邓朝晖, 李尉, 李重阳, 陈曦, 彭德平. 机器人磨抛力柔顺控制研究进展[J]. 中国机械工程, 2021, 32(18): 2217-2230,2238.
[7]	何剑锋;邓兆祥;妥吉英. 准零刚度绝对位移传感器设计及运用[J]. 中国机械工程, 2017, 28(23): 2853-2858.
[8]	陈东宁, 刘一丹, 姚成玉, 蒋栋林, 王可勋, . 基于修正黏性摩擦LuGre模型的比例多路阀摩擦补偿[J]. 中国机械工程, 2017, 28(01): 62-68.
[9]	李鹏, 顾宏斌, 吴东苏. 头盔伺服系统执行机构的动力学建模及其验证[J]. 中国机械工程, 2013, 24(09): 1201-1209.
[10]	李敏, 王家序, 肖科, 黄超, 徐超. 基于模糊RBF神经网络动态摩擦分块补偿的机器人数字鲁棒滑模控制算法[J]. 中国机械工程, 2012, 23(23): 2792-2796.
[11]	程世利, 吴洪涛, 王超群, 姚裕, 朱剑英. 基于正交补的6-3 Stewart并联机构运动学正解 [J]. 中国机械工程, 2011, 22(5): 505-509.
[12]	吴昌林, 陈义. 铝轮曲面主被动柔顺控制抛光方法 [J]. J4, 2009, 20(23): 2821-2824.
[13]	吴博;徐雳;吴盛林;赵克定;. 动感模拟Stewart平台负载交联耦合特性的研究[J]. J4, 2009, 20(10): 0-1158.
[14]	徐东光;吴博;吴盛霖;唐建林. 基于模糊调节的Stewart平台积分滑模变结构控制器的设计[J]. J4, 2008, 19(4): 0-387.
[15]	杨鹏, 梁利华, 李国斌. 基于改进蚁群算法的Stewart平台奇异性分析[J]. 中国机械工程, 2008, 19(2): 163-166.