WO2020006672A1 - 三维空间转弯机动目标的轨迹起始方法及装置 - Google Patents

三维空间转弯机动目标的轨迹起始方法及装置 Download PDF

Info

Publication number
WO2020006672A1
WO2020006672A1 PCT/CN2018/094175 CN2018094175W WO2020006672A1 WO 2020006672 A1 WO2020006672 A1 WO 2020006672A1 CN 2018094175 W CN2018094175 W CN 2018094175W WO 2020006672 A1 WO2020006672 A1 WO 2020006672A1
Authority
WO
WIPO (PCT)
Prior art keywords
measurement data
position measurement
transformed
matrix
maneuvering target
Prior art date
Application number
PCT/CN2018/094175
Other languages
English (en)
French (fr)
Inventor
刘宗香
张慧
李良群
Original Assignee
深圳大学
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 深圳大学 filed Critical 深圳大学
Priority to PCT/CN2018/094175 priority Critical patent/WO2020006672A1/zh
Publication of WO2020006672A1 publication Critical patent/WO2020006672A1/zh

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/20Analysis of motion

Definitions

  • the invention belongs to the technical field of multi-sensor information fusion, and particularly relates to a trajectory starting method and device of a three-dimensional space turning maneuvering target.
  • the main task of the trajectory initiation is to use the measurements obtained by the sensors at multiple different times to detect new targets appearing in the observation space and start their trajectories.
  • the commonly used trajectory starting methods are generally suitable for trajectory starting that assumes that the target moves at a constant speed or uniform acceleration, but these existing trajectory starting methods are not suitable for trajectory starting of turning maneuvering targets. Therefore, how to solve the trajectory initiation problem of a 3D space turning maneuvering target is a key technical problem that needs to be explored and solved at present.
  • the technical problem to be solved by the present invention is to provide a trajectory starting method and device for a three-dimensional space turning maneuvering target, which aims to solve the problem of trajectory starting of a three-dimensional space turning maneuvering target.
  • the invention provides a trajectory starting method of a three-dimensional space turning maneuvering target, the method includes:
  • Step 1 Take one position measurement data from the position measurement data set of the three-dimensional turning maneuvering target at three different times respectively to form a position measurement data set, and use the three position measurement data in the position measurement data set to determine the coordinate transformation matrix. And transforming the three position measurement data onto the xoy plane through the coordinate transformation matrix to obtain transformed three position measurement data, and using the coordinate transformation matrix to the error covariance of the three position measurement data Transforming the matrix to obtain the error covariance matrix transformed from the three position measurement data;
  • the included angle is ⁇ , and the intersection point of the intersection line and the x-axis is [x 0 , 0,0] T ;
  • the superscript T represents the transpose of a vector or matrix
  • Step 2 Test whether the transformed three position measurement data simultaneously meet three preset conditions; if the three preset conditions can be satisfied at the same time, use the transformed three position measurement data to form a tentative trajectory, and turn Go to step 3; otherwise go to step 1 to take the next set of position measurement data for testing;
  • Step 3 Use the transformed three position measurement data to obtain a turning rate estimate of the three-dimensional space turning maneuvering target; use the transformed three position measuring data and the turning rate estimation of the three-dimensional space turning maneuvering target To obtain the initial state estimation and error covariance estimation of the turning 3D maneuvering target in space;
  • Step 4 Inverse transform the initial state estimation and error covariance estimation of the transformed three-dimensional space turning maneuvering target by using the coordinate transformation matrix F c to obtain the initial state estimation and error covariance estimation of the three-dimensional space turning maneuvering target. ;
  • Step 5 After the test of the three position measurement data of one position measurement data set is completed, go to step 1 to take the next set of position measurement data sets for testing, until all the position measurement data sets are tested.
  • the present invention also provides a trajectory starting device for a turning maneuvering target in a three-dimensional space.
  • the device includes:
  • a transformation module for respectively extracting one position measurement data from the position measurement data set of three different moments of turning the maneuvering target in the three-dimensional space to form a position measurement data group, and using the three position measurement data in the position measurement data group to determine coordinates A transformation matrix, and transforming the three position measurement data onto the xoy plane through the coordinate transformation matrix, to obtain transformed three position measurement data, and using the coordinate transformation matrix to the error of the three position measurement data Transforming the covariance matrix to obtain the transformed error covariance matrix of the three position measurement data;
  • the included angle is ⁇ , and the intersection point of the intersection line and the x-axis is [x 0 , 0,0] T ;
  • the superscript T represents the transpose of a vector or matrix
  • the trajectory detection module is used to test whether the three position measurement data after the transformation satisfy three preset conditions at the same time; if the three preset conditions can be satisfied at the same time, use the three position measurement data after the transformation to form a tentative trajectory , And transfer to the state and error covariance estimation module; otherwise, transfer to the transformation module to take the next set of position measurement data sets for testing;
  • a state and error covariance estimation module configured to obtain a turning rate estimate of the three-dimensional turning maneuvering target by using the transformed three position measurement data; using the transformed three position measurement data and the three-dimensional space Estimate the turning rate of the turning maneuvering target, and obtain the transformed 3D space turning maneuvering target initial state estimation and error covariance estimation;
  • An inverse transformation module configured to inversely transform the initial state estimation and error covariance estimation of the three-dimensional turning maneuvering target using the coordinate transformation matrix F c to obtain the initial state estimation and error of the three-dimensional turning maneuvering target. Covariance estimation.
  • the invention provides a trajectory starting method and a device for a turning maneuvering target in a three-dimensional space, and finally detects a turning maneuvering target existing in a three-dimensional space through coordinate transformation, trajectory detection, state and error covariance estimation, and inverse coordinate transformation. And obtain the state estimation and error covariance estimation of the three-dimensional turning maneuvering target, thereby effectively solving the problem that the three-dimensional turning maneuvering target trajectory is difficult to start.
  • the invention can be used in the field of multi-target tracking, and has strong practicability.
  • FIG. 1 is a schematic flowchart of a trajectory initiation method for a three-dimensional space turning maneuvering target according to an embodiment of the present invention
  • FIG. 2 is a system schematic diagram of a trajectory starting device for a turning maneuvering target in a three-dimensional space according to an embodiment of the present invention.
  • a schematic flowchart of a method for starting a trajectory of a three-dimensional space turning maneuvering target includes:
  • Step 101 Take a position measurement data set from three different time position measurement data sets of a maneuvering target in a three-dimensional space to form a position measurement data set, use the three position measurement data in the position measurement data set to determine a coordinate transformation matrix, and The three position measurement data are transformed to the xoy plane by the coordinate transformation matrix, and the three position measurement data are obtained.
  • the coordinate transformation matrix is used to transform the error covariance matrix of the three position measurement data to obtain the three position measurement data. Transformed error covariance matrix.
  • step 101 The main purpose of step 101 is to obtain the transformed three position measurement data by using the coordinate transformation matrix through the position measurement data at three different times.
  • the steps include:
  • the intersection of the intersection line and the x-axis is [x 0 , 0,0] T.
  • the superscript T represents the transpose of a vector or matrix
  • Step 102 Test whether the transformed three position measurement data simultaneously satisfy three preset conditions; if the three preset conditions can be satisfied at the same time, use the transformed three position measurement data to form a tentative trajectory, and proceed to step 103; otherwise, go to step 101 to take the next set of position measurement data for testing.
  • step 102 the three position measurement data transformed by three preset condition tests are mainly used, and the three position measurement data transformed after satisfying the three preset conditions are formed into a tentative trajectory.
  • the specific steps include:
  • test position measurement data with Whether the following three preset conditions are met at the same time:
  • v min , v max , a max, and ⁇ max are the minimum speed, the maximum speed, the maximum acceleration, and the maximum turn rate, respectively
  • 2 represents the 2 norm of the vector
  • Step 103 Use the transformed three position measurement data to obtain the turning rate estimate of the three-dimensional turning maneuvering target; use the transformed three position measuring data and the turning rate estimation of the three-dimensional turning maneuvering target to obtain the transformed three-dimensional turning Estimated initial state and error covariance of maneuvering target. Its specific steps include:
  • sgn (a) is the sign of the variable a
  • Step 104 Use the coordinate transformation matrix F c to inversely transform the initial state estimation and error covariance estimation of the three-dimensional space turning maneuvering target to obtain the initial state estimation and error covariance estimation of the three-dimensional space turning maneuvering target. Its specific steps include:
  • F c (i, j) represents the i-th row and j-th column of the matrix F c .
  • Step 105 After the test of the three position measurement data of one position measurement data set is completed, go to step 101 to take the next set of position measurement data sets for testing, until all the position measurement data sets are tested.
  • a trajectory starting method for a three-dimensional space turning maneuvering target is provided.
  • the observation space is finally detected through coordinate transformation, trajectory detection, state and error covariance estimation, and inverse coordinate transformation.
  • the target exists in the target and the state estimation of the target is obtained, which effectively solves the problem that the trajectory of the maneuvering target in the three-dimensional space is difficult to start. It can be used in the field of multi-target tracking and has strong practicability.
  • FIG. 2 is a schematic diagram of a system for starting a trajectory of a turning maneuvering target in a three-dimensional space according to an embodiment of the present invention.
  • the device includes:
  • a transformation module 10 is configured to separately extract one position measurement data from the position measurement data set of the three-dimensional turning maneuvering target at three different times to form a position measurement data group, and use the three position measurement data in the position measurement data group to determine the coordinate transformation Matrix, and transform the three position measurement data onto the xoy plane through the coordinate transformation matrix to obtain the transformed three position measurement data. Use the coordinate transformation matrix to transform the error covariance matrix of the three position measurement data to obtain three Error covariance matrix after position measurement data transformation.
  • the intersection of the line of intersection and the x-axis is [x 0 , 0,0] T ;
  • the superscript T represents the transpose of a vector or matrix.
  • the trajectory detection module 10 is used to test whether three transformed position measurement data satisfy three preset conditions at the same time; if the three preset conditions can be satisfied at the same time, use the transformed three position measurement data to form a tentative trajectory, And transfer to the state and error covariance estimation module; otherwise, transfer to the transformation module to take the next set of position measurement data sets for testing.
  • the trajectory detection module 10 is specifically configured to:
  • test position measurement data with Whether the following three preset conditions are met at the same time:
  • v min , v max , a max, and ⁇ max are the minimum speed, the maximum speed, the maximum acceleration, and the maximum turn rate, respectively
  • 2 represents the 2 norm of the vector
  • State and error covariance estimation module 30 which is used to obtain the turning rate estimation of a three-dimensional turning maneuvering target using the transformed three position measurement data; using the transformed three position measuring data and the turning rate estimation of a three-dimensional turning maneuvering target , To obtain the initial state estimation and error covariance estimation of the turning 3D maneuvering target in space.
  • the state and error covariance estimation module 30 is specifically configured to:
  • Measured data at three locations using a tentative trajectory with The turning rate of the turning maneuvering target in the three-dimensional space is estimated as:
  • sgn (a) is the sign of the variable a
  • the error covariance matrix transformed at time r is:
  • Inverse transform module 40 for inverse transforming the initial state estimation and error covariance estimation of the three-dimensional turning maneuvering target using the coordinate transformation matrix F c to obtain the initial state estimation and error covariance estimation of the three-dimensional turning maneuvering target.
  • the inverse transform module 40 is specifically configured to:
  • F c (i, j) represents the i-th row and j-th column of the matrix F c .
  • a trajectory starting device for a three-dimensional space turning maneuvering target is provided by a coordinate transformation module, a trajectory detection module, a state and error covariance estimation module, an inverse coordinate transformation module, and a loop device.
  • the target existing in the observation space is detected, and the state estimation of the target is obtained, thereby effectively solving the problem that the trajectory of a maneuvering target in a three-dimensional space is difficult to start.
  • this embodiment uses the method provided by the above-mentioned first embodiment to perform experiments on simulation data.
  • This embodiment mainly considers two turning maneuvering targets that make a turning maneuver in a three-dimensional space.
  • the disclosed apparatus and method may be implemented in other ways.
  • the device embodiments described above are only schematic.
  • the division of modules is only a logical function division.
  • multiple modules or components may be combined or integrated.
  • the displayed or discussed mutual coupling or direct coupling or communication connection may be indirect coupling or communication connection through some interfaces, devices or modules, and may be electrical, mechanical or other forms.
  • Modules described as separate components may or may not be physically separated, and components displayed as modules may or may not be physical modules, which may be located in one place, or may be distributed on multiple network modules. Some or all of the modules may be selected according to actual needs to achieve the objective of the solution of this embodiment.
  • each functional module in each embodiment of the present invention may be integrated into one processing module, or each module may exist separately physically, or two or more modules may be integrated into one module.
  • the above integrated modules can be implemented in the form of hardware or software functional modules.

Landscapes

  • Engineering & Computer Science (AREA)
  • Multimedia (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明公开了一种用于三维空间转弯机动目标的轨迹起始方法,涉及多传感器信息融合技术领域,通过坐标变换、轨迹探测、状态与误差协方差估计,及坐标反变换,最终探测出观测空间中存在的目标,并获得目标的状态估计。本发明还公开了一种用于三维空间转弯机动目标的轨迹起始装置,有效地解决了三维空间转弯机动目标轨迹难以起始的问题,本发明可用于多目标跟踪领域,具有很强的实用性。

Description

三维空间转弯机动目标的轨迹起始方法及装置 技术领域
本发明属于多传感器信息融合技术领域,尤其涉及三维空间转弯机动目标的轨迹起始方法及装置。
背景技术
随着科学技术的发展,在自动控制以及多传感器信息融合技术领域越来越多的涉及到观测空间中新目标的探测,而其中轨迹起始是该领域中的研究人员重点研究的内容。
轨迹起始的主要任务是利用传感器在多个不同时刻获得的测量探测出现于观测空间中的新目标,并起始其轨迹。目前,常用的轨迹起始方法通常适用于假定目标作匀速或匀加速运动的轨迹起始,但是这些现有的轨迹起始方法并不适用于转弯机动目标的轨迹起始。因此,如何解决三维空间转弯机动目标的轨迹起始问题是目前需要探索和解决的一个关键技术问题。
技术问题
本发明所要解决的技术问题为提供一种三维空间转弯机动目标的轨迹起始方法及装置,旨在解决三维空间转弯机动目标的轨迹起始的问题。
技术解决方案
本发明提供了一种三维空间转弯机动目标的轨迹起始方法,所述方法包括:
步骤1、分别从三维空间转弯机动目标三个不同时刻的位置测量数据集中各自取出一个位置测量数据,构成位置测量数据组,用所述位置测量数据组中的三个位置测量数据确定坐标变换矩阵,并通过所述坐标变换矩阵将所述三个位置测量数据变换至xoy平面上,得到变换后的三个位置测量数据,用所述坐标变换矩阵对所述三个位置测量数据的误差协方差矩阵进行变换,得到所述三个位置测量数据变换后的误差协方差矩阵;
其具体步骤包括:设所述三维空间转弯机动目标在三个不同时刻的位置测量数据为y k=(z k,t k),其中,k=1,2,3,t k表示在k时刻的时间,
Figure PCTCN2018094175-appb-000001
Figure PCTCN2018094175-appb-000002
分别表示所述三维空间转弯机动目标在k时刻的位置测量数据的x分量、y分量和z分量;
Figure PCTCN2018094175-appb-000003
其中,i=1,2,3和j=1,2,3;利用连续的三个不同时刻的位置测量数据y 1=(z 1,t 1)、y 2=(z 2,t 2)和y 3=(z 3,t 3)获得所述三维空间转弯机动目标运动平面与xoy平面的夹角为α,所述三维空间转弯机动目标运动平面与xoy平面的交线和x轴间的夹角为β,所述交线与x轴的交点为[x 0,0,0] T
其中,
Figure PCTCN2018094175-appb-000004
Figure PCTCN2018094175-appb-000005
Figure PCTCN2018094175-appb-000006
Figure PCTCN2018094175-appb-000007
Figure PCTCN2018094175-appb-000008
上标T表示向量或矩阵的转置;
利用所述夹角α和所述夹角β,并取α 1=α,α 2=-α,β 1=β,β 2=-β,构建坐标变换矩阵F ij
其中,
Figure PCTCN2018094175-appb-000009
i=1,2和j=1,2;
利用所述坐标变换矩阵F ij,以及所述交点[x 0,0,0] T,分别对位置测量数据z 1、z 2和z 3进行坐标变换得到变换的位置测量数据
Figure PCTCN2018094175-appb-000010
Figure PCTCN2018094175-appb-000011
其中,
Figure PCTCN2018094175-appb-000012
Figure PCTCN2018094175-appb-000013
Figure PCTCN2018094175-appb-000014
利用变换的位置测量数据
Figure PCTCN2018094175-appb-000015
Figure PCTCN2018094175-appb-000016
求取
Figure PCTCN2018094175-appb-000017
其中i=1,2和j=1,2;从s ij,i=1,2和j=1,2中找到最小值对应的索引号,即
Figure PCTCN2018094175-appb-000018
并取索引号(i 1,j 1)对应的坐标变换矩阵作为所求的变换矩阵F c,即
Figure PCTCN2018094175-appb-000019
索引号(i 1,j 1)对应的位置测量数据
Figure PCTCN2018094175-appb-000020
Figure PCTCN2018094175-appb-000021
分别作为变换后的位置测量数据
Figure PCTCN2018094175-appb-000022
Figure PCTCN2018094175-appb-000023
Figure PCTCN2018094175-appb-000024
Figure PCTCN2018094175-appb-000025
设测量z k的误差协方差矩阵为
Figure PCTCN2018094175-appb-000026
其中
Figure PCTCN2018094175-appb-000027
Figure PCTCN2018094175-appb-000028
为误差协方差矩阵R k的元素值;利用所述变换矩阵F c对R k进行变换, 得到变换后的误差协方差矩阵
Figure PCTCN2018094175-appb-000029
其中
Figure PCTCN2018094175-appb-000030
k=1,2,3;
步骤2、测试变换后的三个位置测量数据是否同时满足三个预设条件;若能同时满足三个预设条件,用所述变换后的三个位置测量数据形成一试探性轨迹,并转入步骤3;否则转入步骤1取下一组位置测量数据组进行测试;
步骤3、利用所述变换后的三个位置测量数据得到所述三维空间转弯机动目标的转弯率估计;利用所述变换后的三个位置测量数据和所述三维空间转弯机动目标的转弯率估计,得到变换后的三维空间转弯机动目标初始状态估计和误差协方差估计;
步骤4、利用所述的坐标变换矩阵F c对变换后的三维空间转弯机动目标初始状态估计和误差协方差估计进行反变换,得到所述三维空间转弯机动目标的初始状态估计和误差协方差估计;
步骤5、在一个位置测量数据组的三个位置测量数据的测试完成后,转入步骤1取下一组位置测量数据组进行测试,直至所有的位置测量数据组都进行了测试。
本发明还提供了一种三维空间转弯机动目标的轨迹起始装置,所述装置包括:
变换模块,用于分别从三维空间转弯机动目标三个不同时刻的位置测量数据集中各自取出一个位置测量数据,构成位置测量数据组,用所述位置测量数据组中的三个位置测量数据确定坐标变换矩阵,并通过所述坐标变换矩阵将所述三个位置测量数据变换至xoy平面上,得到变换后的三个位置测量数据,用所述坐标变换矩阵对所述三个位置测量数据的误差协方差矩阵进行变换,得到所述三个位置测量数据变换后的误差协方差矩阵;
其具体用于:设所述三维空间转弯机动目标在三个不同时刻的位置测量数据为y k=(z k,t k),其中,k=1,2,3,t k表示在k时刻的时间,
Figure PCTCN2018094175-appb-000031
Figure PCTCN2018094175-appb-000032
分别表示所述三维空间转弯机动目标在k时刻的位置测量数据的x分量、y分量和z分量;
Figure PCTCN2018094175-appb-000033
其中,i=1,2,3和j=1,2,3;利用连续的三个不同时刻的位置测量数据y 1=(z 1,t 1)、y 2=(z 2,t 2)和y 3=(z 3,t 3)获得所述三维空间转弯机动目标运动平面与xoy平面的夹角为α,所述三维空间转弯机动目标运动平面与xoy平面的交线和x轴间的夹角为β,所述交线与x轴的交点为[x 0,0,0] T
其中,
Figure PCTCN2018094175-appb-000034
Figure PCTCN2018094175-appb-000035
Figure PCTCN2018094175-appb-000036
Figure PCTCN2018094175-appb-000037
Figure PCTCN2018094175-appb-000038
上标T表示向量或矩阵的转置;
利用所述夹角α和夹角β,并取α 1=α,α 2=-α,β 1=β,β 2=-β,构建坐标变换矩阵F ij
其中,
Figure PCTCN2018094175-appb-000039
i=1,2和j=1,2;
利用所述坐标变换矩阵F ij,以及所述交点[x 0,0,0] T,分别对位置测量数据z 1、z 2和z 3进行坐标变换得到变换的位置测量数据
Figure PCTCN2018094175-appb-000040
Figure PCTCN2018094175-appb-000041
其中,
Figure PCTCN2018094175-appb-000042
Figure PCTCN2018094175-appb-000043
Figure PCTCN2018094175-appb-000044
利用变换的位置测量数据
Figure PCTCN2018094175-appb-000045
Figure PCTCN2018094175-appb-000046
求取
Figure PCTCN2018094175-appb-000047
其中i=1,2和j=1,2;从s ij,i=1,2和j=1,2中找到最小值对应的索引号,即
Figure PCTCN2018094175-appb-000048
并取索引号(i 1,j 1)对应的坐标变换矩阵作为所求的变换矩阵F c,即
Figure PCTCN2018094175-appb-000049
索引号(i 1,j 1)对应的位置测量数据
Figure PCTCN2018094175-appb-000050
Figure PCTCN2018094175-appb-000051
分别作为变换后的位置测量数据
Figure PCTCN2018094175-appb-000052
Figure PCTCN2018094175-appb-000053
Figure PCTCN2018094175-appb-000054
Figure PCTCN2018094175-appb-000055
设测量z k的误差协方差矩阵为
Figure PCTCN2018094175-appb-000056
其中
Figure PCTCN2018094175-appb-000057
Figure PCTCN2018094175-appb-000058
为误差协方差矩阵R k的元素值;利用所述变换矩阵F c对R k进行变换,得到变换后的误差协方差矩阵
Figure PCTCN2018094175-appb-000059
其中
Figure PCTCN2018094175-appb-000060
k=1,2,3;
轨迹探测模块,用于测试变换后的三个位置测量数据是否同时满足三个预设条件;若能同时满足三个预设条件,用所述变换后的三个位置测量数据形成一试探性轨迹,并转入状态与误差协方差估计模块;否则转入变换模块取下一组位置测量数据组进行测试;
状态与误差协方差估计模块,用于利用所述变换后的三个位置测量数据得到所述三维 空间转弯机动目标的转弯率估计;利用所述变换后的三个位置测量数据和所述三维空间转弯机动目标的转弯率估计,得到变换后的三维空间转弯机动目标初始状态估计和误差协方差估计;
反变换模块,用于利用所述的坐标变换矩阵F c对变换后的三维空间转弯机动目标初始状态估计和误差协方差估计进行反变换,得到所述三维空间转弯机动目标的初始状态估计和误差协方差估计。
有益效果
本发明提供一种用于三维空间转弯机动目标的轨迹起始方法及装置,通过坐标变换、轨迹探测、状态与误差协方差估计,及坐标反变换,最终探测出三维空间中存在的转弯机动目标,并获得三维空间转弯机动目标的状态估计以及误差协方差估计,从而有效地解决了三维空间转弯机动目标轨迹难以起始的问题,本发明可用于多目标跟踪领域,具有很强的实用性。
附图说明
图1为本发明实施例提供的一种用于三维空间转弯机动目标的轨迹起始方法的流程示意图;
图2为本发明实施例提供的一种用于三维空间转弯机动目标的轨迹起始装置的系统示意图。
本发明的实施方式
作为本发明的第一个实施例,如图1所示,本发明实施例提供的一种用于三维空间转弯机动目标的轨迹起始方法的流程示意图,该方法包括:
步骤101、分别从三维空间转弯机动目标三个不同时刻的位置测量数据集中各自取出一个位置测量数据,构成位置测量数据组,用位置测量数据组中的三个位置测量数据确定坐标变换矩阵,并通过坐标变换矩阵将三个位置测量数据变换至xoy平面上,得到变换后的三个位置测量数据,用坐标变换矩阵对三个位置测量数据的误差协方差矩阵进行变换,得到三个位置测量数据变换后的误差协方差矩阵。
步骤101的主要目的是通过三个不同时刻的位置测量数据,利用坐标变换矩阵,得到变换后的三个位置测量数据,其步骤具体包括:
设三维空间转弯机动目标在三个不同时刻的位置测量数据为y k=(z k,t k),其中,k=1,2,3,t k表示在k时刻的时间,
Figure PCTCN2018094175-appb-000061
Figure PCTCN2018094175-appb-000062
分别表示三维空间转弯机动目标在k时刻的位置测量数据的x分量、y分量和z分量。
Figure PCTCN2018094175-appb-000063
其中,i=1,2,3和j=1,2,3;利用连续的三个不同时刻的位置测量数据y 1=(z 1,t 1)、y 2=(z 2,t 2)和y 3=(z 3,t 3)获得三维空间转弯机动目标运动平面与xoy平面的夹角为α,三维空间转弯机动目标运动平面与xoy平面的交线和x轴间的夹角为β,交线与x轴的交点为[x 0,0,0] T
其中,
Figure PCTCN2018094175-appb-000064
Figure PCTCN2018094175-appb-000065
Figure PCTCN2018094175-appb-000066
Figure PCTCN2018094175-appb-000067
Figure PCTCN2018094175-appb-000068
上标T表示向量或矩阵的转置;
利用夹角α和夹角β,并取α 1=α,α 2=-α,β 1=β,β 2=-β,构建坐标变换矩阵F ij
其中,
Figure PCTCN2018094175-appb-000069
i=1,2和j=1,2。
利用坐标变换矩阵F ij,以及交点[x 0,0,0] T,分别对位置测量数据z 1、z 2和z 3进行坐标变换得到变换的位置测量数据
Figure PCTCN2018094175-appb-000070
Figure PCTCN2018094175-appb-000071
其中,
Figure PCTCN2018094175-appb-000072
Figure PCTCN2018094175-appb-000073
Figure PCTCN2018094175-appb-000074
利用变换的位置测量数据
Figure PCTCN2018094175-appb-000075
Figure PCTCN2018094175-appb-000076
求取
Figure PCTCN2018094175-appb-000077
其中i=1,2和j=1,2;从s ij,i=1,2和j=1,2中找到最小值对应的索引号,即
Figure PCTCN2018094175-appb-000078
并取索引号(i 1,j 1)对应的坐标变换矩阵作为所求的变换矩阵F c,即
Figure PCTCN2018094175-appb-000079
索引号(i 1,j 1)对应的位置测量数据
Figure PCTCN2018094175-appb-000080
Figure PCTCN2018094175-appb-000081
分别作为变换后的位置测量数据
Figure PCTCN2018094175-appb-000082
Figure PCTCN2018094175-appb-000083
Figure PCTCN2018094175-appb-000084
Figure PCTCN2018094175-appb-000085
设测量z k的误差协方差矩阵为
Figure PCTCN2018094175-appb-000086
其中
Figure PCTCN2018094175-appb-000087
Figure PCTCN2018094175-appb-000088
为误差协方差矩阵R k的元素值;利用变换矩阵F c对R k进行变换,得到变换后的误差协方差矩阵
Figure PCTCN2018094175-appb-000089
其中
Figure PCTCN2018094175-appb-000090
k=1,2,3。
步骤102、测试变换后的三个位置测量数据是否同时满足三个预设条件;若能同时满足三个预设条件,用变换后的三个位置测量数据形成一试探性轨迹,并转入步骤103;否则转入步骤101取下一组位置测量数据组进行测试。
步骤102,主要利用三个预设条件测试来变换后的三个位置测量数据,并将满足三个预设条件的变换后的三个位置测量数据形成试探性轨迹,其具体步骤包括:
Figure PCTCN2018094175-appb-000091
Figure PCTCN2018094175-appb-000092
表示变换后的位置测量数据,测试位置测量数据
Figure PCTCN2018094175-appb-000093
Figure PCTCN2018094175-appb-000094
是否同时满足下列三个预设条件:
预设条件1:
Figure PCTCN2018094175-appb-000095
Figure PCTCN2018094175-appb-000096
预设条件2:
Figure PCTCN2018094175-appb-000097
预设条件3:
Figure PCTCN2018094175-appb-000098
其中,v min、v max、a max和ω max分别为最小速度、最大速度、最大加速度和最大转弯率,||·|| 2表示向量的2范数,b 1、b 2和c是三个与协方差矩阵
Figure PCTCN2018094175-appb-000099
相关的参数;以V k表示矩阵
Figure PCTCN2018094175-appb-000100
的乔里斯基(Cholesky)分解矩阵,即
Figure PCTCN2018094175-appb-000101
以V k,1、V k,2和V k,3表示分解矩阵V k的主对角线上的三个元素,其中,k=1,2,3,则参数b 1、b 2和c分别取为
Figure PCTCN2018094175-appb-000102
Figure PCTCN2018094175-appb-000103
Figure PCTCN2018094175-appb-000104
其中,b 3控制参数,其取值范围为b 3=1~3。
步骤103、利用变换后的三个位置测量数据得到三维空间转弯机动目标的转弯率估计;利用变换后的三个位置测量数据和三维空间转弯机动目标的转弯率估计,得到变换后的三维空间转弯机动目标初始状态估计和误差协方差估计。其具体步骤包括:
利用已形成试探性轨迹的变换后的三个位置测量数据
Figure PCTCN2018094175-appb-000105
Figure PCTCN2018094175-appb-000106
得到三维空间转弯机动目标的转弯率估计为
Figure PCTCN2018094175-appb-000107
其中,
Figure PCTCN2018094175-appb-000108
sgn(a)为取变量a的符号,且有
Figure PCTCN2018094175-appb-000109
利用已形成试探性轨迹的变换后的三个位置测量数据
Figure PCTCN2018094175-appb-000110
Figure PCTCN2018094175-appb-000111
形成列向量m y,得到
Figure PCTCN2018094175-appb-000112
Figure PCTCN2018094175-appb-000113
表示r时刻坐标变换后的三维空间转弯机动目标状态估计,其中
Figure PCTCN2018094175-appb-000114
Figure PCTCN2018094175-appb-000115
分别表示位置的x分量、y分量和z分量,
Figure PCTCN2018094175-appb-000116
Figure PCTCN2018094175-appb-000117
分别表示速度的x分量和y分量;
基于列向量m y及转弯率估计
Figure PCTCN2018094175-appb-000118
获得在r时刻变换后的三维空间转弯机动目标状态估计为
Figure PCTCN2018094175-appb-000119
其中,
Figure PCTCN2018094175-appb-000120
Figure PCTCN2018094175-appb-000121
k=1,2,3
在r时刻变换后的误差协方差矩阵为
Figure PCTCN2018094175-appb-000122
其中,
Figure PCTCN2018094175-appb-000123
步骤104、利用的坐标变换矩阵F c对变换后的三维空间转弯机动目标初始状态估计和误差协方差估计进行反变换,得到三维空间转弯机动目标的初始状态估计和误差协方差估计。其具体步骤包括:
利用变换矩阵F c对变换后的三维空间转弯机动目标状态估计
Figure PCTCN2018094175-appb-000124
进行反变换,以获得三维空间转弯机动目标在r时刻的状态估计为
Figure PCTCN2018094175-appb-000125
利用变换矩阵F c对变换后的误差协方差矩阵
Figure PCTCN2018094175-appb-000126
进行反变换,得到目标在r时刻的误差协方差矩阵为P r
其中,
Figure PCTCN2018094175-appb-000127
Figure PCTCN2018094175-appb-000128
Figure PCTCN2018094175-appb-000129
其中,F c(i,j)表示矩阵F c的第i行第j列元素。
步骤105、在一个位置测量数据组的三个位置测量数据的测试完成后,转入步骤101取下一组位置测量数据组进行测试,直至所有的位置测量数据组都进行了测试。
在本发明第一个实施例所提供的一种用于三维空间转弯机动目标的轨迹起始方法,通过坐标变换、轨迹探测、状态与误差协方差估计,及坐标反变换,最终探测出观测空间中存在的目标,并获得目标的状态估计,从而有效地解决了三维空间转弯机动目标轨迹难以起始的问题,可用于多目标跟踪领域,具有很强的实用性。
作为本发明的第二个实施例,请参阅图2,图2为本发明实施例提供的一种用于三维空间转弯机动目标的轨迹起始装置的系统示意图。该装置包括:
变换模块10,用于分别从三维空间转弯机动目标三个不同时刻的位置测量数据集中各自取出一个位置测量数据,构成位置测量数据组,用位置测量数据组中的三个位置测量数据确定坐标变换矩阵,并通过坐标变换矩阵将三个位置测量数据变换至xoy平面上,得到变换后的三个位置测量数据,用坐标变换矩阵对三个位置测量数据的误差协方差矩阵进行变换,得到三个位置测量数据变换后的误差协方差矩阵。
其具体用于:设三维空间转弯机动目标在三个不同时刻的位置测量数据为y k=(z k,t k), 其中,k=1,2,3,t k表示在k时刻的时间,
Figure PCTCN2018094175-appb-000130
Figure PCTCN2018094175-appb-000131
Figure PCTCN2018094175-appb-000132
分别表示三维空间转弯机动目标在k时刻的位置测量数据的x分量、y分量和z分量。
Figure PCTCN2018094175-appb-000133
其中,i=1,2,3和j=1,2,3;利用连续的三个不同时刻的位置测量数据y 1=(z 1,t 1)、y 2=(z 2,t 2)和y 3=(z 3,t 3)获得三维空间转弯机动目标运动平面与xoy平面的夹角为α,三维空间转弯机动目标运动平面与xoy平面的交线和x轴间的夹角为β,交线与x轴的交点为[x 0,0,0] T
其中,
Figure PCTCN2018094175-appb-000134
Figure PCTCN2018094175-appb-000135
Figure PCTCN2018094175-appb-000136
Figure PCTCN2018094175-appb-000137
Figure PCTCN2018094175-appb-000138
上标T表示向量或矩阵的转置。
利用的夹角α和夹角β,并取α 1=α,α 2=-α,β 1=β,β 2=-β,构建坐标变换矩阵F ij
其中,
Figure PCTCN2018094175-appb-000139
i=1,2和j=1,2。
利用坐标变换矩阵F ij,以及交点[x 0,0,0] T,分别对位置测量数据z 1、z 2和z 3进行坐标变换得到变换的位置测量数据
Figure PCTCN2018094175-appb-000140
Figure PCTCN2018094175-appb-000141
其中,
Figure PCTCN2018094175-appb-000142
Figure PCTCN2018094175-appb-000143
Figure PCTCN2018094175-appb-000144
利用变换的位置测量数据
Figure PCTCN2018094175-appb-000145
Figure PCTCN2018094175-appb-000146
求取
Figure PCTCN2018094175-appb-000147
其中i=1,2和j=1,2;从s ij,i=1,2和j=1,2中找到最小值对应的索引号,即
Figure PCTCN2018094175-appb-000148
并取索引号(i 1,j 1)对应的坐标变换矩阵作为所求的变换矩阵F c,即
Figure PCTCN2018094175-appb-000149
索引号(i 1,j 1)对应的位置测量数据
Figure PCTCN2018094175-appb-000150
Figure PCTCN2018094175-appb-000151
分别作为变换后的位置测量数据
Figure PCTCN2018094175-appb-000152
Figure PCTCN2018094175-appb-000153
Figure PCTCN2018094175-appb-000154
Figure PCTCN2018094175-appb-000155
设测量z k的误差协方差矩阵为
Figure PCTCN2018094175-appb-000156
其中
Figure PCTCN2018094175-appb-000157
Figure PCTCN2018094175-appb-000158
为误差协方差矩阵R k的元素值;利用变换矩阵F c对R k进行变换,得到变换后的误差协方差矩阵
Figure PCTCN2018094175-appb-000159
其中
Figure PCTCN2018094175-appb-000160
k=1,2,3。
轨迹探测模块10,用于测试变换后的三个位置测量数据是否同时满足三个预设条件;若能同时满足三个预设条件,用变换后的三个位置测量数据形成一试探性轨迹,并转入状态与误差协方差估计模块;否则转入变换模块取下一组位置测量数据组进行测试。轨迹探测模块10具体用于:
Figure PCTCN2018094175-appb-000161
Figure PCTCN2018094175-appb-000162
表示变换后的位置测量数据,测试位置测量数据
Figure PCTCN2018094175-appb-000163
Figure PCTCN2018094175-appb-000164
是否同时满足下列三个预设条件:
预设条件1:
Figure PCTCN2018094175-appb-000165
Figure PCTCN2018094175-appb-000166
预设条件2:
Figure PCTCN2018094175-appb-000167
预设条件3:
Figure PCTCN2018094175-appb-000168
其中,v min、v max、a max和ω max分别为最小速度、最大速度、最大加速度和最大转弯率,||·|| 2表示向量的2范数,b 1、b 2和c是三个与协方差矩阵
Figure PCTCN2018094175-appb-000169
相关的参数;以V k表示矩阵
Figure PCTCN2018094175-appb-000170
的乔里斯基(Cholesky)分解矩阵,即
Figure PCTCN2018094175-appb-000171
以V k,1、V k,2和V k,3表示分解矩阵V k的主对角线上的三个元素,其中,k=1,2,3,则参数b 1、b 2和c分别取为
Figure PCTCN2018094175-appb-000172
Figure PCTCN2018094175-appb-000173
Figure PCTCN2018094175-appb-000174
其中,b 3控制参数,其取值范围为b 3=1~3。
状态与误差协方差估计模块30,用于利用变换后的三个位置测量数据得到三维空间转弯机动目标的转弯率估计;利用变换后的三个位置测量数据和三维空间转弯机动目标的转弯率估计,得到变换后的三维空间转弯机动目标初始状态估计和误差协方差估计。状态与误差协方差估计模块30具体用于:
利用已形成试探性轨迹的变换后的三个位置测量数据
Figure PCTCN2018094175-appb-000175
Figure PCTCN2018094175-appb-000176
得到三维空间转弯机动目标的转弯率估计为:
Figure PCTCN2018094175-appb-000177
其中,
Figure PCTCN2018094175-appb-000178
sgn(a)为取变量a的符号,且有
Figure PCTCN2018094175-appb-000179
利用已形成试探性轨迹的变换后的三个位置测量数据
Figure PCTCN2018094175-appb-000180
Figure PCTCN2018094175-appb-000181
形成列向量m y,得到
Figure PCTCN2018094175-appb-000182
Figure PCTCN2018094175-appb-000183
表示r时刻坐标变换后的三维空间转弯机动目标状态估计,其中
Figure PCTCN2018094175-appb-000184
Figure PCTCN2018094175-appb-000185
分别表示位置的x分量、y分量和z分量,
Figure PCTCN2018094175-appb-000186
Figure PCTCN2018094175-appb-000187
分别表示速度的x分量和y分量。
基于列向量m y及转弯率估计
Figure PCTCN2018094175-appb-000188
获得在r时刻变换后的三维空间转弯机动目标状态估 计为
Figure PCTCN2018094175-appb-000189
其中,
Figure PCTCN2018094175-appb-000190
Figure PCTCN2018094175-appb-000191
k=1,2,3。
在r时刻变换后的误差协方差矩阵为:
Figure PCTCN2018094175-appb-000192
其中,
Figure PCTCN2018094175-appb-000193
反变换模块40,用于利用的坐标变换矩阵F c对变换后的三维空间转弯机动目标初始状态估计和误差协方差估计进行反变换,得到三维空间转弯机动目标的初始状态估计和误差协方差估计。反变换模块40具体用于:
利用变换矩阵F c对变换后的三维空间转弯机动目标状态估计
Figure PCTCN2018094175-appb-000194
进行反变换,以获得三维空间转弯机动目标在r时刻的状态估计为
Figure PCTCN2018094175-appb-000195
利用变换矩阵F c对变换后的误差协方差矩阵
Figure PCTCN2018094175-appb-000196
进行反变换,得到目标在r时刻的误差协方差矩阵为P r
其中,
Figure PCTCN2018094175-appb-000197
Figure PCTCN2018094175-appb-000198
Figure PCTCN2018094175-appb-000199
其中,F c(i,j)表示矩阵F c的第i行第j列元素。
本发明第二个实施例所提供的一种用于三维空间转弯机动目标的轨迹起始装置,通过坐标变换模块、轨迹探测模块、状态与误差协方差估计模块、坐标反变换模块以及循环装置,最终探测出观测空间中存在的目标,并获得目标的状态估计,从而有效地解决了三维空间转弯机动目标轨迹难以起始的问题,可用于多目标跟踪领域,具有很强的实用性。
作为本发明的第三个实例,其采用了如上述第一个实施例所提供的方法对仿真数据进行了实验。本实施例主要考虑两个在三维空间中作转弯机动的转弯机动目标,目标1的转弯率为ω=-5°/s,其初始状态为
Figure PCTCN2018094175-appb-000200
其在t=0、t=T和t=2T时刻位置分别为[-866.8m,969.2m,207.1m] T,[-324.6m,1224.0m,193.5m] T和[251.6m,1383.7m,153.4m] T,目标2的转弯转弯率为ω=5°/s,其初始状态为[-733.1m,242.5m/s,1203.8m,140.0m/s,-310.6m,0m/s] T,其在t=0、t=T和t=2T时刻位置分别为[-733.1m,1203.8m,-310.6m] T,[-274.2m,1523.2m,-323.2m] T和[123.8m,1914.4m,-360.7m] T。传感器测量目标位置,其采样周期为T=2s,位置测量数据为目标位置加上测量噪声,用σ x表示传感器在x方向上的测量噪声的标准差,σ y.表示传感器在y方向上的测量噪声的标准差,σ z.表示传感器在z方向上的测量噪声的标准差,它们的取值为:σ x=σ y=σ z=1m,协方差矩阵中σ xy、σ yz和σ xz的取为σ xy=σ yz=σ xz=0m。传感器在t=0、t=T和t=2T对目标测量,得到3个位置测量数据。两个目标在t=0s时的状态值如下表1所示:
表1:两个目标在t=0s时的状态值
Figure PCTCN2018094175-appb-000201
为了处理传感器获得的测量数据,设最小速度v min=450m/s、最大速度v max=200m/s、最大加速度a max=3m/s 2,最大转弯率ω max=12°/s(即ω max=0.2094rad/s),控制参数b 3=2.5。采用如本发明第一实施例所提供的方法对传感器获得的测量数据进行处理,可以成功地探测出观测空间中的两个目标,并能得到这两个目 标在t=0s时的状态估计,两个目标在t=0s时的状态估计如下表2所示:
表2:一次实验得到的两个目标在t=0s时的状态估计
Figure PCTCN2018094175-appb-000202
采用本发明第一实施例所提供的方法,进行了100次蒙特·卡罗统计模拟实验,得到上述两个目标在t=0s时的状态估计下表3所示:
表3:100次蒙特·卡罗统计模拟得到的两个目标在t=0s时的状态估计
Figure PCTCN2018094175-appb-000203
对比表1所示的两目标的状态值,表2和表3的实验结果表明,本发明所提供的三维空间转弯机动目标的轨迹起始方法,可以获得较为精确和可靠的目标状态估计、各目标的状态估计非常接近它们真实的状态值。
序列表自由内容
以上仅为本发明的较佳实施例而已,并不用以限制发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
在本申请所提供的几个实施例中,应该理解到,所揭露的装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,模块的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个模块或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或模块的间接耦合或通信连接,可以是电性,机械或其它的形式。
作为分离部件说明的模块可以是或者也可以不是物理上分开的,作为模块显示的部件可以是或者也可以不是物理模块,即可以位于一个地方,或者也可以分布到多个网络模块上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。
另外,在本发明各个实施例中的各功能模块可以集成在一个处理模块中,也可以是各个模块单独物理存在,也可以两个或两个以上模块集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。
集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
需要说明的是,对于前述的各方法实施例,为了简便描述,故将其都表述为一系列的动作组合,但是本领域技术人员应该知悉,本发明并不受所描述的动作顺序的限制,因为依据 本发明,某些步骤可以采用其它顺序或者同时进行。其次,本领域技术人员也应该知悉,说明书中所描述的实施例均属于优选实施例,所涉及的动作和模块并不一定都是本发明所必须的。
在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述的部分,可以参见其它实施例的相关描述。
以上为对本发明所提供的一种用于三维空间转弯机动目标的轨迹起始方法及装置的描述,对于本领域的技术人员,依据本发明实施例的思想,在具体实施方式及应用范围上均会有改变之处,综上,本说明书内容不应理解为对本发明的限制。

Claims (8)

  1. 一种用于转弯机动目标的轨迹起始方法,其特征在于,所述方法包括:
    步骤1、分别从三维空间转弯机动目标三个不同时刻的位置测量数据集中各自取出一个位置测量数据,构成位置测量数据组,用所述位置测量数据组中的三个位置测量数据确定坐标变换矩阵,并通过所述坐标变换矩阵将所述三个位置测量数据变换至xoy平面上,得到变换后的三个位置测量数据,用所述坐标变换矩阵对所述三个位置测量数据的误差协方差矩阵进行变换,得到所述三个位置测量数据变换后的误差协方差矩阵;
    其具体步骤包括:设所述三维空间转弯机动目标在三个不同时刻的位置测量数据为y k=(z k,t k) 其中,k=1,2,3,t k表示在k时刻的时间,
    Figure PCTCN2018094175-appb-100001
    Figure PCTCN2018094175-appb-100002
    分别表示所述三维空间转弯机动目标在k时刻的位置测量数据的x分量、y分量和z分量;
    Figure PCTCN2018094175-appb-100003
    其中,i=1,2,3和j=1,2,3;利用连续的三个不同时刻的位置测量数据y 1=(z 1,t 1)、y 2=(z 2,t 2)和y 3=(z 3,t 3)获得所述三维空间转弯机动目标运动平面与xoy平面的夹角为α,所述三维空间转弯机动目标运动平面与xoy平面的交线和x轴间的夹角为β,所述交线与x轴的交点为[x 0,0,0] T
    其中,
    Figure PCTCN2018094175-appb-100004
    Figure PCTCN2018094175-appb-100005
    Figure PCTCN2018094175-appb-100006
    Figure PCTCN2018094175-appb-100007
    Figure PCTCN2018094175-appb-100008
    上标T表示向量或矩阵的转置;
    利用所述夹角α和所述夹角β,并取α 1=α,α 2=-α,β 1=β,β 2=-β,构建坐标变换矩阵F ij
    其中,
    Figure PCTCN2018094175-appb-100009
    i=1,2和j=1,2;
    利用所述坐标变换矩阵F ij,以及所述交点[x 0,0,0] T,分别对位置测量数据z 1、z 2和z 3进行坐标变换得到变换的位置测量数据
    Figure PCTCN2018094175-appb-100010
    Figure PCTCN2018094175-appb-100011
    其中,
    Figure PCTCN2018094175-appb-100012
    Figure PCTCN2018094175-appb-100013
    Figure PCTCN2018094175-appb-100014
    利用变换的位置测量数据
    Figure PCTCN2018094175-appb-100015
    求取
    Figure PCTCN2018094175-appb-100016
    其中i=1,2和j=1,2;从s ij,i=1,2和j=1,2中找到最小值对应的索引号,即
    Figure PCTCN2018094175-appb-100017
    并取索引号(i 1,j 1)对应的坐标变换矩阵作为所求的变换矩阵F c,即
    Figure PCTCN2018094175-appb-100018
    索引号(i 1,j 1)对应的位置测量数据
    Figure PCTCN2018094175-appb-100019
    Figure PCTCN2018094175-appb-100020
    分别作为变换后的位置测量数据
    Figure PCTCN2018094175-appb-100021
    Figure PCTCN2018094175-appb-100022
    Figure PCTCN2018094175-appb-100023
    Figure PCTCN2018094175-appb-100024
    设测量z k的误差协方差矩阵为
    Figure PCTCN2018094175-appb-100025
    其中
    Figure PCTCN2018094175-appb-100026
    Figure PCTCN2018094175-appb-100027
    为误差协方差矩阵R k的元素值;利用所述变换矩阵F c对R k进行变换,得到变换后的误差协方差矩阵
    Figure PCTCN2018094175-appb-100028
    其中
    Figure PCTCN2018094175-appb-100029
    k=1,2,3;
    步骤2、测试变换后的三个位置测量数据是否同时满足三个预设条件;若能同时满足三个预设条件,用所述变换后的三个位置测量数据形成一试探性轨迹,并转入步骤3;否则转入步骤1取下一组位置测量数据组进行测试;
    步骤3、利用所述变换后的三个位置测量数据得到所述三维空间转弯机动目标的转弯率估计;利用所述变换后的三个位置测量数据和所述三维空间转弯机动目标的转弯率估计,得到变换后的三维空间转弯机动目标初始状态估计和误差协方差估计;
    步骤4、利用所述的坐标变换矩阵F c对变换后的三维空间转弯机动目标初始状态估计和误差协方差估计进行反变换,得到所述三维空间转弯机动目标的初始状态估计和误差协方差估计;
    步骤5、在一个位置测量数据组的三个位置测量数据的测试完成后,转入步骤1取下一组位置测量数据组进行测试,直至所有的位置测量数据组都进行了测试。
  2. 如权利要求1所述的方法,其特征在于,所述步骤2包括:
    Figure PCTCN2018094175-appb-100030
    Figure PCTCN2018094175-appb-100031
    表示变换后的位置测 量数据,测试所述位置测量数据
    Figure PCTCN2018094175-appb-100032
    Figure PCTCN2018094175-appb-100033
    是否同时满足下列三个预设条件:
    预设条件1:
    Figure PCTCN2018094175-appb-100034
    Figure PCTCN2018094175-appb-100035
    预设条件2:
    Figure PCTCN2018094175-appb-100036
    预设条件3:
    Figure PCTCN2018094175-appb-100037
    其中,v min、v max、a max和ω max分别为最小速度、最大速度、最大加速度和最大转弯率,||·|| 2表示向量的2范数,b 1、b 2和c是三个与协方差矩阵
    Figure PCTCN2018094175-appb-100038
    相关的参数;以V k表示矩阵
    Figure PCTCN2018094175-appb-100039
    的乔里斯基(Cholesky)分解矩阵,即
    Figure PCTCN2018094175-appb-100040
    以V k,1、V k,2和V k,3表示分解矩阵V k的主对角线上的三个元素,其中,k=1,2,3,则参数b 1、b 2和c分别取为
    Figure PCTCN2018094175-appb-100041
    Figure PCTCN2018094175-appb-100042
    Figure PCTCN2018094175-appb-100043
    其中,b 3控制参数,其取值范围为b 3=1~3。
  3. 如权利要求2所述的方法,其特征在于,所述步骤3包括:
    利用已形成试探性轨迹的所述变换后的三个位置测量数据
    Figure PCTCN2018094175-appb-100044
    Figure PCTCN2018094175-appb-100045
    得到所述三维空间转弯机动目标的转弯率估计为
    Figure PCTCN2018094175-appb-100046
    其中,
    Figure PCTCN2018094175-appb-100047
    sgn(a)为取变量a的符号,且 有
    Figure PCTCN2018094175-appb-100048
    利用已形成试探性轨迹的所述变换后的三个位置测量数据
    Figure PCTCN2018094175-appb-100049
    Figure PCTCN2018094175-appb-100050
    形成列向量m y,得到
    Figure PCTCN2018094175-appb-100051
    Figure PCTCN2018094175-appb-100052
    表示r时刻坐标变换后的三维空间转弯机动目标状态估计,其中
    Figure PCTCN2018094175-appb-100053
    Figure PCTCN2018094175-appb-100054
    分别表示位置的x分量、y分量和z分量,
    Figure PCTCN2018094175-appb-100055
    Figure PCTCN2018094175-appb-100056
    分别表示速度的x分量和y分量;
    基于所述列向量m y及所述转弯率估计
    Figure PCTCN2018094175-appb-100057
    获得在r时刻变换后的三维空间转弯机动目标状态估计为
    Figure PCTCN2018094175-appb-100058
    其中,
    Figure PCTCN2018094175-appb-100059
    Figure PCTCN2018094175-appb-100060
    k=1,2,3
    在r时刻变换后的误差协方差矩阵为
    Figure PCTCN2018094175-appb-100061
    其中,
    Figure PCTCN2018094175-appb-100062
  4. 如权利要求3所述的方法,其特征在于,所述步骤4包括:
    利用所述变换矩阵F c对变换后的三维空间转弯机动目标状态估计
    Figure PCTCN2018094175-appb-100063
    进行反变换,以获得三维空间转弯机动目标在r时刻的状态估计为
    Figure PCTCN2018094175-appb-100064
    利用所述变换矩阵F c对变换后的误差协方差矩阵
    Figure PCTCN2018094175-appb-100065
    进行反变换,得到目标在r时刻的误差协方差矩阵为P r
    其中,
    Figure PCTCN2018094175-appb-100066
    Figure PCTCN2018094175-appb-100067
    Figure PCTCN2018094175-appb-100068
    其中,F c(i,j)表示矩阵F c的第i行第j列元素。
  5. 三维空间转弯机动目标的轨迹起始装置,其特征在于,所述装置包括:
    变换模块,用于分别从三维空间转弯机动目标三个不同时刻的位置测量数据集中各自取出一个位置测量数据,构成位置测量数据组,用所述位置测量数据组中的三个位置测量数据确定坐标变换矩阵,并通过所述坐标变换矩阵将所述三个位置测量数据变换至xoy平面上,得到变换后的三个位置测量数据,用所述坐标变换矩阵对所述三个位置测量数据的误差协方差矩阵进行变换,得到所述三个位置测量数据变换后的误差协方差矩阵;
    其具体用于:设所述三维空间转弯机动目标在三个不同时刻的位置测量数据为y k=(z k,t k),其中,k=1,2,3,t k表示在k时刻的时间,
    Figure PCTCN2018094175-appb-100069
    Figure PCTCN2018094175-appb-100070
    分别表示所述三维空间转弯机动目标在k时刻的位置测量数据的x分量、y分量和z分量;
    Figure PCTCN2018094175-appb-100071
    其中,i=1,2,3和j=1,2,3;利用连续的三个不同时刻的位置测量数据y 1=(z 1,t 1)、y 2=(z 2,t 2)和y 3=(z 3,t 3)获得所述三维空间转弯机动目标运动平面与xoy平面的夹角为α,所述三维空间转弯机动目标运动平面与xoy平面的交线和x轴间的夹角为β,所述交线与x轴的交点为[x 0,0,0] T
    其中,
    Figure PCTCN2018094175-appb-100072
    Figure PCTCN2018094175-appb-100073
    Figure PCTCN2018094175-appb-100074
    Figure PCTCN2018094175-appb-100075
    Figure PCTCN2018094175-appb-100076
    上标T表示向量或矩阵的转置;
    利用所述夹角α和夹角β,并取α 1=α,α 2=-α,β 1=β,β 2=-β,构建坐标变换矩阵F ij
    其中,
    Figure PCTCN2018094175-appb-100077
    i=1,2和j=1,2;
    利用所述坐标变换矩阵F ij,以及所述交点[x 0,0,0] T,分别对位置测量数据z 1、z 2和z 3进行坐标变换得到变换的位置测量数据
    Figure PCTCN2018094175-appb-100078
    Figure PCTCN2018094175-appb-100079
    其中,
    Figure PCTCN2018094175-appb-100080
    Figure PCTCN2018094175-appb-100081
    Figure PCTCN2018094175-appb-100082
    利用变换的位置测量数据
    Figure PCTCN2018094175-appb-100083
    Figure PCTCN2018094175-appb-100084
    求取
    Figure PCTCN2018094175-appb-100085
    其中i=1,2和j=1,2;从s ij,i=1,2和j=1,2中找到最小值对应的索引号,即
    Figure PCTCN2018094175-appb-100086
    并取索引号(i 1,j 1)对应的坐标变换矩阵作为所求的变换矩阵F c,即
    Figure PCTCN2018094175-appb-100087
    索引号(i 1,j 1)对应的位置测量数据
    Figure PCTCN2018094175-appb-100088
    Figure PCTCN2018094175-appb-100089
    分别作为变换后的位置测量数据
    Figure PCTCN2018094175-appb-100090
    Figure PCTCN2018094175-appb-100091
    Figure PCTCN2018094175-appb-100092
    Figure PCTCN2018094175-appb-100093
    设测量z k的误差协方差矩阵为
    Figure PCTCN2018094175-appb-100094
    其中
    Figure PCTCN2018094175-appb-100095
    Figure PCTCN2018094175-appb-100096
    为误差协方差矩阵R k的元素值;利用所述变换矩阵F c对R k进行变换,得到变换后的误差协方差矩阵
    Figure PCTCN2018094175-appb-100097
    其中
    Figure PCTCN2018094175-appb-100098
    k=1,2,3;
    轨迹探测模块,用于测试变换后的三个位置测量数据是否同时满足三个预设条件;若能同时满足三个预设条件,用所述变换后的三个位置测量数据形成一试探性轨迹,并转入状态与误差协方差估计模块;否则转入变换模块取下一组位置测量数据组进行测试;
    状态与误差协方差估计模块,用于利用所述变换后的三个位置测量数据得到所述三维空间转弯机动目标的转弯率估计;利用所述变换后的三个位置测量数据和所述三维空间转弯机动目标的转弯率估计,得到变换后的三维空间转弯机动目标初始状态估计和误差协方差估计;
    反变换模块,用于利用所述的坐标变换矩阵F c对变换后的三维空间转弯机动目标初始状态估计和误差协方差估计进行反变换,得到所述三维空间转弯机动目标的初始状态估计和误差协方差估计。
  6. 如权利要求5所述的装置,其特征在于,所述轨迹探测模块具体用于:
    Figure PCTCN2018094175-appb-100099
    Figure PCTCN2018094175-appb-100100
    表示变换后的位置测量数据,测试所述位置测量数据
    Figure PCTCN2018094175-appb-100101
    Figure PCTCN2018094175-appb-100102
    是否同时满足下列三个预设条件:
    预设条件1:
    Figure PCTCN2018094175-appb-100103
    Figure PCTCN2018094175-appb-100104
    预设条件2:
    Figure PCTCN2018094175-appb-100105
    预设条件3:
    Figure PCTCN2018094175-appb-100106
    其中,v min、v max、a max和ω max分别为最小速度、最大速度、最大加速度和最大转弯率,||·|| 2表示向量的2范数,b 1、b 2和c是三个与协方差矩阵
    Figure PCTCN2018094175-appb-100107
    相关的参数;以V k表示矩阵
    Figure PCTCN2018094175-appb-100108
    的乔里斯基(Cholesky)分解矩阵,即
    Figure PCTCN2018094175-appb-100109
    以V k,1、V k,2和V k,3表示分解矩阵V k的主对角线上的三个元素,其中,k=1,2,3,则参数b 1、b 2和c分别取为
    Figure PCTCN2018094175-appb-100110
    Figure PCTCN2018094175-appb-100111
    Figure PCTCN2018094175-appb-100112
    其中,b 3控制参数,其取值范围为b 3=1~3。
  7. 如权利要求6所述的装置,其特征在于,所述状态与误差协方差估计模块具体用于:
    利用已形成试探性轨迹的所述变换后的三个位置测量数据
    Figure PCTCN2018094175-appb-100113
    Figure PCTCN2018094175-appb-100114
    得到所述三维空间转弯机动目标的转弯率估计为
    Figure PCTCN2018094175-appb-100115
    其中,
    Figure PCTCN2018094175-appb-100116
    sgn(a)为取变量a的符号,且有
    Figure PCTCN2018094175-appb-100117
    利用已形成试探性轨迹的所述变换后的三个位置测量数据
    Figure PCTCN2018094175-appb-100118
    Figure PCTCN2018094175-appb-100119
    形成列向量m y,得到
    Figure PCTCN2018094175-appb-100120
    Figure PCTCN2018094175-appb-100121
    表示r时刻坐标变换后的三维空间转弯机动目标状态估计,其中
    Figure PCTCN2018094175-appb-100122
    Figure PCTCN2018094175-appb-100123
    分别表示位置的x分量、y分量和z分量,
    Figure PCTCN2018094175-appb-100124
    Figure PCTCN2018094175-appb-100125
    分别表示速度的x分量和y分量;
    基于所述列向量m y及所述转弯率估计
    Figure PCTCN2018094175-appb-100126
    获得在r时刻变换后的三维空间转弯机动目标状态估计为
    Figure PCTCN2018094175-appb-100127
    其中,
    Figure PCTCN2018094175-appb-100128
    Figure PCTCN2018094175-appb-100129
    在r时刻变换后的误差协方差矩阵为
    Figure PCTCN2018094175-appb-100130
    其中,
    Figure PCTCN2018094175-appb-100131
  8. 如权利要求7所述的装置,其特征在于,所述反变换模块具体用于:
    利用所述变换矩阵F c对变换后的三维空间转弯机动目标状态估计
    Figure PCTCN2018094175-appb-100132
    进行反变换,以获得三维空间转弯机动目标在r时刻的状态估计为
    Figure PCTCN2018094175-appb-100133
    利用所述变换矩阵F c对变换后的误差协方差矩阵
    Figure PCTCN2018094175-appb-100134
    进行反变换,得到目标在r时刻的误差协方差矩阵为P r
    其中,
    Figure PCTCN2018094175-appb-100135
    Figure PCTCN2018094175-appb-100136
    Figure PCTCN2018094175-appb-100137
    其中,F c(i,j)表示矩阵F c的第i行第j列元素。
PCT/CN2018/094175 2018-07-03 2018-07-03 三维空间转弯机动目标的轨迹起始方法及装置 WO2020006672A1 (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/CN2018/094175 WO2020006672A1 (zh) 2018-07-03 2018-07-03 三维空间转弯机动目标的轨迹起始方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2018/094175 WO2020006672A1 (zh) 2018-07-03 2018-07-03 三维空间转弯机动目标的轨迹起始方法及装置

Publications (1)

Publication Number Publication Date
WO2020006672A1 true WO2020006672A1 (zh) 2020-01-09

Family

ID=69059199

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2018/094175 WO2020006672A1 (zh) 2018-07-03 2018-07-03 三维空间转弯机动目标的轨迹起始方法及装置

Country Status (1)

Country Link
WO (1) WO2020006672A1 (zh)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104318059A (zh) * 2014-09-24 2015-01-28 深圳大学 用于非线性高斯系统的目标跟踪方法和跟踪系统
CN104377447A (zh) * 2014-10-27 2015-02-25 北京遥测技术研究所 一种基于Kalman滤波器的机动目标跟踪控制系统
CN105719312A (zh) * 2016-01-19 2016-06-29 深圳大学 基于序贯贝叶斯滤波的多目标跟踪方法及跟踪系统
CN106168943A (zh) * 2016-07-12 2016-11-30 深圳大学 一种用于跟踪转弯机动目标的方法及其系统
CN106952290A (zh) * 2017-04-07 2017-07-14 深圳大学 一种用于三维空间跟踪转弯机动目标的方法及系统
CN107390631A (zh) * 2017-07-14 2017-11-24 深圳大学 一种用于转弯机动目标的轨迹起始方法及系统

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104318059A (zh) * 2014-09-24 2015-01-28 深圳大学 用于非线性高斯系统的目标跟踪方法和跟踪系统
CN104377447A (zh) * 2014-10-27 2015-02-25 北京遥测技术研究所 一种基于Kalman滤波器的机动目标跟踪控制系统
CN105719312A (zh) * 2016-01-19 2016-06-29 深圳大学 基于序贯贝叶斯滤波的多目标跟踪方法及跟踪系统
CN106168943A (zh) * 2016-07-12 2016-11-30 深圳大学 一种用于跟踪转弯机动目标的方法及其系统
CN106952290A (zh) * 2017-04-07 2017-07-14 深圳大学 一种用于三维空间跟踪转弯机动目标的方法及系统
CN107390631A (zh) * 2017-07-14 2017-11-24 深圳大学 一种用于转弯机动目标的轨迹起始方法及系统

Similar Documents

Publication Publication Date Title
CN110865343B (zh) 基于lmb的粒子滤波检测前跟踪方法及系统
Gasbarri et al. Ground tests for vision based determination and control of formation flying spacecraft trajectories
CN107390631B (zh) 一种用于转弯机动目标的轨迹起始方法及系统
CN111401180B (zh) 神经网络识别模型训练方法、装置、服务器及存储介质
CN106054167A (zh) 基于强度滤波器的多扩展目标跟踪方法
CN110595479B (zh) 一种基于icp算法的slam轨迹评估方法
CN104777469B (zh) 一种基于量测误差协方差矩阵范数的雷达节点选择方法
CN107289968B (zh) 一种转弯机动目标的状态估计方法及装置
CN115508824A (zh) 多目标大数据关联融合跟踪方法及系统
Liu et al. Maneuvering extended object tracking based on constrained expectation maximization
WO2020006672A1 (zh) 三维空间转弯机动目标的轨迹起始方法及装置
CN117786525A (zh) 一种航天器意图识别方法、装置、电子设备及存储介质
CN108921870B (zh) 三维空间转弯机动目标的轨迹起始方法及装置
WO2019218241A1 (zh) 一种三维空间转弯机动目标的状态估计方法及系统
CN104750998B (zh) 基于强度滤波器的被动多传感器目标跟踪方法
Long et al. A triple-stage robust ellipse fitting algorithm based on outlier removal
CN113342057B (zh) 轨迹的融合方法、装置、无人机探测系统、设备和介质
CN108917745B (zh) 一种三维空间转弯机动目标的状态估计方法及系统
CN113850009B (zh) 一种基于椭圆rhm的标签粒子多扩展目标跟踪方法
CN116304966A (zh) 基于多源数据融合的航迹关联方法
CN109405833B (zh) 一种逻辑基的轨迹起始方法、系统、电子装置和存储介质
CN112185412A (zh) 一种多目标声信号混叠下的识别方法
Feng et al. Research on Target Tracking Algorithm of Micro‐UAV Based on Monocular Vision
WO2020102932A1 (zh) 一种逻辑基的轨迹起始方法、系统、电子装置和存储介质
WO2019010688A1 (zh) 一种用于转弯机动目标的轨迹起始方法及系统

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 18925433

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

32PN Ep: public notification in the ep bulletin as address of the adressee cannot be established

Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205A DATED 26.04.2021)

122 Ep: pct application non-entry in european phase

Ref document number: 18925433

Country of ref document: EP

Kind code of ref document: A1