本发明总体而言涉及航天器姿态控制技术领域,具体而言,涉及一种基于四元数的时间最优的卫星姿态快速机动方法。
背景技术:
随着现代卫星技术的不断发展,卫星在各个领域得到了广泛的应用。这其中,科学探测卫星占据了很大比例。科学探测卫星的一个重要作用是对宇宙空间的探索,例如对宇宙射线等爆发源的观测。在太空中,一旦发现了诸如爆发源之类的观测目标,需要尽快将探测器指向观测目标。由于宇宙射线等观测目标大多属于暂现源信号,因此需要卫星通过快速姿态机动迅速地指向爆发源观测目标,其姿态机动时间的长短直接决定了科学观测任务完成的效果,甚至决定了任务的成败。这对卫星姿态机动的快速性提出了很高的要求。
目前常用的卫星姿态快速机动算法主要基于欧拉轴进行的各种路径规划算法,但卫星的姿态机动并不局限于某一个欧拉轴,而是一个空间轴的机动,传统的姿态机动算法无法兼顾时间最优及轨迹最优的双重需求。
技术实现要素:
本发明的任务是提供一种基于四元数的时间最优的卫星姿态快速机动方法,通过该方法,可以满足姿态快速机动的需求,从而尽可能快地将探测器定向到观测目标以完成观测。
根据本发明,该任务通过一种基于四元数的时间最优的卫星姿态快速机动方法来解决,该方法包括下列步骤:
根据初始姿态机动四元数和目标姿态机动四元数确定姿态机动空间轴和姿态机动角;
根据所述姿态机动角确定角速度;以及
基于所述角速度确定四元数机动轨迹。
在本发明的一个优选方案中规定,根据初始姿态机动四元数和目标姿态机动四元数确定姿态机动空间轴和姿态机动角包括:
根据初始姿态四元数qint和目标姿态四元数qend计算出误差四元数qe:
若q0e<0,则:qe=[-q0e-q1e-q2e-q3e]t;
将误差四元数表示成由标量和三维矢量组成的形式:
确定机动的空间角
在本发明的另一优选方案中规定,根据所述姿态机动角确定角速度包括:
如果
其中:
如果
其中:
其中ωmax为最大机动限幅角速度,dωmax最大机动角加速度。
在本发明的又一优选方案中规定,基于所述角速度确定四元数机动轨迹包括:
根据所述角速度,实时地计算出旋转空间角e(θ),包括:
如果
其中:
如果
其中:
实时地计算出相比于初始姿态四元数qint的误差四元数:
根据qint、dqe实时地计算出姿态机动过程中惯性系下姿态四元数q:
q=qint·dqe。
本发明至少具有下列有益效果:本发明针对卫星空间轴姿态机动,对姿态四元数进行了时间最优的轨迹规划,满足了应用卫星对姿态快速机动的需求;本发明提出的技术方案通过了地面仿真验证,机动过程中,姿态四元数按照规划的最优时间进行轨迹机动,保证了卫星姿态机动的快速性需求。
附图说明
下面结合附图参考具体实施例来进一步阐述本发明。
图1示出了根据本发明的空间轴机动轨迹规划示意图;
图2示出了本发明的姿态四元数时间最优路径规划示意图;
图3示出了在具体实施例中应用的根据本发明的姿态四元数时间最优路径规划示意图;
图4(a)示出了在具体实施例中应用的根据本发明的快速机动算法仿真得出的姿态四元数的机动轨迹;
图4(b)示出了在具体实施例中应用的根据本发明的快速机动算法仿真得出的机动过程中卫星角速度变化曲线;
图4(c)示出了在具体实施例中应用的根据本发明的快速机动算法仿真得出的机动过程中卫星角速度变化曲线细节图;
图5(a)示出了未采用本发明提出的方法仿真得到的姿态四元数的机动轨迹;
图5(b)示出了未采用本发明提出的方法仿真得到的机动过程中卫星角速度变化曲线;以及
图5(c)示出了未采用本发明提出的方法仿真得到的机动过程中卫星角速度变化曲线细节图。
具体实施方式
应当指出,各附图中的各组件可能为了图解说明而被夸大地示出,而不一定是比例正确的。在各附图中,给相同或功能相同的组件配备了相同的附图标记。
在本发明中,除非特别指出,“布置在…上”、“布置在…上方”以及“布置在…之上”并未排除二者之间存在中间物的情况。此外,“布置在…上或上方”仅仅表示两个部件之间的相对位置关系,而在一定情况下、如在颠倒产品方向后,也可以转换为“布置在…下或下方”,反之亦然。
在本发明中,各实施例仅仅旨在说明本发明的方案,而不应被理解为限制性的。
在本发明中,除非特别指出,量词“一个”、“一”并未排除多个元素的场景。
在此还应当指出,在本发明的实施例中,为清楚、简单起见,可能示出了仅仅一部分部件或组件,但是本领域的普通技术人员能够理解,在本发明的教导下,可根据具体场景需要添加所需的部件或组件。
在此还应当指出,在本发明的范围内,“相同”、“相等”、“等于”等措辞并不意味着二者数值绝对相等,而是允许一定的合理误差,也就是说,所述措辞也涵盖了“基本上相同”、“基本上相等”、“基本上等于”。
另外,本发明的各方法的步骤的编号并未限定所述方法步骤的执行顺序。除非特别指出,各方法步骤可以以不同顺序执行。
下面根据两个实施例进一步阐述本发明。
实施例一
本发明实施例提供的一种基于四元数时间最优轨迹规划的卫星姿态快速机动算法包括:
步骤一、已知:
姿态机动前的初始姿态四元数为:
qint=[q0intq1intq2intq3int]t
姿态机动后的目标姿态四元数为:
qend=[q0endq1endq2endq3end]t
根据初始姿态四元数和目标姿态四元数计算出误差四元数:
若q0e<0,则:qe=[-q0e-q1e-q2e-q3e]t
根据姿态四元数的定义可知,四元数由标量和三维矢量组成,标量代表欧拉轴转角,三维矢量代表欧拉轴方向,因此,误差四元数可表示为:
可以得出机动的空间角及旋转空间轴如下所示:
步骤二、根据步骤一求出的空间角
空间轴机动轨迹规划示意图如图1,其中ωmax为最大机动限幅角速度,dωmax最大机动角加速度,dωmax由卫星惯量和执行机构所能提供的最大力矩共同决定。
(1)若
其中:
(2)若
其中:
步骤三、提出了确定四元数机动轨迹的方法,主要包括以下几个步骤:
步骤3.1、根据步骤二中的角速度规划结果,实时计算出旋转空间角e(θ):
(1)若
其中:
(2)若
其中:
上式中,由此可以实时计算出旋转空间角e(θ)。
步骤3.2、实时计算出相比于初始姿态四元数qint的误差四元数:
根据qint、dqe实时计算出姿态机动过程中惯性系下姿态四元数q:q=qint·dqe
实时获得了机动过程中的姿态四元数,便获得了四元数的轨迹规划路线,从而实现了卫星姿态的快速机动,如图2所示。
实施例二
本实例针对某型号卫星,描述本发明实例的具体实施方式。
以某科学探测卫星为例,该卫星的主要功能是探测宇宙中的x射线,当发现目标源时,要求卫星通过姿态机动快速将安装于卫星本体上的高精度载荷探测器对准目标源,因此对卫星姿态机动的快速性提出了很高的要求。
本发明实施例提供的一种基于四元数时间最优的轨迹规划卫星姿态快速机动算法包括:
步骤一、已知姿态机动前的初始姿态四元数和目标姿态四元数分别为:
qint=[1000]t
可以计算出初始姿态四元数和终止姿态四元数的误差四元数:
由于q0e<0,故:
由于:
可以得出机动的空间角和旋转空间轴如下:
步骤二、对机动轴进行角速度时间最优轨迹规划:
由步骤一求得机动空间角
由于
其中:
步骤三、提出了确定四元数机动轨迹的方法,主要包括以下几个步骤:
步骤3.1、根据步骤二中的角速度规划结果,实时计算出旋转空间角e(θ):
步骤3.2、实时计算出相比于初始姿态四元数qint的误差四元数:
根据qint、dqe实时计算出姿态机动过程中惯性系下姿态四元数q:
q=qint·dqe=dqe
即
实时获得了机动过程中的姿态四元数,便获得了四元数的轨迹规划路线,图4(a)为姿态四元数的机动轨迹,图4(b)和图4(c)分别为机动过程中卫星的姿态角速度变化曲线和细节图,从图上可以看出机动开始96s后角速率控制精度优于0.001°/s。
图5(a)-(c)为未采用本发明所用方法仿真得出的曲线,图5(a)为姿态四元数的机动轨迹,图5(b)和图5(c)分别为机动过程中卫星的姿态角速度变化曲线和细节图,从图上可以看出,四元数没有轨迹规划,卫星的姿态加速度需要在机动开始190s后才能达到角速率控制精度优于0.001°/s。
本发明至少具有下列有益效果:本发明针对卫星空间轴姿态机动,对姿态四元数进行了时间最优的轨迹规划,满足了应用卫星对姿态快速机动的需求;本发明提出的技术方案通过了地面仿真验证,机动过程中,姿态四元数按照规划的最优时间进行轨迹机动,保证了卫星姿态机动的快速性需求。
虽然本发明的一些实施方式已经在本申请文件中予以了描述,但是本领域技术人员能够理解,这些实施方式仅仅是作为示例示出的。本领域技术人员在本发明的教导下可以想到众多的变型方案、替代方案和改进方案而不超出本发明的范围。所附权利要求书旨在限定本发明的范围,并藉此涵盖这些权利要求本身及其等同变换的范围内的方法和结构。