[go: up one dir, main page]

CN106482896A - A kind of contactless factor of inertia discrimination method of arbitrary shape rolling satellite - Google Patents

A kind of contactless factor of inertia discrimination method of arbitrary shape rolling satellite Download PDF

Info

Publication number
CN106482896A
CN106482896A CN201610858914.0A CN201610858914A CN106482896A CN 106482896 A CN106482896 A CN 106482896A CN 201610858914 A CN201610858914 A CN 201610858914A CN 106482896 A CN106482896 A CN 106482896A
Authority
CN
China
Prior art keywords
lambda
equation
matrix
quaternion
constant
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
Application number
CN201610858914.0A
Other languages
Chinese (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.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
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 Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201610858914.0A priority Critical patent/CN106482896A/en
Publication of CN106482896A publication Critical patent/CN106482896A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01MTESTING STATIC OR DYNAMIC BALANCE OF MACHINES OR STRUCTURES; TESTING OF STRUCTURES OR APPARATUS, NOT OTHERWISE PROVIDED FOR
    • G01M1/00Testing static or dynamic balance of machines or structures
    • G01M1/10Determining the moment of inertia

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种任意形状翻滚卫星的非接触式惯量系数辨识方法,选取三个主频率构造含有待定参数的三角函数作为姿态动力学方程的近似解析解,并使用这些待定参数代替系统变量表征系统的状态,并利用线性最小方差估计方法进行辨识。翻滚卫星的姿态四元数可以通过现有的技术手段进行测量,随着观测量的增加,估计精度越来越高。利用这些待定参数的值,本方法直接推算出翻滚卫星的惯性参数,即主转动惯量之间的比值。相比于以往的常值估计法,本方法不限于轴对称目标的参数估计,对任意形状的翻滚目标的主转动惯量之间的比值均可进行辨识。

The invention discloses a non-contact inertia coefficient identification method for tumbling satellites with arbitrary shapes. Three main frequencies are selected to construct trigonometric functions containing undetermined parameters as the approximate analytical solution of the attitude dynamic equation, and these undetermined parameters are used to replace the system variable representation The state of the system is identified using the linear minimum variance estimation method. The attitude quaternion of the tumbling satellite can be measured by existing technical means, and with the increase of observations, the estimation accuracy is getting higher and higher. Using the values of these undetermined parameters, this method directly calculates the inertial parameters of the rolling satellite, that is, the ratio between the main moments of inertia. Compared with the previous constant value estimation method, this method is not limited to the parameter estimation of axisymmetric targets, and can identify the ratio between the principal moments of inertia of rolling targets with arbitrary shapes.

Description

一种任意形状翻滚卫星的非接触式惯量系数辨识方法A non-contact inertial coefficient identification method for arbitrarily shaped tumbling satellites

技术领域technical field

本发明属于翻滚目标的姿态估计及参数辨识领域,涉及航天领域的空间在轨服务技术,具体涉及一种任意形状翻滚卫星的非接触式惯量系数辨识方法。The invention belongs to the field of attitude estimation and parameter identification of tumbling targets, relates to space on-orbit service technology in the aerospace field, and in particular to a non-contact inertia coefficient identification method for tumbling satellites with arbitrary shapes.

背景技术Background technique

航天器在轨服务的对象多种多样,其中动力失效的卫星或空间碎片占据很大比例。由于失去了动力控制,失效卫星在初始角速度及干扰力矩的作用下一般会陷入绕惯性主轴自由慢翻滚状态,若要对其进行近距离交会、逼近乃至抓捕,必须对其姿态变化规律进行预判,然后选择合适的接近角度靠近,以避免碰撞而导致装置损坏。Spacecraft serve a variety of objects in orbit, among which power-failed satellites or space debris occupy a large proportion. Due to the loss of power control, the failed satellite will generally fall into a state of free and slow rolling around the main axis of inertia under the action of the initial angular velocity and disturbance torque. If it is to rendezvous, approach or even capture it at close range, it must predict the law of its attitude change. Judgment, and then choose a suitable approach angle to avoid collision and damage to the device.

为了对翻滚目标未来较长时间的运动状态进行精确预测,以制定更合理的抓捕时机和抓捕路径,必须在抓捕之前使用非接触式的方法对翻滚目标的惯性参数进行准确的辨识。这对于节省抓捕所耗费的时间和燃料、提高抓捕成功率是十分必要的。In order to accurately predict the motion state of the tumbling target for a long time in the future, and to formulate a more reasonable capture timing and capture path, it is necessary to use a non-contact method to accurately identify the inertial parameters of the tumbling target before capture. This is very necessary for saving the time and fuel spent in capturing and improving the success rate of capturing.

对于大部分失效卫星来说由于燃料消耗或结构的损坏等可能会使转动惯量发生变化。在现有技术下利用立体视觉设备或激光测距仪可以在不接触的情况下对未知卫星的姿态信息进行离散测量,但是,在非接触的情况下对卫星的惯性参数进行精确辨识极其困难。目前最常用的参数辨识方法是使用卡尔曼滤波器将其转动惯量作为状态变量之一进行递推拟合,但精度很低,而且需要给定足够精确的角速度测量初值才能保证算法收敛。有文献提出使用常值参数设计滤波器进行辨识,但仅适用于翻滚目标为对称刚体的特殊情况。实际应用中多在抓捕后使用接触的方法对翻滚卫星的转动惯量进行测量,这样虽然简化了任务过程,但会增加额外的能量消耗。For most invalid satellites, the moment of inertia may change due to fuel consumption or structural damage. Under the existing technology, stereo vision equipment or laser range finder can be used to discretely measure the attitude information of unknown satellites without contact, but it is extremely difficult to accurately identify the inertial parameters of satellites without contact. At present, the most commonly used parameter identification method is to use the Kalman filter to recursively fit its moment of inertia as one of the state variables, but the accuracy is very low, and it is necessary to give a sufficiently accurate initial value of angular velocity measurement to ensure the convergence of the algorithm. Some literatures propose to use constant parameters to design filters for identification, but it is only applicable to the special case that the tumbling target is a symmetrical rigid body. In practical applications, the contact method is often used to measure the moment of inertia of the tumbling satellite after capture. Although this simplifies the task process, it will increase additional energy consumption.

发明内容Contents of the invention

本发明的目的在于提供一种任意形状翻滚卫星的非接触式惯量系数辨识方法,以克服上述现有技术存在的缺陷,本发明直接推算出翻滚卫星的惯性参数,即主转动惯量之间的比值。相比于以往的常值估计法,本方法不限于轴对称目标的参数估计,对任意形状的翻滚目标的主转动惯量之间的比值均可进行辨识。The purpose of the present invention is to provide a non-contact inertia coefficient identification method for tumbling satellites with arbitrary shapes, so as to overcome the above-mentioned defects in the prior art. The present invention directly calculates the inertia parameters of tumbling satellites, that is, the ratio between the main moments of inertia . Compared with the previous constant value estimation method, this method is not limited to the parameter estimation of axisymmetric targets, and can identify the ratio between the principal moments of inertia of rolling targets with arbitrary shapes.

为达到上述目的,本发明采用如下技术方案:To achieve the above object, the present invention adopts the following technical solutions:

一种任意形状翻滚卫星的非接触式惯量系数辨识方法,包括如下步骤:A non-contact inertia coefficient identification method for tumbling satellites with arbitrary shapes, comprising the following steps:

1)通过近似方法建立翻滚目标四元数λ的运动方程的近似解;1) establish the approximate solution of the motion equation of the rolling target quaternion λ by an approximate method;

2)通过近似解提取常值参数作为系统的状态量x;2) Extract the constant parameter as the state quantity x of the system through the approximate solution;

3)构造扩展卡尔曼滤波器;3) Construct an extended Kalman filter;

4)通过卡尔曼滤波器得到系统的状态量的估计值,并采用估计值估计翻滚卫星的惯性参数。4) Obtain the estimated value of the state quantity of the system through the Kalman filter, and use the estimated value to estimate the inertial parameters of the rolling satellite.

进一步地,步骤1)具体为:Further, step 1) is specifically:

1-1)建立翻滚目标的姿态四元数的运动学模型:1-1) Establish the kinematics model of the attitude quaternion of the rolling target:

其中,λ0123为翻滚目标的本体主轴坐标系相对于惯性坐标系的姿态四元数四个分量,ωxyz为目标的角速度在本体坐标系中的投影;Among them, λ 0 , λ 1 , λ 2 , λ 3 are the four components of the attitude quaternion of the main axis coordinate system of the rolling target relative to the inertial coordinate system, and ω x , ω y , ω z are the angular velocity of the target in the body coordinates projections in the system;

1-2)忽略高频小量,得到翻滚目标的角速度近似解:1-2) Neglecting the small amount of high frequency, the approximate solution of the angular velocity of the rolling target is obtained:

其中,ωxmymzm分别为本体主轴坐标系三个坐标轴方向上的角速度分量的最大值,t为时间,为待辨识的常值参数之一,εxyz均为该坐标轴方向上的高阶无穷小量;Among them, ω xm , ω ym , ω zm are the maximum values of the angular velocity components in the directions of the three coordinate axes of the principal axis coordinate system of the body respectively, t is the time, is one of the constant parameters to be identified, and ε x , ε y , ε z are all high-order infinitesimal quantities in the direction of the coordinate axis;

1-3)使用含有三个特征频率的正弦函数构造描述姿态运动的四元数微分方程的近似解,四元数λ=[λ0 λ1 λ2 λ3]T的解的具体形式为:1-3) Use the sine function containing three characteristic frequencies to construct the approximate solution of the quaternion differential equation describing the attitude motion, the specific form of the solution of the quaternion λ=[λ 0 λ 1 λ 2 λ 3 ] T is:

λ=A4×6ξ (3)λ=A 4×6 ξ (3)

其中A4×6为4行6列的常数矩阵,且where A 4×6 is a constant matrix with 4 rows and 6 columns, and

其中,θ也是待辨识的常值参数;Among them, θ is also a constant parameter to be identified;

1-4)将系统的微分方程转化为代数方程,将式(2)与式(3)同时代入式(1),使用三角函数运算规则合并相同频率项,由三角函数的正则性可知,若等式(1)成立,须令各频率之前的系数均为零,则得到一个由56个算术方程组成的方程组:1-4) Transform the differential equation of the system into an algebraic equation, substitute formula (2) and formula (3) into formula (1) at the same time, and use trigonometric function operation rules to combine the same frequency items. From the regularity of trigonometric functions, if Equation (1) is established, and the coefficients before each frequency must be zero, then an equation system consisting of 56 arithmetic equations is obtained:

其中a为矩阵A4×6按行展开成向量后生成的行向量,为由θ以及ωxm,ωym,ωzm决定的常系数矩阵,其各项的具体形式由式(3)推导得到,下标表示矩阵维数,考虑到系统的初值λ(0),将上式扩展为:Where a is the row vector generated after the matrix A 4×6 is expanded into a vector by row, for the reason The constant coefficient matrix determined by θ and ω xm , ω ym , ω zm , the specific form of each item is derived from formula (3), and the subscript indicates the dimension of the matrix. Considering the initial value λ(0) of the system, the upper expands to:

其中,其中常数矩阵D′的值由D′a=λ(0)推得:Among them, the value of the constant matrix D' is deduced by D'a=λ(0):

式(4)是约束数大于变量数的超定方程组,使用最小二乘准则求得a,及θ的最小二乘解,得到四元数λ关于时间t的近似解,即姿态四元数随时间变化的近似方程,也就是翻滚目标的姿态运动的近似方程。Equation (4) is an overdetermined equation system with the number of constraints greater than the number of variables, using the least squares criterion to obtain a, And the least squares solution of θ, the approximate solution of the quaternion λ about time t is obtained, that is, the approximate equation of the attitude quaternion changing with time, that is, the approximate equation of the attitude motion of the rolling target.

进一步地,步骤2)具体为:Further, step 2) is specifically:

实际观测量η为观测坐标系相对于惯性系的四元数,它与λ之间的关系为:The actual observation value η is the quaternion of the observation coordinate system relative to the inertial system, and the relationship between it and λ is:

η=λομη=λομ

其中“ο”表示四元数乘法运算;μ为观测坐标系与本体主轴坐标系之间的姿态四元数;Among them, "ο" represents the quaternion multiplication operation; μ is the attitude quaternion between the observation coordinate system and the main axis coordinate system of the body;

由于四元数乘法不涉及高次项运算,且μ为常数,故η各项均为λ各项的线性组合,由式(3)可知,观测量η同样具有周期性质,即有:Since the quaternion multiplication does not involve high-order term operations, and μ is a constant, the items of η are linear combinations of the items of λ. It can be seen from formula (3) that the observed quantity η also has periodic properties, that is:

η=B4×6ξ (5)η=B 4×6 ξ (5)

其中B为满足Aξ=Bξομ的常数矩阵,将矩阵B按行来展开得到行向量b24×1,并考虑到待辨识的常值参数及θ,共同组成了系统的常值的状态量:Where B is a constant matrix satisfying Aξ=Bξομ, expand the matrix B by row to obtain a row vector b 24×1 , and consider the constant parameter to be identified and θ, together constitute the constant state quantity of the system:

其中,b,θ,均为待辨识的常值参数。Among them, b, θ, are constant parameters to be identified.

进一步地,步骤3)具体为:Further, step 3) is specifically:

系统的观测方程为The observation equation of the system is

h(x)=ηh(x)=η

将h相对于状态量x求偏导数得到观测敏感度矩阵:Calculate the partial derivative of h relative to the state quantity x to obtain the observation sensitivity matrix:

由于系统的状态量均为常值参数,故状态转移矩阵Φ为:Since the state quantities of the system are constant parameters, the state transition matrix Φ is:

Φ=Ι14×14 (7)Φ=Ι 14×14 (7)

其中,I14×14为14×14的单位矩阵;Wherein, I 14×14 is an identity matrix of 14×14;

由干扰力矩引起的状态量的误差认为是高斯分布的白噪声,则系统过程噪声的方差矩阵Qk定义为:The error of the state quantity caused by the disturbance torque is considered to be white noise of Gaussian distribution, then the variance matrix Q k of the system process noise is defined as:

Qk=σ2Ι14×14 (8)Q k = σ 2 Ι 14×14 (8)

其中,σ2为过程噪声的分布方差;Among them, σ2 is the distribution variance of the process noise;

将式(6)-(8)代入卡尔曼滤波器的一般方程,即得到非对称翻滚目标参数辨识的步骤,构造出由待辨识参数作为状态量构成的广义卡尔曼滤波器。Substituting equations (6)-(8) into the general equation of the Kalman filter is the step of identifying the parameters of the asymmetric tumbling target, and constructing a generalized Kalman filter composed of the parameters to be identified as state variables.

进一步地,步骤4)具体为:Further, step 4) is specifically:

通过卡尔曼滤波器得到状态量x的估计值后,将估计值代入式(4)并求最小二乘解,即得到矩阵D以及角速度参数ωxm,ωym及ωzm的估计值,并进一步求解得到惯量参数的估计值::After the estimated value of the state quantity x is obtained through the Kalman filter, the estimated value is substituted into formula (4) and the least square solution is obtained, that is, the estimated value of the matrix D and the angular velocity parameters ω xm , ω ym and ω zm is obtained, and further Solving for an estimate of the inertia parameter:

其中,px,py,pz为待辨识的转动惯量比值参数,K为角速度的椭圆函数所对应的第一类完全椭圆积分系数。Among them, p x , p y , p z are the moment of inertia ratio parameters to be identified, and K is the first kind of complete elliptic integral coefficient corresponding to the elliptic function of angular velocity.

与现有技术相比,本发明具有以下有益的技术效果:Compared with the prior art, the present invention has the following beneficial technical effects:

(1)该方法使用三个正弦函数近似姿态四元数的运动规律,不局限于特定的解的形式,可以证明该近似方法在所有运动状态下均能取得足够高的精度,因此该方法对目标形状没有限制,适用于任意非对称形状的翻滚目标的参数辨识。(2)该方法用常量参数代替变量参数作为系统的状态参量,使得标称状态下状态参量相对于时间的偏导数为零,当观测的时间间隔较大时,可以显著减小使用数值积分计算的预测值的误差,从而提高惯量参数的估计精度。(3)由于方程具有线性形式,在特征频率θ和的初始值给定较为精确的情况下,对其他初值的精确度没有任何要求,避免了由于初值精度太低而导致的滤波发散现象,提高了惯量参数估计的成功率。使用快速傅里叶变换的数值方法得到θ和的初值,能够保证其精度符合要求。(1) This method uses three sine functions to approximate the motion law of the attitude quaternion, and is not limited to a specific solution form. It can be proved that the approximation method can achieve high enough accuracy in all motion states. There is no restriction on the shape of the target, and it is suitable for parameter identification of tumbling targets with arbitrary asymmetric shapes. (2) This method uses constant parameters instead of variable parameters as the state parameters of the system, so that the partial derivatives of the state parameters with respect to time in the nominal state are zero. When the time interval of observations is large, it can be significantly reduced. The error of the predicted value can improve the estimation accuracy of inertia parameters. (3) Since the equation has a linear form, at the characteristic frequencies θ and When the initial value of is relatively accurate, there is no requirement for the accuracy of other initial values, which avoids the phenomenon of filter divergence caused by the low accuracy of the initial value, and improves the success rate of inertia parameter estimation. Numerical methods using fast Fourier transforms to obtain θ and The initial value of , can ensure that its accuracy meets the requirements.

附图说明Description of drawings

图1为构造四元数动力学方程近似解的流程图;Fig. 1 is the flow chart of constructing the approximate solution of quaternion kinetic equation;

图2为含有噪声的观测数据的实例图;Figure 2 is an example diagram of observation data containing noise;

图3为使用快速傅里叶变化将姿态四元数变化到频域的实例图;Fig. 3 is an example diagram of changing attitude quaternion to frequency domain using fast Fourier transform;

图4为辨识得到的系统运动状态的估计值与预测值随时间变化的轨迹的实例图,其中(a)为观测坐标系对应的四元数分量η0的轨迹图,(b)为观测坐标系对应的四元数分量η1的轨迹图,(c)为观测坐标系对应的四元数分量η2的轨迹图,(d)为观测坐标系对应的四元数分量η3的轨迹图,(e)为角速度分量ωx的轨迹图,(f)为角速度分量ωy的轨迹图,(g)为角速度分量ωz的轨迹图;Fig. 4 is an example diagram of the trajectory of the estimated value and predicted value of the identified system motion state over time, where (a) is the trajectory diagram of the quaternion component η0 corresponding to the observation coordinate system, and (b) is the observation coordinate The locus diagram of the quaternion component η 1 corresponding to the system, (c) is the locus diagram of the quaternion component η 2 corresponding to the observation coordinate system, and (d) is the locus diagram of the quaternion component η 3 corresponding to the observation coordinate system , (e) is the track figure of angular velocity component ω x , (f) is the track figure of angular velocity component ω y , (g) is the track figure of angular velocity component ω z ;

图5为惯性参数估计值的相对误差的收敛过程的实例图。FIG. 5 is an example diagram of a convergence process of relative errors of inertial parameter estimates.

具体实施方式detailed description

下面对本发明作进一步详细描述:The present invention is described in further detail below:

本发明是在非接触的情况对翻滚状态的任意形状的空间碎片或失效卫星的惯性参数进行精确的测算。其主要原理在于:首先选取三个主频率构造含有待定参数的三角函数,作为翻滚目标姿态运动方程的近似解,将这组解代入翻滚目标的四元数姿态动力学方程中,即可将原本的微分方程转化为代数方程,对这组代数方程求解可得以上待定参数的具体值。使用这些待定参数可以代替系统变量表征系统的状态,即翻滚卫星的姿态四元数被表示为关于这些常值参数和时间的函数。翻滚卫星的姿态四元数可以通过现有的技术手段进行测量,本方法通过线性最小方差估计,对待定参数的值进行实时的估计,且随着观测量的增加,估计精度越来越高。利用这些待定参数的值,本方法直接推算出翻滚卫星的惯性参数,即主转动惯量之间的比值。相比于以往的常值估计法,本方法不限于轴对称目标的参数估计,对任意形状的翻滚目标的主转动惯量之间的比值均可进行辨识。The invention accurately measures and calculates the inertial parameters of the space debris of any shape in the tumbling state or the invalid satellite under the condition of non-contact. The main principle is: firstly, three main frequencies are selected to construct a trigonometric function with undetermined parameters as the approximate solution of the rolling target attitude motion equation, and this group of solutions is substituted into the rolling target's quaternion attitude dynamic equation, and the original The differential equations are transformed into algebraic equations, and the specific values of the undetermined parameters can be obtained by solving this set of algebraic equations. These undetermined parameters can be used instead of system variables to characterize the state of the system, that is, the attitude quaternion of the rolling satellite is expressed as a function of these constant parameters and time. The attitude quaternion of the tumbling satellite can be measured by existing technical means. This method estimates the value of the undetermined parameters in real time through linear minimum variance estimation, and the estimation accuracy becomes higher and higher with the increase of observations. Using the values of these undetermined parameters, this method directly calculates the inertial parameters of the rolling satellite, that is, the ratio between the main moments of inertia. Compared with the previous constant value estimation method, this method is not limited to the parameter estimation of axisymmetric targets, and can identify the ratio between the principal moments of inertia of rolling targets with arbitrary shapes.

本发明的方法具体包括以下步骤:Method of the present invention specifically comprises the following steps:

步骤一:通过近似方法建立翻滚目标四元数运动方程的近似解,如图(1)所示。具体流程为:首先建立翻滚目标的姿态四元数的运动学模型Step 1: Establish an approximate solution to the quaternion motion equation of the tumbling target by an approximate method, as shown in Figure (1). The specific process is as follows: first, establish the kinematics model of the attitude quaternion of the rolling target

其中,λ0123为翻滚目标的主轴坐标系相对于惯性系的姿态四元数四个分量,ωxyz为目标的角速度在本体主轴坐标系中的投影;Among them, λ 0 , λ 1 , λ 2 , λ 3 are the four components of the attitude quaternion of the main axis coordinate system of the rolling target relative to the inertial system, and ω x , ω y , ω z are the angular velocity of the target in the main axis coordinate system of the body projection in

忽略高频小量,写出翻滚目标的角速度近似解Ignoring the high-frequency small amount, write the approximate solution of the angular velocity of the rolling target

其中ωxmymzm分别为本体坐标系三个坐标轴方向上的角速度分量的最大值,t为时间,为待辨识的常值参数之一,εxyz均为该坐标轴方向上的高阶无穷小量,ε为高频项,其对于角速度的长期影响为零。Where ω xm , ω ym , ω zm are the maximum values of angular velocity components in the direction of the three coordinate axes of the body coordinate system, t is time, is one of the constant parameters to be identified, ε x , ε y , ε z are high-order infinitesimal quantities in the direction of the coordinate axis, ε is a high-frequency term, and its long-term influence on angular velocity is zero.

通过频域分析可以发现四元数随时间变化的函数在频域中有三个明显的尖峰,因此使用含有三个特征频率的正弦函数构造描述姿态运动的四元数微分方程的近似解。四元数λ的解的具体形式为Through the frequency domain analysis, it can be found that the function of quaternion changing with time has three obvious peaks in the frequency domain, so the approximate solution of the quaternion differential equation describing attitude motion is constructed by using the sinusoidal function with three characteristic frequencies. The specific form of the solution of the quaternion λ is

λ=A4×6ξ(3)λ=A 4×6 ξ(3)

其中A4×6为4行6列的常数矩阵,且where A 4×6 is a constant matrix with 4 rows and 6 columns, and

其中θ与也为待识别的常值参数,且的值仅由角速度特性决定。where θ and is also a constant value parameter to be identified, and The value of is determined only by the angular velocity characteristic.

将系统的微分方程转化为代数方程。将式(2)与式(3)同时代入式(1),使用三角函数运算规则合并相同频率项,由三角函数的正则性可知,若等式(1)成立,须令各频率之前的系数均为零,则得到一个由56个算术方程组成的方程组Transform the system of differential equations into algebraic equations. Substitute Equation (2) and Equation (3) into Equation (1) at the same time, and use trigonometric function operation rules to combine the same frequency items. From the regularity of trigonometric functions, it can be seen that if Equation (1) is true, the coefficients before each frequency must be are all zero, an equation system consisting of 56 arithmetic equations is obtained

其中a为矩阵A4×6按行展开成向量后生成的行向量,为由θ以及ωxm,ωym,ωzm决定的常系数矩阵,其各项的具体形式由式(3)推导可得,下标表示矩阵维数。考虑到系统的初值λ(0),上式可扩展为Where a is the row vector generated after the matrix A 4×6 is expanded into a vector by row, for the reason The constant coefficient matrix determined by θ and ω xm , ω ym , ω zm , the specific form of its items can be derived from formula (3), and the subscript indicates the dimension of the matrix. Considering the initial value λ(0) of the system, the above formula can be extended to

其中,其中常数矩阵D′的值由D′a=λ(0)推得:Among them, the value of the constant matrix D' is deduced by D'a=λ(0):

式(4)是约束数大于变量数的超定方程组,可使用最小二乘准则求得a,及θ的最小二乘解,得到四元数λ关于时间t的近似解,即姿态四元数随时间变化的近似方程,也就是翻滚目标的姿态运动的近似方程。事实上,由于自由翻滚目标的角速度满足Jacobi椭圆函数积分的形式,高频项系数很小,因此以此方法确定的近似解具有较高的精度。Equation (4) is an overdetermined equation system in which the number of constraints is greater than the number of variables, and a can be obtained by using the least squares criterion, And the least squares solution of θ, the approximate solution of the quaternion λ about time t is obtained, that is, the approximate equation of the attitude quaternion changing with time, that is, the approximate equation of the attitude motion of the rolling target. In fact, since the angular velocity of the free-rolling target satisfies the integral form of the Jacobi elliptic function, the coefficient of the high-frequency term is very small, so the approximate solution determined by this method has high accuracy.

步骤二:提取常值参数作为系统的状态量。考虑到实际观测量η为观测坐标系相对于惯性系的四元数,它与λ之间的关系Step 2: Extract constant value parameters as the state quantities of the system. Considering that the actual observed value η is the quaternion of the observed coordinate system relative to the inertial system, the relationship between it and λ

η=λομη=λομ

其中“ο”表示四元数乘法运算,μ为观测坐标系与本体主轴坐标系之间的姿态四元数。由于四元数乘法不涉及高次项运算,且μ为常数,故η各项可均为λ各项的线性组合。由式(3)的形式可知,观测量η同样具有周期性质,即有Among them, "ο" represents the quaternion multiplication operation, and μ is the attitude quaternion between the observation coordinate system and the main axis coordinate system of the body. Since the quaternion multiplication does not involve high-order term operations, and μ is a constant, each item of η can be a linear combination of each item of λ. From the form of formula (3), we can see that the observed quantity η also has periodic properties, that is,

η=B4×6ξ (5)η=B 4×6 ξ (5)

其中B为满足Aξ=Bξομ的常数矩阵。将矩阵B按行来展开得到行向量b24×1,并考虑到待辨识的常值参数及θ,共同组成了系统的常值的状态量xWhere B is a constant matrix satisfying Aξ=Bξομ. Expand the matrix B by row to get the row vector b 24×1 , and consider the constant parameter to be identified and θ, together constitute the constant state quantity x of the system

b,θ,均为待辨识的常值参数;b, θ, are constant parameters to be identified;

步骤三:构造扩展卡尔曼滤波器。Step 3: Construct an extended Kalman filter.

系统的观测方程为The observation equation of the system is

h(x)=ηh(x)=η

将h相对于状态量x求偏导数得到观测敏感度矩阵Calculate the partial derivative of h relative to the state quantity x to obtain the observation sensitivity matrix

由于系统的状态量均为常值参数,故状态转移矩阵Φ为单位矩阵Since the state quantities of the system are constant parameters, the state transition matrix Φ is an identity matrix

Φ=Ι14×14 (7)Φ=Ι 14×14 (7)

其中,I14×14为14×14的单位矩阵;Wherein, I 14×14 is an identity matrix of 14×14;

由干扰力矩引起的状态量的误差认为是高斯分布的白噪声,则系统过程噪声的方差矩阵Qk定义为The error of the state quantity caused by the disturbance torque is considered to be white noise of Gaussian distribution, then the variance matrix Q k of the system process noise is defined as

Qk=σ2Ι14×14 (8)Q k = σ 2 Ι 14×14 (8)

其中,σ2为过程噪声的分布方差;Among them, σ2 is the distribution variance of the process noise;

将式(6)-(8)代入卡尔曼滤波器的一般方程,即得到非对称翻滚目标参数辨识的步骤。与对称目标的情况类似,状态量中b向量的各项满足线性形式,不需要给定精确的初值。而θ与涉及三角函数运算,因此需要使用离散傅里叶变换确定特征角频率θ和的初值。Substituting equations (6)-(8) into the general equation of the Kalman filter is the step of identifying the parameters of the asymmetric tumbling target. Similar to the case of the symmetric target, the items of the b vector in the state quantity satisfy the linear form, and there is no need to give an accurate initial value. while θ and Involves trigonometric function operations, so it is necessary to use discrete Fourier transform to determine the characteristic angular frequency θ and initial value.

步骤四:通过卡尔曼滤波器得到状态量x的估计值后,将估计值代入式(4)并求最小二乘解,即可得到矩阵D以及角速度参数ωxm,ωym及ωzm的估计值。进一步,由下式计算转动惯量参数的估计值Step 4: After the estimated value of the state quantity x is obtained through the Kalman filter, the estimated value is substituted into formula (4) and the least square solution is obtained, and the matrix D and the estimation of the angular velocity parameters ω xm , ω ym and ω zm can be obtained value. Further, the estimated value of the moment of inertia parameter is calculated by the following formula

px,py,pz为待辨识的转动惯量比值参数,K为角速度的椭圆函数所对应的第一类完全椭圆积分系数。p x , p y , p z are the moment of inertia ratio parameters to be identified, and K is the first kind of complete elliptic integral coefficient corresponding to the elliptic function of angular velocity.

为了更好地说明本发明的目的和优点,下面结合附图和实例对本发明内容做进一步说明:In order to better illustrate the purpose and advantages of the present invention, the contents of the present invention will be further described below in conjunction with the accompanying drawings and examples:

设翻滚目标在空间中作自由漂浮运动,使用立体视觉设备或激光测距仪可以测得姿态四元数四个变量随时间变化的函数,如图2所示。由于干扰力矩和观测误差的影响,测量结果是受噪声污染的。应用本方法,可以利用这些观测噪声实时地估计出该翻滚卫星的惯性参数px,py及pz,具体包括以下步骤:Assuming that the tumbling target is floating freely in space, the function of the four variables of the attitude quaternion changing with time can be measured by using a stereo vision device or a laser range finder, as shown in Figure 2. Due to the influence of disturbance torque and observation error, the measurement result is polluted by noise. By applying this method, the inertial parameters p x , p y and p z of the tumbling satellite can be estimated in real time by using these observation noises, which specifically includes the following steps:

步骤一:先使用快速傅里叶变换算法将λ0(t)的部分数据变化到频域,如图3所示。频域中有三个尖峰,将中间尖峰的横坐标的值赋给θ,尖峰横坐标之间的间隔赋给作为初值。x中其他参数的初值被赋为0。Step 1: first use the fast Fourier transform algorithm to transform part of the data of λ 0 (t) into the frequency domain, as shown in FIG. 3 . There are three peaks in the frequency domain, assign the value of the abscissa of the middle peak to θ, and assign the interval between the abscissas of the peaks to as the initial value. The initial values of other parameters in x are assigned 0.

步骤二:以x为状态参数,以姿态四元数λ的实时观测量为输入,构建卡尔曼滤波器,逐步估计出状态参数更精确的值。如图4所示,由常值参数的估计值计算并预测得到的姿态四元数及角速度的误差均小于直接观测值的误差。Step 2: Taking x as the state parameter and taking the real-time observation of the attitude quaternion λ as input, construct a Kalman filter to gradually estimate more accurate values of the state parameter. As shown in Figure 4, the errors of the attitude quaternion and angular velocity calculated and predicted by the estimated value of the constant parameter are smaller than the error of the direct observation value.

步骤三:利用x各参数的值计算翻滚卫星惯量参数px,py及pz的值,其估计值随时间变化曲线如图5所示,可见惯性参数的估计值随着观测量的增加而趋近真实值。Step 3: Calculate the values of the rolling satellite inertia parameters p x , p y and p z by using the values of each parameter x. The curves of the estimated values changing with time are shown in Figure 5. It can be seen that the estimated values of the inertial parameters increase with the increase of observations approaching the real value.

本实例中采用的系统参数的值如表1所示:The values of the system parameters used in this example are shown in Table 1:

表1.实例采用的系统参数值Table 1. System parameter values used in the example

Claims (5)

1.一种任意形状翻滚卫星的非接触式惯量系数辨识方法,其特征在于,包括如下步骤:1. A non-contact inertial coefficient identification method for tumbling satellites with arbitrary shapes, characterized in that it comprises the steps: 1)通过近似方法建立翻滚目标四元数λ的运动方程的近似解;1) establish the approximate solution of the motion equation of the rolling target quaternion λ by an approximate method; 2)通过近似解提取常值参数作为系统的状态量x;2) Extract the constant parameter as the state quantity x of the system through the approximate solution; 3)构造扩展卡尔曼滤波器;3) Construct an extended Kalman filter; 4)通过卡尔曼滤波器得到系统的状态量的估计值,并采用估计值估计翻滚卫星的惯性参数。4) Obtain the estimated value of the state quantity of the system through the Kalman filter, and use the estimated value to estimate the inertial parameters of the rolling satellite. 2.根据权利要求1所述的一种任意形状翻滚卫星的非接触式惯量系数辨识方法,其特征在于,步骤1)具体为:2. The non-contact inertia coefficient identification method of a tumbling satellite of any shape according to claim 1, wherein step 1) is specifically: 1-1)建立翻滚目标的姿态四元数的运动学模型:1-1) Establish the kinematics model of the attitude quaternion of the rolling target: λλ ·· 00 == 11 22 (( -- ωω xx λλ 11 -- ωω ythe y λλ 22 -- ωω zz λλ 33 )) λλ ·· 11 == 11 22 (( ωω xx λλ 00 ++ ωω zz λλ 22 -- ωω ythe y λλ 33 )) λλ ·· 22 == 11 22 (( ωω ythe y λλ 00 -- ωω zz λλ 11 ++ ωω xx λλ 33 )) λλ ·· 33 == 11 22 (( ωω zz λλ 00 ++ ωω ythe y λλ 11 -- ωω xx λλ 22 )) -- -- -- (( 11 )) 其中,λ0123为翻滚目标的本体主轴坐标系相对于惯性坐标系的姿态四元数四个分量,ωxyz为目标的角速度在本体坐标系中的投影;Among them, λ 0 , λ 1 , λ 2 , λ 3 are the four components of the attitude quaternion of the main axis coordinate system of the rolling target relative to the inertial coordinate system, and ω x , ω y , ω z are the angular velocity of the target in the body coordinates projections in the system; 1-2)忽略高频小量,得到翻滚目标的角速度近似解:1-2) Neglecting the small amount of high frequency, the approximate solution of the angular velocity of the rolling target is obtained: 其中,ωxmymzm分别为本体主轴坐标系三个坐标轴方向上的角速度分量的最大值,t为时间,为待辨识的常值参数之一,εxyz均为该坐标轴方向上的高阶无穷小量;Among them, ω xm , ω ym , ω zm are the maximum values of the angular velocity components in the directions of the three coordinate axes of the principal axis coordinate system of the body respectively, t is the time, is one of the constant parameters to be identified, and ε x , ε y , ε z are all high-order infinitesimal quantities in the direction of the coordinate axis; 1-3)使用含有三个特征频率的正弦函数构造描述姿态运动的四元数微分方程的近似解,四元数λ=[λ0 λ1 λ2 λ3]T的解的具体形式为:1-3) Use the sine function containing three characteristic frequencies to construct the approximate solution of the quaternion differential equation describing the attitude motion, the specific form of the solution of the quaternion λ=[λ 0 λ 1 λ 2 λ 3 ] T is: λ=A4×6ξ (3)λ=A 4×6 ξ (3) 其中A4×6为4行6列的常数矩阵,且where A 4×6 is a constant matrix with 4 rows and 6 columns, and 其中,θ也是待辨识的常值参数;Among them, θ is also a constant value parameter to be identified; 1-4)将系统的微分方程转化为代数方程,将式(2)与式(3)同时代入式(1),使用三角函数运算规则合并相同频率项,由三角函数的正则性可知,若等式(1)成立,须令各频率之前的系数均为零,则得到一个由56个算术方程组成的方程组:1-4) Transform the differential equation of the system into an algebraic equation, substitute formula (2) and formula (3) into formula (1) at the same time, and use the trigonometric function operation rules to combine the same frequency items. From the regularity of the trigonometric function, if Equation (1) is established, and the coefficients before each frequency must be zero, then an equation system consisting of 56 arithmetic equations is obtained: 其中a为矩阵A4×6按行展开成向量后生成的行向量,为由θ以及ωxm,ωym,ωzm决定的常系数矩阵,其各项的具体形式由式(3)推导得到,下标表示矩阵维数,考虑到系统的初值λ(0),将上式扩展为:Where a is the row vector generated after the matrix A 4×6 is expanded into a vector by row, for the reason The constant coefficient matrix determined by θ and ω xm , ω ym , ω zm , the specific form of each item is derived from formula (3), and the subscript indicates the dimension of the matrix. Considering the initial value λ(0) of the system, the upper expands to: 其中,其中常数矩阵D′的值由D′a=λ(0)推得:Among them, the value of the constant matrix D' is deduced by D'a=λ(0): DD. ′′ == 11 00 11 00 11 00 11 00 11 00 11 00 11 00 11 00 11 00 11 00 11 00 11 00 式(4)是约束数大于变量数的超定方程组,使用最小二乘准则求得a,及θ的最小二乘解,得到四元数λ关于时间t的近似解,即姿态四元数随时间变化的近似方程,也就是翻滚目标的姿态运动的近似方程。Equation (4) is an overdetermined equation system with the number of constraints greater than the number of variables, using the least squares criterion to obtain a, And the least squares solution of θ, the approximate solution of the quaternion λ about time t is obtained, that is, the approximate equation of the attitude quaternion changing with time, that is, the approximate equation of the attitude motion of the rolling target. 3.根据权利要求2所述的一种任意形状翻滚卫星的非接触式惯量系数辨识方法,其特征在于,步骤2)具体为:3. The non-contact method for identifying the coefficient of inertia of a tumbling satellite of any shape according to claim 2, wherein step 2) is specifically: 实际观测量η为观测坐标系相对于惯性系的四元数,它与λ之间的关系为:The actual observation value η is the quaternion of the observation coordinate system relative to the inertial system, and the relationship between it and λ is: 其中表示四元数乘法运算;μ为观测坐标系与本体主轴坐标系之间的姿态四元数;in Indicates the quaternion multiplication operation; μ is the attitude quaternion between the observation coordinate system and the main axis coordinate system of the body; 由于四元数乘法不涉及高次项运算,且μ为常数,故η各项均为λ各项的线性组合,由式(3)可知,观测量η同样具有周期性质,即有:Since the quaternion multiplication does not involve high-order term operations, and μ is a constant, the items of η are linear combinations of the items of λ. It can be seen from formula (3) that the observed quantity η also has periodic properties, that is: η=B4×6ξ (5)η=B 4×6 ξ (5) 其中B为满足的常数矩阵,将矩阵B按行来展开得到行向量b24×1,并考虑到待辨识的常值参数及θ,共同组成了系统的常值的状态量:where B is satisfied The constant matrix of , expand the matrix B by row to get the row vector b 24×1 , and consider the constant parameter to be identified and θ, together constitute the constant state quantity of the system: 其中,均为待辨识的常值参数。in, are constant parameters to be identified. 4.根据权利要求2所述的一种任意形状翻滚卫星的非接触式惯量系数辨识方法,其特征在于,步骤3)具体为:4. The non-contact method for identifying the coefficient of inertia of a tumbling satellite of any shape according to claim 2, wherein step 3) is specifically: 系统的观测方程为The observation equation of the system is h(x)=ηh(x)=η 将h相对于状态量x求偏导数得到观测敏感度矩阵:Calculate the partial derivative of h relative to the state quantity x to obtain the observation sensitivity matrix: 由于系统的状态量均为常值参数,故状态转移矩阵Φ为:Since the state quantities of the system are constant parameters, the state transition matrix Φ is: Φ=Ι14×14 (7)Φ=Ι 14×14 (7) 其中,I14×14为14×14的单位矩阵;Wherein, I 14×14 is the identity matrix of 14×14; 由干扰力矩引起的状态量的误差认为是高斯分布的白噪声,则系统过程噪声的方差矩阵Qk定义为:The error of the state quantity caused by the disturbance torque is considered to be white noise of Gaussian distribution, then the variance matrix Q k of the system process noise is defined as: Qk=σ2Ι14×14 (8)Q k = σ 2 Ι 14×14 (8) 其中,σ2为过程噪声的分布方差;Among them, σ2 is the distribution variance of the process noise; 将式(6)-(8)代入卡尔曼滤波器的一般方程,即得到非对称翻滚目标参数辨识的步骤,构造出由待辨识参数作为状态量构成的广义卡尔曼滤波器。Substituting equations (6)-(8) into the general equation of the Kalman filter is the step of identifying the parameters of the asymmetric tumbling target, and constructing a generalized Kalman filter composed of the parameters to be identified as state variables. 5.根据权利要求4所述的一种任意形状翻滚卫星的非接触式惯量系数辨识方法,其特征在于,步骤4)具体为:5. The non-contact method for identifying the coefficient of inertia of a tumbling satellite of any shape according to claim 4, wherein step 4) is specifically: 通过卡尔曼滤波器得到状态量x的估计值后,将估计值代入式(4)并求最小二乘解,即得到矩阵D以及角速度参数ωxm,ωym及ωzm的估计值,并进一步求解得到惯量参数的估计值::After the estimated value of the state quantity x is obtained through the Kalman filter, the estimated value is substituted into formula (4) and the least square solution is obtained, that is, the estimated value of the matrix D and the angular velocity parameters ω xm , ω ym and ω zm is obtained, and further Solving for an estimate of the inertia parameter: 其中,px,py,pz为待辨识的转动惯量比值参数,K为角速度的椭圆函数所对应的第一类完全椭圆积分系数。Among them, p x , p y , p z are the moment of inertia ratio parameters to be identified, and K is the first kind of complete elliptic integral coefficient corresponding to the elliptic function of angular velocity.
CN201610858914.0A 2016-09-28 2016-09-28 A kind of contactless factor of inertia discrimination method of arbitrary shape rolling satellite Pending CN106482896A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610858914.0A CN106482896A (en) 2016-09-28 2016-09-28 A kind of contactless factor of inertia discrimination method of arbitrary shape rolling satellite

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610858914.0A CN106482896A (en) 2016-09-28 2016-09-28 A kind of contactless factor of inertia discrimination method of arbitrary shape rolling satellite

Publications (1)

Publication Number Publication Date
CN106482896A true CN106482896A (en) 2017-03-08

Family

ID=58267906

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610858914.0A Pending CN106482896A (en) 2016-09-28 2016-09-28 A kind of contactless factor of inertia discrimination method of arbitrary shape rolling satellite

Country Status (1)

Country Link
CN (1) CN106482896A (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107168350A (en) * 2017-05-24 2017-09-15 西北工业大学 It is a kind of be directed to Servicing spacecraft fixed-axis rotation when optimal spin velocity computational methods
CN108680198A (en) * 2018-04-11 2018-10-19 北京空间飞行器总体设计部 A kind of Relative Navigation target inertial parameter identification method based on plume disturbance
CN109145387A (en) * 2018-07-25 2019-01-04 西北工业大学 The intelligent identification Method of space Tum bling Target inertia characteristics based on characteristic frequency
CN109871658A (en) * 2019-03-26 2019-06-11 哈尔滨工业大学 A Multi-Attitude Optimal Estimation Method for Missile Warhead Moment of Inertia and Inertia Product Measurement
CN110081906A (en) * 2019-03-28 2019-08-02 西北工业大学 Two step discrimination methods of the noncooperative target inertia characteristics parameter based on adsorption process
CN110567462A (en) * 2019-08-22 2019-12-13 北京航空航天大学 An Approximate Identification Method for Three-Axis Moment of Inertia Ratio of Spinning Non-cooperative Spacecraft

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1471398A1 (en) * 2003-04-24 2004-10-27 Abb Research Ltd. Method for operation of a Kalman filter and device for carrying out the method
CN102305630A (en) * 2011-05-17 2012-01-04 哈尔滨工业大学 Autonomous synthetic aperture radar (SAR) satellite orbit determination method based on extended kalman filter
CN102620886A (en) * 2012-03-27 2012-08-01 南京航空航天大学 Two-step in-orbit recognition rotary inertia estimation method for combined spacecraft
CN103218482A (en) * 2013-03-29 2013-07-24 南京航空航天大学 Estimation method for uncertain parameters in dynamic system

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1471398A1 (en) * 2003-04-24 2004-10-27 Abb Research Ltd. Method for operation of a Kalman filter and device for carrying out the method
CN102305630A (en) * 2011-05-17 2012-01-04 哈尔滨工业大学 Autonomous synthetic aperture radar (SAR) satellite orbit determination method based on extended kalman filter
CN102620886A (en) * 2012-03-27 2012-08-01 南京航空航天大学 Two-step in-orbit recognition rotary inertia estimation method for combined spacecraft
CN103218482A (en) * 2013-03-29 2013-07-24 南京航空航天大学 Estimation method for uncertain parameters in dynamic system

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
于永军 等: "非同步量测特性的惯量/星光/卫星组合算法研究", 《仪器仪表学报》 *
林佳伟 等: "基于GTLS的零动量卫星惯量矩阵在轨辨识", 《空间控制技术与应用》 *

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107168350A (en) * 2017-05-24 2017-09-15 西北工业大学 It is a kind of be directed to Servicing spacecraft fixed-axis rotation when optimal spin velocity computational methods
CN108680198A (en) * 2018-04-11 2018-10-19 北京空间飞行器总体设计部 A kind of Relative Navigation target inertial parameter identification method based on plume disturbance
CN109145387A (en) * 2018-07-25 2019-01-04 西北工业大学 The intelligent identification Method of space Tum bling Target inertia characteristics based on characteristic frequency
CN109871658A (en) * 2019-03-26 2019-06-11 哈尔滨工业大学 A Multi-Attitude Optimal Estimation Method for Missile Warhead Moment of Inertia and Inertia Product Measurement
CN109871658B (en) * 2019-03-26 2022-11-15 哈尔滨工业大学 Multi-attitude optimal estimation method for measuring rotational inertia and inertia product of missile warhead
CN110081906A (en) * 2019-03-28 2019-08-02 西北工业大学 Two step discrimination methods of the noncooperative target inertia characteristics parameter based on adsorption process
CN110567462A (en) * 2019-08-22 2019-12-13 北京航空航天大学 An Approximate Identification Method for Three-Axis Moment of Inertia Ratio of Spinning Non-cooperative Spacecraft

Similar Documents

Publication Publication Date Title
CN106482896A (en) A kind of contactless factor of inertia discrimination method of arbitrary shape rolling satellite
Yang et al. Extended Kalman filter for extended object tracking
CN102620886B (en) Two-step in-orbit recognition rotary inertia estimation method for combined spacecraft
CN103034123B (en) Based on the parallel robot control method of kinetic parameters identification
Kurz et al. Recursive nonlinear filtering for angular data based on circular distributions
CN106950562A (en) A kind of state fusion method for tracking target based on predicted value measurement conversion
Lee et al. Interacting multiple model estimation for spacecraft maneuver detection and characterization
CN105954742B (en) Radar target tracking method with Doppler observation in spherical coordinate system
CN106468554B (en) A kind of measuring method of the inertial parameter of contactless rolling satellite
CN106646453A (en) Doppler radar target tracking method based on predicted value measurement conversion
CN104180799A (en) Robot localization method based on self-adaptive Monte Carlo localization method
Gadsden et al. Nonlinear estimation techniques applied on target tracking problems
CN105785358B (en) Radar target tracking method with Doppler measurement in direction cosine coordinate system
Al-Shabi et al. The unscented smooth variable structure filter application into a robotic arm
Hong et al. Motion-parameter estimation for precession-with-nutation space targets based on wideband radar measurements
CN107421541A (en) A kind of morphological parameters measuring method of fault-tolerant contactless inert satellite
CN105021199A (en) LS (Least square)-based multi- model adaptive state estimation method and system
CN103528449A (en) Missile formation control method based on disturbance observer and finite time control
Chen et al. A new pose estimation method for non-cooperative spacecraft based on point cloud
Xiao et al. A multiple model particle filter for maneuvering target tracking based on composite sampling
Baum et al. Extended object tracking based on set-theoretic and stochastic fusion
Maithripala et al. Phantom track generation through cooperative control of multiple ECAVs based on feasibility analysis
Frencl et al. Tracking with range rate measurements: turn rate estimation and particle filtering
CN102890743B (en) Planetary scale enters lander drop point analysis on Uncertainty method
CN109084751B (en) High-energy-efficiency satellite attitude determination algorithm based on box particle filter

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
WD01 Invention patent application deemed withdrawn after publication
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20170308