[发明专利]利用一维测向快速确定目标三维坐标的方法

摘要

本发明属于电子信息技术领域，涉及一种利用一维测向快速确定目标三维坐标的方法。本发明的目的在于针对利用一维测向进行三维定位的背景技术中非线性最小二乘方法的三维搜索计算量大的问题、伪线性最小二乘方法信息利用不充分的问题，使用观测站的一维测向结果和观测站的线阵自身的方位角度测量，并通过迭代搜索的方式实现对目标的三维定位，避免三维坐标搜索，快速确定目标的三维坐标。

主权项

1.利用一维测向快速确定目标三维坐标的方法，其特征在于，包括以下步骤：S1、初始化：设置观测站位于平面上，并确定观测站数目以及每个观测站位置坐标、每个观测站的线阵与平面直角坐标x轴的夹角、每个线阵与目标来波方向的夹角测量；随机选取一个初始位置三维坐标作为当前迭代的位置三维坐标，设置距离门限和迭代门限，并令当前迭代次数k＝1；S2、计算当前迭代的位置三维坐标到观测站的距离，利用每个观测站坐标、每个线阵与地平面直角坐标x轴夹角、每个线阵与目标来波方向的夹角测量以及当前迭代的位置三维坐标到观测站的距离建立关于(x,y)的线性方程组(a)，并计算线性方程组(a)的最小二乘解(p_k+1,x,p_k+1,y)；S3、利用每个观测站坐标、每个线阵与地平面直角坐标x轴夹角、每个线阵与目标来波方向的夹角测量以及线性方程组(a)的最小二乘解建立关于(z²)的线性方程组(b)，并计算线性方程组(b)的最小二乘解η_k+1，利用线性方程组(a)和线性方程组(b)的最小二乘解得到下一次迭代的位置三维坐标；S4、计算下一次迭代的位置三维坐标和当前迭代的位置三维坐标之间的距离，若距离大于距离门限或迭代次数小于迭代门限，则令k+1代替k，转到步骤S2；否则得到目标位置的三维坐标估计停止迭代。