CN113280687B - 一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法 - Google Patents
一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法 Download PDFInfo
- Publication number
- CN113280687B CN113280687B CN202110516854.5A CN202110516854A CN113280687B CN 113280687 B CN113280687 B CN 113280687B CN 202110516854 A CN202110516854 A CN 202110516854A CN 113280687 B CN113280687 B CN 113280687B
- Authority
- CN
- China
- Prior art keywords
- data
- mine
- mobile robot
- ground mobile
- detection
- 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
- 238000001514 detection method Methods 0.000 title claims abstract description 112
- 238000000034 method Methods 0.000 title claims abstract description 29
- 238000003384 imaging method Methods 0.000 title claims abstract description 28
- 238000012545 processing Methods 0.000 claims description 10
- 238000004891 communication Methods 0.000 claims description 7
- 239000000523 sample Substances 0.000 claims description 7
- 239000011159 matrix material Substances 0.000 claims description 6
- IYLGZMTXKJYONK-ACLXAEORSA-N (12s,15r)-15-hydroxy-11,16-dioxo-15,20-dihydrosenecionan-12-yl acetate Chemical compound O1C(=O)[C@](CC)(O)C[C@@H](C)[C@](C)(OC(C)=O)C(=O)OCC2=CCN3[C@H]2[C@H]1CC3 IYLGZMTXKJYONK-ACLXAEORSA-N 0.000 claims description 4
- IYLGZMTXKJYONK-UHFFFAOYSA-N ruwenine Natural products O1C(=O)C(CC)(O)CC(C)C(C)(OC(C)=O)C(=O)OCC2=CCN3C2C1CC3 IYLGZMTXKJYONK-UHFFFAOYSA-N 0.000 claims description 4
- 238000005070 sampling Methods 0.000 claims description 4
- 230000008859 change Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000009434 installation Methods 0.000 claims description 3
- 238000002372 labelling Methods 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 230000000007 visual effect Effects 0.000 abstract description 5
- 230000008569 process Effects 0.000 abstract description 3
- 238000010408 sweeping Methods 0.000 description 16
- 230000004927 fusion Effects 0.000 description 6
- 230000006870 function Effects 0.000 description 4
- 238000012800 visualization Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000009510 drug design Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000003340 mental effect Effects 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 230000001681 protective effect Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
Images
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F41—WEAPONS
- F41H—ARMOUR; ARMOURED TURRETS; ARMOURED OR ARMED VEHICLES; MEANS OF ATTACK OR DEFENCE, e.g. CAMOUFLAGE, IN GENERAL
- F41H11/00—Defence installations; Defence devices
- F41H11/12—Means for clearing land minefields; Systems specially adapted for detection of landmines
- F41H11/13—Systems specially adapted for detection of landmines
-
- 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
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- General Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法,包括探雷机器人系统,探雷机器人系统包括基站、地面移动机器人和操控终端。本发明所述的一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法,具有较好的移植性,可广泛用于各种无人或有人的地雷目标探测平台甚至单兵探雷装备中,以实现上述探测装备在探测作业过程中的探测区域信号强度分布可视化成像与可疑目标高精度定位。
Description
技术领域
本发明涉及无人化探扫雷领域,特别涉及一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法。
背景技术
当前基于人道主义的探扫雷作业模式仍以人工抵近探扫作业模式为主,探扫雷人员身着扫雷防护服,手持探扫作业装置抵近地雷区域作业,风险性极高,作业人员作业过程中也面临着巨大的身心压力,基于地雷目标的高危险性和探扫雷作业的高风险性,为减少探扫雷作业人员伤亡,无人化探扫雷作业装备代替人工探扫是必然趋势,但现有无人化探扫作业装备,尤其是中小型无人化装备,多为中小型地面移动机器人与单兵探扫雷作业装备的简单组合形式为主,缺少有效物理集成与深度数据融合,并以遥控作业方式为主,智能化程度不高,
国内最早用于人道主义扫雷作业的机器人是由北京理工大学、湖北汉丹机电有限公司在2005年联合研制的,该扫雷机器人在北京理工大学与湖北汉丹机电有限公司联合研制的防爆弹发射机器人平台安装有GTL115单兵金属探测器,人员在后端遥控机器人对地雷目标进行探测,完全依靠探测器探测时的报警信号(声光)确定目标位置,与纯人工探测定位方式基本相同,
近年来,随着单兵探雷装置探测精度的提高和虚警率的降低以及地面移动机器人平台在地形适应能力、环境感知能力、地面平台与探雷机械臂的智能控制方面的长足发展,国内一些机器人公司和研究机构在现有中小型排爆机器人平台基础上通过集成最新一代地雷目标探测器(包括复合使用多种探测器),对排爆机器人应用于地雷探扫作业方面进行了一些实际应用探索,但该类应用作业模式仍以遥控为主且未能实现探测器探测信号与移动平台位置信息的深度融合,后端遥控人员依然靠探测器探测目标时的声光信号粗略感知目标位置,而无法直观且近乎实时的获取雷场已探测区域信号的二维或三维可视化图像并对可疑地雷目标进行精准定位,整个系统的数据深度融合和智能化处理程度不高,影响了无人化探扫雷机器人系统自主探测定位目标能力的实现。
发明内容
本发明的主要目的在于提供一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法,可以有效解决背景技术中的问题。
为实现上述目的,本发明采取的技术方案为:
一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法,包括探雷机器人系统,所述探雷机器人系统包括基站、地面移动机器人和操控终端,其中,
所述基站设置在待测雷场附近,所述基站内设置有GNSS差分定位定向装置;
所述地面移动机器人设置在待探测雷场起点处,所述地面移动机器人内集成有GNSS差分定位定向移动站、高精度姿态传感器、探雷作业装置以及通信装置,所述探雷作业装置包括探雷机械臂和探雷器;
所述操控终端设置在距探测起点必要安全距离之外,且能与所述地面移动机器人保持可靠、稳定的通信。
优选的,具体步骤如下:
(S1)、通过所述操控终端向所述地面移动机器人发送开始探测指令;
所述地面移动机器人前端控制系统接收到探测指令后启动探雷作业装置;
(S2)、所述探雷作业装置按设定的探测扫描运动轨迹以恒定的角速度作左右等角度弧线扫描探测;
(S3)、所述地面移动机器人中的GNSS差分定位定向移动站解算出地面移动机器人中移动站定位天线的实时位置与方向数据,所述地面移动机器人中的高精度姿态传感器所采集的地面移动机器人实时姿态数据和探雷器所采集的探测信号实时数据通过有线方式进入地面移动机器人前端控制系统,地面移动机器人前端控制系统通过串口将移动站定位天线的实时位置与方向数据、地面移动机器人实时姿态数据和探雷器所采集的探测信号实时数据传输到所述操控终端上位机中;
(S4)、所述操控终端上位机软件读取所述串口中的有效数据,并进行实时处理。
优选的,所述步骤(S2)中的左右等角度弧线扫描探测的左右角度为45°。
优选的,所述步骤(S2)中的所述探雷作业装置每完成一次弧线探测后,探雷作业装置顺径向伸展一个距离△H,再启动下一次反向弧线探测,待探雷作业装置向前累计伸展距离达到极限时,即完成一次区域探测。
优选的,所述步骤(S4)中的所述操控终端有效数据实时处理,具体步骤如下:
(S4.1)、探雷器探头中心位置坐标数据解算
坐标转换关系为:
式中XB、YB、ZB——探雷器中心B的真实位置信息;
XC、YC、ZC——地面移动机器人上定位天线中心点C点的GNSS位置信息;
利用GNSS实时动态差分定位定向测得大地坐标系下地面移动机器人航向角α信息,航向角α是地面移动机器人中定位天线与定向天线安装位置构成的向量与正北方向夹角,通过地面移动机器人上的高精度姿态传感器准确测得横滚角俯仰角γ的值后,代入式(2)可求出方向余弦矩阵再结合GNSS差分定位定向移动站测得的大地坐标系下的定位天线中心点C点处的坐标信息代入式(1)即可解算出探雷器中心B点的真实GNSS位置信息;
操控终端上位机实时读取通过串口传输来的位置与姿态数据后,实时解算出探雷器在弧线扫描探测阶段探头中心位置的坐标变化数据;
(S4.2)、匹配对齐探雷器中心位置坐标数据点与探测信号强度数据点
操控终端上位机读取串口传输来的有效位置和姿态数据并实时解算出探雷器中心位置坐标信息后,对采样率低的数据源进行线性插值,人为增加数据点个数,使每次探测器弧线扫描探测阶段内的位置数据与信号强度数据点个数一致,并将位置数据点与信号强度数据点按采集时间对应关系一一对齐匹配储存为一个单独的数据文件;
(S4.3)、位置数据与信号强度数据融合与可视化成像
在探雷装置自动进行N次左右等角度弧线扫描探测完成一次局部区域探测后,操控终端的上位机数据处理软件生成N个完成位置数据与信号强度数据匹配的数据文件;
操控终端的上位机数据处理软件利用N个数据文件以x轴为横坐标,y轴为纵坐标,通过画图函数将数据文件中的位置数据点对应的信号强度数据进行内插求出等值点,并将等值点连接而形成坐标平面内的信号强度分布等值线图,等值线除标记数值外,还使用颜色深浅直观反应信号强度分布大小差别,也可以通过上位机软件以x轴为横坐标,y轴为纵坐标,z轴为信号强度,由画图函数生成的三维图像形式;
完成一次探测信号强度分布区域成像后,利用操控终端的上位机数据处理软件在上述坐标平面内的信号强度分布等值线图像中采用滑动窗口的方法搜索探测信号强度数据局部极大值,滑动窗口采用矩形窗口样式,以信号强度值大于特定阈值I0(可取探测区域平均背景噪声值的120%)的强度数据点Ii为中心,长、宽尺寸各l(l可取最小地雷目标最大特征尺寸的200%),搜索出所有的局部极大值记为{localmax{Ii}j},对应的坐标位置数据为{Xlocalmax{Ii}j,Ylocalmax{Ii}j},利用对应的坐标数据在等值线图中进行标注,若局部极大值标注位置与个数与等值线图中信号强度波峰位置与个数存在出入时,可调整滑动窗口长宽参数l,以使标注结果与实际图像呈现结果基本一致,所有标注的极大值点也即等值线图中的波峰位置即可认为是可疑目标所在位置,操控终端上位机数据处理软件完成局部极大值搜索与标注后,自动输出所有可疑目标位置坐标。
优选的,还包括步骤(S5),在所述操控终端上位机数据处理软件自动完成所有可疑目标位置标注后,人工也可在操控终端介入,根据经验结合等值线图像,在所有自动输出的可疑目标位置点中进一步挑选出最有可能的地雷目标位置。
与现有技术相比,本发明具有如下有益效果:
本发明通过在地面移动机器人前端集成GNSS差分定位定向装置、高精度姿态传感器和高灵敏度探雷器等硬件,上述硬件系统所采集的前端数据通过通信系统实时回传至后端数据处理进行实时处理与融合后,可实现探测区域信号强度与坐标位置的一一对应和区域信号强度分布的二维等值线或三维立体可视化成像,相比于现有仅依靠探雷器探测信号数据感知雷场信号强度分布的探测手段和方法,可更直观形象的实时感知到雷场探测区域可疑目标分布态势;
本发明通过在后端通过数据融合实现探测区域信号强度分布可视化成像后,在生成的探测信号二维等值线图像或三维图像中后端数据处理通过搜索局部极大值以确定出每个极大值对应的绝对或相对位置坐标,从而实现探测目标的高精度水平二维坐标定位,克服了现有单兵探雷器装置无法准确获取目标位置坐标信息的缺点,为后续机器人系统自主目标标识与处置提供了高精度位置数据基础;
综上所述,本发明方法具有较好的移植性,可广泛用于各种无人或有人的地雷目标探测平台甚至单兵探雷装备中,以实现上述探测装备在探测作业过程中的探测区域信号强度分布可视化成像与可疑目标高精度定位。
附图说明
图1为本发明一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法的流程框图;
图2为本发明一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法中探雷作业装置采用左右等角度扫描探测图;
图3为本发明一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法中探雷器探测信号强度分布可视化成像原理图。
具体实施方式
为使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体实施方式,进一步阐述本发明。
参照图1-3,本发明公开了一种适用地面移动机器人的雷场目标探测信号分布可视化成像与可疑目标高精度定位实现方法,包括探雷机器人系统,所述探雷机器人系统包括基站、地面移动机器人和操控终端,其中,
基站设置在待测雷场附近,基站内设置有GNSS差分定位定向装置;
地面移动机器人设置在待探测雷场起点处,地面移动机器人内集成有GNSS差分定位定向移动站、高精度姿态传感器、探雷作业装置以及通信装置,探雷作业装置包括探雷机械臂和探雷器;
操控终端设置在距探测起点必要安全距离之外,且能与地面移动机器人保持可靠、稳定的通信。
具体步骤如下:
(S1)、通过操控终端向地面移动机器人发送开始探测指令;
地面移动机器人前端控制系统接收到探测指令后启动探雷作业装置;
(S2)、探雷作业装置按设定的探测扫描运动轨迹以恒定的角速度作左右等角度弧线扫描探测;
(S3)、地面移动机器人中的GNSS差分定位定向移动站解算出地面移动机器人中移动站定位天线的实时位置与方向数据,地面移动机器人中的高精度姿态传感器所采集的地面移动机器人实时姿态数据和探雷器所采集的探测信号实时数据通过有线方式进入地面移动机器人前端控制系统,地面移动机器人前端控制系统通过串口将移动站定位天线的实时位置与方向数据、地面移动机器人实时姿态数据和探雷器所采集的探测信号实时数据传输到操控终端上位机中;
(S4)、操控终端上位机软件读取串口中的有效数据,并进行实时处理。
步骤(S2)中的左右等角度弧线扫描探测的左右角度为45°。
步骤(S2)中的探雷作业装置每完成一次弧线探测后,探雷作业装置顺径向伸展一个距离△H,再启动下一次反向弧线探测,待探雷作业装置向前累计伸展距离达到极限时,即完成一次区域探测。
步骤(S4)中的操控终端有效数据实时处理,具体步骤如下:
(S4.1)、探雷器探头中心位置坐标数据解算
坐标转换关系为:
式中XB、YB、ZB——探雷器中心B的真实位置信息;
XC、YC、ZC——地面移动机器人上定位天线中心点C点的GNSS位置信息;
利用GNSS实时动态差分定位定向测得大地坐标系下地面移动机器人航向角α信息,航向角α是地面移动机器人中定位天线与定向天线安装位置构成的向量与正北方向夹角,通过地面移动机器人上的高精度姿态传感器准确测得横滚角俯仰角γ的值后,代入式(2)可求出方向余弦矩阵再结合GNSS差分定位定向移动站测得的大地坐标系下的定位天线中心点C点处的坐标信息代入式(1)即可解算出探雷器中心B点的真实GNSS位置信息;
操控终端上位机实时读取通过串口传输来的位置与姿态数据后,实时解算出探雷器在弧线扫描探测阶段探头中心位置的坐标变化数据;
(S4.2)、匹配对齐探雷器中心位置坐标数据点与探测信号强度数据点
操控终端上位机读取串口传输来的有效位置和姿态数据并实时解算出探雷器中心位置坐标信息后,由于位置数据和信号强度数据采样率不一致,需要与第二串口读取的探测器信号强度数据点进行匹配和对齐后才可完成后续数据融合与可视化成像,即对采样率低的数据源进行线性插值,人为增加数据点个数,使每次探测器弧线扫描探测阶段内的位置数据与信号强度数据点个数一致,并将位置数据点与信号强度数据点按采集时间对应关系一一对齐匹配储存为一个单独的数据文件;
(S4.3)、位置数据与信号强度数据融合与可视化成像
在探雷装置自动进行N次左右等角度弧线扫描探测完成一次局部区域探测后,操控终端的上位机数据处理软件生成N个完成位置数据与信号强度数据匹配的数据文件;
操控终端的上位机数据处理软件利用N个数据文件以x轴为横坐标,y轴为纵坐标,通过画图函数将数据文件中的位置数据点对应的信号强度数据进行内插求出等值点,并将等值点连接而形成坐标平面内的信号强度分布等值线图,等值线除标记数值外,还使用颜色深浅直观反应信号强度分布大小差别,也可以通过上位机软件以x轴为横坐标,y轴为纵坐标,z轴为信号强度,由画图函数生成的三维图像形式;
完成一次探测信号强度分布区域成像后,利用操控终端的上位机数据处理软件在上述坐标平面内的信号强度分布等值线图像中采用滑动窗口的方法搜索探测信号强度数据局部极大值,滑动窗口采用矩形窗口样式,以信号强度值大于特定阈值I0(可取探测区域平均背景噪声值的120%)的强度数据点Ii为中心,长、宽尺寸各l(l可取最小地雷目标最大特征尺寸的200%),搜索出所有的局部极大值记为{localmax{li}j},对应的坐标位置数据为{Xlocalmax{Ii}j,Ylocalmax{Ii}j},利用对应的坐标数据在等值线图中进行标注,若局部极大值标注位置与个数与等值线图中信号强度波峰位置与个数存在出入时,可调整滑动窗口长宽参数l,以使标注结果与实际图像呈现结果基本一致,所有标注的极大值点也即等值线图中的波峰位置即可认为是可疑目标所在位置,操控终端上位机数据处理软件完成局部极大值搜索与标注后,自动输出所有可疑目标位置坐标。
还包括步骤(S5),在操控终端上位机数据处理软件自动完成所有可疑目标位置标注后,人工也可在操控终端介入,根据经验结合等值线图像,在所有自动输出的可疑目标位置点中进一步挑选出最有可能的地雷目标位置。
以上显示和描述了本发明的基本原理和主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。
Claims (4)
1.一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法,包括探雷机器人系统,其特征在于,所述探雷机器人系统包括基站、地面移动机器人和操控终端,其中:
所述基站设置在待测雷场附近,所述基站内设置有GNSS差分定位定向装置;
所述地面移动机器人设置在待探测雷场起点处,所述地面移动机器人内集成有GNSS差分定位定向移动站、高精度姿态传感器、探雷作业装置以及通信装置,所述探雷作业装置包括探雷机械臂和探雷器;
所述操控终端设置在距探测起点必要安全距离之外,且能与所述地面移动机器人保持可靠、稳定的通信;
基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法,具体步骤如下:
(S1)、通过操控终端向所述地面移动机器人发送开始探测指令;
地面移动机器人前端控制系统接收到探测指令后启动探雷作业装置;
(S2)、所述探雷作业装置按设定的探测扫描运动轨迹以恒定的角速度作左右等角度弧线扫描探测;
(S3)、所述地面移动机器人中的GNSS差分定位定向移动站解算出地面移动机器人中移动站定位天线的实时位置与方向数据,所述地面移动机器人中的高精度姿态传感器所采集的地面移动机器人实时姿态数据和探雷器所采集的探测信号实时数据通过有线方式进入地面移动机器人前端控制系统,地面移动机器人前端控制系统通过串口将移动站定位天线的实时位置与方向数据、地面移动机器人实时姿态数据和探雷器所采集的探测信号实时数据传输到所述操控终端上位机中;
(S4)、所述操控终端上位机软件读取所述串口中的有效数据,并进行实时处理;
所述步骤(S4)中的操控终端进行有效数据实时处理,具体步骤如下:
(S4.1)、探雷器探头中心位置坐标数据解算
坐标转换关系为:
式中XB、YB、ZB——探雷器中心B的真实位置信息;
XC、YC、ZC——地面移动机器人上定位天线中心点C点的GNSS位置信息;
利用GNSS实时动态差分定位定向移动站测得大地坐标系下地面移动机器人航向角α信息,航向角α是地面移动机器人中定位天线与定向天线安装位置构成的向量与正北方向夹角,通过地面移动机器人上的高精度姿态传感器准确测得横滚角俯仰角γ的值后,代入式(2)可求出方向余弦矩阵再结合GNSS差分定位定向移动站测得的大地坐标系下的定位天线中心点C点处的坐标信息代入式(1)即可解算出探雷器中心B点的真实GNSS位置信息;
操控终端上位机实时读取通过串口传输来的位置与姿态数据后,实时解算出探雷器在弧线扫描探测阶段探头中心位置的坐标变化数据;
(S4.2)、匹配对齐探雷器中心位置坐标数据点与探测信号强度数据点
操控终端上位机读取串口传输来的有效位置和姿态数据并实时解算出探雷器中心位置坐标信息后,对采样率低的数据源进行线性插值,人为增加数据点个数,使每次探测器弧线扫描探测阶段内的位置数据与信号强度数据点个数一致,并将位置数据点与信号强度数据点按采集时间对应关系一一对齐匹配储存为一个单独的数据文件;
(S4.3)、位置数据与信号强度数据融合与可视化成像
在探雷装置自动进行N次左右等角度弧线扫描探测完成一次局部区域探测后,操控终端的上位机数据处理软件生成N个完成位置数据与信号强度数据匹配的数据文件;
操控终端的上位机数据处理软件利用N个数据文件以x轴为横坐标,y轴为纵坐标,通过画图函数将数据文件中的位置数据点对应的信号强度数据进行内插求出等值点,并将等值点连接而形成坐标平面内的信号强度分布等值线图,等值线除标记数值外,还使用颜色深浅直观反应信号强度分布大小差别,也可以通过上位机软件以x轴为横坐标,y轴为纵坐标,z轴为信号强度,由画图函数生成三维图像形式;
完成一次探测信号强度分布区域成像后,利用操控终端的上位机数据处理软件在上述坐标平面内的信号强度分布等值线图像中采用滑动窗口的方法搜索探测信号强度数据局部极大值,滑动窗口采用矩形窗口样式,以信号强度值大于特定阈值I0的强度数据点Ii为中心,长、宽尺寸各l,搜索出所有的局部极大值记为{localmax{Ii}j},对应的坐标位置数据为{Xlocalmax{Ii}j,Ylocalmax{Ii}j},利用对应的坐标数据在等值线图中进行标注,若局部极大值标注位置与个数与等值线图中信号强度波峰位置与个数存在出入时,可调整滑动窗口长宽参数l,以使标注结果与实际图像呈现结果基本一致,所有标注的极大值点也即等值线图中的波峰位置即可认为是可疑目标所在位置,操控终端上位机数据处理软件完成局部极大值搜索与标注后,自动输出所有可疑目标位置坐标。
2.根据权利要求1所述的一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法,其特征在于:所述步骤(S2)中的左右等角度弧线扫描探测的左右角度为45°。
3.根据权利要求1所述的一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法,其特征在于:所述步骤(S2)中的所述探雷作业装置每完成一次弧线探测后,探雷作业装置顺径向伸展一个距离△H,再启动下一次反向弧线探测,待探雷作业装置向前累计伸展距离达到极限时,即完成一次区域探测。
4.根据权利要求1所述的一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法,其特征在于:还包括步骤(S5),在操控终端上位机数据处理软件自动完成所有可疑目标位置标注后,人工也可在操控终端介入,根据经验结合等值线图像,在所有自动输出的可疑目标位置点中进一步挑选出最有可能的地雷目标位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110516854.5A CN113280687B (zh) | 2021-05-12 | 2021-05-12 | 一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110516854.5A CN113280687B (zh) | 2021-05-12 | 2021-05-12 | 一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113280687A CN113280687A (zh) | 2021-08-20 |
CN113280687B true CN113280687B (zh) | 2022-06-07 |
Family
ID=77278722
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110516854.5A Active CN113280687B (zh) | 2021-05-12 | 2021-05-12 | 一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113280687B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114609655A (zh) * | 2021-12-28 | 2022-06-10 | 湖北华中光电科技有限公司 | 基于北斗定位时统的激光告警组网系统及激光威胁源方位识别方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB9801992D0 (en) * | 1997-02-04 | 1998-03-25 | Diehl Gmbh & Co | Mine detector |
US6377872B1 (en) * | 1999-07-02 | 2002-04-23 | Bae Systems Information And Electronic Systems Integration Inc | Apparatus and method for microwave imaging and excavation of objects |
CN107328308A (zh) * | 2017-07-20 | 2017-11-07 | 上海圭目机器人有限公司 | 一种自主式探雷机器人系统及探雷方法 |
CN206638092U (zh) * | 2017-03-09 | 2017-11-14 | 扬州大学 | 一种基于差分定位技术全覆盖式路径规划扫雷装置 |
-
2021
- 2021-05-12 CN CN202110516854.5A patent/CN113280687B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB9801992D0 (en) * | 1997-02-04 | 1998-03-25 | Diehl Gmbh & Co | Mine detector |
US6377872B1 (en) * | 1999-07-02 | 2002-04-23 | Bae Systems Information And Electronic Systems Integration Inc | Apparatus and method for microwave imaging and excavation of objects |
CN206638092U (zh) * | 2017-03-09 | 2017-11-14 | 扬州大学 | 一种基于差分定位技术全覆盖式路径规划扫雷装置 |
CN107328308A (zh) * | 2017-07-20 | 2017-11-07 | 上海圭目机器人有限公司 | 一种自主式探雷机器人系统及探雷方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113280687A (zh) | 2021-08-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6590640B1 (en) | Method and apparatus for mapping three-dimensional features | |
CN109737981B (zh) | 基于多传感器的无人车目标搜索装置及方法 | |
US9175975B2 (en) | Systems and methods for navigation | |
CN110009739A (zh) | 移动摄像机的数字视网膜的运动特征的提取与编码方法 | |
CN110446159A (zh) | 一种室内无人机精确定位与自主导航的系统及方法 | |
CN108983248A (zh) | 一种基于3d激光雷达及v2x的网联车定位方法 | |
CN107132846B (zh) | 陌生室内场景下的γ辐射探测方法 | |
CN110514225A (zh) | 一种矿井下多传感器融合的外部参数标定及精准定位方法 | |
CN114444158B (zh) | 一种基于三维重建的地下巷道形变预警方法及系统 | |
CN110146089A (zh) | 一种基于嵌入式ai计算平台的巡检机器人定位方法 | |
CN104569972B (zh) | 一种植物根系三维构型无损检测方法 | |
CN108303043B (zh) | 多传感器信息融合的植物叶面积指数检测方法及系统 | |
CN108413965A (zh) | 一种室内室外巡检机器人综合系统及巡检机器人导航方法 | |
CN112857246A (zh) | 一种利用地面三目视频匹配的露天矿边坡形变在线监测方法 | |
WO2019135726A1 (en) | Metal detector capable of visualizing the target shape | |
CN110796681A (zh) | 一种用于船舶协同工作的视觉定位系统及方法 | |
US20230351629A1 (en) | Reflective cable locating system | |
CN106370160A (zh) | 一种机器人室内定位系统和方法 | |
CN113280687B (zh) | 一种基于地面移动机器人的雷场目标探测信号区域成像与定位实现方法 | |
KR20180072914A (ko) | 지리정보시스템과 노면영상정보의 동시간 활용을 통한 지표레이더탐사 위치확인 시스템 | |
CN111259807B (zh) | 井下有限区域移动设备定位系统 | |
CN116027351A (zh) | 一种手持/背包式slam装置及定位方法 | |
CN109839109A (zh) | 基于图像识别和多传感器融合的掘进机绝对位姿检测方法 | |
CN110232301A (zh) | 一种人体的检测方法、装置及存储介质 | |
KR20230101241A (ko) | 지하광산 내 3차원 위치 인식방법 |
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 |