CN106980265A - 一种悬挂式低重力环境模拟系统输出反馈鲁棒h∞控制方法 - Google Patents

一种悬挂式低重力环境模拟系统输出反馈鲁棒h∞控制方法 Download PDF

Info

Publication number
CN106980265A
CN106980265A CN201710418719.0A CN201710418719A CN106980265A CN 106980265 A CN106980265 A CN 106980265A CN 201710418719 A CN201710418719 A CN 201710418719A CN 106980265 A CN106980265 A CN 106980265A
Authority
CN
China
Prior art keywords
servomotor
buffer unit
omega
type low
suspension type
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201710418719.0A
Other languages
English (en)
Other versions
CN106980265B (zh
Inventor
贾英民
李�浩
孙施浩
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beihang University
Original Assignee
Beihang University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beihang University filed Critical Beihang University
Priority to CN201710418719.0A priority Critical patent/CN106980265B/zh
Publication of CN106980265A publication Critical patent/CN106980265A/zh
Application granted granted Critical
Publication of CN106980265B publication Critical patent/CN106980265B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明针对悬挂式低重力模拟系统提出一种输出反馈鲁棒H∞控制方法。悬挂式低重力模拟系统包括由X向滑轨、Y向滑轨、伺服电机、倾角传感器等构成的水平随动系统,和Z向传动齿条、伺服电机、缓冲装置、张力传感器、万向节等构成的张力伺服系统。利用牛顿‑欧拉法给出动力学模型,在此基础之上提出一种输出反馈鲁棒H∞控制方法,使重力补偿系统具有对响应的快速性和对于外部干扰的鲁棒性,从而能够长时间提供低重力环境,保证地面验证系统的稳定性与可靠性。

Description

一种悬挂式低重力环境模拟系统输出反馈鲁棒H∞控制方法
所属技术领域
本发明属于自动化技术领域,具体涉及悬挂式低重力环境模拟系统输出反馈鲁棒H∞控制方法。
背景技术
随着航天科技的快速发展,发射星球探测器已经成为一个国家科学技术发展的重要标志,如我国正在开展的嫦娥探月工程计划中的“玉兔号”月球车。月球表面重力约为地球1/6,星球车运动性能受重力影响,因此地面研制月球车的性能需要提供等效的空间环境,即低重力环境。空间重力补偿系统是地面验证系统的核心部件,通过给探测器提供恒定补偿力,抵消部分重力,实现对于星球表面低重力环境的模拟。由于悬挂法具有结构简单,易于实现,可长时间、大空间地运动等显著优点,在地面验证系统总发挥重要作用。本发明通过建立悬挂式低重力补偿系统模型,为保证补偿系统响应的快速性以及对于干扰的鲁棒性,提出一种输出反馈鲁棒H∞控制方法。
发明内容
本发明针对悬挂式低重力环境模拟系统提出一种输出反馈鲁棒H∞控制方法,使其具有响应的快速性和对于外部干扰的鲁棒性,从而能够长时间提供低重力环境,保证地面验证系统的稳定性与可靠性。
本发明的技术方案:
悬挂式低重力补偿系统由水平滑轨,伺服电机,传动齿条,缓冲装置,倾角传感器,张力传感器等组成。其中X向滑轨、Y向滑轨、伺服电机、倾角传感器等构成的水平随动系统,伺服电机可驱动水平滑轨使得传动齿条沿X轴Y轴方向运动,倾角传感器能够感知传动齿条与缓冲装置形成的夹角;Z向传动齿条、伺服电机、缓冲装置、张力传感器、万向节等构成的张力伺服系统,缓冲装置与传动齿条通过万向节和张力传感器相连,张力传感器能够感知缓冲装置所受张力。根据悬挂式低重力环境补偿系统的结构,利用牛顿-欧拉法建立系统的动力学模型,通过李雅普诺夫线性化方法将其转化成标准的鲁棒H∞控制问题,利用LMI方法将输出反馈鲁棒H∞控制器的求解问题转化成对线性矩阵不等式的求解问题。通过对输出反馈鲁棒H∞控制器的求解,使得水平随动系统通过倾角传感器的角度信息控制伺服电机,电机通过传送带驱动传动齿条水平运动,以确保传动齿条始终处于被悬吊物体的正上方以精确地平衡竖直方向的力;使得张力伺服系统能够基于张力传感器测量张力信号,控制力矩电机对缓冲装置张力进行控制,使张力始终抵消一部分重力,实现地面低重力环境。
本发明有以下特点:
(1)抗干扰能力强。针对系统设计了输出反馈鲁棒H∞控制器,能够约束外部干扰的影响,且模型中考虑了外部扰动对系统的影响,鲁棒性能好。
(2)补偿精度高。鲁棒控制器设计过程中约束性能常数γ经过多次选择,在控制量可以实现的情况下,达到最大限度的补偿误差。
(3)控制过程平稳,系统的波荡小。建模采用动力学建模,系统的输入为伺服电机的驱动力,因此伺服电机采用转矩控制模式,相比于位置控制模式更加平滑,减少系统波动。
附图说明
图1本发明的结构示意图。
图中标号:1:X向滑轨;2:Y向滑轨;3:传动齿条;4:缓冲装置;5:悬挂目标。
图2本发明的控制流程图。
图3本发明的控制器设计原理图。
图4本发明所采用的输出反馈控制器示意图。
图5本发明加入输出反馈鲁棒H∞控制后缓冲装置角度变化图(受单位脉冲信号干扰)
图6本发明加入输出反馈鲁棒H∞控制后缓冲装置长度变化图(受单位脉冲信号干扰)
具体实施方式
1、动力学模型的建立
如图1,悬挂式低重力补偿系统由XY水平滑轨、伺服电机、传动齿条、缓冲装置、倾角传感器、张力传感器、悬挂目标等组成。被悬挂目标与缓冲装置相连,缓冲装置上装有张力传感器,缓冲装置的上端装有张力传感器,张力传感器通过万向节与传动齿条下端相连,伺服电机Z驱动传动齿条在Z方向上运动,传动齿条与Z向伺服电机安装在X向滑轨上,伺服电机X驱动传动齿条在X方向上运动,X向滑轨与伺服电机X安装在Y向滑轨上,伺服电机Y驱动X向滑轨在Y方向上运动。
由于缓冲装置与悬挂目标直接相连,因此缓冲装置上的张力传感器与倾角传感器的数据将直接反映悬挂目标的状态,张力传感器与倾角传感器通过采集卡采集信号,根据张力信息控制伺服电机运动。控制卡与驱动器直接相连发出电机期望的转矩信号,驱动器与伺服电机直接相连驱动电机转动,具体工作流程如图2。
如图1,O-XYZ为世界坐标系,其中Z方向为重力反方向,X方向沿纸面向外,Y方向与X、Z方向构成右手坐标系,xw,yw,zw表示传动齿条低端的坐标,xc,yc,zc代表悬挂目标质心坐标,R表示缓冲装置的长度,mc表示悬挂目标的质量,mw表示传动齿条的质量,msX分别表示X方向滑轨的质量,mmX,mmY,mmZ分别表示伺服电机X的质量、伺服电机Y的质量、伺服电机Z的质量,S表示缓冲装置所受张力大小,Fx表示在伺服电机X提供的驱动力,Fy表示伺服电机Y提供的驱动力,Fz表示在伺服电机Z提供的驱动力,Tx,Ty,Tz分别表示沿滑轨在X方向上运动的摩擦力、沿滑轨在Y方向上运动的摩擦力、传动齿条在Z方向上运动的摩擦力,Jx,Jy分别表示被悬挂小车在X方向和Y方向上受到的阻力,θx表示Z轴反方向与缓冲装置在X-Z平面上投影之间的夹角,θy表示缓冲装置与缓冲装置在X-Z平面上投影之间的夹角。
缓冲装置作为储能结构,能够将伺服电机对悬挂目标力的作用转化成缓冲装置的形变量,从而避免对悬挂目标的直接作用造成的机械震荡。缓冲装置可简化成为弹簧模型,记缓冲装置的弹性系数为k,当未悬挂目标时缓冲装置的长度记为L。假如采用月球的低重力环境,即为地球表面重力的1/6,因此补偿的目标需要达到5/6的重力。根据胡克定律,缓冲装置长度R与所受张力大小S之间的对应关系为:S=k(R-L),
记缓冲装置补偿重力之后理想长度为R0,可通过计算得到:R0=L+5mcg/6k。
根据模型结构可以看出,传动齿条末端坐标与悬挂目标质心坐标之间存在以下关系:
用Sx,Sy,Sz表示缓冲装置中拉力S在X,Y,Z方向上的分力,可得:
由于在实际操作中,传感器能够测量非常微小的角度变化以及拉力变化,当系统工作在低速情况下,缓冲装置偏移竖直方向一个非常小的角度,传感器能够探测到缓冲装置角度的微小变化,天车随动系统将会迅速调节,使得缓冲装置保持竖直。缓冲装置的工作摆动角度非常小,在实际中通常在5°之内,因此可以做这样的假设:
sinθx≈θx,sinθy≈θy
cosθx≈cosθy≈1
通过上述简化过程,(1)和(2)可以写成以下形式:
假设悬挂目标为在接近水平的地面上运动的小车,对悬挂小车在X,Y方向上进行受力分析,且对传动齿条在X,Y,Z方向上进行受力分析。
悬挂小车在手减速装置的拉力S和地面阻力Jx,Jy的影响,其动力学模型为:
接下来对传动齿条末端运动进行分析。在Z方向上,传动齿条受伺服电机Z的驱动力Fz、传动齿条的重力mwg、缓冲装置对其在Z向的拉力Sz和传动齿条与伺服电机Z之间摩擦阻力Tz;在X方向上,将传动齿条与伺服电机Z模块看作一个整体,受伺服电机X的驱动力Fx、缓冲装置在X方向上的拉力Sx和沿滑轨在X方向上运动的阻力Tx;在Y方向上,将传动齿条、伺服电机Z、X方向滑轨和伺服电机X看作一个整体,受伺服电机Y的驱动力Fy、缓冲装置在Y方向上的拉力Sy和沿滑轨在Y方向上运动的阻力Ty。利用牛顿运动方程且将(4)带入,可得传动齿条末端坐标的动态方程:
对于(3)式进行二阶微分可得:
对于上式变形得:
将(5)(6)带入(7)可得:
为了能够将上式简洁直观地写成状态方程的形式,做如下假设:
可以得到状态方程:
在(8)式的状态方程中,反应了缓冲装置的角度以及张力大小,能够间接反映低重力补偿系统的补偿效果,表示系统的状态;反应了伺服电机提供的驱动力的大小,表示系统输入;作为系统的外部扰动,其中反应了悬挂目标受到的干扰力,是悬挂目标Z方向的加速度,是地面不平整对于目标运动的影响。
2.控制器的设计
由于得到的状态方程(8)是非线性的,不容易直接设计控制器。由李雅普诺夫稳定理论知,如果线性化系统是严格稳定的(即系统矩阵A的特征值在复平面的左开平面内),那么非线性系统的平衡点是渐进稳定的。根据这个定理,对原非线性系统在平衡点处进行线性化处理,针对得到的线性系统设计控制器,使得线性系统是严格稳定的,由李雅普诺夫稳定理论得知,原非线性系统加入该控制器也是稳定的。为了使得设计的控制器不仅能够使得系统稳定,且能够将外部扰动约束到一定的范围之内,使得外部扰动对于系统的影响始终得到限制,因此采用输出反馈鲁棒H∞控制器,具体实施过程如图3。
为了推导方便,进行以下变量替换使得零点是系统的平衡点:
带入系统(8)中得到其中是系统的状态,ω=(ω123)T是系统的外部干扰,u=(u1,u2,u3)T是系统的输入。
线性化的结果为:
其中:
因此得到一个标准的鲁棒H∞控制问题:
其中z是被控输出,y是测量输出,其中D11,D12,D21,D22是零矩阵,C1是单位阵I6×6,C2是以下形式:
如图4所示,记(10)式所表示的系统为P,外部扰动ω与系统的输入u同时作用于线性系统系统P,输出反馈控制器以测量输出y作为控制器的输入,输出反馈鲁棒H∞控制器的目标是找出如(11)式的控制器K,使得原系统加入控制器后稳定,且从扰动ω到被控输出z的传递函数Tzw(s)的H∞范数满足||Tzw(s)||<γ,从而达到抑制干扰影响的作用。
输出反馈鲁棒H∞控制器可以通过线性矩阵不等式(LMI)方法得到,对于(10)式所描述的系统,LMI方法求解控制器由以下步骤得到:
(1)得到符合以下LMI的矩阵X和Y
1.
2.
3.
(2)获得满足X-Y-1=X2X2 T的矩阵X2,利用X2构成矩阵Xc
(3)得到符合以下等式的LMI的矩阵K:
HXc+PXc TKQ+QTKTPXc<0
其中:
输出反馈控制器(Ak,Bk,Ck,Dk)从矩阵K中可得到:
通过上述分析,选取R0=1,L=0.9,k=10,mc=mw=mmZ=1,msX=mmX=1,Tx=Ty=Tz=0.1,根据以上分析步骤设计控制器。
理论上来说γ越小,表明控制器对于外部干扰的抑制效果越好,但是γ如果选取的过于小,所需要的控制量则会相应越大。比如γ选取0.001这样小的值,控制器的数量级将会出现10的十几次方大的数值,这样的话在理论分析上是不必要的,在实际操作中也是不可行的。在实际设计中,γ取值一般小于1便可认为控制器的性能比较好,经过比较和筛选,最终将γ的取值选取为0.4,控制器的设计结果为:
当外部扰动ω=(ω123)T全部选取为在零时刻强度为1的脉冲信号,控制器的效果如图5,6所示。当没有加控制器的时候可以看到,图5中角度数值与图6中减震装置长度数值将会来回波动,表明系统不稳定,不能使其收敛到期望值。当把控制器加到原系统中,可以看到系统快速稳定,其中图5中角度数值迅速稳定表明水平随动系统能够快速跟踪被悬挂目标,图6中缓冲装置的长度R迅速趋于R0表明张力伺服系统能够通过调节使得缓冲装置能够始终保持所期望张力。因此所设计的控制器能够长时间的提供低重力环境,完成地面验证的需求。

Claims (8)

1.一种悬挂式低重力环境模拟系统输出反馈鲁棒H∞控制方法,其特征是:利用传感器的测量信息作为输入,通过设计控制器控制伺服电机使得缓冲装置的倾角与张力快速达到期望值,提供长时间的微重力环境,与此同时,所设计的鲁棒H∞控制器能够始终将外部干扰限制在一定范围之内,抑制干扰的影响。
2.根据权利要求1所述的一种悬挂式低重力环境模拟系统输出反馈鲁棒H∞控制方法,其特征是:悬挂式低重力补偿系统由XY水平滑轨、伺服电机、传动齿条、缓冲装置、倾角传感器、张力传感器、悬挂目标等组成。被悬挂目标与缓冲装置相连,缓冲装置上装有张力传感器,缓冲装置的上端装有张力传感器,张力传感器通过万向节与传动齿条下端相连,伺服电机Z驱动传动齿条在Z方向上运动,传动齿条与Z向伺服电机安装在X向滑轨上,伺服电机X驱动传动齿条在X方向上运动,X向滑轨与伺服电机X安装在Y向滑轨上,伺服电机Y驱动X向滑轨在Y方向上运动。根据欧拉-牛顿法建立动力学模型,考虑了水平滑轨摩擦阻力、传动齿条阻力、缓冲装置阻力、地面阻力等多种因素,将伺服电机提供的牵引力作为系统输入,将被悬挂目标水平受到的干扰力与纵向地面起伏作为系统的外部扰动,将缓冲装置的偏角与长度作为输出。建立的动力学模型的简化模型为:
x ^ · 1 = x ^ 2
x ^ · 2 = ( a 1 + t 3 - u ^ 3 ) x ^ 1 x ^ 5 - a 2 x ^ 1 + ( ω ^ 1 - u ^ 1 + t 1 ) 1 x ^ 5 - 2 x ^ 6 x ^ 2 x ^ 5 + ω ^ 3 x ^ 2 x ^ 5
x ^ · 3 = x ^ 4
x ^ · 4 = ( b 1 + t 3 - u ^ 3 ) x ^ 3 x ^ 5 - b 2 x ^ 3 + ( ω ^ 2 - u ^ 2 + t 2 ) 1 x ^ 5 - 2 x ^ 6 x ^ 4 x ^ 5 + ω ^ 3 x ^ 4 x ^ 5
x ^ · 5 = x ^ 6
x ^ · 6 = c 1 - c 2 x ^ 5 - t 3 + u ^ 3 - ω ^ 3
其中反应了缓冲装置的角度以及张力大小,能够间接反映低重力补偿系统的补偿效果,表示系统的状态;反应了伺服电机提供的驱动力的大小,表示系统输入;作为系统的外部扰动,其中反应了悬挂目标受到的干扰力,是悬挂目标Z方向的加速度,是地面不平整对于目标运动的影响。
3.根据权利要求2所述的一种悬挂式低重力环境模拟系统输出反馈鲁棒H∞控制方法,其特征是:
a 1 = ( k m c + k m w + m m Z - k m w ) L + g a 2 = ( k m c + k m w + m m Z - k m w ) c 1 = k L m w - g c 2 = k m w
b 1 = ( k m c + k m w + m m Z + m m X + m s X - k m w ) L + g b 2 = ( k m c + k m w + m m Z + m m X + m s X - k m w ) ω ^ 1 = J x m c , ω ^ 2 = J y m c , ω ^ 3 = z ·· c
t 1 = T x m w + m m Z t 2 = T y m w + m m Z + m m X + m s X t 3 = T z m w
u ^ 1 = F x m w + m m Z u ^ 2 = F y m w + m m Z + m m X + m s X u ^ 3 = F z m w
xw,yw,zw表示传动齿条低端的坐标,xc,yc,zc代表悬挂目标质心坐标,R表示缓冲装置的长度,mc表示悬挂目标的质量,mw表示传动齿条的质量,msX分别表示X方向滑轨的质量,mmX,mmY,mmZ分别表示伺服电机X的质量、伺服电机Y的质量、伺服电机Z的质量,S表示缓冲装置所受张力大小,Fx表示在伺服电机X提供的驱动力,Fy表示伺服电机Y提供的驱动力,Fz表示在伺服电机Z提供的驱动力,Tx,Ty,Tz分别表示沿滑轨在X方向上运动的摩擦力、沿滑轨在Y方向上运动的摩擦力、传动齿条在Z方向上运动的摩擦力,Jx,Jy分别表示被悬挂小车在X方向和Y方向上受到的阻力,θx表示Z轴反方向与缓冲装置在X-Z平面上投影之间的夹角,θy表示缓冲装置与缓冲装置在X-Z平面上投影之间的夹角,g为地球表面重力加速度。
4.根据权利要求3所述的一种悬挂式低重力环境模拟系统输出反馈鲁棒H∞控制方法,其特征是:利用李亚普诺夫稳定理论对悬挂式低重力环境模拟系统的动力学模型在平衡点处进行线性化,将对非线性的悬挂式低重力环境模拟系统的控制问题转化成为标准的鲁棒H∞控制问题。利用李雅普诺夫线性化方法将系统的模型线性化为:A,B1,B2,其中变量替换为:
x 1 = x ^ 1 , x 2 = x ^ 2 , x 3 = x ^ 3 , x 4 = x ^ 4 , x 5 = x ^ 5 - R 0 , x 6 = x ^ 6
ω 1 = ω ^ 1 , ω 2 = ω ^ 2 , ω 3 = ω ^ 3
u 1 = - u ^ 1 + t 1 , u 2 = - u ^ 2 + t 2 , u 3 = c 1 - c 2 R 0 - t 3 + u ^ 3
x=(x1,x2,x3,x4,x5,x6)T是系统的状态,ω=(ω123)T是系统的外部干扰,u=(u1,u2,u3)T是系统的输入,记缓冲装置补偿重力之后理想长度为R0,A,B1,B2由李雅普诺夫线性化方法得到:
A = ∂ F ∂ X | 0 = 0 1 0 0 0 0 ( a 1 + c 1 - c 2 R 0 ) R 0 - a 2 0 0 0 0 0 0 0 0 1 0 0 0 0 ( b 1 + c 1 - c 2 R 0 ) R 0 - b 2 0 0 0 0 0 0 0 0 1 0 0 0 0 - c 2 0 B 1 = ∂ F ∂ D | 0 = 0 0 0 1 R 0 0 0 0 0 0 0 1 R 0 0 0 0 0 0 0 - 1 B 2 = ∂ F ∂ U | 0 = 0 0 0 1 R 0 0 0 0 0 0 0 1 R 0 0 0 0 0 0 0 1
5.根据权利要求4所述的一种悬挂式低重力环境模拟系统输出反馈鲁棒H∞控制方法,其特征是:将上述线性化的系统写成标准的鲁棒H∞控制问题,
x · = A x + B 1 ω + B 2 u
z=C1x+D11ω+D12u
y=C2x+D21ω+D22u
其中z是被控输出,y是测量输出,其中D11,D12,D21,D22是零矩阵,C1是单位阵I6×6,C2是以下形式:
C 2 = 1 0 0 0 0 0 0 0 1 0 0 0 0 0 0 0 1 0
6.根据权利要求5所述的一种悬挂式低重力环境模拟系统输出反馈鲁棒H∞控制方法,其特征是:设计输出反馈鲁棒H∞控制器,具有形式
x ^ · = A k x ^ + B k y
u = C k x ^ + D k y
利用传感器测量输出作为控制器的输入,不仅能够使得系统能够快速稳定,且外部扰动ω到被控输出z的传递函数Tzw(s)的H∞范数始终满足||Tzw(s)||<γ,达到抑制干扰影响的作用。
7.根据权利要求6所述的一种悬挂式低重力环境模拟系统输出反馈鲁棒H∞控制方法,其特征是:将输出反馈鲁棒控制器设计问题转化成为LMI的求解问题,通过三步求解LMI求出针对悬挂式低重力环境模拟系统的输出反馈鲁棒H∞控制器,
(1)得到符合以下LMI的矩阵X和Y
1.
2.
3.
(2)获得满足X-Y-1=X2X2 T的矩阵X2,利用X2构成矩阵Xc
X c = X X 2 X 2 T I
(3)得到符合以下等式的LMI的矩阵K:
HXc+PXc TKQ+QTKTPXc<0
其中:
H X c = A 0 T X c + X c A 0 X c B 0 C 0 B 0 T X c - γ I D 11 T C 0 D 11 - γ I P X c = B ‾ T X c 0 D ‾ 12 T Q = C ‾ D ‾ 12 0 A 0 = A 0 0 0 , B 0 = B 1 0 , C 0 = C 1 0 B ‾ = 0 B 2 I 0 , C ‾ = 0 I C 2 0 , D 12 = 0 D 12 , D 21 = 0 D 21
输出反馈控制器(Ak,Bk,Ck,Dk)从矩阵K中可得到:
K = A k B k C k D k
8.根据权利要求7所述的一种悬挂式低重力环境模拟系统输出反馈鲁棒H∞控制方法,其特征是:选取R0=1,L=0.9,k=10,mc=mw=mmZ=1,msX=mmX=1,Tx=Ty=Tz=0.1,经过比较和筛选,将γ的取值选取为0.4,得到的控制器的结果为:
A k = - 56.2435 129.1820 0 0 0 0 - 4.1892 - 177.8201 0 0 0 0 0 0 - 55.9851 131.2972 0 0 0 0 - 4.4654 - 178.0785 0 0 0 0 0 0 - 54.8600 140.5087 0 0 0 0 - 5.6680 - 179.2037 B k = - 313.6066 0 0 24.0849 0 0 0 - 312.7948 0 0 22.6625 0 0 0 - 309.2594 0 0 16.4683
C k = - 53.1557 143.7686 0 0 0 0 0 0 - 52.8778 145.7847 0 0 0 0 0 0 - 51.6678 154.5641 D k = - 307.2503 0 0 0 - 306.4722 0 0 0 - 293.6916
CN201710418719.0A 2017-06-06 2017-06-06 一种悬挂式低重力环境模拟系统输出反馈鲁棒h∞控制方法 Active CN106980265B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710418719.0A CN106980265B (zh) 2017-06-06 2017-06-06 一种悬挂式低重力环境模拟系统输出反馈鲁棒h∞控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710418719.0A CN106980265B (zh) 2017-06-06 2017-06-06 一种悬挂式低重力环境模拟系统输出反馈鲁棒h∞控制方法

Publications (2)

Publication Number Publication Date
CN106980265A true CN106980265A (zh) 2017-07-25
CN106980265B CN106980265B (zh) 2020-06-30

Family

ID=59344763

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710418719.0A Active CN106980265B (zh) 2017-06-06 2017-06-06 一种悬挂式低重力环境模拟系统输出反馈鲁棒h∞控制方法

Country Status (1)

Country Link
CN (1) CN106980265B (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109353551A (zh) * 2018-10-29 2019-02-19 哈尔滨工业大学 重力卸荷设备动态指标的准静态测试方法
CN110045633A (zh) * 2019-04-28 2019-07-23 上海交通大学 无人机双索运输减振控制方法、系统及存储介质
CN110175409A (zh) * 2019-05-28 2019-08-27 欣旺达电子股份有限公司 重力反馈补偿方法
CN112115547A (zh) * 2020-09-09 2020-12-22 天津航天机电设备研究所 悬挂式重力补偿吊点位置确定方法
CN114185271A (zh) * 2021-11-30 2022-03-15 中国人民解放军63921部队 一种环形桁架三维随动系统及其控制方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0494125A1 (fr) * 1991-01-04 1992-07-08 Société anonyme dite: TECNOMA Appareillage de traitement du sol ou de la végétation, comprenant une rampe pouvant pivoter par rapport à des axes longitudinal et transversal
CN103466109A (zh) * 2013-09-05 2013-12-25 哈尔滨工业大学 一种空间微重力环境地面模拟实验装置
CN103482089A (zh) * 2013-10-09 2014-01-01 北京航空航天大学 一种无约束悬挂式主动重力补偿系统设计方法
CN105573297A (zh) * 2016-01-18 2016-05-11 哈尔滨工业大学 一种悬吊式恒力系统的在线故障诊断方法
CN106005497A (zh) * 2016-06-13 2016-10-12 北京航空航天大学 一种悬挂式六自由度微重力环境模拟系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0494125A1 (fr) * 1991-01-04 1992-07-08 Société anonyme dite: TECNOMA Appareillage de traitement du sol ou de la végétation, comprenant une rampe pouvant pivoter par rapport à des axes longitudinal et transversal
CN103466109A (zh) * 2013-09-05 2013-12-25 哈尔滨工业大学 一种空间微重力环境地面模拟实验装置
CN103482089A (zh) * 2013-10-09 2014-01-01 北京航空航天大学 一种无约束悬挂式主动重力补偿系统设计方法
CN105573297A (zh) * 2016-01-18 2016-05-11 哈尔滨工业大学 一种悬吊式恒力系统的在线故障诊断方法
CN106005497A (zh) * 2016-06-13 2016-10-12 北京航空航天大学 一种悬挂式六自由度微重力环境模拟系统

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
YI HUANG,等: "Robust H∞ control for spacecraft formation flying with coupled translational and rotation Dynamics", 《2016 AMERICAN CONTROL CONFERENCE (ACC)》 *
李荣,等: "基于动态输出反馈的半车主动悬架系统鲁棒控制", 《振动与冲击》 *
贾娇等: "Coutinuous Non-singular Fast Terminal Sliding Mode Control for an Active Gravity field Simulator", 《JOURNAL OF ROBOTICS》 *

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109353551A (zh) * 2018-10-29 2019-02-19 哈尔滨工业大学 重力卸荷设备动态指标的准静态测试方法
CN110045633A (zh) * 2019-04-28 2019-07-23 上海交通大学 无人机双索运输减振控制方法、系统及存储介质
CN110175409A (zh) * 2019-05-28 2019-08-27 欣旺达电子股份有限公司 重力反馈补偿方法
CN110175409B (zh) * 2019-05-28 2022-01-25 欣旺达电子股份有限公司 重力反馈补偿方法
CN112115547A (zh) * 2020-09-09 2020-12-22 天津航天机电设备研究所 悬挂式重力补偿吊点位置确定方法
CN112115547B (zh) * 2020-09-09 2022-08-16 天津航天机电设备研究所 悬挂式重力补偿吊点位置确定方法
CN114185271A (zh) * 2021-11-30 2022-03-15 中国人民解放军63921部队 一种环形桁架三维随动系统及其控制方法
CN114185271B (zh) * 2021-11-30 2024-04-09 中国人民解放军63921部队 一种环形桁架三维随动系统及其控制方法

Also Published As

Publication number Publication date
CN106980265B (zh) 2020-06-30

Similar Documents

Publication Publication Date Title
CN106980265A (zh) 一种悬挂式低重力环境模拟系统输出反馈鲁棒h∞控制方法
CN105945979B (zh) 对欠驱动二指爪机构进行柔顺控制的方法
CN103558079B (zh) 基于并联机构驱动力闭环的多自由度加载方法
CN103425100B (zh) 基于力矩平衡的机器人直接示教控制方法
CN103302667B (zh) 机器人控制方法、机器人控制装置和机器人控制系统
CN104626152B (zh) 工业机器人主动柔顺控制方法及装置
CN107121256B (zh) 一种连续在轨运动的六自由度捕获轨迹试验方法
CN105739537B (zh) 一种小天体表面附着运动主动控制方法
CN103869834B (zh) 基于经验模态法的三轴气浮台质心智能调节方法
CN103118842A (zh) 机器人、机器人的控制装置、控制方法以及控制程序
CN105345823B (zh) 一种基于空间力信息的工业机器人自由驱动示教方法
CN102736628B (zh) 一种具有环境适应性的足式机器人稳定性控制方法及系统
CN107505846B (zh) 一种空间机械臂系统抗干扰姿态协调验证装置及控制方法
CN102189550A (zh) 具有学习控制功能的机器人
CN109634100A (zh) 仿人机器人行走加速度补偿方法、装置及仿人机器人
CN104972465A (zh) 根据力而动作的机器人的机器人控制装置及机器人系统
CN110007594A (zh) 一种汽车电泳涂装输送用混联机器人的自适应鲁棒滑模控制方法
CN106200614A (zh) 一种采用控制力矩陀螺真实力矩的航天器姿控测试系统及方法
CN104809276B (zh) 一种多手指机器人动力学解析模型及其建模方法
US20230294281A1 (en) Multi-legged robot load balancing method, multi-legged robot, and storage medium
CN107161360A (zh) 空间任务可置换的自由基座运动再现跨尺度验证装置
CN105404744A (zh) 一种空间机械臂全状态动力学半物理仿真系统
CN109683480A (zh) 考虑执行器故障的非线性机械系统类固定时间控制方法
CN104682789A (zh) 一种应用于双轮机器人的pid 控制器
CN108802427A (zh) 预紧式并联六维加速度传感器及其测量和灵敏度分析方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant