CN111026163B - 一种面向室内的失控放射源自主搜寻机器人及其搜寻方法 - Google Patents

一种面向室内的失控放射源自主搜寻机器人及其搜寻方法 Download PDF

Info

Publication number
CN111026163B
CN111026163B CN201911331145.9A CN201911331145A CN111026163B CN 111026163 B CN111026163 B CN 111026163B CN 201911331145 A CN201911331145 A CN 201911331145A CN 111026163 B CN111026163 B CN 111026163B
Authority
CN
China
Prior art keywords
unit
robot
radiation dose
main control
control unit
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
Application number
CN201911331145.9A
Other languages
English (en)
Other versions
CN111026163A (zh
Inventor
蔡杰进
易登星
伍聪烜
王壮
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN201911331145.9A priority Critical patent/CN111026163B/zh
Publication of CN111026163A publication Critical patent/CN111026163A/zh
Application granted granted Critical
Publication of CN111026163B publication Critical patent/CN111026163B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/12Target-seeking control
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01TMEASUREMENT OF NUCLEAR OR X-RADIATION
    • G01T1/00Measuring X-radiation, gamma radiation, corpuscular radiation, or cosmic radiation
    • G01T1/02Dosimeters
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0285Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using signals transmitted via a public communication network, e.g. GSM network

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Optics & Photonics (AREA)
  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • High Energy & Nuclear Physics (AREA)
  • Molecular Biology (AREA)
  • Spectroscopy & Molecular Physics (AREA)
  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种面向室内的失控放射源搜寻机器人及其搜寻方法;失控放射源搜寻机器人包括机械部分、探测部分、控制部分以及数据存储部分;失控放射源搜寻机器人的搜寻方法为:采用沿墙走算法进行全局路径搜索,当位于辐射剂量探测单元上方的辐射剂量探测装置检测到辐射剂量率大于第一阈值时,进入第一局部路径搜索模式,当位于辐射剂量探测单元侧面的辐射剂量探测装置检测到辐射剂量率大于第一阈值时,进入第二局部路径搜索模式,若两者同时检测到辐射剂量率大于第一阈值,则优先进行第一局部路径搜索模式;本发明使工作人员避免了直接进行放射源搜寻的过程,降低了放射源搜寻人员受到辐射伤害的可能性,进一步保障了人们生产生活的安全性。

Description

一种面向室内的失控放射源自主搜寻机器人及其搜寻方法
技术领域
本发明涉及机器人搜寻领域,尤其涉及一种面向室内的失控放射源自主搜寻机器人及其搜寻方法。
背景技术
自21世纪以来,无论是国际还是国内,核工业与核技术都得到巨大发展。与此同时,放射源也被广泛应用于医疗、工业探伤、农作物育种等生产生活的各个方面,为人们的生产生活提供了巨大的帮助。然而,由于管理不善、人为盗窃等原因,放射源丢失事故时有发生。例如2003年金昌市、2005年邢台市、2014年南京市均发生过不同程度的放射源丢失事件。对于失控的放射源,目前仍采用技术人员携探测仪器人工搜寻或遥控机器人搜寻的方式,不仅效率不高,而且放射源搜寻人员极易受到辐照伤害。
针对诸如此类的问题,自主探寻并处置失控放射源的智能机器人开始受到研究人员的关注。2018年3月,西南科技大学张华等人提出了一种基于异构机器人的放射物搜寻系统及方法(西南科技大学.一种基于异构机器人的放射物搜寻系统及方法:CN201810255940.3[P].2018-09-25.)。该系统利用多旋翼飞行器与陆地机器人配合,能够快速有效的探寻到失控放射源的位置并做出处置措施。但同时,该系统也存在一些不可避免的问题。例如,对于可能散落在室内的放射源,多旋翼飞行器难以进入现场进行搜寻,而受到墙壁等物体的隔离作用,当无人机在室外配合陆地机器人进行探寻时不能够准确定位放射源所在的位置;利用GPS定位设备对系统内的多旋翼飞行器及陆地机器人进行定位,定位精度不高。
发明内容
为了解决现有技术中的不足之处,本发明公开一种面向室内的失控放射源自主搜寻机器人,该机器人利用机器人技术,能够在室内环境中灵活、快速地运动,并且探测自身周边环境的障碍物信息、图像信息以及辐射剂量信息,准确搜寻出可能散落在室内各个位置的放射源,使工作人员避免了直接进行放射源搜寻的过程,降低了放射源搜寻人员受到辐射伤害的可能性,进一步保障了人们生产生活的安全性。
本发明的另一目的在于:提供一种面向室内的失控放射源自主搜寻机器人的搜寻方法。
本发明的目的至少通过如下技术方案之一实现:
一种面向室内的失控放射源自主搜寻机器人,包括机械部分、探测部分、控制部分以及数据存储部分;所述机械部分具体包括运动机构、驱动机构和设备搭载平台;所述探测部分具体包括激光测距单元、辐射剂量探测单元、摄像单元和超宽带定位单元;所述控制部分具体包括电源、主控单元和无线通讯单元;所述数据存储部分具体包括数据存储单元;
所述运动机构分别与驱动机构及设备搭载平台连接;
所述电源分别与驱动机构、激光测距单元、辐射剂量探测单元、摄像单元、超宽带定位单元、主控单元、无线通讯单元以及数据存储单元连接;
所述主控单元分别与电源、激光测距单元、辐射剂量探测单元、摄像单元、超宽带定位单元、无线通讯单元以及数据存储单元连接;
所述运动机构具体包括轮子以及依靠轮子支撑的底盘,通过驱动机构的驱动,实现机器人的前进、后退以及转向;
所述驱动机构接收主控单元发出的指令,用于驱动运动机构做出动作;
所述设备搭载平台固定在运动机构的底盘上,包含上、下两层,每一层均被划分为9块区域,每层的9块区域大小可根据所搭载仪器设备尺寸进行调整确定,用于搭载各种仪器设备;设备搭载平台上层9块区域按左前、正前、右前、左侧、中间、右侧、左后、正后、右后的位置顺序分别编号:U1、U2、U3、U4、U5、U6、U7、U8、U9;设备搭载平台下层的9块区域按左前、正前、右前、左侧、中间、右侧、左后、正后、右后的位置顺序分别编号:D1、D2、D3、D4、D5、D6、D7、D8、D9;
所述激光测距单元用于实时探测机器人自身与障碍物以及墙壁之间的距离,并且将探测到的信息实时传输到主控单元;
所述辐射剂量探测单元用于探测待搜寻区域内的辐射剂量率以及辐射剂量分布情况;
所述摄像单元用于实时记录搜寻过程中的图像信息;
所述超宽带定位单元用于确定机器人在室内的位置,将位置坐标信息存储到数据存储单元,并通过无线通讯单元将位置坐标信息传输到技术人员终端设备;
所述电源安装在设备搭载平台的D1号位置,用于为机器人身上各种装置提供所需的电能;
所述主控单元用于控制机器人的各种行为;
所述无线通讯单元用于将机器人搜寻过程采集到的距离信息、辐射剂量强度信息、图像信息、位置坐标信息实时传输到技术人员的终端设备上;
所述数据存储单元用于存储机器人在搜寻过程中采集到的各种信息。
进一步地,所述机械部分的驱动机构具体包括电动机和角度伺服电机;所述电动机安装在设备搭载平台的D5号位置,分别与电源运动机构的轮子以及主控单元连接,用于控制机器人前进、后退以及控制机器人的直线运动速度;所述角度伺服电机安装在设备搭载平台的D3号位置,分别与电动机、电源以及主控单元连接,用于控制机器人的转向动作。
进一步地,所述探测部分的激光测距单元具体包括第一测距单元、第二测距单元和第三测距单元;所述第一测距单元安装在设备搭载平台的D2号位置,分别与电源、主控单元、无线通讯单元以及数据存储单元连接,用于测量前方障碍物的形体特征以及障碍物与机器人之间的距离,并将探测到的数据实时传输到主控单元;所述第二测距单元和第三测距单元分别安装在设备搭载平台的D4及D6号位置,第二测距单元和第三测距单元均分别与电源、主控单元、无线通讯单元以及数据存储单元连接,用于探测机器人与墙壁之间的距离,并将探测到的信息实时传输到主控单元。
进一步地,所述探测部分的辐射剂量探测单元安装在设备搭载平台的U5号位置,安装方式为:直棱柱轴线垂直于地面,两个底面中无探针一侧靠近地面;辐射剂量探测单元具体包括辐射屏蔽体和辐射剂量探测装置,辐射屏蔽体构成辐射剂量探测单元的外部,是一个底面为正八边形、上底面以及8个侧面各开有一个圆形小孔的、内部掏空的直棱柱;辐射剂量探测装置安装在辐射屏蔽体的内部,具体包括9个以GM管为主的相互独立的辐射剂量探测装置;所述9个以GM管为主的相互独立的辐射剂量探测装置分别安装在辐射剂量探测单元屏蔽体的上方、前方、后方、左方、右方、左前方、左后方、右前方以及右后方9个方向上,并分别与电源以及主控单元相连,侧面8个方向上的探针与机器人四个轮子底端所在平面平行,上底面的探针竖直向上,用于探测机器人搜寻区域内各个方向的辐射剂量率,并将探测到的辐射剂量率实时传输的主控单元;所述GM管的探针通过小孔探测该方向上的剂量率。
进一步地,所述探测部分的摄像单元安装在设备搭载平台的U2号位置,分别与电源、无线通讯单元、数据存储单元连接,用于采集搜寻过程的图像,并通过无线通讯单元将图像信息传输到技术人员的终端设备上,并将图像信息存储到数据存储单元中。
进一步地,所述探测部分的超宽带定位单元具体包括定位标签、定位基站以及定位解算引擎;所述定位标签安装在设备搭载平台的U1号位置,分别与电源、主控单元、无线通讯单元以及数据存储单元连接,用于发射超短时脉冲信号以及接收定位基站发送回来的定位数据;所述定位基站同时具有有线以太网和WiFi两种回传信道,根据实际情况布置到室内,用于接收定位标签发送的超短时脉冲信号,并通过信号传输设备将脉冲信号传输到定位解算引擎;所述定位解算引擎为技术人员终端设备上的定位软件,用于解算定位基站传回的信号,实时确定机器人所处位置坐标信息。
进一步地,所述控制部分的主控单元安装在设备搭载平台的D7号位置,具体包括处理器和中断控制器;所述处理器分别与电动机、角度伺服电机、电源、无线通讯单元、数据存储单元、激光测距单元、辐射剂量探测单元、摄像单元、定位标签、定位解算引擎连接,用于处理各种装置反馈的信息,并向各种装置发送指令;所述中断控制器内置于处理器中,分别与电动机、角度伺服电机、电源连接,用于中断全局路径搜索并执行局部路径搜索,当完成局部路径搜索后,控制机器人返回中断点,继续执行全局路径规划搜索。
进一步地,所述控制部分的无线通讯单元,用于将搜寻过程中的图像信息传输到工作人员的终端设备。
本发明的另一目的可以通过以下技术方案来实现:
一种面向室内的失控放射源自主搜寻机器人的搜寻方法,步骤如下:
S1.参数初始化;
S2.进行采用沿墙走算法的全局路径搜索;
S3.第一局部路径搜索模式;
S4.第二局部路径搜索模式;
S5.确定目标物,返回中断点,并结束局部路径搜索;
S6.判断是否继续执行全局路径搜索;
S7.完成搜索,回到起始点,结束搜寻任务;
在整个搜索过程中:所述控制部分的电源始终为各种装置提供需要的电能;所述激光测距单元实时测量距离信息并传输到主控单元,主控单元根据激光测距单元的反馈数据做出判断,控制机器人避开障碍物;所述辐射剂量探测单元实时探测9个方向上的辐射剂量率并将采集到的数据传输到主控单元以及数据记录单元;所述摄像单元实时记录搜寻过程中机器人周边环境的图像信息,并将数据保存到数据存储单元,并通过无线通讯单元将图像传输至工作人员的终端设备;所述超宽带定位单元实时确定机器人所处位置坐标信息。
进一步地,步骤S1中,初始化的参数具体包括:设定辐射剂量率第一阈值a1、辐射剂量率第二阈值a2、离墙最近距离m1、离墙最远距离m2、转向及避障距离m3、间隔时间t1、第一局部搜索半径m4、机器人步长x1、第一局部路径搜索递增半径b以及重复次数n。
进一步地,步骤S2中,包括以下步骤:
S2.1,设定循环次数k=0;
S2.2,进行采用沿墙走算法的全局路径搜索;在搜索过程中,所述辐射剂量探测单元的辐射剂量探测装置将探测到的辐射剂量数据实时传输到主控单元,主控单元实时判断辐射剂量探测单元上方的辐射剂量探测装置探测到的辐射剂量率是否大于第一阈值a1,若是,进入步骤S3,若否,判断辐射剂量探测单元侧方的辐射剂量探测装置探测到的辐射剂量率是否大于第一阈值a1,若是,进入步骤S4,若否,继续进行全局路径搜索。
进一步地,步骤S3中,具体步骤如下:
S3.1,主控单元令k=k+1,并控制机器人暂停运动;
S3.2,经过时间t1后,主控单元控制机器人沿着以中断点为圆心、m4为半径的圆绕行;在机器人沿着以中断点为圆心、m4为半径的圆绕行的过程中,所述辐射剂量探测单元上方的辐射剂量探测装置将探测到的辐射剂量率传输到主控单元;
S3.3,主控单元将步骤S3.2返回的辐射剂量数据与第二阈值a2比较,若探测到的辐射剂量率大于第二阈值a2,则进入步骤S5;否则进入步骤S3.4;
S3.4,主控单元令m4=m4+b;
S3.5,判断循环次数k是否等于n,若是,则返回步骤S2.2;若否,返回步骤S3.1。
进一步地,步骤S4中,具体步骤如下:
S4.1,主控单元令k=k+1,主控单元控制机器人暂停运动,并对8组数据按大小排序;
S4.2,经过时间t1后,主控单元控制机器人沿辐射剂量率最大的方向前进一个步长x1的距离;
S4.3,判断辐射剂量率最大值是否大于第二阈值a2,若是,则进入步骤S5;否则进入步骤S4.4;
S4.4,判断循环次数k是否等于n,若是,则认为判断失误,返回步骤S2.2;若否,返回步骤S4.1。
进一步地,步骤S5中,具体步骤如下:
S5.1,认为机器人找到目标物;
S5.2,主控单元控制机器人暂停运动;
S5.3,主控单元通过数据处理的方式对机器人当前位置坐标进行特殊标记,并将机器人当前位置坐标设定为报警点,并将报警点记录在数据存储单元中,并通过无线通讯单元将报警点坐标传输到技术人员终端设备;
S5.4,完成放射源位置标记任务,主控单元控制机器人原路返回中断点。
进一步地,步骤S6中,具体步骤如下:主控单元通过超宽带定位单元探测到的定位信息判断机器人是否回到起始点,若是,则进入步骤S7;否则返回步骤S2.2。
与现有技术相比,本发明的优点在于:
1.本发明使用全自动机器人进行放射源的搜索,使工作人员避免了直接进行放射源搜寻的过程,降低了放射源搜寻人员受到辐射伤害的可能性,进一步保障了人们生产生活的安全性。
2.当机器人从单一方向搜索前进时,放射源有可能被障碍物阻挡,导致机器人检测到的辐射剂量率误差较大,本发明采用沿墙走算法进行全局搜索,能从不同方向对室内核辐射剂量率进行检测,可最大程度减少此类问题的出现。
3.本发明提出了正八面体形状的辐射剂量测量单元结构,使得机器人在一个位置时能同时测量尽可能多方向上的辐射剂量率,加快搜寻效率,提高搜寻精度。
附图说明
图1为本发明一种面向室内的失控放射源自主搜寻机器人系统的组成机构图;
图2为本发明实施例中的辐射剂量探测单元的结构示意图;
图3为本发明一种面向室内的失控放射源自主搜寻机器人的搜寻方法流程图;
图4为本发明实施例中步骤S2的实施流程图;
图5为本发明实施例中步骤S3的实施流程图;
图6为本发明实施例中步骤S4的实施流程图。
具体实施方式
下面结合实施例及附图对本发明的具体实施作进一步详细的描述,但本发明的实施方式不限于此。
实施例:
如图1所示,一种面向室内的失控放射源自主搜寻机器人,包括机械部分、探测部分、控制部分以及数据存储部分;所述机械部分具体包括运动机构、驱动机构和设备搭载平台;所述探测部分具体包括激光测距单元、辐射剂量探测单元、摄像单元和超宽带定位单元;所述控制部分具体包括电源、主控单元和无线通讯单元;所述数据存储部分具体包括数据存储单元;
所述运动机构分别与驱动机构及设备搭载平台连接;
所述电源分别与驱动机构、激光测距单元、辐射剂量探测单元、摄像单元、超宽带定位单元、主控单元、无线通讯单元以及数据存储单元连接;
所述主控单元分别与电源、激光测距单元、辐射剂量探测单元、摄像单元、超宽带定位单元、无线通讯单元以及数据存储单元连接;
所述运动机构具体包括轮子以及依靠轮子支撑的底盘,通过驱动机构的驱动,实现机器人的前进、后退以及转向;
所述驱动机构接收主控单元发出的指令,用于驱动运动机构做出动作;
所述设备搭载平台固定在运动机构的底盘上,包含上、下两层,每一层均被划分为9块区域,每层的9块区域大小可根据所搭载仪器设备尺寸进行调整确定,用于搭载各种仪器设备;设备搭载平台上层9块区域按左前、正前、右前、左侧、中间、右侧、左后、正后、右后的位置顺序分别编号:U1、U2、U3、U4、U5、U6、U7、U8、U9;设备搭载平台下层的9块区域按左前、正前、右前、左侧、中间、右侧、左后、正后、右后的位置顺序分别编号:D1、D2、D3、D4、D5、D6、D7、D8、D9;
所述激光测距单元用于实时探测机器人自身与障碍物以及墙壁之间的距离,并且将探测到的信息实时传输到主控单元;
所述辐射剂量探测单元用于探测待搜寻区域内的辐射剂量率以及辐射剂量分布情况;
所述摄像单元用于实时记录搜寻过程中的图像信息;
所述超宽带定位单元用于确定机器人在室内的位置,将位置坐标信息存储到数据存储单元,并通过无线通讯单元将位置坐标信息传输到技术人员终端设备;
所述电源安装在设备搭载平台的D1号位置,用于为机器人身上各种装置提供所需的电能;
所述主控单元用于控制机器人的各种行为;
所述无线通讯单元用于将机器人搜寻过程采集到的距离信息、辐射剂量强度信息、图像信息、位置坐标信息实时传输到技术人员的终端设备上;
所述数据存储单元用于存储机器人在搜寻过程中采集到的各种信息。
所述机械部分的驱动机构具体包括电动机和角度伺服电机;所述电动机安装在设备搭载平台的D5号位置,分别与电源运动机构的轮子以及主控单元连接,用于控制机器人前进、后退以及控制机器人的直线运动速度;所述角度伺服电机安装在设备搭载平台的D3号位置,分别与电动机、电源以及主控单元连接,用于控制机器人的转向动作。
所述探测部分的激光测距单元具体包括第一测距单元、第二测距单元和第三测距单元;所述第一测距单元安装在设备搭载平台的D2号位置,分别与电源、主控单元、无线通讯单元以及数据存储单元连接,用于测量前方障碍物的形体特征以及障碍物与机器人之间的距离,并将探测到的数据实时传输到主控单元;所述第二测距单元和第三测距单元分别安装在设备搭载平台的D4及D6号位置,第二测距单元和第三测距单元均分别与电源、主控单元、无线通讯单元以及数据存储单元连接,用于探测机器人与墙壁之间的距离,并将探测到的信息实时传输到主控单元。
如图2所示,所述探测部分的辐射剂量探测单元安装在设备搭载平台的U5号位置,安装方式为:直棱柱轴线垂直于地面,两个底面中无探针一侧靠近地面;辐射剂量探测单元具体包括辐射屏蔽体和辐射剂量探测装置,辐射屏蔽体构成辐射剂量探测单元的外部,是一个底面为正八边形、上底面以及8个侧面各开有一个圆形小孔的、内部掏空的直棱柱;辐射剂量探测装置安装在辐射屏蔽体的内部,具体包括9个以GM管为主的相互独立的辐射剂量探测装置;所述9个以GM管为主的相互独立的辐射剂量探测装置分别安装在辐射剂量探测单元屏蔽体的上方、前方、后方、左方、右方、左前方、左后方、右前方以及右后方9个方向上,并分别与电源以及主控单元相连,侧面8个方向上的探针与机器人四个轮子底端所在平面平行,上底面的探针竖直向上,用于探测机器人搜寻区域内各个方向的辐射剂量率,并将探测到的辐射剂量率实时传输的主控单元;所述GM管的探针通过小孔探测该方向上的剂量率。
所述探测部分的摄像单元安装在设备搭载平台的U2号位置,分别与电源、无线通讯单元、数据存储单元连接,用于采集搜寻过程的图像,并通过无线通讯单元将图像信息传输到技术人员的终端设备上,并将图像信息存储到数据存储单元中。
所述探测部分的超宽带定位单元具体包括定位标签、定位基站以及定位解算引擎;所述定位标签安装在设备搭载平台的U1号位置,分别与电源、主控单元、无线通讯单元以及数据存储单元连接,用于发射超短时脉冲信号以及接收定位基站发送回来的定位数据;所述定位基站同时具有有线以太网和WiFi两种回传信道,根据实际情况布置到室内,用于接收定位标签发送的超短时脉冲信号,并通过信号传输设备将脉冲信号传输到定位解算引擎;所述定位解算引擎为技术人员终端设备上的定位软件,用于解算定位基站传回的信号,实时确定机器人所处位置坐标信息。
所述控制部分的主控单元安装在设备搭载平台的D7号位置,具体包括处理器和中断控制器;所述处理器分别与电动机、角度伺服电机、电源、无线通讯单元、数据存储单元、激光测距单元、辐射剂量探测单元、摄像单元、定位标签、定位解算引擎连接,用于处理各种装置反馈的信息,并向各种装置发送指令;所述中断控制器内置于处理器中,分别与电动机、角度伺服电机、电源连接,用于中断全局路径搜索并执行局部路径搜索,当完成局部路径搜索后,控制机器人返回中断点,继续执行全局路径规划搜索。
如图3所示,一种面向室内的失控放射源自主搜寻机器人的搜寻方法,步骤如下:
S1.参数初始化;初始化的参数具体包括:设定辐射剂量率第一阈值a1、辐射剂量率第二阈值a2、离墙最近距离m1、离墙最远距离m2、转向及避障距离m3、间隔时间t1、第一局部搜索半径m4、机器人步长x1、第一局部路径搜索递增半径b以及重复次数n。
S2.进行采用沿墙走算法的全局路径搜索;如图4所示,包括以下步骤:
S2.1,设定循环次数k=0;
S2.2,进行采用沿墙走算法的全局路径搜索;在搜索过程中,所述辐射剂量探测单元的辐射剂量探测装置将探测到的辐射剂量数据实时传输到主控单元,主控单元实时判断辐射剂量探测单元上方的辐射剂量探测装置探测到的辐射剂量率是否大于第一阈值a1,若是,进入步骤S3,若否,判断辐射剂量探测单元侧方的辐射剂量探测装置探测到的辐射剂量率是否大于第一阈值a1,若是,进入步骤S4,若否,继续进行全局路径搜索。
S3.第一局部路径搜索模式;如图5所示,具体步骤如下:
S3.1,主控单元令k=k+1,并控制机器人暂停运动;
S3.2,经过时间t1后,主控单元控制机器人沿着以中断点为圆心、m4为半径的圆绕行;在机器人沿着以中断点为圆心、m4为半径的圆绕行的过程中,所述辐射剂量探测单元上方的辐射剂量探测装置将探测到的辐射剂量率传输到主控单元;
S3.3,主控单元将步骤S3.2返回的辐射剂量数据与第二阈值a2比较,若探测到的辐射剂量率大于第二阈值a2,则进入步骤S5;否则进入步骤S3.4;
S3.4,主控单元令m4=m4+b;
S3.5,判断循环次数k是否等于n,若是,则返回步骤S2.2;若否,返回步骤S3.1。
S4.第二局部路径搜索模式;如图6所示,具体步骤如下:
S4.1,主控单元令k=k+1,主控单元控制机器人暂停运动,并对8组数据按大小排序;
S4.2,经过时间t1后,主控单元控制机器人沿辐射剂量率最大的方向前进一个步长x1的距离;
S4.3,判断辐射剂量率最大值是否大于第二阈值a2,若是,则进入步骤S5;否则进入步骤S4.4;
S4.4,判断循环次数k是否等于n,若是,则认为判断失误,返回步骤S2.2;若否,返回步骤S4.1。
S5.确定目标物,返回中断点,并结束局部路径搜索;具体步骤如下:
S5.1,认为机器人找到目标物;
S5.2,主控单元控制机器人暂停运动;
S5.3,主控单元通过数据处理的方式对机器人当前位置坐标进行特殊标记,并将机器人当前位置坐标设定为报警点,并将报警点记录在数据存储单元中,并通过无线通讯单元将报警点坐标传输到技术人员终端设备;
S5.4,完成放射源位置标记任务,主控单元控制机器人原路返回中断点。
S6.判断是否继续执行全局路径搜索;具体步骤如下:主控单元通过超宽带定位单元探测到的定位信息判断机器人是否回到起始点,若是,则进入步骤S7;否则返回步骤S2.2。
S7.完成搜索,回到起始点,结束搜寻任务;
在整个搜索过程中:所述控制部分的电源始终为各种装置提供需要的电能;所述激光测距单元实时测量距离信息并传输到主控单元,主控单元根据激光测距单元的反馈数据做出判断,控制机器人避开障碍物;所述辐射剂量探测单元实时探测9个方向上的辐射剂量率并将采集到的数据传输到主控单元以及数据记录单元;所述摄像单元实时记录搜寻过程中机器人周边环境的图像信息,并将数据保存到数据存储单元,并通过无线通讯单元将图像传输至工作人员的终端设备;所述超宽带定位单元实时确定机器人所处位置坐标信息。
以上所述仅为本发明的一种较佳实施例而已,对于本领域的普通技术人员,在不脱离本发明的精神和原则之下所做出的若干变型和改进,都应当认为是本发明的保护范围。

Claims (7)

1.一种面向室内的失控放射源自主搜寻机器人的搜寻方法,所述面向室内的失控放射源自主搜寻机器人包括机械部分、探测部分、控制部分以及数据存储部分;所述机械部分具体包括运动机构、驱动机构和设备搭载平台;所述探测部分具体包括激光测距单元、辐射剂量探测单元、摄像单元和超宽带定位单元;所述控制部分具体包括电源、主控单元和无线通讯单元;所述数据存储部分具体包括数据存储单元;
所述运动机构分别与驱动机构及设备搭载平台连接;
所述电源分别与驱动机构、激光测距单元、辐射剂量探测单元、摄像单元、超宽带定位单元、主控单元、无线通讯单元以及数据存储单元连接;
所述主控单元分别与电源、激光测距单元、辐射剂量探测单元、摄像单元、超宽带定位单元、无线通讯单元以及数据存储单元连接;
所述运动机构具体包括轮子以及依靠轮子支撑的底盘,通过驱动机构的驱动,实现机器人的前进、后退以及转向;
所述驱动机构接收主控单元发出的指令,用于驱动运动机构做出动作;
所述设备搭载平台固定在运动机构的底盘上,包含上、下两层,每一层均被划分为9块区域,每层的9块区域大小可根据所搭载仪器设备尺寸进行调整确定,用于搭载各种仪器设备;设备搭载平台上层9块区域按左前、正前、右前、左侧、中间、右侧、左后、正后、右后的位置顺序分别编号:U1、U2、U3、U4、U5、U6、U7、U8、U9;设备搭载平台下层的9块区域按左前、正前、右前、左侧、中间、右侧、左后、正后、右后的位置顺序分别编号:D1、D2、D3、D4、D5、D6、D7、D8、D9;
所述激光测距单元用于实时探测机器人自身与障碍物以及墙壁之间的距离,并且将探测到的信息实时传输到主控单元;
所述辐射剂量探测单元用于探测待搜寻区域内的辐射剂量率以及辐射剂量分布情况;
所述摄像单元用于实时记录搜寻过程中的图像信息;
所述超宽带定位单元用于确定机器人在室内的位置,将位置坐标信息存储到数据存储单元,并通过无线通讯单元将位置坐标信息传输到技术人员终端设备;
所述电源安装在设备搭载平台的D1号位置,用于为机器人身上各种装置提供所需的电能;
所述主控单元用于控制机器人的各种行为;
所述无线通讯单元用于将机器人搜寻过程采集到的距离信息、辐射剂量强度信息、图像信息、位置坐标信息实时传输到技术人员的终端设备上;
所述数据存储单元用于存储机器人在搜寻过程中采集到的各种信息;
其特征在于,所述面向室内的失控放射源自主搜寻机器人的搜寻方法包括如下步骤:
S1.参数初始化,初始化的参数具体包括:设定辐射剂量率第一阈值a1、辐射剂量率第二阈值a2、离墙最近距离m1、离墙最远距离m2、转向及避障距离m3、间隔时间t1、第一局部搜索半径m4、机器人步长x1、第一局部路径搜索递增半径b以及重复次数n;
S2.进行采用沿墙走算法的全局路径搜索,包括以下步骤:
S2.1,设定循环次数k=0;
S2.2,进行采用沿墙走算法的全局路径搜索;在搜索过程中,所述辐射剂量探测单元的辐射剂量探测装置将探测到的辐射剂量数据实时传输到主控单元,主控单元实时判断辐射剂量探测单元上方的辐射剂量探测装置探测到的辐射剂量率是否大于第一阈值a1,若是,进入步骤S3,若否,判断辐射剂量探测单元侧方的辐射剂量探测装置探测到的辐射剂量率是否大于第一阈值a1,若是,进入步骤S4,若否,继续进行全局路径搜索;
S3.第一局部路径搜索模式;
S4.第二局部路径搜索模式;
S5.确定目标物,返回中断点,并结束局部路径搜索;
S6.判断是否继续执行全局路径搜索;
S7.完成搜索,回到起始点,结束搜寻任务;
在整个搜索过程中:所述控制部分的电源始终为各种装置提供需要的电能;所述激光测距单元实时测量距离信息并传输到主控单元,主控单元根据激光测距单元的反馈数据做出判断,控制机器人避开障碍物;所述辐射剂量探测单元实时探测9个方向上的辐射剂量率并将采集到的数据传输到主控单元以及数据记录单元;所述摄像单元实时记录搜寻过程中机器人周边环境的图像信息,并将数据保存到数据存储单元,并通过无线通讯单元将图像传输至工作人员的终端设备;所述超宽带定位单元实时确定机器人所处位置坐标信息。
2.根据权利要求1所述的一种面向室内的失控放射源自主搜寻机器人的搜寻方法,其特征在于:所述机械部分的驱动机构具体包括电动机和角度伺服电机;所述电动机安装在设备搭载平台的D5号位置,分别与电源运动机构的轮子以及主控单元连接,用于控制机器人前进、后退以及控制机器人的直线运动速度;所述角度伺服电机安装在设备搭载平台的D3号位置,分别与电动机、电源以及主控单元连接,用于控制机器人的转向动作。
3.根据权利要求1所述的一种面向室内的失控放射源自主搜寻机器人的搜寻方法,其特征在于:所述探测部分的激光测距单元具体包括第一测距单元、第二测距单元和第三测距单元;所述第一测距单元安装在设备搭载平台的D2号位置,分别与电源、主控单元、无线通讯单元以及数据存储单元连接,用于测量前方障碍物的形体特征以及障碍物与机器人之间的距离,并将探测到的数据实时传输到主控单元;所述第二测距单元和第三测距单元分别安装在设备搭载平台的D4及D6号位置,第二测距单元和第三测距单元均分别与电源、主控单元、无线通讯单元以及数据存储单元连接,用于探测机器人与墙壁之间的距离,并将探测到的信息实时传输到主控单元;
所述探测部分的辐射剂量探测单元安装在设备搭载平台的U5号位置,安装方式为:直棱柱轴线垂直于地面,两个底面中无探针一侧靠近地面;辐射剂量探测单元具体包括辐射屏蔽体和辐射剂量探测装置,辐射屏蔽体构成辐射剂量探测单元的外部,是一个底面为正八边形、上底面以及8个侧面各开有一个圆形小孔的、内部掏空的直棱柱;辐射剂量探测装置安装在辐射屏蔽体的内部,具体包括9个以GM管为主的相互独立的辐射剂量探测装置;所述9个以GM管为主的相互独立的辐射剂量探测装置分别安装在辐射剂量探测单元屏蔽体的上方、前方、后方、左方、右方、左前方、左后方、右前方以及右后方9个方向上,并分别与电源以及主控单元相连,侧面8个方向上的探针与机器人四个轮子底端所在平面平行,上底面的探针竖直向上,用于探测机器人搜寻区域内各个方向的辐射剂量率,并将探测到的辐射剂量率实时传输的主控单元;所述GM管的探针通过小孔探测该方向上的剂量率;
所述探测部分的摄像单元安装在设备搭载平台的U2号位置,分别与电源、无线通讯单元、数据存储单元连接,用于采集搜寻过程的图像,并通过无线通讯单元将图像信息传输到技术人员的终端设备上,并将图像信息存储到数据存储单元中;
所述探测部分的超宽带定位单元具体包括定位标签、定位基站以及定位解算引擎;所述定位标签安装在设备搭载平台的U1号位置,分别与电源、主控单元、无线通讯单元以及数据存储单元连接,用于发射超短时脉冲信号以及接收定位基站发送回来的定位数据;所述定位基站同时具有有线以太网和WiFi两种回传信道,根据实际情况布置到室内,用于接收定位标签发送的超短时脉冲信号,并通过信号传输设备将脉冲信号传输到定位解算引擎;所述定位解算引擎为技术人员终端设备上的定位软件,用于解算定位基站传回的信号,实时确定机器人所处位置。
4.根据权利要求1所述的一种面向室内的失控放射源自主搜寻机器人的搜寻方法,其特征在于:所述控制部分的主控单元安装在设备搭载平台的D7号位置,具体包括处理器和中断控制器;所述处理器分别与电动机、角度伺服电机、电源、无线通讯单元、数据存储单元、激光测距单元、辐射剂量探测单元、摄像单元、定位标签、定位解算引擎连接,用于处理各种装置反馈的信息,并向各种装置发送指令;所述中断控制器内置于处理器中,分别与电动机、角度伺服电机、电源连接,用于中断全局路径搜索并执行局部路径搜索,当完成局部路径搜索后,控制机器人返回中断点,继续执行全局路径规划搜索。
5.根据权利要求1所述的一种面向室内的失控放射源自主搜寻机器人的搜寻方法,其特征在于:步骤S3中,具体步骤如下:
S3.1,主控单元令k=k+1,并控制机器人暂停运动;
S3.2,经过时间t1后,主控单元控制机器人沿着以中断点为圆心、m4为半径的圆绕行;在机器人沿着以中断点为圆心、m4为半径的圆绕行的过程中,所述辐射剂量探测单元上方的辐射剂量探测装置将探测到的辐射剂量率传输到主控单元;
S3.3,主控单元将步骤S3.2返回的辐射剂量数据与第二阈值a2比较,若探测到的辐射剂量率大于第二阈值a2,则进入步骤S5;否则进入步骤S3.4;
S3.4, 主控单元令m4=m4+b;
S3.5,判断循环次数k是否等于n,若是,则返回步骤S2.2;若否,返回步骤S3.1。
6.根据权利要求5所述的一种面向室内的失控放射源自主搜寻机器人的搜寻方法,其特征在于:步骤S4中,具体步骤如下:
S4.1,主控单元令k=k+1,主控单元控制机器人暂停运动,并对8组数据按大小排序;
S4.2,经过时间t1后,主控单元控制机器人沿辐射剂量率最大的方向前进一个步长x1的距离;
S4.3,判断辐射剂量率最大值是否大于第二阈值a2,若是,则进入步骤S5;否则进入步骤S4.4;
S4.4,判断循环次数k是否等于n,若是,则认为判断失误,返回步骤S2.2;若否,返回步骤S4.1。
7.根据权利要求6所述的一种面向室内的失控放射源自主搜寻机器人的搜寻方法,其特征在于:步骤S5中,具体步骤如下:
S5.1,认为机器人找到目标物;
S5.2,主控单元控制机器人暂停运动;
S5.3,主控单元通过数据处理的方式对机器人当前位置坐标进行特殊标记,并将机器人当前位置坐标设定为报警点,并将报警点记录在数据存储单元中,并通过无线通讯单元将报警点坐标传输到技术人员终端设备;
S5.4,完成放射源位置标记任务,主控单元控制机器人原路返回中断点
步骤S6中,具体步骤如下:主控单元通过超宽带定位单元探测到的定位信息判断机器人是否回到起始点,若是,则进入步骤S7;否则返回步骤S2.2。
CN201911331145.9A 2019-12-20 2019-12-20 一种面向室内的失控放射源自主搜寻机器人及其搜寻方法 Active CN111026163B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911331145.9A CN111026163B (zh) 2019-12-20 2019-12-20 一种面向室内的失控放射源自主搜寻机器人及其搜寻方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911331145.9A CN111026163B (zh) 2019-12-20 2019-12-20 一种面向室内的失控放射源自主搜寻机器人及其搜寻方法

Publications (2)

Publication Number Publication Date
CN111026163A CN111026163A (zh) 2020-04-17
CN111026163B true CN111026163B (zh) 2021-10-26

Family

ID=70211350

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911331145.9A Active CN111026163B (zh) 2019-12-20 2019-12-20 一种面向室内的失控放射源自主搜寻机器人及其搜寻方法

Country Status (1)

Country Link
CN (1) CN111026163B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114063135A (zh) * 2021-11-18 2022-02-18 中国核动力研究设计院 一种核活动相关区域内的辐射调查装置及调查方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104460671A (zh) * 2014-11-12 2015-03-25 西南科技大学 三维空间中的放射源交叉定位方法及系统
CN110297503A (zh) * 2019-07-08 2019-10-01 中国电子科技集团公司第二十九研究所 一种多无人系统协同搜索危险源的方法

Family Cites Families (30)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102007023157A1 (de) * 2007-05-16 2008-11-20 Robert Bosch Gmbh Roboter-Fahrzeug mit Antriebsmitteln sowie Verfahren zum Ansteuern von Antriebsmitteln
CN201233443Y (zh) * 2008-07-14 2009-05-06 成都理工大学 一种环境辐射剂量移动测量机器人
GB0909148D0 (en) * 2009-05-28 2009-07-01 F Robotics Acquisitions Ltd Localisation system
CN107149689A (zh) * 2009-11-10 2017-09-12 免疫之光有限责任公司 对可辐射固化介质进行固化的系统和产生光的方法
DE102012217038A1 (de) * 2012-09-21 2014-03-27 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zur Flugroutenberechnung unter Berücksichtigung Strahlendosis-relevanter Ereignisse
CN103226983B (zh) * 2013-04-25 2016-01-13 华北电力大学 一种基于网状拓扑结构的辐射场三维监测系统及探测方法
CN203414598U (zh) * 2013-08-28 2014-01-29 核工业二九〇研究所 一种可遥控陆上行走的χ-γ剂量率测量仪
EP3045936A1 (en) * 2015-01-13 2016-07-20 XenomatiX BVBA Surround sensing system with telecentric optics
CN105425794A (zh) * 2015-11-25 2016-03-23 哈尔滨工业大学 一种移动机器人寻找放射源轨迹的方法
US10444758B2 (en) * 2015-12-01 2019-10-15 Ricoh Company, Ltd. Autonomous traveling device
KR20170124216A (ko) * 2016-05-02 2017-11-10 삼성전자주식회사 청소로봇 및 그 제어 방법
CN106125119A (zh) * 2016-06-13 2016-11-16 成都新核泰科科技有限公司 放射源应急探测机器人探测系统
CN105841750A (zh) * 2016-06-13 2016-08-10 成都新核泰科科技有限公司 放射源应急探测机器人
CN205749918U (zh) * 2016-06-27 2016-11-30 昆山市中医医院 一种核与辐射环境场所剂量检测机器人
CN106324651B (zh) * 2016-08-10 2019-02-01 中国船舶重工集团公司第七一九研究所 一种放射源智能搜寻器及其工作方法
CN106730841B (zh) * 2017-01-17 2020-10-27 网易(杭州)网络有限公司 一种寻路方法和装置
CN106671086B (zh) * 2017-01-24 2018-01-02 中国人民解放军火箭军工程大学 一种履带式辐射监测机器人及其使用方法
CN107132846B (zh) * 2017-06-21 2020-06-05 南华大学 陌生室内场景下的γ辐射探测方法
CN107328419A (zh) * 2017-06-21 2017-11-07 上海斐讯数据通信技术有限公司 一种清扫机器人的清扫路径的规划方法及清扫机器人
US10382145B2 (en) * 2017-07-13 2019-08-13 Benjamin J. Egg System and method for improving wireless data links
CN206905811U (zh) * 2017-07-18 2018-01-19 北京高能新技术有限公司 核辐射环境巡检系统
WO2019040997A1 (en) * 2017-09-04 2019-03-07 Commonwealth Scientific And Industrial Research Organisation METHOD AND SYSTEM FOR USE IN REALIZING LOCATION
CN107643536A (zh) * 2017-09-13 2018-01-30 华南理工大学 一种辐射场可视化系统及其方法
CN108279702A (zh) * 2018-01-12 2018-07-13 华南理工大学 一种用于核电站安全壳内环境监测的无人机及其控制方法
CN108196555B (zh) * 2018-03-09 2019-11-05 珠海市一微半导体有限公司 自主移动机器人沿边行走的控制方法
US10627826B2 (en) * 2018-03-27 2020-04-21 Toyota Motor Engineering & Manufacturing North America, Inc. Systems and methods for pairing a power base of a modular wheelchair system with a guide robot
CN208358860U (zh) * 2018-06-15 2019-01-11 厦门机灵宝宝教育科技有限公司 机器人的障碍探测装置及机器人
CN208255420U (zh) * 2018-06-15 2018-12-18 厦门机灵宝宝教育科技有限公司 机器人的障碍探测及防跌装置和机器人
CN109764905A (zh) * 2018-12-06 2019-05-17 华南理工大学 一种用于核辐射环境的无人机与机器人监测系统
CN109633729B (zh) * 2018-12-29 2022-09-20 哈尔滨工业大学 一种移动机器人核环境下的放射源定位及强度估计方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104460671A (zh) * 2014-11-12 2015-03-25 西南科技大学 三维空间中的放射源交叉定位方法及系统
CN110297503A (zh) * 2019-07-08 2019-10-01 中国电子科技集团公司第二十九研究所 一种多无人系统协同搜索危险源的方法

Also Published As

Publication number Publication date
CN111026163A (zh) 2020-04-17

Similar Documents

Publication Publication Date Title
CN107966150B (zh) 基于路口点和路段的变电站作业机器人路径规划及导航定位方法
CN105607635B (zh) 自动导引车全景光学视觉导航控制系统及全向自动导引车
CN111522339A (zh) 畜禽舍巡检机器人自动路径规划与定位方法及装置
WO2017041730A1 (zh) 一种移动机器人避障导航的方法和系统
CN112518739B (zh) 履带式底盘机器人侦察智能化自主导航方法
CN105425809B (zh) 一种无人机避障方法及系统
CN107168337A (zh) 一种基于视觉识别的移动机器人路径规划与调度方法
CN109407675A (zh) 机器人回座的避障方法和芯片以及自主移动机器人
JP2006285547A (ja) 移動ロボット及び移動ロボットによる監視システム
CN106774295B (zh) 一种分布式引导机器人自主充电系统
CN102379277A (zh) 智能驱鸟机器人
CN214846390U (zh) 基于自动导引小车的动态环境避障系统
CN103586870B (zh) 蒸汽发生器爬壁机器人
CN103487812A (zh) 一种温室自主移动车辆的超声波导航装置及方法
CN214520204U (zh) 一种基于深度相机和激光雷达的港区智能巡检机器人
CN114448114A (zh) 基于移动机器人的智能无线供电系统
CN113190020A (zh) 一种移动机器人队列系统及路径规划、跟随方法
CN109291063A (zh) 一种电力作业现场安全监督机器人
CN111026163B (zh) 一种面向室内的失控放射源自主搜寻机器人及其搜寻方法
CN107943026B (zh) Mecanum轮巡视机器人及其巡视方法
CN211786766U (zh) 一种基于激光雷达的畜禽舍巡检机器人行走控制装置
CN108152829B (zh) 一种加装直线导轨的二维激光雷达建图装置及其建图方法
CN116494237A (zh) 一种未知环境放射源自主搜索方法、装置及系统
EP4293459A1 (en) Intelligent mowing system and intelligent mowing device
CN118151643A (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