CN109884582A - 利用一维测向快速确定目标三维坐标的方法 - Google Patents
利用一维测向快速确定目标三维坐标的方法 Download PDFInfo
- Publication number
- CN109884582A CN109884582A CN201910232128.3A CN201910232128A CN109884582A CN 109884582 A CN109884582 A CN 109884582A CN 201910232128 A CN201910232128 A CN 201910232128A CN 109884582 A CN109884582 A CN 109884582A
- Authority
- CN
- China
- Prior art keywords
- dimensional coordinate
- observation station
- dimensional
- target
- linear
- 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.)
- Granted
Links
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明属于电子信息技术领域,涉及一种利用一维测向快速确定目标三维坐标的方法。本发明的目的在于针对利用一维测向进行三维定位的背景技术中非线性最小二乘方法的三维搜索计算量大的问题、伪线性最小二乘方法信息利用不充分的问题,使用观测站的一维测向结果和观测站的线阵自身的方位角度测量,并通过迭代搜索的方式实现对目标的三维定位,避免三维坐标搜索,快速确定目标的三维坐标。
Description
技术领域
本发明属于电子信息技术领域,涉及一种利用多个观测站对目标的一维测向快速确定目标三维坐标的方法。
背景技术
无线电定位技术根据所利用的信号参数测量,可分为测距定位、测向定位以及测频定位等,其中测向定位方法由于测向所需时间短,定位所需的计算量少等特性,在无线电定位等领域的应用十分广泛。
在常用的测向定位***中,每个观测站利用线阵或面阵分别对目标进行一维测向或二维测向,然后结合观测站的地理坐标进行交叉定位,计算目标位置的二维坐标或三维坐标。但是,同时测量目标方位角和俯仰角的面阵测向***比较复杂,成本较高,且无人机、船舶、车辆等空间比较狭窄的平台上难以提供满足二维测向要求的布阵区域,导致基于二维测向的三维定位方法较少使用,常用的是基于一维测向的二维定位方法。为此,有必要发展基于线阵一维测向的三维定位方法。
由于每个观测站的线阵的一维测向与目标的三维位置坐标之间是非线性关系,利用常用的非线性最小二乘方法求解目标的三维坐标,需要确定一个三维的非线性代价函数的极值位置,但是三维搜索的计算量大,不利于实时定位。为此,有必要发展基于线阵一维测向的快速三维定位方法。
申请号为201710333182.8的中国专利《一种基于一维测向的三维定位方法》,提出对非线性方程组进行伪线性处理,利用伪线性最小二乘方法确定目标位置的三维坐标估计,但该方法由于忽略了伪线性处理后变量之间的非线性约束关系,不仅需要不少于6个的观测站,而且定位精度也不高。
发明内容
本发明的目的在于针对利用一维测向进行三维定位的背景技术中非线性最小二乘方法的三维搜索计算量大的问题、伪线性最小二乘方法信息利用不充分的问题,使用观测站的一维测向结果和观测站的线阵自身的方位角度测量,并通过迭代搜索的方式实现对目标的三维定位,避免三维坐标搜索,快速确定目标的三维坐标。
本发明的技术方案是:
首先,将观测站放置于平面上,初始化:确定观测站数目以及每个观测站位置坐标,每个观测站的线阵与平面直角坐标x轴的夹角,每个线阵与目标来波方向的夹角测量,随机选取一个初始位置三维坐标作为当前迭代的位置三维坐标,设置距离门限和迭代门限,并令当前迭代次数k=1;
然后,计算当前迭代的位置三维坐标到观测站的距离,利用每个观测站坐标、线阵与平面直角坐标x轴夹角、每个线阵与目标来波方向的夹角测量以及当前迭代的位置三维坐标到观测站的距离建立关于(x,y)的线性方程组(a),并计算线性方程组(a)的最小二乘解;
接着,利用每个观测站坐标、每个线阵与地平面直角坐标x轴夹角、每个线阵与目标来波方向的夹角测量以及线性方程组(a)的最小二乘解建立关于(z2)的线性方程组(b),并计算线性方程组(b)的最小二乘解,利用线性方程组(a)和线性方程组(b)的最小二乘解确定下一次迭代的位置三维坐标;
最后,计算下一次迭代的位置三维坐标和当前迭代的位置三维坐标之间的距离,若距离大于距离门限或迭代次数小于迭代门限,则令k+1代替k,转到步骤2;否则得到目标位置的三维坐标估计,停止迭代。
本发明方法包括的步骤是:
步骤1:设置观测站位于平面上,初始化确定观测站数目以及每个观测站位置坐标,确定每个观测站的线阵与平面直角坐标x轴的夹角,每个线阵与目标来波方向的夹角测量;随机选取一个初始位置三维坐标作为当前迭代的位置三维坐标,设置距离门限和迭代门限,并令当前迭代次数k=1;
步骤2:计算当前迭代的位置三维坐标到观测站的距离,利用每个观测站坐标、每个线阵与地平面直角坐标x轴夹角、每个线阵与目标来波方向的夹角测量以及当前迭代的位置三维坐标到观测站的距离建立关于(x,y)的线性方程组(a),并计算线性方程组(a)的最小二乘解;
步骤3:利用每个观测站坐标、每个线阵与地平面直角坐标x轴夹角、每个线阵与目标来波方向的夹角测量以及线性方程组(a)的最小二乘解建立关于(z2)的线性方程组(b),并计算线性方程组(b)的最小二乘解,利用线性方程组(a)和线性方程组(b)的最小二乘解得到下一次迭代的位置三维坐标;
步骤4:计算下一次迭代的位置三维坐标和当前迭代的位置三维坐标之间的距离,若距离大于距离门限或迭代次数小于迭代门限,则令k+1代替k,转到步骤2;否则得到目标位置的三维坐标估计停止迭代。
步骤1所述设置观测站位于平面上,初始化确定观测站数目为N,第n个观测站的位置坐标为Bn,n=1,2,...,N,确定每个观测站的线阵与平面直角坐标x轴的夹角为αn,n=1,2,...,N,每个线阵与目标来波方向的夹角测量为所述随机选取一个初始位置三维坐标作为当前迭代的位置三维坐标p1=(p1,x,p1,y,p1,z),设置距离门限为w0、迭代门限为k0,并令当前迭代次数k=1;
步骤2所述计算三维坐标pk到N个观测站的距离为
所述利用每个观测站坐标Bn、每个线阵与地平面直角坐标x轴夹角αn、每个线阵与目标来波方向的夹角测量以及三维坐标pk到N个观测站的距离rkn建立关于(x,y)的线性方程组(a)为
并计算线性方程组(a)的最小二乘解为(pk+1,x,pk+1,y);
步骤3所述利用每个观测站坐标Bn、每个线阵与地平面直角坐标x轴夹角αn、每个线阵与目标来波方向的夹角测量以及线性方程组(a)的最小二乘解(pk+1,x,pk+1,y)建立关于(z2)的线性方程组(b)为
并计算线性方程组(b)的最小二乘解为ηk+1,利用线性方程组(a)和线性方程组(b)的最小二乘解得到下一次迭代的位置三维坐标
步骤4所述计算下一次迭代的位置三维坐标pk+1和当前迭代的位置三维坐标pk之间的距离为wk+1=||pk+1-pk||,||||表示向量的Frobenius范数,若距离wk+1大于距离门限w0或迭代次数k小于迭代门限k0,则令k+1代替k,转到步骤2;否则停止迭代,得到目标位置的三维坐标估计
本发明的有益效果:
本发明利用观测站使用线阵对目标的一维测向结果并通过迭代搜索的方式实现对目标的三维定位,一方面,定位的实时性优于采用三维坐标搜索的非线性最小二乘方法,另一方面,定位的精度优于伪线性最小二乘方法。
具体实施方式
实施例
本例是以4个位置已知的观测站和1个需要在三维平面进行定位的目标为例,各个观测站的位置坐标分别为(100,0,0)、(0,100,0)、(-100,0,0)、(0,-100,0)米,每个观测站具有一个2阵元的均匀线阵,阵元间距为0.5米,每个线阵与地平面直角坐标x轴的夹角分别为(0,0.7854,1.5708,2.3562)(单位:弧度),信号中心频率为300MHz以及目标位置的三维坐标为(-102.1430,440.7459,813.4441)米。
本例的具体实施方式的流程如下:
步骤1:假设观测站位于地平面上,初始化确定观测站数目(N)为4,以及观测站位置坐标(Bn)分别为(100,0,0)、(0,100,0)、(-100,0,0)、(0,-100,0)(单位:米),确定观测站的线阵与地平面直角坐标x轴的夹角(αn)分别为(0,0.7854,1.5708,2.3562)(单位:弧度),4个线阵与目标来波方向的夹角测量分别为(-0.4260,0.2800,0.4630,-0.4390);
步骤2:随机选取一个初始位置三维坐标(p1)为(468.9570,995.2395,923.2978),设置距离门限(w0)为0.01米、迭代门限(k0)为20,并令当前迭代次数k=1;计算三维坐标(pk)到N个观测站的距离为
利用每个观测站坐标(Bn)、每个线阵与地平面直角坐标x轴夹角(αn)、每个线阵与目标来波方向的夹角测量以及三维坐标(pk)到N个观测站的距离(rkn)建立关于(x,y)的线性方程组(a)为
并计算线性方程组(a)的最小二乘解(pk+1,x,pk+1,y);
步骤3:利用每个观测站坐标(Bn)、每个线阵与地平面直角坐标x轴夹角(αn)、每个线阵与目标来波方向的夹角测量以及线性方程组(a)的最小二乘解(pk+1,x,pk+1,y)建立关于(z2)的线性方程组(b)为
并计算线性方程组(b)的最小二乘解(ηk+1),利用线性方程组(a)和线性方程组(b)的最小二乘解得到更新后的三维坐标
步骤4:计算更新后的三维坐标(pk+1)和更新前的三维坐标(pk)之间的距离(wk+1=||pk+1-pk||),||||表示向量的Frobenius范数,若距离(wk+1)大于距离门限(w0)或迭代次数k小于迭代门限(k0),则令k+1代替k,转到步骤2,否则确定目标的定位位置坐标为pk+1=(-127.4360,465.1013,854.4243)米,停止迭代。
定义定位误差为目标的定位位置坐标与目标的实际位置坐标之间的距离。在本实施例中,目标的实际位置坐标为(-102.1430,440.7459,813.4441)(单位:米),可见,实施本发明方法的定位误差等于53.9658米。
Claims (5)
1.利用一维测向快速确定目标三维坐标的方法,其特征在于,包括以下步骤:
S1、初始化:设置观测站位于平面上,并确定观测站数目以及每个观测站位置坐标、每个观测站的线阵与平面直角坐标x轴的夹角、每个线阵与目标来波方向的夹角测量;随机选取一个初始位置三维坐标作为当前迭代的位置三维坐标,设置距离门限和迭代门限,并令当前迭代次数k=1;
S2、计算当前迭代的位置三维坐标到观测站的距离,利用每个观测站坐标、每个线阵与地平面直角坐标x轴夹角、每个线阵与目标来波方向的夹角测量以及当前迭代的位置三维坐标到观测站的距离建立关于(x,y)的线性方程组(a),并计算线性方程组(a)的最小二乘解(pk+1,x,pk+1,y);
S3、利用每个观测站坐标、每个线阵与地平面直角坐标x轴夹角、每个线阵与目标来波方向的夹角测量以及线性方程组(a)的最小二乘解建立关于(z2)的线性方程组(b),并计算线性方程组(b)的最小二乘解ηk+1,利用线性方程组(a)和线性方程组(b)的最小二乘解得到下一次迭代的位置三维坐标;
S4、计算下一次迭代的位置三维坐标和当前迭代的位置三维坐标之间的距离,若距离大于距离门限或迭代次数小于迭代门限,则令k+1代替k,转到步骤S2;否则得到目标位置的三维坐标估计停止迭代。
2.根据权利要求1所述的利用一维测向快速确定目标三维坐标的方法,其特征在于,所述步骤S1具体包括:
观测站数目为N,第n个观测站的位置坐标为Bn,n=1,2,...,N,确定每个观测站的线阵与平面直角坐标x轴的夹角为αn,n=1,2,...,N,每个线阵与目标来波方向的夹角测量为随机选取一个初始位置三维坐标作为当前迭代的位置三维坐标p1=(p1,x,p1,y,p1,z),设置距离门限为w0、迭代门限为k0,并令当前迭代次数k=1。
3.根据权利要求2所述的利用一维测向快速确定目标三维坐标的方法,其特征在于,所述步骤S2的具体方法为:
计算三维坐标pk到N个观测站的距离为
所述利用每个观测站坐标Bn、每个线阵与地平面直角坐标x轴夹角αn、每个线阵与目标来波方向的夹角测量以及三维坐标pk到N个观测站的距离rkn建立关于(x,y)的线性方程组(a)为
并计算线性方程组(a)的最小二乘解为(pk+1,x,pk+1,y)。
4.根据权利要求3所述的利用一维测向快速确定目标三维坐标的方法,其特征在于,所述步骤S3的具体方法为:
利用每个观测站坐标Bn、每个线阵与地平面直角坐标x轴夹角αn、每个线阵与目标来波方向的夹角测量以及线性方程组(a)的最小二乘解(pk+1,x,pk+1,y)建立关于(z2)的线性方程组(b)为
并计算线性方程组(b)的最小二乘解为ηk+1,利用线性方程组(a)和线性方程组(b)的最小二乘解得到下一次迭代的位置三维坐标
5.根据权利要求4所述的利用一维测向确定目标三维坐标的凸优化方法,其特征在于,所述步骤S4的具体方法为:
计算下一次迭代的位置三维坐标pk+1和当前迭代的位置三维坐标pk之间的距离为wk+1=||pk+1-pk||,|| ||表示向量的Frobenius范数,若距离wk+1大于距离门限w0或迭代次数k小于迭代门限k0,则令k+1代替k,转到步骤S2;否则停止迭代,得到目标位置的三维坐标估计
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910232128.3A CN109884582B (zh) | 2019-03-26 | 2019-03-26 | 利用一维测向快速确定目标三维坐标的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910232128.3A CN109884582B (zh) | 2019-03-26 | 2019-03-26 | 利用一维测向快速确定目标三维坐标的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109884582A true CN109884582A (zh) | 2019-06-14 |
CN109884582B CN109884582B (zh) | 2023-02-28 |
Family
ID=66934262
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910232128.3A Active CN109884582B (zh) | 2019-03-26 | 2019-03-26 | 利用一维测向快速确定目标三维坐标的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109884582B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112697129A (zh) * | 2020-12-15 | 2021-04-23 | 电子科技大学 | 一种利用一维测角确定天线线阵二维姿态的快速方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4954837A (en) * | 1989-07-20 | 1990-09-04 | Harris Corporation | Terrain aided passive range estimation |
US20160265903A1 (en) * | 2013-11-20 | 2016-09-15 | Tianjiin University | Accuracy traceability method based on precision coordinate control network for workshop measurement positioning system |
CN106707234A (zh) * | 2016-12-16 | 2017-05-24 | 西北工业大学 | 一种联合时延差与角度测量的传感器网络目标定位方法 |
CN107148081A (zh) * | 2017-06-02 | 2017-09-08 | 重庆邮电大学 | 基于非线性约束最小二乘的单站定位方法 |
CN107144815A (zh) * | 2017-05-12 | 2017-09-08 | 电子科技大学 | 一种基于一维测向的三维定位方法 |
CN107229033A (zh) * | 2017-05-16 | 2017-10-03 | 电子科技大学 | 基于高度维分段搜索的多目标到达时间差定位方法 |
CN108717176A (zh) * | 2018-04-12 | 2018-10-30 | 哈尔滨工程大学 | 基于人工蜂群算法的多站时差定位方法 |
CN108717184A (zh) * | 2018-04-27 | 2018-10-30 | 杭州电子科技大学 | 基于误差校正的联合doa与toa单站无源定位方法 |
CN109298388A (zh) * | 2018-08-21 | 2019-02-01 | 中国人民解放军战略支援部队信息工程大学 | 基于方位信息的超视距目标地理坐标直接估计方法 |
-
2019
- 2019-03-26 CN CN201910232128.3A patent/CN109884582B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4954837A (en) * | 1989-07-20 | 1990-09-04 | Harris Corporation | Terrain aided passive range estimation |
US20160265903A1 (en) * | 2013-11-20 | 2016-09-15 | Tianjiin University | Accuracy traceability method based on precision coordinate control network for workshop measurement positioning system |
CN106707234A (zh) * | 2016-12-16 | 2017-05-24 | 西北工业大学 | 一种联合时延差与角度测量的传感器网络目标定位方法 |
CN107144815A (zh) * | 2017-05-12 | 2017-09-08 | 电子科技大学 | 一种基于一维测向的三维定位方法 |
CN107229033A (zh) * | 2017-05-16 | 2017-10-03 | 电子科技大学 | 基于高度维分段搜索的多目标到达时间差定位方法 |
CN107148081A (zh) * | 2017-06-02 | 2017-09-08 | 重庆邮电大学 | 基于非线性约束最小二乘的单站定位方法 |
CN108717176A (zh) * | 2018-04-12 | 2018-10-30 | 哈尔滨工程大学 | 基于人工蜂群算法的多站时差定位方法 |
CN108717184A (zh) * | 2018-04-27 | 2018-10-30 | 杭州电子科技大学 | 基于误差校正的联合doa与toa单站无源定位方法 |
CN109298388A (zh) * | 2018-08-21 | 2019-02-01 | 中国人民解放军战略支援部队信息工程大学 | 基于方位信息的超视距目标地理坐标直接估计方法 |
Non-Patent Citations (2)
Title |
---|
万群 等: "分布式信号源波达方向估计方法", 《电子科技大学学报》 * |
沈晓峰 等: "基于正性约束的测向交叉定位方法", 《电子科技大学学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112697129A (zh) * | 2020-12-15 | 2021-04-23 | 电子科技大学 | 一种利用一维测角确定天线线阵二维姿态的快速方法 |
CN112697129B (zh) * | 2020-12-15 | 2023-05-05 | 电子科技大学 | 一种利用一维测角确定天线线阵二维姿态的快速方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109884582B (zh) | 2023-02-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106912105B (zh) | 基于pso_bp神经网络的三维定位方法 | |
US8369184B2 (en) | Systems and methods with improved three-dimensional source location processing including constraint of location solutions to a two-dimensional plane | |
US8188919B2 (en) | Globally-convergent geo-location algorithm | |
CN109917333B (zh) | 融合aoa观测量与tdoa观测量的无源定位方法 | |
CN105547297A (zh) | 一种基于uwb定位***的室内定位方法 | |
RU2258242C2 (ru) | Разностно-дальномерный способ пеленгования источника радиоизлучения и реализующее его устройство | |
CN109901106A (zh) | 一种tdoa/aoa混合定位方法 | |
CN103826298A (zh) | 一种协作式迭代优化的无线传感器网络定位计算方法 | |
Feng et al. | GDOP index in UWB indoor location system experiment | |
CN110187333B (zh) | 一种基于合成孔径雷达技术的rfid标签定位方法 | |
CN108168559A (zh) | 一种基于分布式天线的室内定位***及方法 | |
CN112163052B (zh) | 一种信息缺失量测下的多传感器空间配准方法 | |
CN107607904B (zh) | 一种基于测角信息的多目标同一性识别方法 | |
CN108738132A (zh) | 一种基于tdoa的三基站移动通信定位方法 | |
CN107144815B (zh) | 一种基于一维测向的三维定位方法 | |
CN108594193A (zh) | 一种基于固定目标与非合作目标的雷达***偏差估计方法 | |
Koledoye et al. | Improved MDS-based localization with non-line-of-sight RF links | |
CN112822633B (zh) | 一种基于误差补偿的定位方法,***,终端设备及可读存储介质 | |
CN109884582A (zh) | 利用一维测向快速确定目标三维坐标的方法 | |
CN109884583A (zh) | 利用一维测向确定目标三维坐标的凸优化方法 | |
CN104391272A (zh) | 利用测向数据进行目标定位的方法与*** | |
KR101509569B1 (ko) | 지구곡률과 신호방향정보를 이용한 신호원 위치추정방법 | |
Tai et al. | Robust non-line-of-sight localisation system in indoor environment | |
Zhang et al. | An efficient estimator for target localization in a multistation redundancy system without matrix inversion | |
CN107484119B (zh) | 一种用于移动通信***的终端跟踪定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |