基于等碰撞概率面法的航天器安全接近控制方法技术

针对航天器近距离操作中的安全接近控制技术中的问题，本发明专利技术提供了基于等碰撞概率面的航天器安全接近控制方法，包括以下步骤：首先建立目标航天器的轨道坐标系；在目标航天器的轨道坐标系中，构建跟踪航天器的非线性相对运动方程；采用无迹变化方法来推导跟踪航天器的非线性相对运动方程的不确定性传播；计算目标航天器和跟踪航天器之间的碰撞概率密度；计算目标航天器和跟踪航天器两个卫星之间的碰撞概率梯度也即碰撞概率梯度；最后确定最终作用在跟踪航天器上的控制力。本发明专利技术有效地解决了目前安全接近控制方法中存在的计算量大、实时性不好以及未能考虑不确定性影响等问题。

Safety Approach Control Method for Spacecraft Based on Equicollision Probability Surface Method

Aiming at the problem of safety approach control technology in spacecraft close operation, the present invention provides a safety approach control method for Spacecraft Based on equal collision probability surface, including the following steps: firstly, the orbit coordinate system of the target spacecraft is established; in the orbit coordinate system of the target spacecraft, the non-linear relative motion equation of the tracking spacecraft is constructed; and the trackless change method is adopted. The uncertainties propagation of the non-linear relative motion equation of the tracking spacecraft is deduced; the probability density of collision between the target spacecraft and the tracking spacecraft is calculated; the probability gradient of collision between the target spacecraft and the tracking spacecraft is calculated, that is, the probability gradient of collision; finally, the control force acting on the tracking spacecraft is determined. The invention effectively solves the problems of large amount of calculation, poor real-time performance and failure to consider the influence of uncertainty in the current safety approach control method.

【技术实现步骤摘要】
基于等碰撞概率面法的航天器安全接近控制方法
本专利技术涉及航天器近距离安全接近控制
，具体涉及一种基于等碰撞概率面的航天器安全接近控制方法。
技术介绍
近年来随着在轨航天器失效案例日益增多，在轨服务受到了更多的关注。航天器在轨服务对提高航天器操作能力，增强航天器适应性和可伸缩性，延长航天器寿命，节省航天器研制费用等有积极作用。近距离操作是在轨服务的重要关键技术，涉及到近距离操作的空间任务几乎都需要进行航天器相对控制，当服务航天器靠近目标时，需要保证航天器不与目标发生碰撞，因此航天器安全接近控制是近距离操作技术的关键技术之一。目前，在实现航天器安全接近的方法中，人工势函数制导方法(ArtificialPotentialFunction,APF)由于具有在复杂环境下形式简单、计算量小等特点，但近年来在空间近距离操作中得到了广泛关注。人工势函数制导方法最初源自机器人路径规划问题，IsmaelLopez和ColinR.McInnes首次将人工势函数制导方法应用到航天器自主避障的路径控制上来，在其文献中根据航天器相对运动C-W方程，将人工势函数制导方法分别应用于多个障碍物的交会和终端带约束的交会两个场景中。Hyung-ChulLim等将人工势函数与滑模控制相结合，设计了针对卫星编队飞行的控制器。EnderSt.John-Olcayto和ColinR.McInnes等人研究了在国际空间站的交会和近距离作业中，采用势函数制导的安全自主近距离机动，实现了V/R-bar方向的安全自主交会对接。ShawnB.McCamish和MarcelloRomano等人针对圆轨道上多个航天器近距离交会问题提出了一种基于LinearQuadraticRegulator(LQR)和人工势函数方法相结合的制导算法，并利用SPHERES进行地面试验，验证了所设计算法的可行性。LenelPalacios和MatteoCeriotti等利用LQR和人工势函数方法设计了一种适用于圆轨道和椭圆轨道的制导追踪算法，并利用并利用SAFE(SpaceborneAutonomousFormationFlyingExperiment)进行了验证。JosueD.Munoz和NormanG.Fitz-Coy提出了一种自适应的人工势函数制导方法，针对静态障碍物，研究了航天器近距离操作中的轨道和姿态运动快速规划，比传统人工势函数制导方法更加节省燃料。高鹏和罗建军在JosueD.Munoz和NormanG.Fitz-Coy工作的基础上，针对航天器近距离操作中的动态障碍物规避问题，研究了一种燃料较省、精度较高的规避动态障碍物的自适应人工势函数制导方法。张大伟针对非合作航天器，提出了将人工势函数与模糊控制相结合的制导方法，能够实现对动态障碍物的规避。针对APF局部极小点问题，可寻找更好的势场函数，使势场中出现极小值的概率减小；或将人工势场法和其他方法相融合，如采用沿墙跟踪方法及极限环法。鲁新军等提出了虚拟水流法，但效率不高。基于遗传算法的改进APF法实现最优路径搜索，收敛速度有待提高。为了解决实际应用中控制对象在全动态环境中的路径规划问题，殷路等提出了全动态环境中改进的势能函数构造方法，使研究对象时刻趋向与目标相同、与障碍物相悖的运动趋势。但是目前人工势函数中的势函数未考虑近距离操作中的导航不确定性和控制不确定性，而目前国内外学者普遍采用碰撞概率函数作为不确定影响下对航天器可能发生的碰撞进行预警。1997年，Chan针对空间中的两个物体，在两者位置误差互不关注的前提下，对误差协方差矩阵的可叠加性做出了验证，为碰撞概率研究奠定了基础。早期研究的航天器和空间碎片的碰撞问题主要针对典型的线性相对运动碰撞，其计算方法比较成熟。线性相对运动碰撞概率计算的基本假设为：1)相遇时间非常短(通常为几秒量级)，相对运动可以简化为线性模型；2)相对速度矢量在相遇期间保持不变，积分体近似为无限长圆柱体；3)两空间目标位置误差PDF在相遇期间保持不变。目前在大部分情况下，线性相对运动碰撞概率计算都适用。但是在近距离操作中，接近时相对速度较小，目标之间会长时间接近，接近期间相对速度的大小和方向都会发生变化，目标之间是非线性相对运动。此时线性相对运动假设的碰撞概率的描述方法和计算方法不再适用。对于非线性情况，Chan分析了线性相对运动假设成立的条件，并讨论了非线性相对碰撞概率的计算方法。Patera通过变化将相对位置误差协方差矩阵转换成三维空间中对称形式，此时平行于相对速度的一维就可以和其他两维互相解耦，然后得到某一小段事件内的碰撞概率分量，在整个事件间隔内对其积分就可以得到非线性碰撞概率值。Alfano提出了两种计算非线性相对运动情况下碰撞概率计算方法。第一种方法对线性碰撞概率计算方法进行了扩展，将碰撞管道分割为一系列相邻的圆柱体，在圆柱体内运动是近似线性的。计算每段对应的碰撞概率，然后求和。第二种方法将碰撞管道在马氏空间内进行体积有限元划分，表示为在马氏空间中建立体积有限元网格，计算每个有限元网格内的概率并求和。McKinley通过建立积分坐标系，在此坐标系中积分得到碰撞概率。针对卫星与空间绳系卫星之间的相对运动，ChobotovPatera采用一重曲线积分的方法对碰撞概率进行了计算，并对相对运动弱非线性运动时的碰撞概率进行了研究。但是，碰撞概率方法没有给出碰撞概率与碰撞参数之间的直接的和显式的联系，难以得到碰撞概率与影响因素之间的关系；而且碰撞概率法容易受到协方差不确定性的影响；而且其计算量相对于人工势函数法仍然很大。
技术实现思路
针对现有技术中存在的缺陷，针对航天器近距离操作中的安全接近控制技术中的问题，本专利技术提供了基于等碰撞概率面的航天器安全接近控制方法。为实现本专利技术之目的，采用以下技术方案予以实现：基于等碰撞概率面的航天器安全接近控制方法，包括以下步骤：(1)建立目标航天器的轨道坐标系；(2)在目标航天器的轨道坐标系中，构建跟踪航天器的非线性相对运动方程；(3)采用无迹变化方法来推导跟踪航天器的非线性相对运动方程的不确定性传播；(4)计算目标航天器和跟踪航天器之间的碰撞概率密度；(5)计算目标航天器和跟踪航天器两个卫星之间的碰撞概率梯度；(6)确定最终作用在跟踪航天器上的控制力。步骤(1)坐标系的建立方法如下：以O-XYZ表示J2000地球惯性坐标系，原点为地心，X轴指向历元J2000春分点，基本面为地球平赤道面，Z轴指向地球北极，根据右手螺旋定律由X轴与Z轴得出Y轴的方向。以o-xyz表示目标航天器的轨道坐标系，以目标航天器的质心为坐标原点，x轴由地心指向跟踪航天器的质心，z轴指向跟踪航天器轨道面法线方向，y轴由右手法则，垂直于x轴和z轴所组成的平面。rTarget表示目标航天器在J2000地球惯性坐标系下的位置矢量，且rTarget＝[X1Y1,Z1]T。rTrack表示跟踪航天器在J2000地球惯性坐标系下的位置矢量，且rTrack＝[X2,Y2,Z2]T。rLVLH表示跟踪航天器在目标航天器的轨道坐标系下的位置矢量，且rLVLH＝[x,y,z]T。vLVLH表示跟踪航天器在目标航天器的轨道坐标系下的速度矢量，且vLVLH＝[vx,vy,vz]T。步骤(2)中，跟踪航本文档来自技高网...

【技术保护点】
1.基于等碰撞概率面的航天器安全接近控制方法，其特征在于，包括以下步骤：(1)建立目标航天器的轨道坐标系；(2)在目标航天器的轨道坐标系中，构建跟踪航天器的非线性相对运动方程；(3)采用无迹变化方法来推导跟踪航天器的非线性相对运动方程的不确定性传播；(4)计算目标航天器和跟踪航天器之间的碰撞概率密度；(5)计算目标航天器和跟踪航天器两个卫星之间的碰撞概率梯度；(6)确定最终作用在跟踪航天器上的控制力。

【技术特征摘要】
1.基于等碰撞概率面的航天器安全接近控制方法，其特征在于，包括以下步骤：(1)建立目标航天器的轨道坐标系；(2)在目标航天器的轨道坐标系中，构建跟踪航天器的非线性相对运动方程；(3)采用无迹变化方法来推导跟踪航天器的非线性相对运动方程的不确定性传播；(4)计算目标航天器和跟踪航天器之间的碰撞概率密度；(5)计算目标航天器和跟踪航天器两个卫星之间的碰撞概率梯度；(6)确定最终作用在跟踪航天器上的控制力。2.根据权利要求1所述的基于等碰撞概率面的航天器安全接近控制方法，其特征在于，步骤(1)中，以O-XYZ表示J2000地球惯性坐标系，原点为地心，X轴指向历元J2000春分点，基本面为地球平赤道面，Z轴指向地球北极，根据右手螺旋定律由X轴与Z轴得出Y轴的方向；以o-xyz表示目标航天器的轨道坐标系，以目标航天器的质心为坐标原点，x轴由地心指向跟踪航天器的质心，z轴指向跟踪航天器轨道面法线方向，y轴由右手法则，垂直于x轴和z轴所组成的平面；rTarget表示目标航天器在J2000地球惯性坐标系下的位置矢量，且rTarget＝[X1Y1,Z1]T；rTrack表示跟踪航天器在J2000地球惯性坐标系下的位置矢量，且rTrack＝[X2,Y2,Z2]T；rLVLH表示跟踪航天器在目标航天器的轨道坐标系下的位置矢量，且rLVLH＝[x,y,z]T；vLVLH表示跟踪航天器在目标航天器的轨道坐标系下的速度矢量，且vLVLH＝[vx,vy,vz]T。3.根据权利要求2所述的基于等碰撞概率面的航天器安全接近控制方法，其特征在于，步骤(2)中，跟踪航天器的非线性相对运动方程，如下所示：其中：x,y,z表示目标航天器在三个方向的位置参数；表示目标航天器在三个方向的速度参数；表示目标航天器在三个方向的加速度参数；r1表示目标航天器的质心相距地心的距离；r2表示跟踪航天器的质心相距目标航天器质心的距离；μ表示地球引力常数；u＝[ux,uy,uz]T表示控制力；ω,分别表示目标航天器的转动速度和转动角速度，且如下表示：其中：a是目标航天器轨道半长轴；e是目标航天器偏心率；f是目标航天器真近点角度；假设状态向量X＝[rLVLHT,vLVLHT]T，则方程(1)可改写成如下形式Xk+1＝f(Xk,uk)(4)其中Xk+1表示第k+1步相对状态矢量；Xk表示第k步相对状态矢量；uk表示第k步输入控制状态矢量。4.根据权利要求3所述的基于等碰撞概率面的航天器安全接近控制方法，其特征在于，步骤(3)中采用无迹变化方法推导方程(4)的不确定性传播，方法如下：令L表示状态向量X的长度，N＝2L+1表示需要的采样数，给定初始采样点r(tk)(k＝1,2,...,N)，初始采样点的均值为m(t0)，方差为P(t0)；产生N个西格玛采样点和权重如下所示：其中：α,β,κ,λ是尺度参数，α>0,β>0,κ>0,λ>0...

【专利技术属性】
技术研发人员：白玉铸，陈小前，赵勇，王祎，
申请(专利权)人：中国人民解放军国防科技大学，
类型：发明
国别省市：湖南,43