一种三自由度遥操作绝对稳定控制方法
【专利说明】一种三自由度遥操作绝对稳定控制方法 【技术领域】
[0001] 本发明属于空间遥操作领域，涉及一种三自由度遥操作绝对稳定控制方法。 【【背景技术】】
[0002] 随着空间技术的发展，空间遥操作技术已经成为航天器维修、空间站在轨服务，譬 如燃料加注、辅助交汇对接等方面的重要技术之一，该技术一方面可以避免航天员进行直 接维修，解决其维修效率低和严重影响航天员的生命安全的情况，另一方面该技术有助于 弥补空间机器人智能程度不够以及难以应付复杂非结构化环境的自主操作问题。但是遥操 作系统的稳定性问题确是目前遥操作中亟需解决的问题，目前遥操作系统的稳定性研究的 重点主要集中在单自由度或多自由度非耦合情况下的系统稳定问题，对于多个自由度耦合 情况下的系统稳定问题很少被研究。 【
【发明内容】
】
[0003] 本发明的目的在于解决上述问题，提供涉及一种三自由度遥操作绝对稳定控制方 法。
[0004] 为实现上述目的，本发明采用以下技术方案予以实现：
[0005] -种三自由度遥操作绝对稳定控制方法，包括以下步骤：
[0006] 1)建立操作者和环境的接触动力学模型
[0007] ZnVh= F h+Fcm
[0008] ZsVe= Fe+Fcs
[0009] 其中，Zni= MniS和Zs= MsS分别表示主从手3X3阻抗矩阵，Mni表示主手质量矩阵， Ms表示从手质量矩阵，s表示微分算子；Fh= [f hx, fhy, fhz]T表示在x，y和z三个自由度方向 主手与操作者之间的作用力，Fail表示主手控制器作用于操作手的作用力，F e= [f\x，f；y，f J τ表示在x，y和z三个自由度方向从手与环境之间的作用力，Fm表示从手控制器产生的作 用力；V h= [vhx, vhy, VhJ1^PVf3= [Vrai, Vf3y, VJt分别为主手和从手的运动速度；其中，Mi, i = m, s分别表不为：
[0011] 2)位置-位置ro控制器设计
[0012] 设计位置-位置ro控制器：
[0013] Fcn=-CnVh+CnVe
[0014] Fcs= -C sVe+CsVh
[0015] 其中，(；和Cs分别为控制器参数，表示为
[0018] 其中，kvnu，k pnuj，i，j = x，y，z分别表示主手手控器i和j方向的PD控制器参 数，kvsl#P k psl]，i，j = X，y，z分别表示从手手控器i和j方向的控制器参数
[0019] 于是，包含阻抗矩阵的三自由度阻抗矩阵的遥操作系统的表达式为：
[0021 ] 3)三自由度双边遥操作控制稳定性条件
[0022] 令s = jw，其中j表示虚数，w表示频率，于是根据无源性理论，得到绝对稳定条 件：
[0032] 以上ro控制器参数满足条件
[0035] 此外，为了保证系统的稳定性，系统参数中留数需要满足条件：
[0039] 则系统三自由度遥操作绝对稳定控制的条件需要同时满足条件（1)、（2)和（3)。
[0040] 与现有技术相比，本发明具有以下有益效果：
[0041] 本发明将遥操作系统X，y和z三个自由度方向上耦合情况下的稳定性条件，通过 将其分解为三端口网络，讨论利用无源稳定条件给出双边三自由度遥操作系统的绝对稳定 条件，通过建立三自由度的双边遥操作模型，分析主从手与操作者和环境之间的动力学特 征，通过无源稳定条件给出三自由度的双边遥操作系统模型的绝对稳定条件，保证遥操作 系统在三自由度耦合条件的绝对稳定，提高系统操作的可靠性。 【【附图说明】】
[0042] 图1为三自由度双边遥操作系统在绝对稳定和潜在不稳定条件下的输入能量比 较图。 【【具体实施方式】】
[0043] 下面结合附图对本发明做进一步详细的说明。
[0044] 参见图1，本发明一种三自由度遥操作绝对稳定控制方法，包括以下三个步骤：
[0045] 第一步：建立操作者和环境的接触动力学模型
[0046] ZnVh= F h+Fcn,
[0047] ZsVe= Fe+Fcs
[0048] 其中，Zni= MniS和Zs= MsS分别表示主从手3X3阻抗矩阵，Mni表示主手质量矩阵， Ms表示从手质量矩阵，其中M i, i = m, s分别表示为
[0050] 此外，Fh= [f hx, fhy, fhz]T表示在x，y和z三个自由度方向主手与操作者之间的作 用力，Ff3= [Uf3y, Ut表示在x，y和z三个自由度方向从手与环境之间的作用力。Vh = [vhx，vhy，V h= [V hx, vhy, VhJAlU为主手和从手的运动速度。
[0051] 第二步：位置-位置ro控制器设计
[0052] 设计位置-位置ro控制器
[0053] Fcni=-CniVQ1Ve
[0054] Fcs= -C sVe+CsVh
[0055] 其中，(；和Cs分别为控制器参数，可以表示为
[0058] 于是，包含阻抗矩阵的三自由度阻抗矩阵的遥操作系统的表达式为
[0060] 第三步：三自由度双边遥操作控制稳定性条件
[0061] 令s = jw，其中j表示虚数，w表示频率，于是根据无源性理论，不难得到绝对稳定 条件：
[0071] 以上ro控制器参数满足条件
[0074] 此外，为了保证系统的稳定性，系统参数中留数需要满足条件：
[0078] 则系统三自由度遥操作绝对稳定控制的条件需要同时满足条件（1)、（2)和（3)。
[0079] 选取三自由度输入的作用力为Fh= [fhx，fhy，fhz]T= [1，1，1] τ，环境作用于从端的 作用力为Ff3= [f μ, fq, Ut= [1，1，1] τ，系统运行时间为t e [0, 30s]，分别选取绝对稳定 条件参数为：
[0084] 和不稳定条件参数为：
[0088] Msxx= 160 ；Msyy= 160 ；MSZZ= 10 ；Msxy= 160 ；MSXZ= 120 ；Msyz= 16 ；
[0089] 对三自由度遥操作的输入能量进行分析，三自由度双边遥操作系统在绝对稳定和 潜在不稳定条件下的输入能量比较如图1所示，不难看出在绝对稳定条件下，系统的输出 能量与时间成正比关系，说明输入能量平稳增加，而在潜在不稳定情况下，输出的能量为发 散趋势，说明输入的能量不仅波动而且输入量越来越大，可能造成系统的不稳定。
[0090] 以上内容仅为说明本发明的技术思想，不能以此限定本发明的保护范围，凡是按 照本发明提出的技术思想，在技术方案基础上所做的任何改动，均落入本发明权利要求书 的保护范围之内。
【主权项】
1.一种Ξ自由度遥操作绝对稳定控制方法，其特征在于，包括W下步骤： 1) 建立操作者和环境的接触动力学模型 ZJh=Fh+F," ZJe=Fe+Fcs 其中，Zm=ΜmS和Zs=ΜsS分别表示主从手3X3阻抗矩阵，Mm表示主手质量矩阵，Ms表示从手质量矩阵，S表示微分算子；Fh=[fh，fhy，fJT表示在X，y和ZΞ个自由度方向主 手与操作者之间的作用力，F。。表示主手控制器作用于操作手的作用力，Fe=[fex,fey,fjT 表示在x，y和zΞ个自由度方向从手与环境之间的作用力，F。,表示从手控制器产生的作用 力；Vh= [Vhx，Vhy，vJ嘴Ve= [Vex，Vey，Vez]T分别为主手和从手的运动速度；其中，Mi，i= m,S分别表不为：2) 位置-位置PD控制器设计 设计位置-位置PD控制器： Fc"= -CJh+CJe F"=-CJe+CJh 其中，Cm和C,分别为控制器参数，表示为其中，kvmij和kpmij,i,j二X,y,Z分别表不主手手巧器i和j方向的PD巧制器参数，kvsij和kpu,，i，j=X，y，Z分别表示从手手控器i和j方向的PD控制器参数 于是，包含阻抗矩阵的Ξ自由度阻抗矩阵的遥操作系统的表达式为：3) Ξ自由度双边遥操作控制稳定性条件 令S=jw，其中j表示虚数，W表示频率，于是根据无源性理论，得到绝对稳定条件：W上PD控制器参数满足条件此外，为了保证系统的稳定性，系统参数中留数需要满足条件：则系统Ξ自由度遥操作绝对稳定控制的条件需要同时满足条件（1)、（2)和（3)。
【专利摘要】本发明公开了一种三自由度遥操作绝对稳定控制方法，包括以下步骤：1)建立操作者和环境的接触动力学模型，2)位置-位置PD控制器设计，3)三自由度双边遥操作控制稳定性条件。本发明将遥操作系统x，y和z三个自由度方向上耦合情况下的稳定性条件，通过将其分解为三端口网络，讨论利用无源稳定条件给出双边三自由度遥操作系统的绝对稳定条件，通过建立三自由度的双边遥操作模型，分析主从手与操作者和环境之间的动力学特征，通过无源稳定条件给出三自由度的双边遥操作系统模型的绝对稳定条件，保证遥操作系统在三自由度耦合条件的绝对稳定，提高系统操作的可靠性。
【IPC分类】G05D1/10, G05D1/08
【公开号】CN105320142
【申请号】CN201510791128
【发明人】黄攀峰, 鹿振宇, 刘正雄, 孟中杰
【申请人】西北工业大学
【公开日】2016年2月10日
【申请日】2015年11月17日