CN107292445A - 一种空间非合作目标位姿预测方法 - Google Patents
一种空间非合作目标位姿预测方法 Download PDFInfo
- Publication number
- CN107292445A CN107292445A CN201710518136.5A CN201710518136A CN107292445A CN 107292445 A CN107292445 A CN 107292445A CN 201710518136 A CN201710518136 A CN 201710518136A CN 107292445 A CN107292445 A CN 107292445A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mover
- predicted
- msubsup
- 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.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q10/00—Administration; Management
- G06Q10/04—Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
Landscapes
- Engineering & Computer Science (AREA)
- Business, Economics & Management (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Strategic Management (AREA)
- Human Resources & Organizations (AREA)
- Economics (AREA)
- General Physics & Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Development Economics (AREA)
- Geometry (AREA)
- Game Theory and Decision Science (AREA)
- Evolutionary Computation (AREA)
- Computer Hardware Design (AREA)
- Entrepreneurship & Innovation (AREA)
- Marketing (AREA)
- Operations Research (AREA)
- Quality & Reliability (AREA)
- Tourism & Hospitality (AREA)
- General Business, Economics & Management (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
一种空间非合作目标位姿预测方法,包括以下步骤:步骤一、设计自回归高斯过程模型,建立自回归高斯过程多步预测的表达式;步骤二、对非合作目标的位置进行预测:根据轨迹三个方向的运动是相互独立的,将轨迹写为x,y,z三个独立变量,然后分别通过对三个变量进行高斯过程回归,用历史的位置进行未来位置的预测;步骤三、对非合作目标的姿态进行预测:将姿态看作分别绕三个轴相互独立转动的运动,使用欧拉角分别表示绕ZYX顺序转动的目标姿态,对未来某一时刻的欧拉角进行预测,得到未来某一时刻的姿态。本发明能够进行目标运动的长周期预测,且只需要少量数据即能够完成计算,实现简单方便。
Description
技术领域
本发明属于非合作目标位姿预测领域,具体涉及一种空间非合作目标位姿预测方法。
背景技术
针对目前太空垃圾数量增加导致轨道资源减少的问题,现有的研究主要集中于两种清理太空垃圾的方式[1]。第一种方式是使用空间机器人对太空垃圾进行抓捕,另外一种方式是使用微小卫星对太空垃圾进行抓捕并在带回大气层的过程中烧毁。这两种方法,都会存在一个估计和预测非合作目标未来运动的问题,对于这个问题,现有研究的主要思想是首先将非合作目标转化为合作目标,然后根据目标已知的模型对目标的位姿进行预测,具体来说就是使用传感器测量获得非合作目标的位姿,完成非合作目标动力学参数的辨识,根据所辨识的非合作目标动力学模型,进而完成非合作目标的位姿预测和控制。
文献[2-3]使用卡尔曼滤波器进行非合作目标惯性参数辨识,但是该方法只能够进行短周期的运动预测。F.Aghili基于激光雷达对恶劣光照条件的影响较为鲁棒这个优点,使用最近点迭代(ICP)算法对激光雷达获得的点云数据进行非合作目标的重构,并构建卡尔曼滤波器(KF)与最近点迭代(ICP)组成的闭环系统,通过卡尔曼滤波器对目标的状态和惯性参数进行估计。这样做的好处在于:首先加快了算法的收敛速度,其次即使当传感器暂时失去信号,系统仍然可以继续正常工作[4]。Ulrich等针对卡尔曼滤波不能进行长期预测的缺点,提出了一种预测时间长达100秒的长期预测,并验证了其可行性[5]。
以上针对非合作目标位姿预测的研究主要存在以下两个问题。第一个是以上方法都是基于将非合作目标转变为合作目标的思想提出的,即首先对非合作目标进行动力学参数辨识,将其转化为合作目标后再进行运动状态预测,然而需要指出的是,空间中实际的非合作目标大多没有先验信息,不能满足上述方法中能够给出仅动力学参数未知的动力学模型假设,因此上述方法不能完美解决所有非合作目标运动预测的问题。第二,上述方法多数采用卡尔曼滤波对运动状态进行预测,只能进行单步、短期的预测,而不能进行多步、长期的预测。
针对上述两个缺点,需要设计一种新的非合作目标位姿预测方法,这种方法不需要进行目标的动力学参数辨识,且能对目标位姿进行长期预测。
参考文献
[1]A.Flores-Abad,O.Ma,K.Pham,S.Ulrich.A review of space roboticstechnologies for on-orbit servicing,Progress in Aerospace Sciences[J].2014,68:1–26.
[2]Lichter,M.D.,Dubowsky,S.:State,Shape and Parameter Estimation ofSpace Objects from Range Images,IEEE International Conference on Robotics andAutomation(ICRA 2004),New Orleans,LA,April 2004.
[3]Greenspan,M.,Shang,L.,Jasiobedzki,P.:Efficient Tracking with theBounded Hough Transform,2004IEEE Computer Society Conference on ComputerVision and Pattern Recognition(CVPR’04),Volume 1,pp.520-527.
[4]Aghili F,Kuryllo M,Okouneva G,et al.Fault-Tolerant Position/Attitude Estimation of Free-Floating Space Objects Using a Laser Range Sensor[J].IEEE Sensors Journal,2011,11(1):176-185.
[5]Hillenbrand U,Lampariello R.Motion and parameter estimation of afree-floating space object from range data for motion prediction[C].8thInternational Symposium on Artificial Intelligence,Robotics,and Automation inSpace.2005.
发明内容
本发明的目的在于针对上述现有技术中的缺陷,提供一种空间非合作目标位姿预测方法,适用范围广,通过高斯过程回归进行空间非合作目标多步以及长期预测。
为了实现上述目的,本发明采用的技术方案包括以下步骤:
步骤一、设计自回归高斯过程模型,建立自回归高斯过程多步预测的表达式;
步骤二、对非合作目标的位置进行预测:
根据轨迹三个方向的运动是相互独立的,将轨迹写为x,y,z三个独立变量,然后分别通过对三个变量进行高斯过程回归,用历史的位置进行未来位置的预测;
步骤三、对非合作目标的姿态进行预测:
将姿态看作分别绕三个轴相互独立转动的运动,使用欧拉角分别表示绕ZYX顺序转动的目标姿态,对未来某一时刻的欧拉角进行预测,得到未来某一时刻的姿态。
所述步骤一自回归高斯过程多步预测的表达式按照以下步骤进行建立:
由均值函数和协方差函数表示高斯过程:f(x)~GP(m(x),k(x,x′));
上式中,m(x)是高斯过程的均值函数,k(x,x′)是高斯过程的协方差函数;
假设为输入数据,为输出数据,对于一个有噪声的数据集,观测模型为:
yi=f(xi)+ωi;
式中:为均值为零,协方差为的高斯白噪声,那么yi与yj之间的协方差写为:
其中:δij是克罗内克函数,当i=j时δij=1,否则,δij=0;
k(xi,xj)=<φ(xi),φ(xj)>是基于非线性映射φ的协方差函数,即机器学习领域的核函数;
将yi与yj之间的协方差关系式表示为矩阵的形式:
上式中,y为输出向量y=[y1…yn]T,K为核矩阵,矩阵元素分别为:[Kij]=k(xi,xj);
在新的输入为x*的条件下,新的输出y*表示为:
新的均值函数为:
使用这个均值作为新数据的预测值,而y*的协方差函数为:
上式中,是已有数据和新数据x*之间的协方差向量,[k*]i=k(x*,xi);
自回归高斯过程多步预测的表达式为:
所述的步骤二对非合作目标的位置进行预测时,对核函数中的超参数进行确定。通过对数边际最大似然对核函数中的超参数进行确定,具体为:给出对数边际最大似然函数并对其求关于超参数的偏导,取使得偏导数等于零时的值作为超参数的值,即完成了超参数的确定。
所述的步骤二按照以下公式对三个变量进行高斯过程回归:
当x,y,z的均值不为零时,给出t+h时刻
根据上式,用历史的位置进行未来位置的预测;通过调节h进行不同周期的预测。
所述的步骤三按照以下公式对非合作目标的姿态进行预测:
当θ,ψ的均值不为零时,给出t+h时刻
通过上式对欧拉角进行预测,即得到空间非合作目标未来某一时刻的姿态。
与现有技术相比,本发明具有如下的有益效果:高斯过程能够看作是具有联合高斯分布的随机变量集合,针对现有非合作目标位姿预测方法无法进行长周期预测、适用的对象有限等缺点,本发明使用自回归高斯过程回归对非合作目标的位置和姿态分别进行学习和预测,借助历史运动信息满足了给出目标仅动力学参数未知的动力学模型非合作目标位姿预测需求。相比于目前普遍使用的卡尔曼滤波方法来说,本发明能够进行目标运动的长周期预测,且只需要少量数据即能够完成计算,实现过程简单方便,能够有效进行在线实施。
附图说明
图1轨迹Ⅰ及其预测轨迹图,“+”表示历史轨迹,“*”表示本发明预测出的轨迹;
图2轨迹Ⅱ及其预测轨迹图,“+”表示历史轨迹,“*”表示本发明预测出的轨迹;
图3轨迹Ⅲ及其预测轨迹图,“+”表示历史轨迹,“*”表示本发明预测出的轨迹;
图4预测轨迹Ⅳ和测量轨迹之间的对比图,“+”表示测量轨迹,“*”表示预测轨迹。
具体实施方式
下面结合附图对本发明做进一步的详细说明。
如图1所示场景,假设非合作目标的运动从下面轨迹中进行采样:
并且在采样中具有噪声,假设从1-10秒的20个数据点是历史运动数据,使用这20个点对11-16秒的20个数据点的位置进行预测。
在此次预测中使用的核函数为平方指数协方差函数,而似然函数使用高斯似然,对协方差函数存在的2个超参数和似然函数的1个超参数使用最大对数边际似然的方法进行计算。
可以得到:hypxcov=[4.2065,4.3682],hypxlik=-2.3028,
hypycov=[4.4451,5.0067],hypylik=-2.3023,
hypzcov=[3.0992,5.2432],hypzlik=-2.2427。
其中cov下标表示协方差函数的超参数,lik下标表示似然函数的超参数。
然后通过公式进行位置的预测:
结果如下表所示:
t | X | Y | Z |
11.0 | 22.0 | 33.0 | 38.3 |
11.2 | 22.5 | 33.7 | 40.6 |
11.5 | 23.0 | 34.5 | 43.0 |
11.7 | 23.5 | 35.3 | 45.4 |
12.0 | 24.0 | 36.1 | 47.9 |
12.3 | 24.6 | 36.9 | 50.5 |
12.5 | 25.1 | 37.7 | 53.1 |
12.8 | 25.6 | 38.4 | 55.8 |
13.1 | 26.1 | 39.2 | 58.5 |
13.3 | 26.6 | 40.0 | 61.2 |
13.6 | 27.1 | 40.8 | 64.0 |
13.8 | 27.7 | 41.6 | 66.9 |
14.1 | 28.2 | 42.3 | 69.8 |
14.4 | 28.7 | 43.1 | 72.7 |
14.6 | 29.2 | 43.9 | 75.6 |
14.9 | 29.7 | 44.7 | 78.7 |
15.2 | 30.2 | 45.4 | 81.7 |
15.4 | 30.7 | 46.2 | 84.8 |
15.7 | 31.2 | 47.0 | 87.9 |
16.0 | 31.7 | 47.8 | 91.0 |
其中t为预测的时刻,X,Y,Z分别为对应个时刻所预测的x,y,z的坐标值。结果如图4所示,图中能够看到测量到的数据与预测的数据基本重合,说明预测的结果准确、可信。同理可以对目标姿态进行预测,这里不再赘述。
Claims (6)
1.一种空间非合作目标位姿预测方法,其特征在于,包括以下步骤:
步骤一、设计自回归高斯过程模型,建立自回归高斯过程多步预测的表达式;
步骤二、对非合作目标的位置进行预测:
根据轨迹三个方向的运动是相互独立的,将轨迹写为x,y,z三个独立变量,然后分别通过对三个变量进行高斯过程回归,用历史的位置进行未来位置的预测;
步骤三、对非合作目标的姿态进行预测:
将姿态看作分别绕三个轴相互独立转动的运动,使用欧拉角分别表示绕ZYX顺序转动的目标姿态,对未来某一时刻的欧拉角进行预测,得到未来某一时刻的姿态。
2.根据权利要求1所述空间非合作目标位姿预测方法,其特征在于,所述步骤一自回归高斯过程多步预测的表达式按照以下步骤进行建立:
由均值函数和协方差函数表示高斯过程:f(x)~GP(m(x),k(x,x′));
上式中,m(x)是高斯过程的均值函数,k(x,x′)是高斯过程的协方差函数;
假设为输入数据,为输出数据,对于一个有噪声的数据集,观测模型为:
yi=f(xi)+ωi;
式中:为均值为零,协方差为的高斯白噪声,那么yi与yj之间的协方差写为:
<mrow>
<mi>cov</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>i</mi>
</msub>
<mo>,</mo>
<msub>
<mi>y</mi>
<mi>j</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>k</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mi>j</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mi>&sigma;</mi>
<mi>&omega;</mi>
<mn>2</mn>
</msubsup>
<msub>
<mi>&delta;</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>;</mo>
</mrow>
其中:δij是克罗内克函数,当i=j时δij=1,否则,δij=0;
k(xi,xj)=<φ(xi),φ(xj)>是基于非线性映射φ的协方差函数,即机器学习领域的核函数;
将yi与yj之间的协方差关系式表示为矩阵的形式:
上式中,y为输出向量y=[y1 … yn]T,K为核矩阵,矩阵元素分别为:[Kij]=k(xi,xj);
在新的输入为x*的条件下,新的输出y*表示为:
新的均值函数为:
使用这个均值作为新数据的预测值,而y*的协方差函数为:
上式中,是已有数据和新数据x*之间的协方差向量,[k*]i=k(x*,xi);
自回归高斯过程多步预测的表达式为:
<mrow>
<msub>
<mover>
<mi>y</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>h</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>t</mi>
</msub>
<mo>,</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>2</mn>
</mrow>
</msub>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mi>M</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>.</mo>
</mrow>
3.根据权利要求2所述空间非合作目标位姿预测方法,其特征在于:所述的步骤二对非合作目标的位置进行预测时,对核函数中的超参数进行确定。
4.根据权利要求3所述空间非合作目标位姿预测方法,其特征在于,通过对数边际最大似然对核函数中的超参数进行确定,具体为:给出对数边际最大似然函数并对其求关于超参数的偏导,取使得偏导数等于零时的值作为超参数的值,即完成了超参数的确定。
5.根据权利要求2所述空间非合作目标位姿预测方法,其特征在于,所述的步骤二按照以下公式对三个变量进行高斯过程回归:
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>h</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>2</mn>
</mrow>
</msub>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mi>M</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
<mrow>
<msub>
<mover>
<mi>y</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>h</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>t</mi>
</msub>
<mo>,</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>2</mn>
</mrow>
</msub>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mi>M</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
1
<mrow>
<msub>
<mover>
<mi>z</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>h</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>z</mi>
<mi>t</mi>
</msub>
<mo>,</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>2</mn>
</mrow>
</msub>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mi>M</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
当x,y,z的均值不为零时,给出t+h时刻
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>m</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mo>*</mo>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>K</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mo>*</mo>
</msub>
<mo>,</mo>
<mi>X</mi>
<mo>)</mo>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>K</mi>
<mi>X</mi>
</msub>
<mo>+</mo>
<msubsup>
<mi>&sigma;</mi>
<mi>&omega;</mi>
<mn>2</mn>
</msubsup>
<mi>I</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mi>m</mi>
<mo>(</mo>
<mi>X</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
<mrow>
<msub>
<mover>
<mi>y</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>m</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mo>*</mo>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>K</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mo>*</mo>
</msub>
<mo>,</mo>
<mi>Y</mi>
<mo>)</mo>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>K</mi>
<mi>Y</mi>
</msub>
<mo>+</mo>
<msubsup>
<mi>&sigma;</mi>
<mi>&omega;</mi>
<mn>2</mn>
</msubsup>
<mi>I</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Y</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mi>m</mi>
<mo>(</mo>
<mi>Y</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
<mrow>
<msub>
<mover>
<mi>z</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>m</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>Z</mi>
<mo>*</mo>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>K</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>Z</mi>
<mo>*</mo>
</msub>
<mo>,</mo>
<mi>Z</mi>
<mo>)</mo>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>K</mi>
<mi>Z</mi>
</msub>
<mo>+</mo>
<msubsup>
<mi>&sigma;</mi>
<mi>&omega;</mi>
<mn>2</mn>
</msubsup>
<mi>I</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>Z</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mi>m</mi>
<mo>(</mo>
<mi>Z</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
根据上式,用历史的位置进行未来位置的预测;通过调节h进行不同周期的预测。
6.根据权利要求2所述空间非合作目标位姿预测方法,其特征在于,所述的步骤三按照以下公式对非合作目标的姿态进行预测:
<mrow>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>h</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>&theta;</mi>
<mi>t</mi>
</msub>
<mo>,</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>2</mn>
</mrow>
</msub>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mi>M</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
<mrow>
<msub>
<mover>
<mi>&psi;</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>h</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>&psi;</mi>
<mi>t</mi>
</msub>
<mo>,</mo>
<msub>
<mi>&psi;</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>&psi;</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>2</mn>
</mrow>
</msub>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<msub>
<mi>&psi;</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mi>M</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
当θ,ψ的均值不为零时,给出t+h时刻
<mrow>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>m</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&theta;</mi>
<mo>*</mo>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>K</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&theta;</mi>
<mo>*</mo>
</msub>
<mo>,</mo>
<mi>&theta;</mi>
<mo>)</mo>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>K</mi>
<mi>&theta;</mi>
</msub>
<mo>+</mo>
<msubsup>
<mi>&sigma;</mi>
<mi>&omega;</mi>
<mn>2</mn>
</msubsup>
<mi>I</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>&theta;</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mi>m</mi>
<mo>(</mo>
<mi>&theta;</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
<mrow>
<msub>
<mover>
<mi>&psi;</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mi>h</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>m</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&psi;</mi>
<mo>*</mo>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>K</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&psi;</mi>
<mo>*</mo>
</msub>
<mo>,</mo>
<mi>&psi;</mi>
<mo>)</mo>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>K</mi>
<mi>&psi;</mi>
</msub>
<mo>+</mo>
<msubsup>
<mi>&sigma;</mi>
<mi>&omega;</mi>
<mn>2</mn>
</msubsup>
<mi>I</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>&psi;</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mi>m</mi>
<mo>(</mo>
<mi>&psi;</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
通过上式对欧拉角进行预测,即得到空间非合作目标未来某一时刻的姿态。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710518136.5A CN107292445A (zh) | 2017-06-29 | 2017-06-29 | 一种空间非合作目标位姿预测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710518136.5A CN107292445A (zh) | 2017-06-29 | 2017-06-29 | 一种空间非合作目标位姿预测方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107292445A true CN107292445A (zh) | 2017-10-24 |
Family
ID=60098589
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710518136.5A Pending CN107292445A (zh) | 2017-06-29 | 2017-06-29 | 一种空间非合作目标位姿预测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107292445A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109164816A (zh) * | 2018-07-25 | 2019-01-08 | 西北工业大学 | 一种控制器故障和饱和特性的非合作目标姿态跟踪控制方法 |
CN109885073A (zh) * | 2019-01-15 | 2019-06-14 | 西北工业大学 | 一种针对空间非合作目标自由漂浮运动状态的预测方法 |
CN112318509A (zh) * | 2020-10-30 | 2021-02-05 | 东南大学 | 一种空间机器人高斯过程轨迹跟踪控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101733746A (zh) * | 2009-12-22 | 2010-06-16 | 哈尔滨工业大学 | 空间机器人非合作目标自主识别与捕获方法 |
CN104048675A (zh) * | 2014-06-26 | 2014-09-17 | 东南大学 | 一种基于高斯过程回归的组合导航系统故障诊断方法 |
-
2017
- 2017-06-29 CN CN201710518136.5A patent/CN107292445A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101733746A (zh) * | 2009-12-22 | 2010-06-16 | 哈尔滨工业大学 | 空间机器人非合作目标自主识别与捕获方法 |
CN104048675A (zh) * | 2014-06-26 | 2014-09-17 | 东南大学 | 一种基于高斯过程回归的组合导航系统故障诊断方法 |
Non-Patent Citations (6)
Title |
---|
WEIZHONG YAN;HAI QIU;YA XUE: "Gaussian Process for Long-Term Time-Series Forecasting", 《IEEE》 * |
乔少杰,金琨等: "一种基于高斯混合模型的轨迹预测算法", 《软件学报》 * |
姚春晓: "关于一类具有特殊协方差函数的高斯过程的极大似然估计方", 《中国优秀硕士学位论文全文数据库 基础科学辑》 * |
张博: "基于高斯过程回归的日最高气温研究", 《中国优秀硕士学位论文全文数据库 基础科学辑》 * |
李军,张友鹏: "基于高斯过程的混沌时间序列单步与多步预测", 《物理学报》 * |
魏喜庆: "航天器相对导航中的非线性滤波问题研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109164816A (zh) * | 2018-07-25 | 2019-01-08 | 西北工业大学 | 一种控制器故障和饱和特性的非合作目标姿态跟踪控制方法 |
CN109164816B (zh) * | 2018-07-25 | 2021-09-14 | 西北工业大学 | 一种控制器故障和饱和特性的非合作目标姿态跟踪控制方法 |
CN109885073A (zh) * | 2019-01-15 | 2019-06-14 | 西北工业大学 | 一种针对空间非合作目标自由漂浮运动状态的预测方法 |
CN109885073B (zh) * | 2019-01-15 | 2021-11-09 | 西北工业大学 | 一种针对空间非合作目标自由漂浮运动状态的预测方法 |
CN112318509A (zh) * | 2020-10-30 | 2021-02-05 | 东南大学 | 一种空间机器人高斯过程轨迹跟踪控制方法 |
CN112318509B (zh) * | 2020-10-30 | 2022-04-29 | 东南大学 | 一种空间机器人高斯过程轨迹跟踪控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109885883B (zh) | 一种基于gk聚类算法模型预测的无人车横向运动的控制方法 | |
Ko et al. | GP-UKF: Unscented Kalman filters with Gaussian process prediction and observation models | |
Sack et al. | A comparison of methods for line extraction from range data | |
CN111983926B (zh) | 一种最大协熵扩展椭球集员滤波方法 | |
CN106338919A (zh) | 基于增强学习型智能算法的无人艇航迹跟踪控制方法 | |
CN107292445A (zh) | 一种空间非合作目标位姿预测方法 | |
CN110640736A (zh) | 用于智能制造的机械臂运动规划方法 | |
Xie et al. | Dual-channel and bidirectional neural network for hypersonic glide vehicle trajectory prediction | |
CN102981160B (zh) | 一种确定空中目标航迹的方法及装置 | |
CN110209180A (zh) | 一种基于HuberM-Cubature卡尔曼滤波的无人水下航行器目标跟踪方法 | |
CN111309035A (zh) | 多机器人协同移动与动态避障方法、装置、设备及介质 | |
Zhang et al. | Piecewise optimal trajectories of observer for bearings-only tracking by quantization | |
Ikram et al. | Real time hand gesture recognition using leap motion controller based on CNN-SVM architechture | |
Lin et al. | A novel robust algorithm for position and orientation detection based on cascaded deep neural network | |
CN112379350A (zh) | 智能车辆毫米波雷达多目标跟踪方法、装置及设备 | |
Ge et al. | Tracking video target via particle filtering on manifold | |
CN111931368A (zh) | 一种基于gru粒子滤波的uuv目标状态估计方法 | |
Li et al. | An intelligence image processing method of visual servo system in complex environment | |
CN101635028A (zh) | 一种图像检测方法及装置 | |
CN113763434B (zh) | 一种基于卡尔曼滤波多运动模型切换的目标轨迹预测方法 | |
Sun et al. | Performance evaluation for shape estimation of extended objects using a modified Hausdorff distance | |
CN113483769B (zh) | 基于粒子滤波器的车辆自定位方法、系统、设备和介质 | |
Chen et al. | Research on adaptive Monte Carlo location method based on fusion posture estimation | |
Zhang et al. | The research for a kind of information fusion model based on BP neural network with multi position sources and big data selection | |
Huang et al. | Circle detection and fitting using laser range finder for positioning system |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20171024 |
|
RJ01 | Rejection of invention patent application after publication |