CN103268067A - 一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法 - Google Patents

一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法 Download PDF

Info

Publication number
CN103268067A
CN103268067A CN 201310160984 CN201310160984A CN103268067A CN 103268067 A CN103268067 A CN 103268067A CN 201310160984 CN201310160984 CN 201310160984 CN 201310160984 A CN201310160984 A CN 201310160984A CN 103268067 A CN103268067 A CN 103268067A
Authority
CN
China
Prior art keywords
phi
centerdot
rho
omega
body series
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
CN 201310160984
Other languages
English (en)
Other versions
CN103268067B (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.)
Harbin University of Technology Satellite Technology Co.,Ltd.
Original Assignee
Harbin Institute of Technology
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 Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN201310160984.5A priority Critical patent/CN103268067B/zh
Publication of CN103268067A publication Critical patent/CN103268067A/zh
Application granted granted Critical
Publication of CN103268067B publication Critical patent/CN103268067B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法,涉及一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪方法,为解决目前涉及卫星指向跟踪控制器所用到的运动学参数设计不合理,不能保证卫星的运动路径最短,并且没有统一的适用于指向跟踪控制的运动学方程的问题。根据指向跟踪控制的要求定义目标系,并保证本体系相对于目标系的欧拉角最小;确定卫星本体系相对于目标系的欧拉角与欧拉轴以及他们在本体系中的运动学方程;确定拟四元数与拟四元数在本体系中的运动学方程;涉及控制器使卫星姿态能够跟踪目标姿态。本发明可广泛应用于卫星指向跟踪控制系统。

Description

一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法
技术领域
本发明涉及一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法。
背景技术
随着航天任务的多样化,卫星对指向跟踪技术的需求越来越明显。对于低轨地面固定目标点与运动目标点进行持续成像的卫星、对地面某一固定区域进行视频成像的视频卫星、对飞行中的导弹进行跟踪拍照的侦查卫星等都需要卫星具有快速捕获目标并对目标进行持续指向跟踪的能力。
通常情况下为了能够快速的捕获目标需要卫星能够按照最短路径运行。卫星是否能够按照最短路径运行,取决于是否能够找出描述卫星运行最短路径的参数。在以往的许多文献中,人们通过一系列的假设试图避免需找描述卫星运行最短路径的参数,通常假设卫星初始状态为三轴稳定状态,并且卫星在运行过程中一直沿着欧拉轴运动。在这些假设条件的基础上,将目标坐标系定义为相对轨道坐标系为路径最短的坐标系,这样定义是因为能够运用原有姿态参数得到运动学方程,可以避免重新推导新的运动学方程。然而,对于实际运行的卫星(敏捷卫星)来讲,这些假设的条件是苛刻的,即使能够满足这些条件,对于指向跟踪问题,卫星目标点在惯性空间一直再变化,所定义的目标系也不满足这些条件,对于指向跟踪问题,卫星目标点在惯性空间一直在变化,所定义的目标系也不满足运动的每一时刻都是保证路径最短的,这样就使得卫星跟踪过程中运动的路径不是最短的。因此有必要在没有任何假设的前提下重新定义最短路径参数(拟四元数),并推导出基于该参数的运动学方程,利用拟四元数设计控制器,使卫星姿态跟踪的路径最短,缩短控制时间。
发明内容
本发明为解决目前设计卫星指向跟踪控制器所用到的运动学参数设计不合理,不能保证卫星的运动路径最短,并且没有统一的适用于指向跟踪控制的运动学方程的问题,从而提供一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法。
一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法,它包括如下步骤:
步骤一、根据指向跟踪控制的要求定义目标系oxtytzt,并保证本体系相对于目标系oxtytzt的欧拉角最小;
步骤二、确定卫星本体系相对于目标系的欧拉轴ebt与欧拉角Φ,表达式为:
e bt = z t × z b sin Φ
Φ=acos(zt·zb)
式中,zt为目标系ozt轴方向单位矢量,zb为本体系的偏航轴方向单位矢量,ebt为本体系相对于目标系的欧拉轴矢量,Φ为本体系相对于目标系的欧拉角;
步骤三、确定欧拉轴ebt与欧拉角Φ在本体系表示的运动学方程,表达式为:
e · bt b = ω bt b tan Φ - ( z t z b ) b · ω bt b sin Φ - e bt b Φ · tan Φ
Φ · = e bt b · ω bt b
式中,
Figure BDA00003141945400024
表示
Figure BDA00003141945400025
相对于本体系的导数在本体系的分量列阵,
Figure BDA00003141945400026
为本体系相对于目标系的姿态角速度在本体系的分量列阵,
Figure BDA00003141945400027
表示本体系相对于目标系的欧拉轴矢量在本体系的分量列阵,ztzb表示矢量zt与矢量zb的并矢,
Figure BDA00003141945400028
为3×3的矩阵,表示并矢ztzb在本体系的分量形式,
Figure BDA00003141945400029
为欧拉角变化率;
步骤四、根据欧拉轴ebt与欧拉角Φ定义拟四元数ρ:
ρ = cos Φ e bt sin Φ
步骤五、根据欧拉轴ebt与欧拉角Φ的运动学方程确定拟四元数的运动学方程在本体系的表达式为:
Figure BDA000031419454000211
式中,运算符号⊙定义为:
ρ · b = - ρ 1 - ρ 2 - ρ 3 ρ 0 0 ρ 2 0 ρ 0 - ρ 1 0 0 0 ω bt b
式中,ρb=[ρ0ρ1ρ20]T
步骤六、根据步骤四定义的拟四元数ρ与步骤五得到的运动学方程设计控制器使卫星姿态能够跟踪目标姿态。
本发明实现了一种基于拟四元数为姿态参数的指向跟踪控制,能够保证卫星的运动路径最短。本发明提出的拟四元数是路径最短的姿态参数,实际应用中拟四元数容易获取。以拟四元数为姿态参数设计的指向跟踪控制器的形式简单,便于设计分析。由于拟四元数的运动学方程形式简单,以拟四元数为姿态参数设计的控制器的稳定性、鲁棒性的分析比较简单。
附图说明
图1为本发明一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法的流程图;
图2为具体实施方式一所述目标系zt轴与本体系的关系示意图;
图3为具体实施方式一所述本体系相对于目标系的姿态角速度变化曲线;图中——代表滚动轴角速度曲线,图中
Figure BDA00003141945400031
代表俯仰轴角速度曲线,图中-----代表偏航轴角速度曲线;
图4为具体实施方式一所述姿态四元数积分得到的相对于目标系的欧拉角;图中符号ΦQ表示由四元数积分得到本体系相对于目标系的欧拉角;
图5为具体实施方式一所述拟四元数积分得到的相对于目标系的欧拉角,图中符号ΦP表示由新姿态参数积分得到本体系相对于目标系的欧拉角;
图6为具体实施方式一所述姿态四元数积分得到欧拉角与拟四元数得到的欧拉角的差值,图中符号ΔΦ表示姿态四元数积分得到欧拉角与新姿态参数得到的欧拉角的差值。
具体实施方式
具体实施方式一、结合图1说明本具体实施方式。一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法,它包括如下步骤:
步骤一、根据指向跟踪控制的要求定义目标系oxtytzt,并保证本体系相对于目标坐标系oxtytzt的欧拉角最小;
步骤二、确定卫星本体系相对于目标系的欧拉轴ebt与欧拉角Φ,表达式为:
e bt = z t × z b sin Φ
Φ=acos(zt·zb)
式中,zt为目标系ozt轴方向单位矢量,zb为本体系的偏航轴方向单位矢量,ebt为本体系相对于目标系的欧拉轴矢量,Φ为本体系相对于目标系的欧拉角;
步骤三、确定欧拉轴ebt与欧拉角Φ在本体系表示的运动学方程,表达式为:
e · bt b = ω bt b tan Φ - ( z t z b ) b · ω bt b sin Φ - e bt b Φ · tan Φ
Φ · = e bt b · ω bt b
式中,
Figure BDA00003141945400043
表示相对于本体系的导数在本体系的分量列阵,
Figure BDA00003141945400045
为本体系相对于目标系的姿态角速度在本体系的分量列阵,
Figure BDA00003141945400046
表示本体系相对于目标系的欧拉轴矢量在本体系的分量列阵,ztzb表示矢量zt与矢量zb的并失,
Figure BDA00003141945400047
为3×3的矩阵,表示并矢ztzb在本体系的分量形式,
Figure BDA00003141945400048
为欧拉角变化率;
步骤四、根据欧拉轴ebt与欧拉角Φ定义拟四元数ρ:
ρ = cos Φ e bt sin Φ
步骤五、根据欧拉轴ebt与欧拉角Φ的运动学方程确定拟四元数的运动学方程在本体系的表达式为:
Figure BDA000031419454000410
式中,运算符号⊙定义为
ρ · b = - ρ 1 - ρ 2 - ρ 3 ρ 0 0 ρ 2 0 ρ 0 - ρ 1 0 0 0 ω bt b
式中,ρb=[ρ0ρ1ρ20]T
步骤六、根据步骤四定义的拟四元数ρ与步骤五得到的运动学方程设计控制器使卫星姿态能够跟踪目标姿态。
结合图1-图6进行说明本发明的详细步骤:
一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法,它包括如下步骤:
步骤一、根据指向跟踪控制的要求定义目标系oxtytzt,并保证本体系相对于目标坐标系oxtytzt的欧拉角最小;
指向跟踪控制的要求为:要求卫星的敏感轴指向目标点,而卫星绕敏感轴的转角不进行限制。为了方便说明并且不失一般性,通常将偏航轴看作敏感轴。卫星控制的目的是:控制卫星姿态使得卫星本体系与目标系重合。由于卫星绕偏航轴的转角不受限制,因此存在无穷多个目标系能够满足指向跟踪控制的要求。而实际应用中定义的目标坐标系需要满足条件:在卫星运动过程中的任意时刻,本体系与目标系之间的欧拉转角最小。因此目标坐标系定义如下:
目标坐标系oxtytzt的原点o在卫星的质心,目标系oxtytzt的ozt轴为目标点与卫星质心连线指向目标点方向的单位矢量,记为zt;目标系的oxt、oyt轴分别由本体系的滚动轴、俯仰轴绕着zt×zb方向转过Φ角得到;
其中,zb为卫星本体系偏航轴方向单位矢量,Φ为zt与zb的夹角。
步骤二、确定卫星本体系相对于目标系的欧拉轴ebt与欧拉角Φ,表达式为:
e bt = z t × z b sin Φ
Φ=acos(zt·zb)
式中,zt为目标系ozt轴方向单位矢量,zb为本体系的偏航轴方向单位矢量,ebt为本体系相对于目标系的欧拉轴矢量,Φ为本体系相对于目标系的欧拉角;
步骤三、确定欧拉轴ebt与欧拉角Φ在本体系表示的运动学方程,表达式为:
e · bt b = ω bt b tan Φ - ( z t z b ) b · ω bt b sin Φ - e bt b Φ · tan Φ
Φ · = e bt b · ω bt b
式中,
Figure BDA00003141945400054
表示相对于本体系的导数在本体系的分量列阵,
Figure BDA00003141945400056
为本体系相对于目标系的姿态角速度在本体系的分量列阵,
Figure BDA00003141945400057
表示本体系相对于目标系的欧拉轴矢量在本体系的分量列阵,ztzb表示矢量zt与矢量zb的并失,
Figure BDA00003141945400058
为3×3的矩阵,表示并矢ztzb在本体系的分量形式,
Figure BDA00003141945400059
为欧拉角变化率;
所述步骤三、确定欧拉轴ebt在本体系表示的运动学方程的过程为:
首先,对欧拉轴ebt在本体系下求导得到:
d b e bt dt = ( ω tb × z t ) × z b sin Φ - ( z t × z b ) Φ · cos Φ sin 2 Φ
式中,
Figure BDA00003141945400062
表示矢量&相对于本体系的导数,ωtb为目标系相对于本体系的姿态角速度矢量;
由于对于任意矢量a、b、c有下面的关系式成立
(a×b)×c=-c×(a×b)=-(c×b)×a
则有
d b e bt dt = z b × ( ω bt × z t ) sin Φ - e bt Φ · tan Φ
利用公式a×(b×c)=(a·c)·b-(ca)·b,得到:
d b e bt dt = ( z t · z b ) · ω bt sin Φ - ( z t z b ) · ω bt sin Φ - e bt Φ · tan Φ
式中,ztzb为矢量zt与矢量zb的并矢。带入zt·zb=cosΦ,最终得到关于欧拉轴的姿态运动学方程如下:
d b e bt dt = ω bt tan Φ - ( z t z b ) · ω bt sin Φ - e bt Φ · tan Φ
将上式写成本体系下的分量形式可以表示为
e · bt b = ω bt b tan Φ - ( z t b z b b ) · ω bt b sin Φ - e bt b Φ · tan Φ .
所述步骤三、确定欧拉角Φ在本体系表示的运动学方程的过程为:
首先,将Φ表达成zt与zb的函数的形式:
cosΦ=zt·zb
对方程两边同时求导(由于Φ是标量,可以再任意坐标系下求导,为了方便,在本体系下进行求导)得:
- Φ · sin Φ = ( ω tb × z t ) · z b
经过矢量变换,得到:
Φ · sin Φ = ( z t × z b ) ω bt
由于ebtsinΦ=zt×zb,带入上式得到关于欧拉角Φ的运动学方程:
Φ · = e bt · ω bt
将上式写成本体系下的分量形式为:
Φ · = e bt b · ω bt b .
步骤四、根据欧拉轴ebt与欧拉角Φ定义拟四元数ρ:
ρ = cos Φ e bt sin Φ
步骤五、根据欧拉轴ebt与欧拉角Φ的运动学方程确定拟四元数的运动学方程在本体系的表达式为:
Figure BDA00003141945400074
式中,运算符号⊙定义为:
ρ · b = - ρ 1 - ρ 2 - ρ 3 ρ 0 0 ρ 2 0 ρ 0 - ρ 1 0 0 0 ω bt b
式中,ρb=[ρ0ρ1ρ20]T
所述步骤五、根据欧拉轴ebt与欧拉角Φ的运动学方程确定拟四元数的运动学方程的过程为:
定义ρ0=cosΦ,ρv=ebtsinΦ,对拟四元数在本体系下进行求导,分别对ρ0与ρv进行求导,首先ρ0在本体系求导得到:
ρ · 0 = - Φ · sin Φ = - e bt · ω bt sin Φ = - ρ v · ω bt
对ρv在本体系求导进行求导得到:
d b ρ v dt = d b e bt dt sin Φ + e bt Φ · cos Φ
化简得到:
d b ρ v dt = ω bt cos Φ - ( z t z b ) · ω bt = ( ρ 0 E - z t z b ) · ω bt
将上式在本体下进行分解,由并矢的定义可知ztzb在本体系的分量为:
z t b · ( z b b ) T = 0 3 0 3 z t b
式中,03表示所有元素都为0的3维列阵;由于矢量zt在本体系下zb轴的分量为:
z t bz = z b · z t = cos Φ = ρ 0
式中,
Figure BDA00003141945400082
是一个标量,表示矢量zt在本体系的zb轴的分量;zt在另外两轴的分量由坐标系几何关系获得,表示为:
z t bx = sin α · sin Φ = - e bt by sin Φ = - ρ 2
z t by = cos α · sin Φ = e bt bx sin Φ = ρ 1
式中,
Figure BDA00003141945400085
表示矢量a$在坐标系&的#轴的分量,b表示本体系;
由上述计算获得得到方程:
ρ · b = - ρ 1 - ρ 2 - ρ 3 ρ 0 0 ρ 2 0 ρ 0 - ρ 1 0 0 0 ω bt b .
步骤六、根据步骤四定义的拟四元数ρ与步骤五得到的运动学方程设计控制器使卫星姿态能够跟踪目标姿态。
利用拟四元数参数可以得到类似于PD控制器的稳定的指向跟踪控制器,具体形式为
T c = - K p ρ v b - K d ω bt b
式中,Tc为控制卫星姿态所需的三轴指令力矩,
Figure BDA00003141945400088
Kp为3×3的对角阵,对角阵的元素代表控制器比例系数的大小,Kd为3×3的对角阵,对角阵的元素代表控制器微分系数的大小,Kp与Kd元素取值大小与经典控制理论的PD控制器参数设计方法相同。根据步骤五得到的运动学方程,可以得到该控制器是稳定的。
具体控制的实现:在每一个控制周期内,利用卫星姿态确定系统得到姿态参数ρb与卫星相对于本体系的姿态角速度
Figure BDA00003141945400089
结合Kp与Kd计算出指令力矩Tc的数值,将计算得到的数值Tc发送到执行机构,驱动执行机构动作,控制卫星能够准确的跟踪目标姿态。
具体对比实施例:结合图3-图6说明本具体实施例。
下面设计根据卫星的姿态跟踪控制系统的仿真,验证基于拟四元数描述的卫星相对于目标系的欧拉角最小,即拟四元数运动学方程是路径最短的。给定卫星本体系相对于目标系的姿态角速度变化曲线
Figure BDA000031419454000810
根据已知的姿态角速度
Figure BDA000031419454000811
在初始姿态相同的前提下,分别对姿态四元数运动学方程与基于拟四元数的运动学方程积分,可以得到两组本体系相对于目标系的欧拉角ΦQ与ΦP,姿态四元数积分得到欧拉角与新姿态参数得到的欧拉角的差值ΔΦ,其中ΔΦ=ΦQP基于拟四元数的运动学方程积分得到的欧拉角一直小于姿态四元数积分得到欧拉角,说明拟四元数描述的姿态是路径最短的。具体仿真结果为图3至图6。

Claims (6)

1.一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法,其特征在于它包括如下步骤:
步骤一、根据指向跟踪控制的要求定义目标系oxtytzt,并保证本体系相对于目标坐标系oxtytzt的欧拉角最小;
步骤二、确定卫星本体系相对于目标系的欧拉轴ebt与欧拉角Φ,表达式为:
e bt = z t × z b sin Φ
Φ=acos(zt·zb)
式中,zt为目标系ozt轴方向单位矢量,zb为本体系的偏航轴方向单位矢量,ebt为本体系相对于目标系的欧拉轴矢量,Φ为本体系相对于目标系的欧拉角;
步骤三、确定欧拉轴ebt与欧拉角Φ在本体系表示的运动学方程,表达式为:
e · bt b = ω bt b tan Φ - ( z t z b ) b · ω bt b sin Φ - e bt b Φ · tan Φ
Φ · = e bt b · ω bt b
式中,
Figure FDA00003141945300014
表示
Figure FDA00003141945300015
相对于本体系的导数在本体系的分量列阵,
Figure FDA00003141945300016
为本体系相对于目标系的姿态角速度在本体系的分量列阵,
Figure FDA00003141945300017
表示本体系相对于目标系的欧拉轴矢量在本体系的分量列阵,ztzb表示矢量zt与矢量zb的并矢,
Figure FDA00003141945300018
为3×3的矩阵,表示并矢ztzb在本体系的分量形式,
Figure FDA00003141945300019
为欧拉角变化率;
步骤四、根据欧拉轴ebt与欧拉角Φ定义拟四元数ρ:
ρ = cos Φ e bt sin Φ
步骤五、根据欧拉轴ebt与欧拉角Φ的运动学方程确定拟四元数的运动学方程在本体系的表达式为:
Figure FDA000031419453000111
式中,运算符号⊙定义为:
ρ · b = - ρ 1 - ρ 2 - ρ 3 ρ 0 0 ρ 2 0 ρ 0 - ρ 1 0 0 0 ω bt b
式中,ρb=[ρ0ρ1ρ20]T
步骤六、根据步骤四定义的拟四元数ρ与步骤五得到的运动学方程设计控制器,通过所述控制器对卫星进行指向跟踪控制。
2.根据权利要求1所述的一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法,其特征在于所述步骤一、根据指向跟踪控制的要求定义目标坐标系oxtytzt的过程为:
目标坐标系oxtytzt的原点o在卫星的质心,目标坐标系oxtytzt的ozt轴为目标点与卫星质心连线指向目标点方向的单位矢量,记为zt;目标坐标系的oxt、oyt轴分别由本体系的滚动轴、俯仰轴绕着zt×zb方向转过Φ角得到;
其中,zb为卫星本体系偏航轴方向单位矢量,Φ为zt与zb的夹角。
3.根据权利要求1或2所述的一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法,其特征在于所述步骤三、确定欧拉轴ebt在本体系表示的运动学方程的过程为:
首先,对欧拉轴ebt在本体系下求导得到:
d b e bt dt = ( ω tb × z t ) × z b sin Φ - ( z t × z b ) Φ · cos Φ sin 2 Φ
式中,
Figure FDA00003141945300023
表示矢量&相对于本体系的导数,ωtb为目标系相对于本体系的姿态角速度矢量;
由于对于任意矢量a、b、c有下面的关系式成立
(a×b)×c=-c×(a×b)=-(c×b)×a
则有
d b e bt dt = z b × ( ω bt × z t ) sin Φ - e bt Φ · tan Φ
利用公式a×(b×c)=(a·c)·b-(ca)·b,得到:
d b e bt dt = ( z t · z b ) · ω bt sin Φ - ( z t z b ) · ω bt sin Φ - e bt Φ · tan Φ
式中,ztzb为矢量zt与矢量zb的并矢;带入zt·zb=cosΦ,最终得到关于欧拉轴的姿态运动学方程如下:
d b e bt dt = ω bt tan Φ - ( z t z b ) · ω bt sin Φ - e bt Φ · tan Φ
将上式写成本体系下的分量形式可以表示为
e · bt b = ω bt b tan Φ - ( z t b z b b ) · ω bt b sin Φ - e bt b Φ · tan Φ .
4.根据权利要求3所述的一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法,其特征在于所述步骤三、确定欧拉角Φ在本体系表示的运动学方程的过程为:
首先,将Φ表达成zt与zb的函数的形式:
cosΦ=zt·zb
对方程两边同时求导得:
- Φ · sin Φ = ( ω tb × z t ) · z b
经过矢量变换,得到:
Φ · sin Φ = ( z t × z b ) ω bt
ebtsinΦ=zt×zb,带入上式得到关于欧拉角Φ的运动学方程:
Φ · = e bt · ω bt
将上式写成本体系下的分量形式为:
Φ · = e bt b · ω bt b .
5.根据权利要求1或4所述的一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法,其特征在于所述步骤五、根据欧拉轴ebt与欧拉角Φ的运动学方程确定拟四元数的运动学方程的过程为:
定义ρ0=cosΦ,ρv=ebtsinΦ,对拟四元数在本体系下进行求导,分别对ρ0与ρv进行求导,首先ρ0在本体系求导得到:
ρ · 0 = - Φ · sin Φ = - e bt · ω bt sin Φ = - ρ v · ω bt
对ρv在本体系求导进行求导得到:
d b ρ v dt = d b e bt dt sin Φ + e bt Φ · cos Φ
化简得到:
d b ρ v dt = ω bt cos Φ - ( z t z b ) · ω bt = ( ρ 0 E - z t z b ) · ω bt
将上式在本体下进行分解,由并矢的定义可知ztzb在本体系的分量为:
z t b · ( z b b ) T = 0 3 0 3 z t b
式中,03表示所有元素都为0的3维列阵;由于矢量zt在本体系下zb轴的分量为:
z t bz = z b · z t = cos Φ = ρ 0
式中,
Figure FDA00003141945300045
是一个标量,表示矢量zt在本体系的zb轴的分量;zt在另外两轴的分量由坐标系几何关系获得,表示为:
z t bx = sin α · sin Φ = - e bt by sin Φ = - ρ 2
z t by = cos α · sin Φ = e bt bx sin Φ = ρ 1
式中,
Figure FDA00003141945300048
表示矢量a$在坐标系&的#轴的分量,b表示本体系;
由上述计算获得得到方程:
ρ · b = - ρ 1 - ρ 2 - ρ 3 ρ 0 0 ρ 2 0 ρ 0 - ρ 1 0 0 0 ω bt b .
6.根据权利要求5所述的一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法,其特征在于所述步骤六、根据步骤四定义的拟四元数ρ与步骤五得到的运动学方程设计控制器的过程为:
利用拟四元数参数得到稳定的指向跟踪控制器,具体形式为:
T c = - K p ρ v b - K d ω bt b
式中,Tc为控制卫星姿态所需的三轴指令力矩,
Figure FDA000031419453000411
Kp为3×3的对角阵,对角阵的元素代表控制器比例系数的大小,Kd为3×3的对角阵,对角阵的元素代表控制器微分系数的大小,Kp与Kd元素取值大小与经典控制理论的PD控制器参数设计方法相同。
CN201310160984.5A 2013-05-03 2013-05-03 一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法 Active CN103268067B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310160984.5A CN103268067B (zh) 2013-05-03 2013-05-03 一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310160984.5A CN103268067B (zh) 2013-05-03 2013-05-03 一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法

Publications (2)

Publication Number Publication Date
CN103268067A true CN103268067A (zh) 2013-08-28
CN103268067B CN103268067B (zh) 2016-02-10

Family

ID=49011703

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310160984.5A Active CN103268067B (zh) 2013-05-03 2013-05-03 一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法

Country Status (1)

Country Link
CN (1) CN103268067B (zh)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103472849A (zh) * 2013-09-04 2013-12-25 航天东方红卫星有限公司 基于闭环模式合作目标跟踪的卫星姿态机动跟踪方法
CN103871075A (zh) * 2013-12-30 2014-06-18 华中科技大学 一种大椭圆遥感卫星地球背景相对运动估计方法
CN104656453A (zh) * 2015-03-09 2015-05-27 北京航空航天大学 一种基于非相似余度作动系统缓变故障的被动容错控制方法
CN104960674A (zh) * 2015-06-01 2015-10-07 北京控制工程研究所 一种运动目标的指向跟踪控制方法
CN105157705A (zh) * 2015-07-07 2015-12-16 西安电子工程研究所 一种半捷联雷达导引头视线角速度提取方法
CN105955031A (zh) * 2016-06-13 2016-09-21 吉林大学 非线性预测控制的fpga硬件加速控制器及其加速实现方法
CN106184819A (zh) * 2016-09-09 2016-12-07 上海航天控制技术研究所 一种姿态机动自适应轨迹规划方法
CN111319793A (zh) * 2020-02-25 2020-06-23 上海航天控制技术研究所 敏捷卫星多种工作模式姿态基准通用设计方法

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB9403644D0 (en) * 1994-02-25 1994-04-13 Advanced Robotics Res Manipulator controller
KR100480787B1 (ko) * 2001-11-27 2005-04-07 삼성전자주식회사 좌표 인터폴레이터의 키 값 데이터 부호화/복호화 방법 및 장치
CN101462598B (zh) * 2009-01-12 2010-10-13 徐国栋 一种卫星姿态定向系统及方法
CN101982732B (zh) * 2010-09-14 2012-02-01 北京航空航天大学 一种基于esoqpf和ukf主从滤波的微小卫星姿态确定方法
CN102692928B (zh) * 2012-05-31 2014-06-18 西北工业大学 基于飞行器四元数模型的控制器区域设计方法

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103472849A (zh) * 2013-09-04 2013-12-25 航天东方红卫星有限公司 基于闭环模式合作目标跟踪的卫星姿态机动跟踪方法
CN103472849B (zh) * 2013-09-04 2015-10-21 航天东方红卫星有限公司 基于闭环模式合作目标跟踪的卫星姿态机动跟踪方法
CN103871075A (zh) * 2013-12-30 2014-06-18 华中科技大学 一种大椭圆遥感卫星地球背景相对运动估计方法
CN103871075B (zh) * 2013-12-30 2015-11-18 华中科技大学 一种大椭圆遥感卫星地球背景相对运动估计方法
CN104656453A (zh) * 2015-03-09 2015-05-27 北京航空航天大学 一种基于非相似余度作动系统缓变故障的被动容错控制方法
CN104960674A (zh) * 2015-06-01 2015-10-07 北京控制工程研究所 一种运动目标的指向跟踪控制方法
CN105157705A (zh) * 2015-07-07 2015-12-16 西安电子工程研究所 一种半捷联雷达导引头视线角速度提取方法
CN105157705B (zh) * 2015-07-07 2017-12-01 西安电子工程研究所 一种半捷联雷达导引头视线角速度提取方法
CN105955031A (zh) * 2016-06-13 2016-09-21 吉林大学 非线性预测控制的fpga硬件加速控制器及其加速实现方法
CN105955031B (zh) * 2016-06-13 2018-11-06 吉林大学 非线性预测控制的fpga硬件加速控制器及其加速实现方法
CN106184819A (zh) * 2016-09-09 2016-12-07 上海航天控制技术研究所 一种姿态机动自适应轨迹规划方法
CN111319793A (zh) * 2020-02-25 2020-06-23 上海航天控制技术研究所 敏捷卫星多种工作模式姿态基准通用设计方法
CN111319793B (zh) * 2020-02-25 2022-04-22 上海航天控制技术研究所 敏捷卫星多种工作模式姿态基准通用设计方法

Also Published As

Publication number Publication date
CN103268067B (zh) 2016-02-10

Similar Documents

Publication Publication Date Title
CN103268067A (zh) 一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法
CN104527994B (zh) 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法
Lugo-Cárdenas et al. Dubins path generation for a fixed wing UAV
CN102163057B (zh) 一种自治飞艇平面路径跟踪控制方法
CN104848860B (zh) 一种敏捷卫星成像过程姿态机动规划方法
CN105116910A (zh) 一种对地面点凝视成像的卫星姿态控制方法
CN102981507B (zh) 一种软着陆自主障碍规避常推力器控制方法
CN102175260B (zh) 一种自主导航系统误差校正方法
CN104570742B (zh) 基于前馈pid控制的异面交叉快变轨道快速高精度相对指向控制方法
CN105549606A (zh) 针对失效卫星的超近距离最优防撞接近方法
CN102944241B (zh) 基于多胞型线性微分包含的航天器相对姿态确定方法
CN104281150A (zh) 一种姿态机动的轨迹规划方法
CN103914073A (zh) 基于变质心滚控模式的再入飞行器轨迹优化方法
CN102331785B (zh) 一种航天器指向约束姿态机动控制方法
Xu et al. Parameter estimation of a three-axis spacecraft simulator using recursive least-squares approach with tracking differentiator and Extended Kalman Filter
CN102004491B (zh) 一种卫星初入轨段的初始太阳捕获方法
CN105184002A (zh) 一种数传天线指向角度的仿真分析方法
Xiong et al. A two-position SINS initial alignment method based on gyro information
Wolf et al. Toward improved landing precision on Mars
CN104019818A (zh) 一种基于预测轨迹的行星导航轨道器布局优化方法
Morgan et al. Decentralized model predictive control of swarms of spacecraft using sequential convex programming
CN103950555A (zh) 超近距离的高精度相对位置保持控制方法
CN103900561A (zh) 一种空间绳系机器人中远距离逼近位置估计方法
Wang et al. Novel in-flight coarse alignment of low-cost strapdown inertial navigation system for unmanned aerial vehicle applications
CN111123961A (zh) 基于约束分析的双矢量夹角限制范围确定方法及系统

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20211221

Address after: Room 1107, 11 / F, National University Science Park, Harbin Institute of technology, No. 434, youyou street, Nangang District, Harbin City, Heilongjiang Province

Patentee after: Harbin Institute of Technology Asset Management Co.,Ltd.

Address before: 150001 No. 92 West straight street, Nangang District, Heilongjiang, Harbin

Patentee before: HARBIN INSTITUTE OF TECHNOLOGY

TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20220113

Address after: 150028 6 / F, building 1, innovation and entrepreneurship Plaza, science and technology innovation city, high tech Industrial Development Zone, Harbin City, Heilongjiang Province

Patentee after: Harbin University of Technology Satellite Technology Co.,Ltd.

Address before: Room 1107, 11 / F, National University Science Park, Harbin Institute of technology, No. 434, youyou street, Nangang District, Harbin City, Heilongjiang Province

Patentee before: Harbin Institute of Technology Asset Management Co.,Ltd.