CN108732538A - 一种基于探测距离的双站被动定位算法 - Google Patents
一种基于探测距离的双站被动定位算法 Download PDFInfo
- Publication number
- CN108732538A CN108732538A CN201810522798.4A CN201810522798A CN108732538A CN 108732538 A CN108732538 A CN 108732538A CN 201810522798 A CN201810522798 A CN 201810522798A CN 108732538 A CN108732538 A CN 108732538A
- Authority
- CN
- China
- Prior art keywords
- vector
- source location
- vector sensor
- sensor
- dual station
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
Abstract
本发明公开了一种基于探测距离的双站被动定位算法,其主要技术特征是:它将两个矢量传感器的探测距离考虑到定位算法中,通过建立双站被动定位坐标系、估算目标位置点、二次定位目标位置点等步骤,使定位误差保持在合理的范围内,克服了现有方位交汇双站被动交叉定位算法受观测方位误差影响大、定位结果偏离正常探测区域的问题,它具有实现方法简单、定位精度高等优点,可广泛应用于双站被动定位系统中。
Description
技术领域
本发明涉及一种基于探测距离的双站被动定位算法,属水声技术领域,尤其涉及一种基于探测距离采用两个矢量传感器被动定位水下目标的算法。
背景技术
按照工作方式的不同,水下目标定位可分为主动定位和被动定位两种方式,由于主动定位方式容易暴露传感器自身的位置,而被动定位方式因其良好的隐蔽性,目前得到了广泛的研究和应用。
背景技术中,在水声领域,单个矢量传感器只能获得水下目标的方位信息,目前的水下目标定位一般都是采用基于方位交汇的双站被动定位法,它是一种纯方位被动定位方法,即通过两个矢量传感器的纯方位双站交叉进行被动定位,该方法因受到观测方位误差的影响较大,存在定位结果超出两个矢量传感器探测范围的缺陷,直接采用该方法得到的目标位置误差较大,定位结果经常会偏离正常的探测区域。为了解决现有技术存在的上述不足,我们将两个矢量传感器的探测距离考虑到被动定位算法中,对基于探测距离的双站被动定位算法进行了研究。
发明内容
本发明所要解决的技术问题是要提供一种基于探测距离的双站被动定位算法,它将矢量传感器的探测距离考虑到定位算法中,克服了现有方位交汇双站被动交叉定位算法受观测方位误差影响大、定位结果偏离正常探测区域的问题,其实现方法简单,定位精度高,可广泛应用于双站被动定位系统中。
本发明解决其技术问题采用的技术方案是:
一种基于探测距离的双站被动定位算法,它包括以下步骤:
步骤一:建立双站被动定位坐标系,
建立工作水域的双站被动定位坐标系,定义1号矢量传感器、2号矢量传感器的探测距离,定义所述的1号矢量传感器、所述的2号矢量传感器在工作水域坐标系的坐标位置,定义所述的1号矢量传感器、所述的2号矢量传感器与水下目标之间的直线距离、观测方位角;
步骤二:估算目标位置点,
根据所述的1号矢量传感器、所述的2号矢量传感器观测的目标方位进行双站交叉定位,建立所述的目标与所述的1号矢量传感器、所述的2号矢量传感器的直线1、直线2的方程,得到估算的目标位置点(x,y),求得目标位置点(x,y)与所述1号矢量传感器之间的直线距离r1、与所述2号矢量传感器之间的直线距离r2;
步骤三:二次定位目标位置点,
根据估算的目标位置点(x,y)与所述1号矢量传感器之间的直线距离r1、与所述2号矢量传感器之间的直线距离r2,对目标位置点(x,y)进行二次定位,得到目标位置点。
本发明同背景技术相比所产生的有益效果:
1、采用传统的基于方位交汇的双站交叉被动定位算法因很多定位点远远超过矢量传感器的探测范围,导致得到的目标位置误差较大,精度低,而采用基于探测距离的双站被动定位算法则可以很好地解决定位点超过矢量传感器的探测范围的问题,其对目标的位置估计误差有较大的提升;
2、它具有实现方法简单、定位精度高、应用范围广等优点。
附图说明
图1 为本发明的双站交叉被动定位坐标系图;
图2 为图1中1号矢量传感器、2号矢量传感器探测区域示意图。
具体实施方式
下面结合附图对本发明的具体实施作进一步描述;
一种基于探测距离的双站被动定位算法,它包括以下步骤:
步骤一:建立双站被动定位坐标系,
如图1所示,建立工作水域的双站被动定位坐标系,坐标系定义为:观测角取x轴正向为
0°,逆时针方向为正,角度取值范围为0°~360°。
坐标系中,符号定义为:
1号矢量传感器、2号矢量传感器的探测距离均为R;
1号矢量传感器的坐标位置为(x1,y1);
2号矢量传感器的坐标位置为(x2,y2);
1号矢量传感器与水下目标之间的直线距离为r1;
2号矢量传感器与水下目标之间的直线距离为r2;
1号矢量传感器的观测方位角为θ 1;
2号矢量传感器的观测方位角为θ 2 。
步骤二:估算目标位置点,
根据1号矢量传感器、2号矢量传感器观测的目标方位进行双站交叉定位,估算水下目标位置点(x,y);
如图2所示,建立直线1、直线2的方程:
(1)
当目标位于1号矢量传感器和2号矢量传感器的连接基线上时,交叉定位不能获得目标的位置;
(1)式中:当θ i=90°或270°(i=1,2)时,
当θ i(i=1,2)为其他值时,;
由(1)式可估算目标位置点为:
(2)
由(2)式,根据估算的目标位置点,计算目标位置点(x,y)与1号矢量传感器之间的直线距离r1、与2号矢量传感器之间的直线距离r2:
(3)
(4)。
步骤三:二次定位目标位置点,
根据估算的目标位置点(x,y)与1号矢量传感器之间的直线距离r1、与2号矢量传感器之间的直线距离r2,对目标位置点(x, y)进行二次定位,得到目标位置点,方法为:
(1)当r1≤R且r2≤R, 1号矢量传感器和2号矢量传感器同时发现目标,交叉定位结果落于两探测圆的交叠区域内,得到目标位置点,即:;
(2)当r1>R且r2>R,交叉定位结果不在1号矢量传感器探测圆与2号矢量传感器探测圆的探测覆盖范围内,此时考虑两个矢量传感器的探测距离,对交叉定位结果进行重新定位,1号矢量传感器探测圆与2号矢量传感器探测圆的交叠区的中心点即为目标位置点,即:
=((x1+ x2)/2,(y1+ y2)/2);
(3)当r1≤R且r2>R,估计的目标位置点(x,y)与2号矢量传感器坐标位置(x2,y2)连线和2号矢量传感器探测圆的交点即为目标位置点,即:
其中:θ 2为2号矢量传感器的观测方位角;
(4)当r1>R且r2≤R,估计的目标位置点(x,y)与1号矢量传感器坐标位置(x1,y1)连线和1号矢量传感器探测圆的交点即为目标位置点,即:
其中:θ 1为1号矢量传感器的观测方位角。
Claims (8)
1.一种基于探测距离的双站被动定位算法,其特征在于它通过以下步骤实现:
步骤一:建立双站被动定位坐标系,
建立工作水域的双站被动定位坐标系,定义1号矢量传感器、2号矢量传感器的探测距离,定义所述的1号矢量传感器、所述的2号矢量传感器在工作水域坐标系的坐标位置,定义所述的1号矢量传感器、所述的2号矢量传感器与水下目标之间的直线距离、观测方位角;
步骤二:估算目标位置点,
根据所述的1号矢量传感器、所述的2号矢量传感器观测的目标方位进行双站交叉定位,建立目标与所述的1号矢量传感器、所述的2号矢量传感器的直线1、直线2的方程,得到估算的目标位置点(x,y),求得目标位置点(x,y)与所述1号矢量传感器之间的直线距离r1、与所述2号矢量传感器之间的直线距离r2;
步骤三:二次定位目标位置点,
根据估算的目标位置点(x,y)与所述1号矢量传感器之间的直线距离r1、与所述2号矢量传感器之间的直线距离r2,对目标位置点(x,y)进行二次定位,得到目标位置点。
2.根据权利要求1所述的基于探测距离的双站被动定位算法,其特征在于,步骤一所述的双站被动定位坐标系定义为:观测角取x轴正向为0°,逆时针方向为正,角度取值范围为0°~360°。
3.根据权利要求1所述的基于探测距离的双站被动定位算法,其特征在于,步骤一所述的1号矢量传感器、所述的2号矢量传感器的探测距离均为R,定义所述的1号矢量传感器的坐标位置为(x1,y1),所述的1号矢量传感器与水下目标之间的直线距离为r1,所述的1号矢量传感器的观测方位角为θ 1,定义所述的2号矢量传感器的坐标位置为(x2,y2),所述的2号矢量传感器与水下目标之间的直线距离为r2,所述的2号矢量传感器的观测方位角为θ 2。
4.根据权利要求1所述的基于探测距离的双站被动定位算法,其特征在于,步骤二所述的目标与所述的1号矢量传感器、所述的2号矢量传感器的直线1、直线2的方程为:
当所述的目标位于所述的1号矢量传感器和所述的2号矢量传感器的连接基线上时,交叉定位不能获得所述的目标的位置;
当θ i=90°或270°(i=1,2)时,;
当θ i(i=1,2)为其他值时,;
估算的目标位置点为:
目标位置点(x,y)与所述的1号矢量传感器之间的直线距离r1、与所述的2号矢量传感器之间的直线距离r2为:
。
5.根据权利要求1所述的基于探测距离的双站被动定位算法,其特征在于,步骤三所述的对目标位置点(x,y)进行二次定位时,当r1≤R且r2≤R, 所述的1号矢量传感器和所述的2号矢量传感器同时发现目标,交叉定位结果落于交叠区域内,得到目标位置点,即:
。
6.根据权利要求1所述的基于探测距离的双站被动定位算法,其特征在于,步骤三所述的对目标位置点(x,y)进行二次定位时,当r1>R且r2>R,交叉定位结果不在所述的1号矢量传感器探测圆与所述的2号矢量传感器探测圆的探测覆盖范围内, 1号矢量传感器探测圆与所述的2号矢量传感器探测圆的交叠区的中心点即为目标位置点,即:
=((x1+ x2)/2,(y1+ y2)/2)。
7.根据权利要求1所述的基于探测距离的双站被动定位算法,其特征在于,步骤三所述的对目标位置点(x,y)进行二次定位时,当r1≤R且r2>R,估计的目标位置点(x,y)与所述的2号矢量传感器坐标位置(x2,y2)连线和所述的2号矢量传感器探测圆的交点即为目标位置点,即:
。
8.根据权利要求1所述的基于探测距离的双站被动定位算法,其特征在于,步骤三所述的对目标位置点(x,y)进行二次定位时,当r1>R且r2≤R,估计的目标位置点(x,y)与所述的1号矢量传感器坐标位置(x1,y1)连线和所述的1号矢量传感器探测圆的交点即为目标位置点,即:
。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810522798.4A CN108732538A (zh) | 2018-05-28 | 2018-05-28 | 一种基于探测距离的双站被动定位算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810522798.4A CN108732538A (zh) | 2018-05-28 | 2018-05-28 | 一种基于探测距离的双站被动定位算法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108732538A true CN108732538A (zh) | 2018-11-02 |
Family
ID=63936483
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810522798.4A Pending CN108732538A (zh) | 2018-05-28 | 2018-05-28 | 一种基于探测距离的双站被动定位算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108732538A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110109057A (zh) * | 2019-04-24 | 2019-08-09 | 广州市慧建科技有限公司 | 一种激光定位系统 |
CN112163307A (zh) * | 2020-09-29 | 2021-01-01 | 中国船舶重工集团公司第七二四研究所 | 一种跨站信息保障的目标可信区标绘方法 |
CN113702903A (zh) * | 2021-09-22 | 2021-11-26 | 中船海洋探测技术研究院有限公司 | 基于目标水下极低频矢量电磁场的阵列被动定位跟踪方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003021675A (ja) * | 2001-07-09 | 2003-01-24 | Oki Electric Ind Co Ltd | データ統合方法及び装置 |
JP2007024548A (ja) * | 2005-07-12 | 2007-02-01 | Furuno Electric Co Ltd | 水中探知装置 |
CN101126806A (zh) * | 2007-09-20 | 2008-02-20 | 上海交通大学 | 基于信息融合的修正极大似然配准方法 |
CN102607560A (zh) * | 2011-12-22 | 2012-07-25 | 中国人民解放军海军航空工程学院 | 地球表面基于恒向线的两站测向交叉定位跟踪算法 |
CN105424044A (zh) * | 2015-11-05 | 2016-03-23 | 中国船舶重工集团公司第七二四研究所 | 一种双站交会无源定位站基组合择优方法 |
CN107797091A (zh) * | 2017-10-17 | 2018-03-13 | 杭州电子科技大学 | 一种基于子空间的新型纯方位目标定位方法 |
-
2018
- 2018-05-28 CN CN201810522798.4A patent/CN108732538A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003021675A (ja) * | 2001-07-09 | 2003-01-24 | Oki Electric Ind Co Ltd | データ統合方法及び装置 |
JP2007024548A (ja) * | 2005-07-12 | 2007-02-01 | Furuno Electric Co Ltd | 水中探知装置 |
CN101126806A (zh) * | 2007-09-20 | 2008-02-20 | 上海交通大学 | 基于信息融合的修正极大似然配准方法 |
CN102607560A (zh) * | 2011-12-22 | 2012-07-25 | 中国人民解放军海军航空工程学院 | 地球表面基于恒向线的两站测向交叉定位跟踪算法 |
CN105424044A (zh) * | 2015-11-05 | 2016-03-23 | 中国船舶重工集团公司第七二四研究所 | 一种双站交会无源定位站基组合择优方法 |
CN107797091A (zh) * | 2017-10-17 | 2018-03-13 | 杭州电子科技大学 | 一种基于子空间的新型纯方位目标定位方法 |
Non-Patent Citations (4)
Title |
---|
AL-BAWRI,SS .ET AL: "Localization of outdoor mobile estimation using a single base station scattering distance technique", 《MICROWAVE AND OPTICAL TECHNOLOGY LETTERS》 * |
YANG SUN LEE .ET AL: "A Study on the Performance of Wireless Localization System Based on AoA in WSN Environment", 《2011 THIRD INTERNATIONAL CONFERENCE ON INTELLIGENT NETWORKING AND COLLABORATIVE SYSTEMS》 * |
刘纯贵 等: "正交多站测角机载红外定位技术研究", 《微计算机信息》 * |
陈锋莉 等: "多站多目标交叉定位技术", 《火力与指挥控制》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110109057A (zh) * | 2019-04-24 | 2019-08-09 | 广州市慧建科技有限公司 | 一种激光定位系统 |
CN110109057B (zh) * | 2019-04-24 | 2021-04-20 | 广州市慧建科技有限公司 | 一种激光定位系统 |
CN112163307A (zh) * | 2020-09-29 | 2021-01-01 | 中国船舶重工集团公司第七二四研究所 | 一种跨站信息保障的目标可信区标绘方法 |
CN113702903A (zh) * | 2021-09-22 | 2021-11-26 | 中船海洋探测技术研究院有限公司 | 基于目标水下极低频矢量电磁场的阵列被动定位跟踪方法 |
CN113702903B (zh) * | 2021-09-22 | 2023-12-12 | 中船海洋探测技术研究院有限公司 | 基于目标水下极低频矢量电磁场的阵列被动定位跟踪方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105300375B (zh) | 一种基于单视觉的机器人室内定位和导航方法 | |
CN108732538A (zh) | 一种基于探测距离的双站被动定位算法 | |
CN108614258B (zh) | 一种基于单水声信标距离量测的水下定位方法 | |
CN106019217A (zh) | 基于aoa的二维无线传感器网络半定规划定位方法 | |
CN110026993B (zh) | 一种基于uwb及热释电红外传感器的人体跟随机器人 | |
CN106772351B (zh) | 基于有限步记忆的卡尔曼滤波方法 | |
CN108680942A (zh) | 一种惯性/多天线gnss组合导航方法及装置 | |
CN110207695A (zh) | 一种适用于深海auv的无速度辅助单信标定位方法 | |
CN111380573A (zh) | 用于校准运动的对象传感器的取向的方法 | |
CN103954982A (zh) | 基于多模gnss接收机的可见卫星快速选择方法 | |
CN108107459A (zh) | 基于导航系统的机器人方位检测方法、装置及系统 | |
CN109918812A (zh) | 一种方位俯仰型天线通用正倒镜程序过顶处理方法 | |
CN102749614A (zh) | 一种基于静态声源辅助的声阵列网络自定位方法 | |
CN108413982A (zh) | 一种舰船动态对准位置杆臂补偿方法 | |
CN106405604A (zh) | 一种基于传感器的定位方法及其装置 | |
CN106383345B (zh) | 量测时间间隔不等情况下的滤波器初始化方法 | |
CA2958759C (en) | Enhanced positioning method for moving target in mine shaft based on witness nodes under internet of things architecture | |
CN104977559B (zh) | 一种在干扰环境下的目标定位方法 | |
CN105911990A (zh) | 用于船舶航行转弯阶段的航迹偏差测定方法 | |
CN203433113U (zh) | 激光测距昼视仪 | |
CN204831322U (zh) | 一种实现空间轨迹追踪的装置 | |
JP5600054B2 (ja) | 複数の移動端末の同行状態を推定する同行判定装置、移動端末及びプログラム | |
CN110057383A (zh) | 一种auv推位导航系统杆臂误差标校方法 | |
CN112881970A (zh) | 一种适用于声呐浮标平台的目标测向方法及系统 | |
CN116774142B (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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20181102 |