法律状态公告日
法律状态信息
法律状态
2016-08-24
授权
授权
2014-10-22
实质审查的生效 IPC(主分类):G05D1/08 申请日:20140414
实质审查的生效
2014-09-17
公开
公开
技术领域
本发明涉及航天飞行器控制技术领域,具体为一种空间绳系机器人三轴主动姿态控制方法。
背景技术
空间绳系机器人是一种新型的空间机器人,主要用于捕获空间目标并进行在轨维修、在轨组装等任务。空间绳系机器人的一般架构为“空间平台-空间系绳-空间绳系机器人”,空间平台通过空间系绳释放空间绳系机器人,空间绳系机器人逼近空间目标、抓捕;空间绳系机器人上自带操作机械臂及末端操作手用于执行捕获目标及在轨服务任务。空间绳系机器人的空间绳系机器人在抓捕捕获目标前,必须根据目标状态的变化调整自身三轴姿态以便准确地确定抓捕位置进行抓捕。
传统的卫星或空间机器人的姿态控制系统主要分为被动姿态控制稳定系统和主动姿态控制系统;被动姿态稳定控制系统主要利用重力梯度或卫星的自旋特性实现被动姿态稳定控制,传统的主动姿态控制系统主要包括喷气三轴控制系统、飞轮三轴姿态控制系统及磁力矩器三轴稳定系统。对于卫星的姿态控制方法,申请号:201310036385.2的专利公开了一种卫星轨道和姿态控制方法,该方法适用于在轨喷气过程有大干扰力矩的卫星,在确定轨道干扰力矩的前提下提出了姿态喷气控制方式和角动量交换控制的方法;授权公告号:CN100451898C的专利提出一种微小卫星的姿态控制方法及系统,该发明采用以磁力矩器主动磁控为主,结合重力梯度杆与动量轮偏置稳定的控制系统作为卫星姿态稳定平台;授权公告号:CN101554926B公开了一种航天器姿态控制系统及方法,该发明所述的控制系统仅有一个偏置动量轮、一套三轴磁力矩器及存载算法的姿态控制器,该方法包括速率阻尼控制步骤、初始捕获控制步骤及稳定控制步骤;授权公告号:CN101934863B公开了一种基于磁力矩器和飞轮的卫星姿态全方位控制方法,该发明涉及一种利用磁力矩器和飞轮完成卫星入轨阶段全方位姿态控制方法,解决了现有卫星姿态全方位控制技术可靠性低、寿命短的问题。可见传统卫星姿态控制系统基本采用传统执行机构(如推力器、飞轮、磁力矩器等) 来实现卫星的三轴姿态稳定控制。
空间绳系机器人作为一种新型的空间机器人,空间系绳的存在导致其结构不同于传统的卫星或空间机器人,因此其姿态控制器的设计也与传统的卫星或空间机器人不同。对于空间绳系机器人姿态控制系统,申请号:201210540460.1公开了一种可移动系绳点的空间绳系机器人的逼近姿态协调控制方法,该方法设计了系绳控制机构,通过改变系绳点的位置改变拉力的方向产生需要的姿态控制力矩;申请号:201310018221.7公开了一种空间绳系机器人目标抓捕后复合体姿态协调控制方法,该方法引进了系绳拉力,设计了系绳拉力和推力器的协调姿态控制方法。但这两个专利对于协调姿态控制方法的实现需要对系绳上拉力保持恒定或进行控制,较难实现。
发明内容
技术方案
本发明的目的在于克服姿态协调控制过程中的系绳拉力控制问题,针对空间绳系机器人的姿态控制问题,提出一种该类机器人的三轴姿态控制方法,该方法的特点是根据目标的姿态利用空间系绳及反作用轮对空间绳系机器人的姿态实施三轴姿态协调控制,该方法结合了被动姿态控制方法和主动姿态控制策略,空间系绳中的张力被动产生,无需控制,该方法适用于空间绳系机器人位于空间平台与地心连线时对空间绳系机器人的三轴姿态控制,该方法的主要步骤包括根据空间绳系机器人的轨道动力学特性计算空间绳系机器人在平衡状态(空间绳系机器人位于空间平台与地心连线上)空间系绳应具有的标称张力,根据空间绳系机器人姿态运动学与动力学方程确定控制力矩变量,建立空间绳系机器人姿态动力学的状态方程和输出方程并根据反馈线性化控制规律计算出三个方向的姿态控制力矩,根据控制力矩与空间系绳连接点位置、反作用轮转速之间的关系得出相应的空间系绳连接点位置及反作用轮的转动角速度。
本发明的技术方案为:
所述一种空间绳系机器人三轴主动姿态控制方法,其特征在于:采用以下步骤:
步骤1:计算空间绳系机器人三个方向的姿态控制力矩ux、uy及uz:
其中x1=φ、x3=θ、x5=ψ、x7=Ωr,φ、θ及ψ为空间绳系机器人的三轴姿态角,Ix、Iy、Iz分别为空间绳系机器人转动惯量,Ωr为反作用轮转动角速度,Ir为反作用轮的转动惯量,nx和nz为系数,Ω为空间绳系机器人的轨道角速度,
步骤2:根据步骤1得到的空间绳系机器人三个方向的姿态控制力矩ux、uy及uz,由公式
得到空间系绳连接点位置xL、yL及反作用轮的转动角速度Ωr实现空间绳系机器人三轴姿态的主动控制;其中Mdx、Mdy和Mdz分别为空间绳系机器人三个轴向的干扰力矩,Mx、My和Mz为空间绳系机器人所受到的力矩,T为空间系绳上的张力,T0为空间绳系机器人在平衡状态时,空间系绳应具有的标称张力,T0=3Ω2mrlmr空间绳系机器人的质量,l为空间系绳的长度;所述平衡状态指空间绳系机器人位于空间平台与地心连线上。
有益效果
本发明提出的空间绳系机器人三轴姿态控制方法,根据目标的姿态利用空间系绳及反作用轮对空间绳系机器人的姿态实施三轴姿态协调控制,该方法结合了被动姿态 控制方法和主动姿态控制策略,空间系绳中的张力被动产生,无需控制,该方法适用于空间绳系机器人位于空间平台与地心连线时对空间绳系机器人的三轴姿态控制。
附图说明
图1为本发明所应用的空间绳系机器人结构及各部分相对位置图。
图2为本发明所应用空间绳系机器人的空间系绳在空间绳系机器人上连接点移动示意图。
图3为本发明所应用空间绳系机器人轨道面内姿态变化时空间系绳长度变化图。
图4为本发明控制流程图。
其中,1表示空间平台,2表示空间系绳,3表示空间绳系机器人,4表示空间平台运动轨道,5表示空间绳系机器人运动轨道,6表示空间系绳在空间绳系机器人上的连接点,7表示空间系绳连接点移动平面
图1中oxyz为空间绳系机器人轨道坐标系,ocxcyczc为空间绳系机器人轨道坐标系,空间平台与空间绳系机器人的连线(空间系绳)方向通过地心。
图2中oc′xc′yc′zc′为空间绳系机器人本体坐标系,反作用轮安装在空间绳系机器人的oc′zc′轴上,空间系绳在空间绳系机器人上的连接点6可以在空间绳系机器人连接点移动平面7上移动。
图3中θ表示空间绳系机器人在其运行轨道面内俯仰姿态角,O表示初始空间系绳连接点位置,L表示在控制过程中空间系绳连接点位置,空间系绳名义长度变化量可以表示为|LL′|-|OOc′|。
具体实施方式
下面结合附图对本发明的实施方式进行说明,本实施例中空间绳系机器人位于空间平台和地心连线上。
在分析过程中,首先由空间绳系机器人的轨道动力学特性给出空间绳系机器人在平衡状态(空间绳系机器人位于空间平台与地心连线上)空间系绳应具有的标称张力T0;
在空间绳系机器人轨道坐标系oxyz中,空间绳系机器人的运动可以由Hill方程 (式(1)~(3))表示:
式(1)~(3)中x、y及z分别为空间绳系机器人在空间绳系机器人轨道坐标系oxyz(x轴为目标轨道切线方向,z轴沿地球半径方向指向地心,y轴垂直与x轴和z轴,并且满足右手定则)中的位置,及分别为空间绳系机器人在空间绳系机器人轨道坐标系oxyz中的速度,及分别为空间绳系机器人在空间绳系机器人轨道坐标系oxyz中的加速度,mr为空间绳系机器人的质量,Fx、Fy及Fz分别为空间绳系机器人上所受的空间绳系机器人轨道坐标系oxyz下的三个方向的外力,Ω为空间绳系机器人的轨道角速度,可以由式(4)所表示。
式(4)中μ=3.986005×1014m3/s2,R0为空间绳系机器人的轨道半径。
空间绳系机器人的平衡状态为:x=y=0,z=±l(l为空间系绳的长度),及在这种情况下由式(1)~(3)可以得出:
Fx=0,Fy=0,Fz=T0≈3Ω2mrl (5)
从而得到空间绳系机器人在平衡状态时空间系绳上的张力T0。
其次根据空间绳系机器人姿态运动学与动力学方程确定控制力矩变量:
设空间绳系机器人轨道坐标系为ocxcyczc,本体坐标系为oc′xc′yc′zc′,ocxczc为空间绳系机器人运行的轨道平面,坐标轴ocxc指向空间绳系机器人轨道切向方向,坐标轴oczc指向地心,空间系绳张力在空间绳系机器人轨道坐标系中可以表示为系绳连接点L在空间绳系机器人本体坐标系oc′xc′yc′zc′中的位置可以表示为 则空间系绳张力产生的对空间绳系机器人的控制力矩QT可以表示为:
式(6)中为空间绳系机器人轨道坐标系ocxcyczc到本体坐标系oc′xc′yc′zc′的转化矩阵,可以表示为:
式(7)中φ为空间绳系机器人绕ocxc旋转的滚转姿态角,θ为绕ocyc旋转的俯仰姿态角,ψ为绕oczc旋转的偏航姿态角。则式(6)可以写为:
根据欧拉转动顺序“3-2-1”,将空间绳系机器人的空间旋转角速度ω在本体坐标系oc′xc′yc′zc′下的分量ωx、ωy及ωz用旋转欧拉角φ、θ及ψ表示得到空间绳系机器人的姿态运动学方程为:
设空间绳系机器人的动量矩为H,M为空间绳系机器人所受到的外力矩(包括控制力矩和干扰力矩),根据动量矩定理,满足以下关系式:
式(12)中
设空间绳系机器人的惯量矩阵
若选取oc′xc′、oc′yc′及oc′zc′为空间绳系机器人的主轴量轴,则Ixy=0、Iyz=0、Ixz=0, 此时空间绳系机器人的动量矩可以表示为:
式(15)中Ir为安装在oc′zc′轴上反作用轮的转动惯量,Ωr为反作用轮转动角速度。
将式(15)代入式(12)即可得到空间绳系机器人的姿态动力学方程:
根据空间绳系机器人复合运动关系,空间旋转角速度ω等于空间绳系机器人本体坐标系oc′xc′yc′zc′相对于空间绳系机器人质心轨道坐标系ocxcyczc的旋转角速度ωr与质心轨道坐标系ocxcyczc相对于惯性坐标系的牵连角速度矢量ωe之和。
ω=ωr+ωe (17)
将式(17)投影至空间绳系机器人本体坐标系oc′xc′yc′zc′上有:
式(18)中
在小角度假设条件下,即:|φ|1rad、|θ|1rad和|ψ|1rad,式(18)可以写为:
将式(19)代入式(16)并忽略二次项即得空间绳系机器人姿态动力学方程的最终表达形式:
式(20)~(22)中Mx=QTx+Mdx、My=QTy+Mdy及其中Mdx、Mdy及Mdz分别为空间绳系机器人三个轴向的干扰力矩,而QTx、QTy及QTz分别确定为空间绳系机器人三个轴向力矩控制变量。那么在实际控制中就需要直接计算空间绳系机器人三个轴向力矩控制变量。
所以建立空间绳系机器人姿态动力学的状态方程和输出方程并根据反馈线性化控制规律计算出三个方向的姿态控制力矩:
将式(20)~(22)中相应变量写为状态变量的形式即设:x1=φ、x3=θ、x5=ψ、x7=Ωr及u=[ux uy uz]T,其中ux=QTx、uy=QTy及uz=QTz,则空间绳系机器人姿态动力学方程用状态方程形式表示为:
设状态变量X=[x1 x2 x3 x4 x5 x6 x7]T,系统输出变量Y=[φ θ ψ]T,则系统状态方程和输出方程可以分别写为:
Y=GX (31)
由于该系统为非线性系统,所以式(30)及(31)中矩阵A不是唯一的,这里给出一个矩阵A的数学表达:
式(30)及(31)中,B及G是唯一确定的,d为系统的干扰,它们可以表示为:
对输出变量Y=[φ θ ψ]T求二阶时间导数并结合空间绳系机器人姿态动力学方程得:
利用“输入—输出”反馈线性化的思想设计控制律:
式(35)~(37)所设计的控制律中
将所设计的控制律式(35)~(37)代入式(34)中得:
式(38)~(40)中eφ=φ-φd,eθ=θ-θd,eψ=ψ-ψd;k1、k2、k3、k4、k5及k6为正常数。
式(35)~(37)所设计的控制律中所计算出的ux、uy及uz即为空间绳系机器人三个轴向的姿态控制力矩。
在得到空间绳系机器人三个轴向的姿态控制力矩后,要转化为实际的控制量,即空间系绳连接点位置、反作用轮转速,所以下面根据控制力矩与空间系绳连接点位置、反作用轮转速之间的关系得出相应的空间系绳连接点位置及反作用轮的转动角速度:
由式(8)及空间绳系机器人姿态动力学方程式(20)~(22)得出空间绳系机器人所受的外力矩为:
Mx=ux+Mdx=-sinφcosθTzL+cosφcosθTyL+Mdx (41)
My=uy+Mdy=-sinθTzL-cosφcosθTxL+Mdy (42)
xL、yL及zL分别为系绳连接点在oc′xc′、oc′yc′及oc′zc′轴向的移动量,一般情况下,空间系绳在空间绳系机器人上的连接点只能在一个平面内移动(即朝两个方向移动),另外一个方向的移动量是固定不变的,如果设zL是固定不变的,则系绳连接点在oc′xc′yc′zc′上的坐标在ocxcyczc中可以表示为:
由于空间系绳在空间绳系机器人上连接点的移动及空间绳系机器人姿态的变化可以导致空间系绳的名义长度(空间平台质心到空间绳系机器人质心长度)由|zL|变为|-sinθxL+sinφcosθyL+cosφcosθzL|,设空间系绳的名义长度为l,则空间系绳上的张力可以表示为:
式(45)中为空间系绳名义长度变化加速度,对|-sinθxL+sinφcosθyL+cosφcosθzL|求二阶导数得到:
在控制过程中可以实时测量得到空间绳系机器人姿态角,姿态角速度可以通过对姿态角的差分得到,姿态角加速度可以通过对姿态角速度的差分得到,因此由式(41)~(43)、式(45)及(46)可以得到关于xL、yL及Ωr的微分方程,解此微分方程即得xL、yL及Ωr。
机译: 运动和姿态感应系统,例如用于用于感测空间中刚性物体的姿态的蜂窝电话具有三轴电磁罗盘,可提供与电子设备姿态变化相关的信号
机译: 一种远程手术机器人的控制方法,涉及将输入设备的输入转换为机械臂的坐标系,该坐标系局部位于公差范围内的笛卡尔坐标系/非笛卡尔坐标系内
机译: 正交三轴机器人和正交三轴机器人的控制方法