删除或更新信息,请邮件至freekaoyan#163.com(#换成@)

机械臂柔性对接半物理仿真系统特性分析

本站小编 哈尔滨工业大学/2019-10-24

机械臂柔性对接半物理仿真系统特性分析

于思淼,郑淑涛,杨宇,曲智勇,韩俊伟

(哈尔滨工业大学 机电工程学院, 哈尔滨 150001)



摘要:

机械臂为数学模型的机械臂对接半物理(HIL)仿真系统会因为对接机构的高接触刚度导致系统不稳定,为准确模拟对接过程,提出将机械臂等效为六维弹簧机构实物来模拟机械臂的对接过程,并对该HIL系统特性进行分析. 用根轨迹法对比分析机械臂为数学模型和六维弹簧机构实物的HIL系统参数对稳定性的影响;应用-20 dB/dec段穿越理论得到系统具有良好特性时的参数配置关系,利用稳定判据得到HIL仿真系统的稳定条件,采用3D根轨迹法和仿真分析得到系统对接动力学频率模拟能力,分析了提出的HIL仿真系统的稳定性和复现精度. 实验结果表明:在对接机构接触刚度较高时,机械臂为数学模型的HIL仿真系统不稳定,而机械臂为实物的HIL仿真系统保持稳定;仿真分析结果与实验结果吻合,说明了机械臂由数学模型变为六维弹簧机构实物对改善系统特性的有效性,以及提出的HIL仿真系统分析结论的正确性.

关键词:  对接半物理仿真系统  机械臂  六维弹簧机构  参数配置关系  系统稳定条件  动力学频率模拟能力  稳定性  复现精度

DOI:10.11918/j.issn.0367-6234.201806158

分类号:TP29

文献标识码:A

基金项目:国家自然科学基金(51475116)



Characteristics analysis of hardware-in-the-loop simulation system for manipulator flexible docking

YU Simiao,ZHENG Shutao,YANG Yu,QU Zhiyong,HAN Junwei

(School of Mechatronics Engineering, Harbin Institute of Technology, Harbin 150001, China)

Abstract:

Manipulator docking hardware-in-the-loop(HIL) simulation system with the manipulator as a mathematical model will cause instability due to the high contact stiffness of the docking mechanism. To accurately simulate the docking process, the manipulator is equivalent to a six-dimensional spring mechanism during the docking process and the characteristics of HIL system are analyzed. Using root locus method, the influences of HIL system parameters with a mathematical model and a six-dimensional spring mechanism on the stability are compared. Based on the -20 dB/dec crossing frequency theory, the stability criterion, the 3D root locus method and the simulation analysis, the stability and reproduction accuracy are studied from three important aspects of the parameter configuration relation, the system stability condition and the dynamics frequency simulation ability. The experimental results show that when the contact stiffness of the docking mechanism is high, the HIL simulation system with a mathematical model manipulator is unstable but the HIL simulation system with a spring mechanism manipulator is stable; the analysis results obtained from the three aspects which satisfy the stability and reproduction accuracy are consistent with the experimental results. The effectiveness of changing manipulator from a mathematical model to a six-dimensional spring mechanism is illustrated.

Key words:  docking hardware-in-the-loop simulation system  manipulator  six-dimensional spring mechanism  parameter configuration relation  system stability condition  dynamics frequency simulation ability  stability  reproduction accuracy


于思淼, 郑淑涛, 杨宇, 曲智勇, 韩俊伟. 机械臂柔性对接半物理仿真系统特性分析[J]. 哈尔滨工业大学学报, 2019, 51(7): 24-32. DOI: 10.11918/j.issn.0367-6234.201806158.
YU Simiao, ZHENG Shutao, YANG Yu, QU Zhiyong, HAN Junwei. Characteristics analysis of hardware-in-the-loop simulation system for manipulator flexible docking[J]. Journal of Harbin Institute of Technology, 2019, 51(7): 24-32. DOI: 10.11918/j.issn.0367-6234.201806158.
基金项目 国家自然科学基金(51475116) 作者简介 于思淼(1988—),男,博士研究生;
韩俊伟(1965—),男,教授,博士生导师 通信作者 杨宇,yangyu1980hit@163.com 文章历史 收稿日期: 2018-06-22



Contents            -->Abstract            Full text            Figures/Tables            PDF


机械臂柔性对接半物理仿真系统特性分析
于思淼, 郑淑涛, 杨宇, 曲智勇, 韩俊伟    
哈尔滨工业大学 机电工程学院, 哈尔滨 150001

收稿日期: 2018-06-22
基金项目: 国家自然科学基金(51475116)
作者简介: 于思淼(1988—),男,博士研究生;
韩俊伟(1965—),男,教授,博士生导师
通信作者: 杨宇,yangyu1980hit@163.com


摘要: 机械臂为数学模型的机械臂对接半物理(HIL)仿真系统会因为对接机构的高接触刚度导致系统不稳定,为准确模拟对接过程,提出将机械臂等效为六维弹簧机构实物来模拟机械臂的对接过程,并对该HIL系统特性进行分析.用根轨迹法对比分析机械臂为数学模型和六维弹簧机构实物的HIL系统参数对稳定性的影响;应用-20 dB/dec段穿越理论得到系统具有良好特性时的参数配置关系,利用稳定判据得到HIL仿真系统的稳定条件,采用3D根轨迹法和仿真分析得到系统对接动力学频率模拟能力,分析了提出的HIL仿真系统的稳定性和复现精度.实验结果表明:在对接机构接触刚度较高时,机械臂为数学模型的HIL仿真系统不稳定,而机械臂为实物的HIL仿真系统保持稳定;仿真分析结果与实验结果吻合,说明了机械臂由数学模型变为六维弹簧机构实物对改善系统特性的有效性,以及提出的HIL仿真系统分析结论的正确性.
关键词: 对接半物理仿真系统    机械臂    六维弹簧机构    参数配置关系    系统稳定条件    动力学频率模拟能力    稳定性    复现精度    
Characteristics analysis of hardware-in-the-loop simulation system for manipulator flexible docking
YU Simiao, ZHENG Shutao, YANG Yu, QU Zhiyong, HAN Junwei    
School of Mechatronics Engineering, Harbin Institute of Technology, Harbin 150001, China


Abstract: Manipulator docking hardware-in-the-loop(HIL) simulation system with the manipulator as a mathematical model will cause instability due to the high contact stiffness of the docking mechanism. To accurately simulate the docking process, the manipulator is equivalent to a six-dimensional spring mechanism during the docking process and the characteristics of HIL system are analyzed. Using root locus method, the influences of HIL system parameters with a mathematical model and a six-dimensional spring mechanism on the stability are compared. Based on the -20 dB/dec crossing frequency theory, the stability criterion, the 3D root locus method and the simulation analysis, the stability and reproduction accuracy are studied from three important aspects of the parameter configuration relation, the system stability condition and the dynamics frequency simulation ability. The experimental results show that when the contact stiffness of the docking mechanism is high, the HIL simulation system with a mathematical model manipulator is unstable but the HIL simulation system with a spring mechanism manipulator is stable; the analysis results obtained from the three aspects which satisfy the stability and reproduction accuracy are consistent with the experimental results. The effectiveness of changing manipulator from a mathematical model to a six-dimensional spring mechanism is illustrated.
Keywords: docking hardware-in-the-loop simulation system    manipulator    six-dimensional spring mechanism    parameter configuration relation    system stability condition    dynamics frequency simulation ability    stability    reproduction accuracy    
机械臂对接半物理(HIL)仿真是地面研究对接硬件、对接初始条件和对接策略的主要手段,是成功实现空间对接的前提[1-2].机械臂对接HIL仿真系统中的机械臂通常建立为数学模型,以方便研究不同机械臂的对接特性.但对接过程中高的物理接触刚度容易导致HIL仿真系统发散[3-7].本文提出了将机械臂由六维物理弹簧等效的方法并设计了机械臂对接HIL仿真系统.通过设计六维弹簧机构可以将机械臂的等效刚度引入到半物理仿真系统中,通过较低的机械臂刚度减小对接系统的物理接触刚度,提高系统的稳定性.

机械臂对接HIL仿真系统中运动模拟器的延迟会严重影响HIL仿真系统的稳定性和复现精度.目前,已有文献针对空间对接地面仿真系统进行了研究. Yang等[8-9]应用串联机构分别模拟两个刚性浮动航天器的对接过程,通过重力补偿方式模拟微重力环境;但文献中并没有系统特性的分析. Qi等[10]针对运动模拟器的延迟导致系统不稳定的问题,提出了一种基于泰勒级数低阶模型补偿方法,应用二阶超前补偿器对模拟器进行补偿,提高了系统的稳定性. Qi等[11]针对运动模拟器延迟问题,提出了阻尼和弹性接触力补偿方法;应用相位超前力补偿器使补偿力接近于动力学模型计算的航天器位置对应的理想力,降低了系统的滞后影响.上述文献对延迟补偿方法进行了研究,但没有系统地研究延迟影响下参数对系统稳定性的影响及稳定边界条件等问题. Zebenay等[6, 12]将HIL仿真系统中的串联机器人建立为二阶时滞系统,并以卫星质量、接触刚度和阻尼为参数,导出了临界时滞系数和频率的函数表达式,应用极点配置法得到了满足系统稳定时各指标的取值关系. Chang[13]、Yan[14]和张文辉等[2]建立了基于两个刚性航天器碰撞的HIL仿真系统模型,得到了动力学频率基频与机器人频宽的制约关系.但文献中的研究对象均为两个刚性物体,且大多用串联机器人模拟航天器的运动.本文的研究对象为机械臂空间对接,HIL仿真系统中加入了机械臂(六维弹簧机构)和末端执行器,使得接触环境变为多刚度、多阻尼和单质量接触,接触环境和系统模型均变得复杂;系统参数及其对系统特性的影响也变得多样化.同时,本研究用并联机器人模拟航天器的运动.在新的研究背景下,为保证所提出的机械臂对接HIL仿真系统能够准确有效模拟对接过程,需要全面地对HIL系统的特性进行研究.主要思路如下:

1) 分别建立机械臂为数学模型和六维弹簧机构实物的HIL仿真系统模型,分析系统接触刚度等参数对稳定性的影响,说明本文提出的HIL仿真系统对于解决高刚度接触导致系统发散的有效性.

2) 从HIL仿真系统参数配置关系、稳定条件和动力学频率模拟能力3个评定系统特性的重要方面综合研究机械臂等效为六维弹簧机构的HIL仿真系统的稳定性和复现精度.

3) 通过实验验证思路1);通过仿真和实验验证思路2).

1 机械臂对接半物理仿真系统介绍空间对接系统由航天器、末端执行器、目标适配器、机械臂和空间站组成(对接时空间站保持静止),如图 1所示.由于机械臂在对接过程中各关节处于锁紧状态以消除机械臂端部大范围运动对对接产生的不利影响[15],则机械臂的运动状态体现为弹性变形,将机械臂视为由可变形的柔性部分和不可变形的刚性部分组成.机械臂的柔性部分等效到末端执行器的尾部,则机械臂的刚性部分和空间站可视为静止不动的整体.对接过程中,末端执行器在尾部柔性环节和接触力的作用下运动.

Fig. 1
图 1 机械臂对接系统 Fig. 1 Manipulator docking system


模拟机械臂对接的半物理仿真系统如图 2所示.物理实物由末端执行器、六维弹簧机构(机械臂柔性环节)、目标适配器、六自由度并联机器人、力传感器和机械框架组成.力传感器安装在机械框架的下面,六维弹簧机构放置在力传感器和末端执行器之间.力传感器采集接触力数据,当机械臂为弹簧机构物理实物时,动力学模型通过接触力计算航天器的运动,并由并联机器人复现运动过程.当机械臂为数学模型时,则图 2中无六维弹簧机构,动力学模型计算航天器和机械臂端部的相对运动,并由并联机构复现相对运动过程.在本研究中,动力学计算和六自由度并联机器人控制分别由两套上下位机完成.

Fig. 2
图 2 机械臂对接半物理仿真系统 Fig. 2 Manipulator docking HIL simulation system


2 机械臂对接半物理仿真系统建模机械臂对接半物理仿真系统模型可描述为如图 3形式.

Fig. 3
图 3 机械臂对接半物理仿真系统模型 Fig. 3 Model of the manipulator docking HIL system


2.1 接触模型图 1中机械臂的柔性环节、对接机构和航天器是串联形式.柔性环节和接触环节均视为六维弹簧阻尼系统,且仅考虑6个自由度的主刚度.由于6个方向的主刚度解耦,则6个方向的对接动力学形式相同,由于6个自由度模拟参数范围相似,则可以通过单个方向的对接特性说明六自由度系统的对接特性.单个自由度的对接示意图如图 4所示,图中各机构处于同一水平线不表示机构的实际对接位置,仅表示单个自由度的对接动力学原理,虚线框为数学模型,点划线框为物理实物.图中物理量描述第i(i=1~6)自由度的平动/转动参数:xe-ixs-i分别为末端执行器和航天器位移/转角的大小(正方向为xe轴正向/逆时针方向);kp-icp-i分别为平动接触刚度/转动接触刚度和平动接触阻尼/转动接触阻尼;km-icm-i分别为机械臂的平动刚度/转动刚度和平动阻尼/转动阻尼;me-ims-i分别为末端执行器和航天器的质量/惯量.

Fig. 4
图 4 机械臂为六维弹簧机构的单自由度对接原理 Fig. 4 Single degree-of-freedom docking principle with manipulator as a six-dimensional spring mechanism


为方便描述和建模,以竖直方向单自由度平动为例建立半物理仿真系统模型并去掉物理量自由度标识i.推导接触力Fpxs的关系和接触模型传递函数为

$F_{\mathrm{p}}=\frac{\left(k_{\mathrm{m}}+c_{\mathrm{m}} s\right)\left(k_{\mathrm{p}}+c_{\mathrm{p}} s\right)}{m_{\mathrm{e}} s^{2}+\left(c_{\mathrm{m}}+c_{\mathrm{p}}\right) s+k_{\mathrm{m}}+k_{\mathrm{p}}} x_{\mathrm{s}}.$

2.2 动力学模型机械臂为六维弹簧机构的系统对接动力学模型为

$x_{\mathrm{s}}^{\prime}=-\frac{F_{\mathrm{p}}}{m_{\mathrm{s}} s^{2}}.$

2.3 并联机器人模型针对每一个自由度,伺服电机控制的并联机器人位置闭环控制传递函数可表示为

$G(s)=\frac{K_{V}}{\frac{s^{3}}{\omega_{\mathrm{n}}^{3}}+\frac{2 \xi}{\omega_{\mathrm{n}}} s^{2}+s+K_{V}}, $

函数中的参数可以由试验辨识确定.

2.4 机械臂对接半物理仿真系统模型由接触模型、动力学模型和并联机器人模型可建立图 3所示的机械臂对接半物理仿真系统模型.机械臂为六维弹簧机构的半物理仿真系统模型如图 5所示.

Fig. 5
图 5 机械臂为六维弹簧机构的半物理仿真系统模型 Fig. 5 HIL simulation system model with manipulator as a six-dimensional spring mechanism


机械臂为数学模型的对接动力学原理如图 6所示,虚线框为数学模型,点划线框为物理实物.可得到机械臂为数学模型的半物理仿真系统模型如图 7所示.

Fig. 6
图 6 机械臂为数学模型的单自由度对接原理 Fig. 6 Single degree-of-freedom docking principle with manipulator as a mathematical model


Fig. 7
图 7 机械臂为数学模型的半物理仿真系统模型 Fig. 7 HIL simulation system model with manipulator as a mathematical model


3 机械臂对接半物理仿真系统特性分析 3.1 半物理仿真系统的根轨迹法稳定性分析应用根轨迹法分别分析机械臂为六维弹簧机构的半物理仿真系统(后文简称为系统Ⅰ)和机械臂为数学模型的半物理仿真系统(后文简称为系统Ⅱ)中刚度参数对系统特性的影响.根轨迹分析参数:km=10 kN/m, kp=10 kN/m, cm=0.8 kN/(m·s-1), cp=0.8 kN/(m·s-1), ms=5 000 kg, me=500 kg, KV=10 Hz, ωn=65 Hz, ξ=0.3,分析结果如图 8所示.

Fig. 8
----△为系统Ⅰ中参数的根轨迹分析曲线,---*为系统Ⅱ中参数的根轨迹分析曲线. 图 8 根轨迹分析结果 Fig. 8 Results of root locus analysis


图 8(a)为km的根轨迹曲线,km在0~+∞范围内均能保证系统稳定,说明当接触刚度较小时,机械臂刚度对系统稳定性影响小.

图 8(b)为kp的根轨迹曲线.当kp过大时,系统Ⅱ变得不稳定;kp在0~+∞范围内,系统Ⅰ均稳定.说明机械臂刚度较小时,系统Ⅰ能够模拟更高的接触刚度,机械臂为物理模型改善了高接触刚度对系统稳定性的影响.

3.2 机械臂为六维弹簧机构的半物理仿真系统参数配置和稳定条件分析图 5的半物理仿真系统的开环传递函数如式(1)所示.

$\begin{aligned} G_{\mathrm{k}}(s)=& \frac{k_{\mathrm{p}} k_{\mathrm{m}}}{\left(k_{\mathrm{p}}+k_{\mathrm{m}}\right) m_{\mathrm{s}}} \cdot\left(\frac{s}{k_{\mathrm{m}} / c_{\mathrm{m}}}+1\right) \cdot\left(\frac{s}{k_{\mathrm{p}} / c_{\mathrm{p}}}+1\right) / \\ &\left[{s_{\mathrm{p}}^{2}\left(\frac{s}{K_{V}}+1\right) \cdot\left(\frac{s^{2}}{\left(k_{\mathrm{p}}+k_{\mathrm{m}}\right) / m_{\mathrm{e}}}+\frac{\left(c_{\mathrm{p}}+c_{\mathrm{m}}\right)}{\left(k_{\mathrm{p}}+k_{\mathrm{m}}\right)} s+1\right)}\right.\cdot\\ &\left. {\left(\frac{s^{2}}{\omega_{\mathrm{n}}^{2}}+\frac{2 \xi-K_{V} / \omega_{\mathrm{n}}}{\omega_{\mathrm{n}}} s+1\right) } \right]. \end{aligned}$ (1)

若系统的开环传递函数的穿越频率在中、低频段,且系统穿越频率处在大约-20 dB/dec段,则可使系统获得较大的相位裕量和稳定裕量.以此为原则分析系统具有较好特性时系统参数的配置关系.

本研究中半物理仿真系统的参数有如下特点:KV约为10 Hz;ωn约为65 Hz;kmkp一般不大于106 N/m量级,mems均大于100 kg;由kmkpme组成的二阶震荡环节的转折频率ω≤10 Hz;设开环传递函数中各环节的转折频率分别为1/T1=ω,1/T2=kp/cp,1/T3=KV,1/T4=km/cm,1/T5=ωn.则根据参数关系有:1/T3 < 1/T5.满足系统穿越频率处在-20 dB/dec段的伯德图如图 9(a)和图 9(b)所示.

Fig. 9
图 9 系统参数满足式(2)和(3)的系统示意伯德图 Fig. 9 System schematic Bode diagram when system parameters satisfy formulas (2)and (3)


图 9(a)中参数配置关系为

$\left\{ {\begin{array}{*{20}{l}}{\frac{1}{{{T_4}}}\left( {\frac{1}{{{T_2}}}} \right) < \frac{1}{{{T_2}}}\left( {\frac{1}{{{T_4}}}} \right) < \frac{1}{{{T_3}}} < \frac{1}{{{T_1}}} < \frac{1}{{{T_5}}};}\\{\log \left( {\left| {G\left( {\frac{1}{{{T_3}}}} \right)} \right|} \right) > 0.且\log \left( {\left| {G\left( {\frac{1}{{{T_1}}}} \right)} \right|} \right) < 0.}\end{array}} \right.$ (2)

若满足图 9(b)的穿越情况,则系统开环传递的其他环节的转折频率大小可任意排列.设大于1/T2或1/T4的下一个转折频率为1/Tx,则满足系统穿越频率处在大约-20 dB/dec段的参数配置关系为

$\left\{ \begin{array}{l}\frac{1}{{{T_4}}}\left( {\frac{1}{{{T_2}}}} \right) < 其他转折频率, \\\log \left( {\left| {G\left( {\frac{1}{{{T_2}}}} \right)} \right|} \right) > 0且\log \left( {\left| {G\left( {\frac{1}{{{T_x}}}} \right)} \right|} \right) < 0, \\或\log \left( {\left| {G\left( {\frac{1}{{{T_4}}}} \right)} \right|} \right) > 0且\log \left( {\left| {G\left( {\frac{1}{{{T_x}}}} \right)} \right|} \right) < 0.\end{array} \right.$ (3)

对接系统的参数有时不满足式(2)和(3)的关系,为保证实验的稳定性,需要求得系统的稳定条件.根据半物理仿真系统的开环传递函数频域特性可知,(kpkm/(kp+km))/ms不宜过大,以保证系统的穿越频率在中、低频段内(高频段系统一定不稳定).鉴于该前提有并联机器人的固有频率ωn远大于系统穿越频率ωc,则并联机器人的二阶震荡环节的频域特性对转折频率处的频域特性影响很小,可忽略其影响.应用劳斯判据可得到半物理仿真系统的稳定条件如式(4)所示.

$\left\{ \begin{array}{l}{K_V} > \max \left[ {\frac{{{c_{\rm{m}}}{c_{\rm{p}}}}}{{{m_{\rm{s}}}\left( {{c_{\rm{m}}} + {c_{\rm{p}}}} \right)}}\quad \frac{{{k_{\rm{m}}}{k_{\rm{p}}}}}{{{c_{\rm{m}}}{k_{\rm{p}}} + {c_{\rm{p}}}{k_{\rm{m}}}}}} \right], \\{m_{\rm{e}}} < \frac{{\left[ {{m_{\rm{s}}}{K_V}\left( {{c_{\rm{m}}} + {c_{\rm{p}}}} \right) - {c_{\rm{m}}}{c_{\rm{p}}}} \right]\left[ {{m_{\rm{s}}}\left( {{k_{\rm{m}}} + {k_{\rm{p}}}} \right) + {c_{\rm{m}}}{c_{\rm{p}}}} \right]}}{{{m_{\rm{s}}}\left[ {{K_V}\left( {{c_{\rm{p}}}{k_{\rm{m}}} + {c_{\rm{m}}}{k_{\rm{p}}}} \right) - {k_{\rm{m}}}{k_{\rm{p}}}} \right]}}, \\{m_{\rm{s}}}\left( {{k_{\rm{m}}} + {k_{\rm{p}}}} \right) + {c_{\rm{m}}}{c_{\rm{p}}} > \frac{{{m_{\rm{s}}}{m_{\rm{e}}}\left[ {{K_V}\left( {{c_{\rm{p}}}{k_{\rm{m}}} + {c_{\rm{m}}}{k_{\rm{p}}}} \right) - {k_{\rm{m}}}{k_{\rm{p}}}} \right]}}{{{m_{\rm{s}}}{K_V}\left( {{c_{\rm{m}}} + {c_{\rm{p}}}} \right) - {c_{\rm{m}}}{c_{\rm{p}}}}}\\ + \frac{{{k_{\rm{m}}}{k_{\rm{p}}}\left[ {{m_{\rm{s}}}{K_V}\left( {{c_{\rm{m}}} + {c_{\rm{p}}}} \right) - {c_{\rm{m}}}{c_{\rm{p}}}} \right]}}{{{K_V}\left( {{c_{\rm{p}}}{k_{\rm{m}}} + {c_{\rm{m}}}{k_{\rm{p}}}} \right) - {k_{\rm{m}}}{k_{\rm{p}}}}}.\end{array} \right.$ (4)

系统中的质量过小或系统刚度过大均会导致系统不稳定.间接体现了对接动力学频率会对系统稳定性产生影响.

3.3 基于3D根轨迹法的半物理仿真系统动力学频率模拟能力分析式(2)、(3)和(4)的数学关系复杂且抽象.机械臂对接动力学过程是一个两自由度有阻尼震荡过程.有两个固有频率(后文称为对接动力学频率)ωlowωhigh和两个对接动力学阻尼比ξ1ξ2[16].本文以半物理仿真系统的稳定性和复现精度为目标,研究对接动力学频率和对接动力学阻尼比对系统特性的影响.分析不同对接动力学阻尼比条件下系统能够模拟的对接动力学频率范围,得到保证系统稳定性和复现精度的对接动力学频率与并联机器人频宽的数值关系(衡量动力学模拟能力的指标).

分析原理:1)设置模拟对象参数ms为103~104 kg,步长为103 kg;km为5~200 kN/m,步长为5 kN/m;kp为7~280 kN/m,步长为7 kN/m;me为500 kg;cmcp由对接动力学阻尼比、质量和刚度参数求解;KVωnξ分别为10、63 Hz和0.3. 2)对每组系统参数求解对接动力学频率(ωlow, ωhig)作为xy轴坐标,求解闭环传递函数根的实部sr的最大值并作为z轴坐标;3)由3D根轨迹法得到所有组的根的最大实部分布,分析系统能够模拟的动力学频率范围.

以对接动力学阻尼比ξ1=0.02和ξ2=0.02为例说明分析过程. 图 10(a)为所有组参数下系统闭环传递函数的根的最大实部分布图.最大实部为正值的情况多集中在动力学频率较大的区域,说明动力学频率越高,稳定性越差. 图 10(c)为图 10(a)中根的最大实部为负值的数据点. 图 10(b)和图 10(d)分别为图 10(a)和图 10(c)的XY俯视图,提取图 10(b)和图 10(d)中ωhigh<2、3和4 Hz的数据点,得到的数据点数目分别为M1M2M3m1m2m3;用m1/M1m2/M2m3/M3表示ωhigh为2、3和4 Hz的稳定比率,定义稳定比率>95%时的对接动力学频率为保证稳定条件下系统对接动力学频率模拟能力.计算得η1=m1/M1=96.65%,η2=m2/M2=84.38%和η3=m3/M3=78.25%,则对接动力学频率模拟能力约为2 Hz,随着对接动力学频率增大,稳定比率快速下降.同理,令ξ1=0.05和ξ2=0.05,可得对接动力学频率为4.9 Hz的稳定比率为η=96.43%.随着阻尼比增大,系统能够模拟的ωhigh由2 Hz增大到4.9 Hz.在模拟参数范围内,ωhigh的最大值为5.2 Hz,为保证半物理仿真系统在模拟参数范围内稳定,则对接动力学阻尼比应不小于0.05.令对接动力学阻尼比为ξ1=0.1和ξ2=0.1,ωhigh为5.2 Hz的稳定比率为η=100%,说明半物理仿真系统在模拟对象的参数范围内均能稳定.

Fig. 10
图 10 ξ1=0.02和ξ2=0.02的系统闭环传递函数的根的最大实部分布图 Fig. 10 Maximum real part distribution of the closed-loop transfer function of the system with ξ1=0.02 and ξ2=0.02


基于满足稳定要求的系统模拟能力结果, 进一步分析满足复现精度要求的系统模拟能力.以图 11所示的震荡位移曲线为例说明评定系统复现精度的标准.设图 4中航天器由初始位置(传感器不受力)偏移10 mm,即图 3中并联机器人偏移10 mm,然后进入动力学过程,并联机器人往复运动模拟图 4中航天器在对接机构作用下的运动.

Fig. 11
图 11 系统复现精度原理 Fig. 11 Principle diagram of system reproduction precision


将理论位移曲线(真实对接过程)与并联机器人的实际位移曲线对比,用式(5)计算半物理仿真系统的位移复现偏差.当对接动力学阻尼比为0.05左右时,经过几个震荡周期位移曲线就会趋于平稳,因此取前5个周期的震荡幅值计算复现偏差.

$\lambda=\left(\frac{l_{1}+l_{2}+l_{3}+l_{4}+l_{5}}{L_{1}+L_{2}+L_{3}+L_{4}+L_{5}}-1\right) \times 100 \%.$ (5)

根据式(5)进行多次仿真计算,得到了对接动力学阻尼比由0.02变化至0.10时,ωhigh的数值及其与并联机器人的频宽ωf的关系,如表 1所示.对接动力学阻尼比增大可以提高系统的动力学频率模拟能力,说明了阻尼比增大可以提高系统的稳定性和复现精度;而从图 12可知,动力学阻尼比增大到一定数值后,ωhigh增长明显变缓,这是因为并联机器人的频宽有限,复现过大的ωhigh会导致并联机器人幅值衰减过大,造成较大的精度损失. 表 1的数值关系为半物理仿真系统模拟对接过程的准确性和有效性提供理论依据.

表 1
表 1 动力学频率模拟能力仿真计算结果 Tab. 1 Calculation results of dynamics frequency simulation ability ξ1ξ2 ωhigh/Hz ωhigh/ωf

0.02 1.5 0.150

0.03 2.1 0.210

0.04 2.6 0.260

0.05 3.0 0.300

0.06 3.3 0.330

0.07 3.50 0.360

0.08 3.65 0.365

0.09 3.73 0.373

0.10 3.80 0.380

- - -



表 1 动力学频率模拟能力仿真计算结果 Tab. 1 Calculation results of dynamics frequency simulation ability


Fig. 12
图 12 对接动力学频率模拟能力 Fig. 12 Docking dynamics frequency simulation ability


4 验证仿真验证和实验验证中的初始条件均令图 3中并联机器人偏移10 mm,然后进入动力学过程,并联机器人往复运动模拟图 4中航天器在对接机构作用下的运动.

4.1 仿真验证应用MATLAB软件的Simulink模块搭建图 5和图 7所示的机械臂对接半物理仿真系统模型,验证第3节分析结果的正确性.仿真参数如表 2所示.参数组2-1用于对比机械臂为数学模型和六维弹簧机构的半物理仿真系统在高刚度接触时的稳定性;参数组2-2和2-3验证系统参数配置分析结果的正确性.参数组2-4和2-5验证半物理仿真系统对接动力学频率模拟能力分析结果的正确性.

表 2
表 2 仿真参数 Tab. 2 Simulation parameters 参数 km/(N·m-1) kp/(N·m-1) cm/(N·m-1·s) cp/(N·m-1·s) ms/kg me/kg

2-1 1.0e4 8.55e4 200 200 5 000 500

2-2 1.0e4 1.00e4 500 3 500 500 50

2-3 4.0e4 4.00e4 800 800 2 000 150

2-4 1.8e4 1.26e5 1 050 320 2 000 500

2-5 1.8e4 1.40e5 800 290 2 000 500



表 2 仿真参数 Tab. 2 Simulation parameters


4.1.1 机械臂为六维弹簧机构的半物理仿真系统模拟高刚度接触的优越性仿真参数如表 2中参数组2-1所示,仿真结果如图 13所示.当接触刚度较大时,机械臂为数学模型的半物理仿真系统呈发散状态,发散曲线的震荡频率约等于并联机器人的固有频率.而机械臂为物理实物的半物理仿真系统为收敛状态.

Fig. 13
图 13 两种半物理仿真系统高刚度接触时的位移曲线 Fig. 13 Displacement of two HIL simulation systems with high stiffness contact


4.1.2 半物理仿真系统参数配置关系分析结果验证表 2中参数组2-2满足式(2)的配置关系,表 2参数组中2-3不满足式(2)和(3).仿真结果如图 14和15所示.

Fig. 14
图 14 表 2中参数组2-2并联机器人位移曲线 Fig. 14 Displacement of the parallel robot with simulation parameters in Tab. 2-2-1


Fig. 15
图 15 表 2中参数2-3并联机器人位移曲线 Fig. 15 Displacement of the parallel robot with simulation parameters in Tab. 2-2-3


高频振荡位移在阻尼作用下很快衰减,运动主要体现为低频振荡特性. 图 14中理论曲线和实际曲线高度重合,偏差率仅为2.5%(满足式(2)和(3)的参数配置通常能保证系统复现, 偏差率不高于5%). 图 15中理论曲线和实际曲线具有较大的偏差,偏差率达到27%,体现了3.2节参数配置分析结果的有效性.

4.1.3 半物理仿真系统动力学频率模拟能力结果验证以对接动力学阻尼比为ξ1=0.05, ξ2=0.05和表 2参数组中2-4为例进行仿真计算,仿真结果如图 16所示.

Fig. 16
图 16 ξ1=0.05和ξ2=0.05的对接动力学频率模拟能力仿真验证 Fig. 16 Simulation verification of docking dynamics frequency simulation ability with ξ1=0.05 and ξ2=0.05


表 2中2-4仿真参数的高对接动力学频率ωhigh=2.95 Hz,ωhigh=0.325ωf,偏差率为8%;表 2中参数组2-5仿真参数的高对接动力学频率ωhigh=3.07 Hz,偏差率为12%.说明了表 1分析结果的正确性.

4.2 实验验证用一个已知刚度和阻尼的弹簧模拟末端执行器对目标适配器的作用,机械臂对接半物理仿真系统的主要实验设备见图 17.传感器下方装有六维弹簧机构和末端执行器,为模拟失重条件下的对接过程,实验前将传感器进行数值清零操作,去除机构重力对实验的影响.传感器仅测得接触力,并由对接动力学计算失重条件下的航天器运动,通过并联机器人复现运动过程.实验中,采用MATLAB的xPC模块作为实时仿真系统,采样时间为1 ms.实验参数为:km=70 kN/m, kp=7 kN/m;cm=1 kN/(m·s-1), cp=0.5 kN/(m·s-1), ms=103kg, me=135 kg.

Fig. 17
图 17 机械臂对接半物理仿真系统实验设备 Fig. 17 Experimental setup for manipulator docking HIL simulation system


4.2.1 稳定条件验证以半物理仿真系统满足中、低频段穿越为前提,得到了式(4)的稳定条件.以式(4)第3条为例,通过实验验证稳定条件的有效性.当KV=2.38 Hz时,系统为临界稳定.调整并联机器人的控制参数使得开环速度增益分别为KV=2.3 Hz(不满足稳定条件)和KV=2.5 Hz(满足稳定条件),得到的并联机器人位移曲线如图 18所示.由结果可知,KV稍小于临界值,则系统稳定,反之系统成发散状态;说明了稳定条件的有效性.

Fig. 18
图 18 稳定条件验证 Fig. 18 Stability condition verification


4.2.2 机械臂对接半物理仿真系统动力学频率模拟能力验证实验参数的动力学阻尼比约为ξ1=0.10和ξ2=0.11,得到的实验结果如图 19所示.

Fig. 19
图 19 ξ1=0.10和ξ2=0.11的对接动力学频率模拟能力实验验证 Fig. 19 Experimental verification of docking dynamics frequency simulation ability with ξ1=0.10 and ξ2=0.11


当末端执行器质量由135 kg变为125 kg时(对接动力学阻尼比基本不变),对接动力学频率ωhigh由3.8 Hz增加到3.9 Hz,不满足表 1中的数值范围,偏差率由9.6%变为12%.实验结果、分析结果和仿真结果一致,说明了对接动力学频率模拟能力分析结果的正确性.

5 结论1) 针对机械臂为数学模型的机械臂对接半物理(HIL)仿真系统会因为对接机构的高接触刚度导致系统不稳定问题,提出了将机械臂等效为六维弹簧机构实物来模拟机械臂的对接过程.通过根轨迹法和实验分析验证了所提出的HIL仿真系统能够有效解决高刚度接触带来的不稳定现象,能够模拟高刚度的对接过程.

2) 机械臂对接HIL仿真系统的参数和接触环境复杂,为保证所提出的HIL仿真系统能够有效模拟对接过程,从3个重要方面对系统稳定性和复现精度进行了分析:应用系统-20 dB/dec段穿越理论得到了系统具有较好特性时系统参数的配置关系;应用稳定判据得到了HIL仿真系统的稳定条件;应用3D根轨迹法和仿真分析得到了系统对接动力学频率模拟能力.通过仿真和实验验证了所得结论的正确性,对空间对机械臂对接的可行性和准确性具有指导意义.


参考文献
[1] 张凯锋, 周晖, 温庆平, 等. 空间站机械臂研究[J]. 空间科学学报, 2010, 30(6): 612.
ZHANG Kaifeng, ZHOU Hui, WEN Qingping, et al. Review of the development of robotic manipulator for international space station[J]. Chinese Journal of Space Science, 2010, 30(6): 612. DOI:10.11728/cjss2010.06.612


[2] 张文辉, 叶晓平, 季晓明, 等. 国内外空间机器人技术发展综述[J]. 飞行力学, 2013, 31(3): 198.
ZHANG Wenhui, YE Xiaoping, JI Xiaoming, et al. Development summarizing of space robot technology national and outside[J]. Flight Dynamics, 2013, 31(3): 198.


[3] ZENG D, YANG Y, CONG D, et al. Space End Effector Capturing Hybrid Simulation System[C]//2015 IEEE International Conference on Fluid Power and Mechatronics (FPM). Piscataway: IEEE Press, 2015: 448. DOI: 10.1109/FPM.2015.7337159 https://ieeexplore.ieee.org/document/7337159/


[4] ZHAO H, ZHANG S. Stability research of space docking dynamics simulation based on Stewart platform[J]. Machine Tool & Hydraulics, 2006(8): 1.


[5] 赵慧, 张尚盈. 空间对接整体动力学仿真系统稳定性分析[J]. 武汉科技大学学报(自然科学版), 2008, 31(1): 87.
ZHAO Hui, ZHANG Shangying. Stability analysis of the whole dynamics simulation system of space docking[J]. Journal of Wuhan University of Science and Technology (Natural Science Edition), 2008, 31(1): 87. DOI:10.3969/j.issn.1674-3644.2008.01.020


[6] ZEBENAY M, BOGE T, KRENN R, et al. Analytical and experimental stability investigation of a hardware-in-the-loop satellite docking simulator[J]. Journal of Aerospace Engineering, 2015, 229(4): 666. DOI:10.1177/0954410014539290


[7] 丰飞.空间大容差末端执行器及其软捕获策略研究[D].哈尔滨: 哈尔滨工业大学, 2013
FENG Fei. Research on space large misalignment tolerance end-effector and its soft capture strategy[D]. Harbin: Harbin Institute of Technology, 2013 http://cdmd.cnki.com.cn/Article/CDMD-10213-1013045224.htm


[8] YANG H, XIE Z, SUN K, et al. Development of ground experiment system for space end-effector capturing the floating target in 3-dimensional space[J]. Industrial Robot: An International Journal, 2015, 42(4): 347. DOI:10.1108/IR-02-2015-0028


[9] YANG H, JIN M, XIE Z, et al. Ground micro-gravity verification of free-floating non-cooperative satellite docking[C]//2015 IEEE International Conference on Advanced Intelligent Mechatronics (AIM). Piscataway: IEEE Press, 2015: 1253. DOI: 10.1109/AIM.2015.7222710 https://ieeexplore.ieee.org/document/7222710


[10] QI C, GAO F, ZHAO X, et al. Low-order model based divergence compensation for hardware-in-the-loop simulation of space discrete contact[J]. Journal of Intelligent & Robotic Systems, 2017, 86(1): 81. DOI:10.1007/s10846-016-0460-y


[11] QI C, GAO F, ZHAO X, et al. A force compensation approach toward divergence of hardware-in-the-loop contact simulation system for damped elastic contact[J]. IEEE Transactions on Industrial Electronics, 2017, 64(4): 2933. DOI:10.1109/TIE.2016.2643625


[12] MA O, ZEBENAY M, BOGE T.Control of industrial robots for hardware-in-the-loop simulation of satellite docking[C]//International Society for Optics and Photonics-Sensors and Systems for Space Applications IV. San Francisco: SPIE Press, 2011: 80440G. DOI: 10.1117/12.886185


[13] CHANG T, CONG D, YE Z, et al. Interface issues in hardware-in-the-loop simulation for spacecraft on-orbit docking[C]//2007 IEEE International Conference on Control and Automation. Piscataway: IEEE Press, 2007: 2584. https://ieeexplore.ieee.org/document/4376829


[14] YAN H, HAN J, TONG Z, et al. Hybrid realtime simulation of the space docking process[C]//16th International Conference on Artificial Reality and Telexistence-Workshops. Piscataway: IEEE Press, 2006: 323. DOI: 10.1109/ICAT.2006.70 https://www.researchgate.net/publication/224281762_Hybrid_Realtime_Simulation_of_the_Space_Docking_Process


[15] HUANG Q, JIANG H, ZHANG S, et al. Spacecraft docking simulation using hardware-in-the-loop simulator with Stewart platform[J]. Chinese Journal of Mechanical Engineering (English Edition), 2005, 18(3): 415. DOI:10.3901/CJME.2005.03.415


[16] 陈奎孚. 机械振动基础[M]. 北京: 中国农业大学出版社, 2011: 120.
CHEN Kuifu. Principles of mechanical vibration[M]. Beijing: China Agricultural University Press, 2011: 120.



相关话题/系统 机械 物理 过程 实验

  • 领限时大额优惠券,享本站正版考研考试资料!
    大额优惠券
    优惠券领取后72小时内有效,10万种最新考研考试考证类电子打印资料任你选。涵盖全国500余所院校考研专业课、200多种职业资格考试、1100多种经典教材,产品类型包含电子书、题库、全套资料以及视频,无论您是考研复习、考证刷题,还是考前冲刺等,不同类型的产品可满足您学习上的不同需求。 ...
    本站小编 Free壹佰分学习网 2022-09-19
  • 热轧过程中高纯钴微观组织及织构演变
    热轧过程中高纯钴微观组织及织构演变李震1,宋克睿1,韩彦鹏1,肖柱1,贺昕2,陈志永1(1.中南大学材料科学与工程学院,长沙410083;2.北京有色金属研究总院有研亿金新材料股份有限公司,北京102200)摘要:金属钴具有同素异构转变特性。为探究热轧工艺对高纯钴的微观组织及织构演变规律的影响,对纯 ...
    本站小编 哈尔滨工业大学 2020-12-05
  • AZ31B镁合金带材热轧过程组织均匀性及性能研究
    AZ31B镁合金带材热轧过程组织均匀性及性能研究曹东东1,2,梅瑞斌1,2,包立1,侯铮1,黄芸1(1.东北大学秦皇岛分校资源与材料学院,河北秦皇岛066004;2.东北大学材料科学与工程学院,沈阳110819)摘要:本文开展了变形温度为300、350、400℃和总压下率分别为15%、30%、45% ...
    本站小编 哈尔滨工业大学 2020-12-05
  • 基于问题导向的生物信息学综合实验教学设计
    基于问题导向的生物信息学综合实验教学设计霍颖异1,2,徐程2,吴敏1,2,陈铭2(1.浙江大学国家级生物实验教学示范中心,杭州310058;2.浙江大学生命科学学院,杭州310058)摘要:针对生物信息学相关课程的实验教学需求,结合前沿科研问题和成果,设计了基于问题导向的生物信息学综合实验。实验以宏 ...
    本站小编 哈尔滨工业大学 2020-12-05
  • 液压轮毂马达辅助驱动系统控制策略实车验证
    液压轮毂马达辅助驱动系统控制策略实车验证曾小华,崔臣,张轩铭,宋大凤,李立鑫(汽车仿真与控制国家重点实验室(吉林大学),长春130025)摘要:为充分提升重型牵引车辆通过不良路面的能力,对国内某款重型牵引车在传统结构的基础上加装了前轴液压轮毂马达辅助驱动系统,并针对该混合动力系统,开发了工程化的控制 ...
    本站小编 哈尔滨工业大学 2020-12-05
  • 考虑高温水泄漏影响的凝水泵启动过程仿真分析
    考虑高温水泄漏影响的凝水泵启动过程仿真分析覃海波,金家善,倪何(海军工程大学动力工程学院,武汉430033)摘要:针对某船用给水机组凝水泵在备用状态和备用转换启动过程中,由于高温除氧水进入凝水泵及其吸入管路而在机组启动后发生汽蚀,导致凝水泵出口压力长时间达不到规定要求的问题,在基于差异演化算法辨识得 ...
    本站小编 哈尔滨工业大学 2020-12-05
  • 电极丝前置式射流电解加工仿真及初步实验研究
    电极丝前置式射流电解加工仿真及初步实验研究李飘庭1,2,荆奇1,3,张勇斌1,李建1,傅波2(1.中国工程物理研究院机械制造工艺研究所,四川绵阳621900;2.四川大学机械工程学院,成都610065;3.复旦大学光科学与工程系,上海200438)摘要:射流电解加工技术在航天、仪器、电子和医疗设备等 ...
    本站小编 哈尔滨工业大学 2020-12-05
  • 铁锰复合阴极MFC-EF耦合系统产电及降解RhB效能
    铁锰复合阴极MFC-EF耦合系统产电及降解RhB效能史珂1,2,赵庆良1,2,王维业2,王琨1,2(1.城市水资源与水环境国家重点实验室(哈尔滨工业大学),哈尔滨150090;2.哈尔滨工业大学环境学院,哈尔滨150090)摘要:为实现微生物燃料电池(MFC)微电的原位利用,结合电芬顿(EF)技术的 ...
    本站小编 哈尔滨工业大学 2020-12-05
  • 污水生物处理过程中溶解性有机氮分布和转化特征
    污水生物处理过程中溶解性有机氮分布和转化特征王小东1,陈明飞1,王子文1,王燕1,王硕1,2,3,李激1,2,3(1.江南大学环境与土木工程学院,江苏无锡214122;2.江苏省厌氧生物技术重点实验室(江南大学),江苏无锡214122;3.江苏省高校水处理技术与材料协同创新中心,江苏苏州215009 ...
    本站小编 哈尔滨工业大学 2020-12-05
  • 桥梁伸缩缝跳车冲击荷载计算方法与模型实验
    桥梁伸缩缝跳车冲击荷载计算方法与模型实验丁勇1,2,王佩1,游玖昂1,诸葛萍1(1.宁波大学土木工程系,浙江宁波315211;2.桥梁工程结构动力学国家重点实验室(重庆交通科研设计院),重庆400067)摘要:为实测移动车辆对桥梁伸缩缝的冲击荷载,防止桥梁伸缩缝在这种冲击荷载作用下发生早期损坏,制作 ...
    本站小编 哈尔滨工业大学 2020-12-05
  • 偏最小二乘法在系统故障诊断中的应用
    偏最小二乘法在系统故障诊断中的应用梁北辰,戴景民(哈尔滨工业大学仪器科学与工程学院,哈尔滨150001)摘要:为研究结合关键性能指标(KPI)的偏最小二乘法(PLS)在系统故障诊断中的作用和应用,通过活性污泥数学模型(BSM1),结合偏最小二乘算法,建立了可以模拟污水处理的仿真模型.通过收集系统在正 ...
    本站小编 哈尔滨工业大学 2020-12-05