CN110031802B - 具有未知量测零偏的双红外传感器的融合定位方法 - Google Patents
具有未知量测零偏的双红外传感器的融合定位方法 Download PDFInfo
- Publication number
- CN110031802B CN110031802B CN201910269448.6A CN201910269448A CN110031802B CN 110031802 B CN110031802 B CN 110031802B CN 201910269448 A CN201910269448 A CN 201910269448A CN 110031802 B CN110031802 B CN 110031802B
- Authority
- CN
- China
- Prior art keywords
- measurement
- error
- target
- fusion
- zero offset
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- 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/16—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明提供一种具有未知量测零偏的双红外传感器的融合定位方法,首先将红外传感器的角度量测转换为传感器指向目标的单位矢量的估计值,并给出原始量测误差到该矢量估计误差的传导公式;接着基于上一步得到的两个矢量信息估计两个传感器与目标的距离信息,并给出原始量测误差到距离估计误差的传导公式;然后根据上述两组矢量与距离信息,提取两组目标位置的估计值,并分析了位置信息的误差组成以及对应的位置估计精度的计算公式;最后基于上一步的误差分析设计新型的权重优化指标,并融合得到最终的位置信息与误差评估值。
Description
技术领域
本发明涉及具有未知量测零偏的双红外传感器进行目标定位的融合方法设计,以及融合精度的评估。该方法为基于红外传感器的室内目标定位问题提供了一个有效的解决方案。
背景技术
红外传感器的量测数据为表征传感器与被观测目标之间指向关系的两个角度。对双红外传感器提供的4个角度信息设计融合方法得到目标在世界坐标系下的位置信息是常用的定位方式。传统的双红外传感器融合方法为:通过双站测距的方式提取目标的两组位置量测,并直接将上述两组位置量测的算术平均值作为融合结果。参见:1、陈云,天基红外预警系统轨迹关联与跟踪关键技术研究[D],国防科学技术大学,2010.2、陈一超,刘秉琦,黄富瑜.超大视场红外双目视觉极线约束与空间定位[J].光子学报,2019,48(02):145-153.3、褚光宇.鱼眼双目视觉成像及定位技术的研究[D].燕山大学,2016.然而该方法存在如下局限性:
1.缺少针对零偏优化指标。与随机量测噪声不同,未知的量测零偏无法通过数据量的累计消除。因此针对具有量测零偏的双红外传感器不能通过均方差最小的指标来得到最优融合权重,需要设计新的权重优化指标。
2.无法实现融合精度的在线评估。由于实际中无法得到被测目标位置的真值,因此要求融合方法不仅提供位置的融合结果,还需在线提供融合的精度,从而得到位置真值所在的范围,保证融合方法的可信度,为后续的控制与决策提供技术支持。
为了解决上述问题,我们针对具有未知量测零偏的双红外传感器提出了一种新型的权重优化指标以及对应的融合方法,该方法可以有效地将双红外传感器对目标的量测数据融合为世界坐标系下的坐标信息,并可对融合精度进行在线评估。
发明内容
本发明解决的技术问题:针对具有未知量测零偏的双红外传感器的融合定位问题,提出了一种有效的融合方法,并给出了融合精度的评估方法。
本发明的解决方案:首先将红外传感器的角度量测转换为传感器指向目标的单位矢量的估计值,并给出原始量测误差到该矢量估计误差的传导公式;接着基于上一步得到的两个矢量信息估计两个传感器与目标的距离信息,并给出原始量测误差到距离估计误差的传导公式;然后根据上述两组矢量与距离信息,提取两组目标位置的估计值,并分析了位置信息的误差组成以及对应的位置估计精度的计算公式;最后基于上一步的误差分析设计新型的权重优化指标,并融合得到最终的位置信息与误差评估值。
本发明与现有技术相比的优点在于:第一,本发明对双红外传感器量测数据融合过程的各个环节进行了细致的分解并获得了对应的误差传播机理,从而实现了信息的有效提取。第二,本发明所提供的信息融合方法可以对融合结果的精度进行在线评估,是后续控制与决策的有效依据。
附图说明
图1是本发明具有未知量测零偏的双红外传感器的融合定位方法的流程图。
图2是两个红外传感器对所选取目标运动轨迹的量测数据。
图3是传统融合方法与本发明提供的融合方法的定位误差最大值。
图4是本发明提供的融合方法的定位误差最大值及其评估值。
具体实施方式
在使用双红外传感器进行室内目标定位时,由于红外传感器所存在的未知量测零偏无法通过数据量的累计消除,因此针对具有量测零偏的双红外传感器不能通过均方差最小的指标来得到最优融合权重,需要设计新的权重优化指标。此外,由于红外传感器所具有的未知量测零偏,其融合结果也相应的存在未知的固定偏差,因此还需要提供融合精度地评估方法。鉴于上述两个在实际系统中遇到的问题,本发明针对具有未知量测零偏的双红外传感器进行目标定位的问题给出了有效的融合方法,并提供了融合精度的评估方法。
下面针对具有未知量测零偏的双红外传感器融合定位问题,说明所提出的融合方法的具体步骤。红外传感器的量测模型如下:
其中Y(j)为第j个红外传感器的量测数据,包括第j个红外传感器到目标p的方位角量测和高低角量测 是第j个红外传感器到目标p的位置矢量在第j个红外传感器的观测坐标系下的表示,为Y(j)的未知量测零偏,为的量测零偏,为的量测零偏,并且和上界分别为和函数
结合附图1,本发明提出的针对具有随机量测噪声的双红外传感器融合定位方法的具体步骤如下:
第一步:原始角度量测零偏与直角坐标系等价量测零偏的关系建立
第二步:红外传感器与目标距离的估计方法以及估计误差形式
由于红外传感器的量测数据中缺少传感器与目标的距离信息,从而无法利用单个红外传感器提取目标的位置信息,故而需要根据两个红外传感器的组合量测信息提取每个传感器与目标的距离信息,并分析由未知量测零偏导致的距离估计误差。
第三步:目标位置矢量的虚拟传感器量测及量测误差的形式
则
第四步:具有相同误差源的两组虚拟量测的融合方法及融合精度计算
对于第三步构造的两组具有相同误差源的虚拟传感器,设计如下加权融合公式
权重W的第s个分量Ws根据本发明设计的如下优化问题得到:
其中
由式(15),(18),(20)确定的融合方法具有如下两个重要性质:
性质1:该方法在权重优化指标(17)的意义下是最优的;
性质2:式(20)提供了融合精度的评估指标。
由式(15),(18),(20)确定的融合方法将原优化问题(17)转化为单个优化问题(18)解决了和之间具有相同误差源的问题,并通过分析待优化目标函数的性质,得到了对应优化问题的最优解,实现了传感器信息的最优融合。
下面以一个典型的双红外传感器进行室内目标定位的仿真为例,说明具有未知量测零偏的双红外传感器进行目标定位的融合方法的具体实施方式。在该实例中,两个具有不同精度的红外传感器被分别布置在不同的位置,用于观测地面上的一个运动目标,从而获取该运动目标的位置信息。
在该仿真实例中取两个红外传感器在世界坐标系下的位置坐标分别为
其中m代表长度单位米。红外传感器的量测模型如公式(1)-(3),其中
两个红外传感器对所选取目标运动轨迹的量测数据如图2所示。根据本说明书提供的融合方法针对未知量测零偏的可能取值范围进行500次试验,得到仿真结果如图3与图4所示。图3说明相比于传统融合方法,本发明提供的融合方法能够显著提高融合精度。而图4则说明,公式(20)提供的评估值与目标实际误差可能达到的最大值基本吻合,这表明仿真结果与理论分析符合。
双红外传感器融合定位方法提供了具有未知量测零偏的双红外传感器融合定位问题的解决方案,并能提供融合精度评估表达式进行融合精度评估。仿真实验表明,所提出的融合方法可以有效地实现双红外传感器量测数据的融合,并且其融合误差范围与所提供的评估值基本吻合。
综上所述,本方法在具有未知量测零偏的双传感器探测场景下,可以实现较高的融合精度。此外融合方法所提供的评估方法与仿真结果基本吻合,为后续的控制与决策提供了参考依据。本方法的未尽事宜属于本领域公知技术。
Claims (1)
1.一种具有未知量测零偏的双红外传感器的融合定位方法,其特征在于:
红外传感器的量测模型如下:
其中Y(j)为第j个红外传感器的量测数据,包括第j个红外传感器到目标p的方位角量测和高低角量测是第j个红外传感器到目标p的位置矢量在第j个红外传感器的观测坐标系下的表示,为Y(j)的未知量测零偏,为的量测零偏,为的量测零偏,并且和上界分别为和函数
具体步骤如下:
第一步:原始角度量测零偏与直角坐标系等价量测零偏的关系建立
第二步:红外传感器与目标距离的估计方法以及估计误差形式
由于红外传感器的量测数据中缺少传感器与目标的距离信息,从而无法利用单个红外传感器提取目标的位置信息,故而需要根据两个红外传感器的组合量测信息提取每个传感器与目标的距离信息,并分析由未知量测零偏导致的距离估计误差;
第三步:目标位置矢量的虚拟传感器量测及量测误差的形式
则
第四步:具有相同误差源的两组虚拟量测的融合方法及融合精度计算
对于第三步构造虚拟传感器,设计如下加权融合公式:
权重W的第s个分量Ws根据本发明设计的如下优化问题得到:
其中
由式(15)、(18)、(20)确定的融合方法具有如下两个重要性质:
性质1:该方法在权重优化指标(17)的意义下是最优的;
性质2:式(20)提供了融合精度的评估指标;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910269448.6A CN110031802B (zh) | 2019-04-04 | 2019-04-04 | 具有未知量测零偏的双红外传感器的融合定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910269448.6A CN110031802B (zh) | 2019-04-04 | 2019-04-04 | 具有未知量测零偏的双红外传感器的融合定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110031802A CN110031802A (zh) | 2019-07-19 |
CN110031802B true CN110031802B (zh) | 2020-10-09 |
Family
ID=67237423
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910269448.6A Active CN110031802B (zh) | 2019-04-04 | 2019-04-04 | 具有未知量测零偏的双红外传感器的融合定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110031802B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11295072A (ja) * | 1998-04-14 | 1999-10-29 | Japan Aviation Electronics Ind Ltd | 方位計 |
CN104730537A (zh) * | 2015-02-13 | 2015-06-24 | 西安电子科技大学 | 基于多尺度模型的红外/激光雷达数据融合目标跟踪方法 |
CN105353367A (zh) * | 2015-11-26 | 2016-02-24 | 中国人民解放军63921部队 | 一种双基地mimo雷达空间机动目标跟踪方法 |
CN105698765A (zh) * | 2016-02-22 | 2016-06-22 | 天津大学 | 双imu单目视觉组合测量非惯性系下目标物位姿方法 |
CN107121666A (zh) * | 2017-04-17 | 2017-09-01 | 南京航空航天大学 | 一种基于无人飞行器的临近空间运动目标定位方法 |
CN107315171A (zh) * | 2017-07-02 | 2017-11-03 | 中国航空工业集团公司雷华电子技术研究所 | 一种雷达组网目标状态与系统误差联合估计算法 |
CN108168706A (zh) * | 2017-12-12 | 2018-06-15 | 河南理工大学 | 一种监测低空无人飞行器的多谱红外成像检测跟踪系统 |
CN109116349A (zh) * | 2018-07-26 | 2019-01-01 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 多传感器协同跟踪联合优化决策方法 |
CN109143223A (zh) * | 2018-08-14 | 2019-01-04 | 中国电子科技集团公司第三十八研究所 | 一种双基地雷达的空间目标跟踪滤波装置及方法 |
CN109212475A (zh) * | 2018-10-17 | 2019-01-15 | 哈尔滨工业大学 | 基于方位角和俯仰角信息的双机无源定位方法 |
FR3028031B1 (fr) * | 2014-10-29 | 2019-09-20 | Safran Electronics & Defense | Procede d'estimation d'un etat de navigation contraint en observabilite |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8515712B1 (en) * | 2010-08-26 | 2013-08-20 | Lockheed Martin Corporation | Information based optimal reduced state estimator for poorly conditioned estimation problems |
CN107192998B (zh) * | 2017-04-06 | 2019-05-31 | 中国电子科技集团公司第二十八研究所 | 一种基于协方差指标函数的自适应分布式航迹数据融合方法 |
CN108896047B (zh) * | 2018-05-09 | 2020-11-06 | 上海交通大学 | 分布式传感器网络协同融合与传感器位置修正方法 |
-
2019
- 2019-04-04 CN CN201910269448.6A patent/CN110031802B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11295072A (ja) * | 1998-04-14 | 1999-10-29 | Japan Aviation Electronics Ind Ltd | 方位計 |
FR3028031B1 (fr) * | 2014-10-29 | 2019-09-20 | Safran Electronics & Defense | Procede d'estimation d'un etat de navigation contraint en observabilite |
CN104730537A (zh) * | 2015-02-13 | 2015-06-24 | 西安电子科技大学 | 基于多尺度模型的红外/激光雷达数据融合目标跟踪方法 |
CN105353367A (zh) * | 2015-11-26 | 2016-02-24 | 中国人民解放军63921部队 | 一种双基地mimo雷达空间机动目标跟踪方法 |
CN105698765A (zh) * | 2016-02-22 | 2016-06-22 | 天津大学 | 双imu单目视觉组合测量非惯性系下目标物位姿方法 |
CN107121666A (zh) * | 2017-04-17 | 2017-09-01 | 南京航空航天大学 | 一种基于无人飞行器的临近空间运动目标定位方法 |
CN107315171A (zh) * | 2017-07-02 | 2017-11-03 | 中国航空工业集团公司雷华电子技术研究所 | 一种雷达组网目标状态与系统误差联合估计算法 |
CN108168706A (zh) * | 2017-12-12 | 2018-06-15 | 河南理工大学 | 一种监测低空无人飞行器的多谱红外成像检测跟踪系统 |
CN109116349A (zh) * | 2018-07-26 | 2019-01-01 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 多传感器协同跟踪联合优化决策方法 |
CN109143223A (zh) * | 2018-08-14 | 2019-01-04 | 中国电子科技集团公司第三十八研究所 | 一种双基地雷达的空间目标跟踪滤波装置及方法 |
CN109212475A (zh) * | 2018-10-17 | 2019-01-15 | 哈尔滨工业大学 | 基于方位角和俯仰角信息的双机无源定位方法 |
Non-Patent Citations (4)
Title |
---|
《Bias estimation for asynchronous multi-rate multi-sensor fusion with unknown inputs》;Hang Geng,Yan Liang, Yurong Liu, Fuad E. Alsaad;《Information Fusion》;20180131;第39卷;139-153 * |
《Consistent distributed state estimation with global observability over sensor network》;Xingkang He, Wenchao Xue, Haitao Fang;《AUTOMATICA》;20180329;第92卷;162-172 * |
《基于融合算法的组合导航方法研究》;李志鹏;《中国优秀硕士学位论文全文数据库 信息科技辑》;20150715(第7期);I136-488 * |
《外场条件下激光捷联惯组多位置标定方法精度分析》;薛文超; 牟玉涛; 黄一; 方海涛;《中国惯性技术学报》;20120215;第20卷(第1期);39-45 * |
Also Published As
Publication number | Publication date |
---|---|
CN110031802A (zh) | 2019-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107084714B (zh) | 一种基于RoboCup3D的多机器人协作目标定位方法 | |
Veth et al. | Fusion of low-cost imagining and inertial sensors for navigation | |
CN106772524B (zh) | 一种基于秩滤波的农业机器人组合导航信息融合方法 | |
CN111487960A (zh) | 一种基于定位能力估计的移动机器人路径规划方法 | |
Cai et al. | Mobile robot localization using gps, imu and visual odometry | |
CN116295511B (zh) | 一种用于管道潜航机器人的鲁棒初始对准方法及系统 | |
CN104729481A (zh) | 一种基于pnp透视模型的合作目标位姿精度测量方法 | |
CN108917772A (zh) | 基于序列图像的非合作目标相对导航运动估计方法 | |
CN105043390B (zh) | 基于泛克里金法的重力场插值方法 | |
Cui et al. | A measurement method of motion parameters in aircraft ground tests using computer vision | |
CN113449254B (zh) | 任意网型变形监测稳定性分析方法及监控点位置确定方法 | |
CN114608568A (zh) | 一种基于多传感器信息即时融合定位方法 | |
CN104075710B (zh) | 一种基于航迹预测的机动扩展目标轴向姿态实时估计方法 | |
CN110031802B (zh) | 具有未知量测零偏的双红外传感器的融合定位方法 | |
Bikmaev et al. | Improving the accuracy of supporting mobile objects with the use of the algorithm of complex processing of signals with a monocular camera and LiDAR | |
Doskocil et al. | Measurement of distance by single visual camera at robot sensor systems | |
Haner et al. | Optimal view path planning for visual SLAM | |
CN110031803B (zh) | 具有随机量测噪声的双红外传感器的融合定位方法 | |
CN114705223A (zh) | 多移动智能体在目标跟踪中的惯导误差补偿方法及系统 | |
CN115356965A (zh) | 一种松散耦合实装数据采集装置及数据处理方法 | |
CN111735459B (zh) | 小天体探测器间协同导航方法 | |
CN112346032A (zh) | 基于一致性扩展卡尔曼滤波的单红外传感器目标定轨方法 | |
Zhang et al. | Flexible on-orbit calibration for monocular camera and laser rangefinder integrated pose measurement system | |
Brink et al. | FastSLAM with stereo vision | |
CN110836618A (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 |