CN202216696U - 基于信息融合的煤矿救灾机器人导航装置 - Google Patents
基于信息融合的煤矿救灾机器人导航装置 Download PDFInfo
- Publication number
- CN202216696U CN202216696U CN201120237354XU CN201120237354U CN202216696U CN 202216696 U CN202216696 U CN 202216696U CN 201120237354X U CN201120237354X U CN 201120237354XU CN 201120237354 U CN201120237354 U CN 201120237354U CN 202216696 U CN202216696 U CN 202216696U
- Authority
- CN
- China
- Prior art keywords
- information
- module
- robot
- navigation
- identifying information
- 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.)
- Expired - Fee Related
Links
- 239000003245 coal Substances 0.000 title claims abstract description 29
- 230000010354 integration Effects 0.000 title abstract description 4
- 238000013439 planning Methods 0.000 claims abstract description 19
- 230000004438 eyesight Effects 0.000 claims description 29
- 230000004927 fusion Effects 0.000 claims description 24
- 238000012545 processing Methods 0.000 claims description 16
- 230000004888 barrier function Effects 0.000 claims description 14
- 239000013307 optical fiber Substances 0.000 claims description 8
- 238000004387 environmental modeling Methods 0.000 claims description 5
- 238000002156 mixing Methods 0.000 claims description 5
- 230000010365 information processing Effects 0.000 abstract description 4
- 238000013528 artificial neural network Methods 0.000 description 29
- 238000000034 method Methods 0.000 description 24
- 238000002604 ultrasonography Methods 0.000 description 12
- 239000011159 matrix material Substances 0.000 description 9
- 239000013598 vector Substances 0.000 description 9
- 230000008901 benefit Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 238000013461 design Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000007613 environmental effect Effects 0.000 description 4
- 238000004519 manufacturing process Methods 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 238000004880 explosion Methods 0.000 description 3
- 230000033001 locomotion Effects 0.000 description 3
- 210000002569 neuron Anatomy 0.000 description 3
- 238000012549 training Methods 0.000 description 3
- 230000004304 visual acuity Effects 0.000 description 3
- 238000009825 accumulation Methods 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 230000001186 cumulative effect Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 239000000203 mixture Substances 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 101000802640 Homo sapiens Lactosylceramide 4-alpha-galactosyltransferase Proteins 0.000 description 1
- 102100035838 Lactosylceramide 4-alpha-galactosyltransferase Human genes 0.000 description 1
- 239000003570 air Substances 0.000 description 1
- 238000005267 amalgamation Methods 0.000 description 1
- 239000012080 ambient air Substances 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 235000019606 astringent taste Nutrition 0.000 description 1
- 238000005422 blasting Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000002817 coal dust Substances 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 239000003302 ferromagnetic material Substances 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000001535 kindling effect Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 230000005291 magnetic effect Effects 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000001537 neural effect Effects 0.000 description 1
- 230000009022 nonlinear effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000007500 overflow downdraw method Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本实用新型公开了一种基于信息融合的煤矿救灾机器人导航装置,煤矿井下的障碍物识别信息6、路标识别信息7、景物识别信息8、机器人的位置速度信息9和机器人的姿态信息10由信息采集模块进行信息采集,采集的信息传送到信息处理模块,其中,障碍物识别信息6、路标识别信息7、机器人的位置速度信息9经过信息处理模块中的融合模块11、定位模块12的处理,与机器人的姿态信息10实现局部路径规划13,景物识别信息8经过信息处理模块中的环境建模模块14的处理实现全局路径规划15,局部路径规划信息13和全局路径规划信息15通过控制机器人控制模块16,从而实现控制机器人进行自主导航。
Description
技术领域
本实用新型涉及一种机器人导航装置,具体是应用于煤矿救灾机器人的,采用多传感器信息融合技术的导航装置。
背景技术
我国是煤炭生产和消费大国,在我国能源工业中,煤炭在我国一次能源生产和消费结构中占70%左右。据全国能源工作会议预测,到“十二五”末,我国煤炭消费总量将超过40亿吨,其中国内产量将超过38亿吨,我国煤炭产量将占全球总产量的50%。煤炭产量的不断加大,加上煤矿自然条件差,技术相对落后和管理欠缺等方面的原因,造成矿井灾害事故频发,人员伤亡惨重。煤矿瓦斯、煤尘等***事故发生后,如果存在着火点,极易发生二次***等事故,抢险人员很难在第一时间进入灾区,延误了救援工作的开展。如果由煤矿救灾机器人先行进入井下,探测事故破坏和环境情况,将瓦斯浓度、有害气体含量、被困或者遇难人员的情况、现场坍塌情况等信息反馈到控制中心,这样可以提高应急抢险能力,并对井上决策提供建议。
目前,常用的导航方式有GPS、同时定位与地图构建(simultaneous localization and mapping,SLAM)、路标导航、惯性导航、罗盘导航、红外线导航、超声波导航、视觉导航等。
(1)GPS导航:GPS导航是适用于室外机器人的一种全局导航***,由于煤矿救灾机器人多工作在井下环境中,煤矿井下救灾机器人无法采用GPS进行导航。
(2)同时定位与地图构建:是在未知环境中依靠传感器所获取的信息进行环境建模,利用所创建的环境地图估计位姿,但是这种方法在如何控制机器人的运动问题还没有得到很好的解决。
(3)路标导航:利用预先设置的路标进行导航,由于煤矿井下一旦发生爆 炸事故后,预先设置的路标极可能受到破坏,该方法在煤矿井下使用受到限制。
(4)惯性导航:是一种不依赖于任何外界环境进行的自主式导航,通过累积获得位置信息的,因此存在累积误差。
(5)罗盘导航:利用磁罗盘能够测量移动机器人的绝对方向,但在移动机器人靠近铁磁物质时误差较大,同时还存在测量精度和响应速度低的问题。
(6)红外线导航、超声波导航:都是利用发射脉冲进行导航的,由于煤层对脉冲的吸收比较大,发射信号的传输损耗大,发射功率易受到影响。
(7)视觉导航:具有获取信息完整,探测范围宽等优点,在机器人导航中占有重要地位,缺点是由于视觉图像处理时间长,实时性较差。
在煤矿井下,由于巷道环境复杂,单一传感器采集到的导航信号具有局部性和片面性,难以保证信息的准确性和可靠性,导致机器人无法对环境信息做出准确的判断,而采用多传感器信息融合的导航技术可以同时提供煤矿井下受灾环境特征的冗余信息、互补信息,多种信息可快速分析当前场景,从而保证救灾机器人准确、快速地完成导航任务。为了充分利用各种传感器的信息,改善导航精度,需要采用融合算法对传感器信息进行融合处理。多传感器是信息融合的硬件基础,多传感器采集到的信息数据是融合的处理对象。常用的信息融合方法有,适用于动态环境的加权平均法、扩展卡尔曼滤波(EKF:Extended Kalman Filter)法,适用于静态环境的贝叶斯估计法、D-S论证推理法、神经网络与模糊推理法等。
中国专利申请号200910087237.7,公开日2009年11月11日,公开了一种基于视觉信息校正的室内移动机器人实时导航方法,该方法采用里程计和视觉传感器采集信息,构造卡尔曼滤波器进行数据融合,进行导航。煤矿井下灾后环境不确定性信息较多,光线昏暗,里程计和视觉传感器采集到的信息量有限,同时卡尔曼滤波器存在信息融合不匹配的问题。
中国专利申请号200810143134.3,公开日2009年1月28日,公开了一种未知环境下移动机器人多行为融合自动导航方法,该方法根据目标和移动机器人的相对位置实时获取当前的方位角,根据障碍物状况获取距离参数,利用模 糊控制器和环境辨识控制器分析数据,进行导航。该方法自适应强,导航可靠性高,由于煤矿井下的非结构化环境中,不确定性信息种类多、数据量大,模糊控制的导航装置应用在煤矿救灾机器人中,收敛性能较差。
中国矿业大学研究的CUMT-II号煤矿救灾机器人,采用双目视觉和阵列超声传感器进行路径规划,结合红外传感器对突发障碍物紧急刹车。这种导航方式的可靠性能满足煤矿井下的要求。但是,如何对多个传感器的信息的不一致性进行融合,以及减少观测误差和融合误差是煤矿救灾机器人导航装置需要解决的一个关键问题。
可见现有的导航技术在煤矿井下非结构化环境中应用还需改进,因此,研究适合煤矿井下救灾机器人的导航装置具有重要的意义。
发明内容
为了满足煤矿井下非结构化环境的需求,本实用新型提供了一种基于信息融合的煤矿救灾机器人导航装置。本实用新型与以往的导航装置相比,采用了超声波导航、视觉导航和惯性导航设计了适用于煤矿救灾机器人的多传感器融合的导航装置,提出了改进的神经网络-扩展卡尔曼滤波法(NNEKF:Neural network Extended Kalman Filter),该算法能有效地解决信息融合不匹配的问题,提高了装置的收敛性和实时性,减少了误差。
以下对本实用新型的方法加以论述。
一种基于信息融合的煤矿救灾机器人导航装置,其特征在于,煤矿井下的障碍物识别信息、路标识别信息、景物识别信息、机器人的位置速度信息和机器人的姿态信息由信息采集模块进行信息采集,采集的信息传送到信息处理模块,其中,障碍物识别信息、路标识别信息、机器人的位置速度信息经过信息处理模块中的融合模块、定位模块的处理,与机器人的姿态信息实现局部路径规划,景物识别信息经过信息处理模块中的环境建模模块的处理实现全局路径规划,局部路径规划信息和全局路径规划信息通过控制机器人控制模块,从而实现控制机器人进行自主导航。
所述的导航装置,所述信息采集模块进一步包括超声波模块、视觉模块和惯性模块。
所述的导航装置,所述超声波模块进一步包括分别安置在机器人的正前方、左前方、右前方的三对超声换能器,采集障碍物识别信息、路标识别信息。
所述的导航装置,所述视觉模块采用三目视觉传感器,采集障碍物识别信息、路标识别信息、景物识别信息。
所述的导航装置,所述惯性模块进一步包括加速度计、光纤陀螺,加速度计采集位置速度信息,光纤陀螺采集姿态信息。
所述的导航装置,超声波模块和视觉模块采集的导航信息对惯性模块采集的导航信息进行修正。
所述的导航装置,进一步包括防爆模块,防爆模块采用正压兼本质安全型的混合防爆方式。
与现有技术相比,本实用新型的优点在于:
(1)本实用新型采用了基于超声波导航、视觉导航和惯性导航的多传感器融合的煤矿救灾机器人导航装置,充分融合了超声波导航、视觉导航和惯性导航的各自优点,提高了导航装置的可靠性,增强了数据的可信度以及装置的分辨力。
(2)本实用新型采用了正压兼本质安全型的混合防爆设计,混合防爆设计的质量轻,既保证了导航装置的安全,又使机器人具有良好的运动性能。
(3)本实用新型采用了改进的NNEKF算法,提高了算法的收敛性和信息融合的匹配性,同时弥补了当数据量增大时EKF算法的实时性差的缺点。
(4)本实用新型在改进的NNEKF算法中,利用BP神经网络A进行特征层匹配融合,提高了数据融合的匹配度。
(5)本实用新型在改进的NNEKF算法中,把修正的估计误差 作为输入值,返回BP神经网络A中,进行修正,可以提高算法的收敛速度。
附图说明
图1是煤矿救灾机器人多传感器融合导航装置结构框图
图2是改进的NNEKF算法组成框图
图3是三层BP神经网络结构图
图4是改进的NNEKF算法实现框图
图5是EKF算法仿真结果图
图6是改进的NNEKF算法仿真结果图
图中,1、超声波模块;2、视觉模块;3、惯性模块;4、加速度计;5、光纤陀螺;6、障碍物识别信息;7、路标识别信息;8、景物识别信息;9、位置速度信息;10、姿态信息;11、融合;12、定位;13、局部路径规划;14、环境建模;15、全局路径规划;16、机器人控制模块;17、输入;18、BP神经网络A;19、扩展卡尔曼滤波器(EKF);20、BP神经网络B;21、输出;22、输入层;23、隐含层;24、输出层。
具体实施方式
下列实施实例将进一步说明本实用新型,实施实例不应被视为限制本实用新型的范围。下面结合附图和实施实例对本实用新型的工作方式做详细说明。
如图1所示,是煤矿救灾机器人多传感器融合导航装置结构框图。
超声波模块1是利用发射波和接收波之间的时间差进行测距。
采用三对超声换能器,分别安置在机器人的正前方、左前方、右前方。超声波导航的优点是测距方式原理简单,测距范围宽,可以从几厘米到几十米,信息处理速度快,易做到实时控制。缺点是波束较宽,其分辨力受到严重的限制,而且只能采集到距离信息,不能得到边界、形状细节等信息,同时由于发 射的冲击电流,易引起煤矿井内瓦斯二次***,因此对传感器的防爆设计要求较高。
视觉模块2采用三目视觉导航。三目视觉导航可以根据同一景物在三个CCD摄像机上的成像的视差可以计算出环境的深度,得到立体信息。在煤矿井下救灾机器人导航中,视觉传感器在煤矿井下光线暗的地方使图像的质量下降,可以采用矿灯照明等方法来弥补其不足。
惯性模块3完全依靠自身的机载设备完成自主导航,不依赖于任何外部的信息,隐蔽性好,适用于煤矿井下灾后恶劣的工作环境。惯性导航通过惯性器件测量机器人在惯性坐标系的线加速度和角加速度,将其对时间进行积分,可以在时间坐标系中得到机器人的速度、偏移角和位置信息等。由于惯性导航是通过累积获得位置和方向信息的,在工作过程中测量的精度会下降,累积误差不断增加。加速度计4和光纤陀螺5惯性器件,适用于煤矿井下作业环境。
障碍物识别信息6和路标识别信息7由超声波模块1和视觉模块2采集,景物识别信息8由视觉模块2采集,位置速度信息9由惯性模块3的加速度计4采集,姿态信息10由惯性模块3的光纤陀螺5采集。
信息处理模块把障碍物识别信息6、路标识别信息7、位置速度信息9经过融合11、定位12,和反映机器人当前状况的姿态信息10共同实现局部路径规划13,景物识别信息8经过环境建模14实现全局路径规划15。
局部路径规划13和全局路径规划15信息通过机器人控制模块16的处理,控制机器人进行自主导航。同时超声波模块1和视觉模块2采集的导航信息对惯性模块3采集的导航信息进行修正。
基于超声波导航、视觉导航和惯性导航的多传感器融合技术充分融合了超声波导航、视觉导航和惯性导航的各自优点,提高了导航装置的可靠性,增强了数据的可信度以及装置的分辨力。
煤矿救灾机器人导航装置的防爆模块设计尽量达到体积小、质量轻的特点,这样机器人才具有良好的运动性能。综合考虑以上因素,采用正压兼本质安全型防爆设计。具体实施方案如下:
(1)超声波模块1的超声波接收传感器、超声波发射传感器,视觉模块2的CCD摄像头,惯性模块3的加速度计4、光纤陀螺5,这些环境探测设备与外界环境直接接触,设计成本质安全型防爆方式。
(2)其他的电路处理模块、机器人控制模块16,布置在正压外壳内,由压缩机向正压外壳内提供保护气,保持内部气压大于外界环境气压,阻止外界环境中***性气体进入正压外壳内。
如图2所示,是改进的NNEKF算法组成框图。
结合煤矿井下非结构化环境下,不确定性信息种类多、数据量大的特点,采用反向传播网络(BP:back propagation network)与EKF法相结合的算法,并对算法进行改进,提出了改进的NNEKF算法。信息融合主要在数据层、特征层和决策层三个不同的层次上进行融合。由于数据层存在数据处理量大的缺点,不进行数据层的融合,而采用将特征层和决策层结合的融合方式。
首先利用BP神经网络在学习、分类和优化上的巨大优势,可将煤矿井下不确定环境的非线性信息,经过BP神经网络A18学习推理,进行特征层匹配融合;再利用扩展卡尔曼滤波器(EKF)19和BP神经网络A18、BP神经网络B20结合的算法进行决策层融合,得到输出结果。BP神经网络的引用,不仅可以提高算法的收敛性和信息融合的匹配性,同时弥补了当数据量增大时EKF算法的实时性差的缺点。
如图3所示,是三层BP神经网络结构图。
BP神经网络是前馈型神经网络,通过最速下降法来不断调整网络的权值,使误差平方和最小。目前,应用中最典型的是三层BP神经网络结构,包括输入层22、隐含层23、输出层24。
设装置输入向量为X=[x1,x2,…,xn]T,经过隐含层23的输出向量为T=[t1,t2,…,tm]T,装置输出向量为Y=[y1,y2,…,yl]T,期望输出为D=(d1,d2,…,dl)T,输入层22与隐含层23之间的权值矩阵为a=[a1,a2,…,am]T,隐含层23与输出层24之间的权值矩阵为b=[b1,b2,…,bl]T。
在煤矿救灾机器人的动态导航过程中,随着CCD的运动,特征点在CCD坐 标系中的运动速度表示为
其中:x′、y′、z′分别表示由超声波测得的特征点沿坐标轴X、Y、Z轴方向的线速度; θ′f、φ′f分别表示CCD绕X、Y、Z轴的角速度,由陀螺仪测出机器人的角速度 θ′、φ′经变换得到;x′f、y′f、z′f分别表示CCD沿X、Y、Z轴方向的线速度;(x,y,z)表示特征点在坐标系中的位置。
对于具有超声波导航、视觉导航和惯性导航装置的煤矿救灾机器人,定义装置状态X为16维向量,输出状态Y为导航装置的测量值构成的13维向量。
其中:x″、y″、z″分别表示特征点沿坐标轴X、Y、Z轴方向的加速度,q1、q2、q3、q4分别表示描述移动机器人方向的四元数。
BP神经网络的目的就是求误差能量的最小值,
即使(3)式的值最小。BP神经网络的学习过程包括正向传播和误差反向传播两部分。正向传播是指输入信号经输入层22、隐含层23的处理,到输出层24输出。输出信号Y与期望输出D不符的话,则转入反向传播,即输出误差信号经过隐含层23到达输入层22。反向传播可以将误差信号分配到各层的每个单元中,相当于将各层每个单元的误差信号进行修正,实质上是一个权值修正的过程,从而使误差能量E达到最小。
如图4所示,是改进的NNEKF算法实现框图。
步骤一:利用输入样本数据库训练BP神经网络A,利用学习样本的输入为预测状态与当前状态扩展卡尔曼滤波器(EKF)的增益,输出为期望数据训练BP 神经网络B;
步骤二:将导航装置采集到的原始信号作为输入信号,由BP神经网络A进行学习推理,BP神经网络A的输出信号作为扩展卡尔曼滤波器(EKF)的输入信号;
步骤三:装置的状态方程和输出方程为非线性信号,通过泰勒公式展开变换成线性信号;
输入的信号经过BP神经网络A处理后,设装置的状态方程X(k+1)和输出方程Y(k)为
其中:A为13维可微向量方程,表示装置的状态矩阵;B为13维可微向量方程,表示噪声到装置的映射矩阵;C为13维可微向量方程,表示装置输出矩阵;W和V为相对独立的、均值为零的高斯白噪声向量,分别描述装置噪声和测量噪声。
令 则
把输出方程中的C围绕预测值 进行泰勒展开,得
令 则
Y(k)=P(k)X(k)+h(k)+V(k) (8)
式(6)和式(8)构成了装置的状态方程和输出方程的线性化模型。
步骤四:经过扩展卡尔曼滤波器(EKF)的时间更新和测试更新,得到装置 的状态方程X(k+1)的线性估计
其中:K(k+1)为待定的最优增益阵。
K(k+1)=S(k+1|k)CT(k+1)[C(k+1)S(k+1|k)CT(k+1)+Rk+1]-1(R为对称的正定矩阵)
(12)
(Q为对称的非负定矩阵)
估计误差方差为
修正的估计误差
如图5、图6所示,分别是EKF算法仿真结果图、改进的NNEKF算法仿真结 果图。
以超声波导航、视觉导航和惯性导航相结合的煤矿救灾机器人导航装置为例,分别对EKF算法和改进的NNEKF算法进行对比仿真实验。在对改进的NNEKF算法仿真时,考虑到煤矿救灾机器人导航装置识别对象的类别以及计算效率和准确度,在实验中选用的BP神经网络结构采用5×8×2,即输入层5个神经元、隐含层8个神经元、输出层2个神经元。假设期望输出信号是一段长为10m的直线路径,初速度V=0.5m/s,设时间t在区间[0,19.9]上,采样频率为5HZ,样本点数N=100,即BP神经网络与EKF经过100次的迭代学习。通过仿真结果可以看出:
(1)导航传感器采集的信息经过EKF算法输出之后,输出轨迹的误差在-0.2至0.2之间,输出轨迹的收敛性较差。
(2)导航传感器采集的信息经过改进的NNEKF算法输出之后,输出轨迹的误差在-0.03至0.03之间稳定波动,可见改进的NNEKF算法比EKF算法导航精度要高,收敛性较好;经BP神经网络A进行特征层匹配融合后,提高了数据信息的匹配度;同时前5个节点的误差比较大,因为BP神经网络有个学习训练的过程,在t=0.2s×5=1s后,算法就处于稳定状态,可见改进的NNEKF算法的收敛速度很快,1s之后,输出信号就能够跟踪上目标,实时性较好。
(3)在煤矿井下实际应用中,应该结合巷道环境的具体情况,对速度进行设定,一般取0.1m/s至0.6m/s之间。速度过快会也会增加导航的误差,从而影响导航装置的准确度。
Claims (7)
1.一种基于信息融合的煤矿救灾机器人导航装置,其特征在于,煤矿井下的障碍物识别信息、路标识别信息、景物识别信息、机器人的位置速度信息和机器人的姿态信息由信息采集模块进行信息采集,采集的信息传送到信息处理模块,其中,障碍物识别信息、路标识别信息、机器人的位置速度信息经过信息处理模块中的融合模块、定位模块的处理,与机器人的姿态信息实现局部路径规划,景物识别信息经过信息处理模块中的环境建模模块的处理实现全局路径规划,局部路径规划信息和全局路径规划信息通过控制机器人控制模块,从而实现控制机器人进行自主导航。
2.根据权利要求1所述的导航装置,其特征在于,所述信息采集模块进一步包括超声波模块、视觉模块和惯性模块。
3.根据权利要求2所述的导航装置,其特征在于,所述超声波模块进一步包括分别安置在机器人的正前方、左前方、右前方的三对超声换能器,采集障碍物识别信息、路标识别信息。
4.根据权利要求2所述的导航装置,其特征在于,所述视觉模块采用三目视觉传感器,采集障碍物识别信息、路标识别信息、景物识别信息。
5.根据权利要求2所述的导航装置,其特征在于,所述惯性模块进一步包括加速度计、光纤陀螺,加速度计采集位置速度信息,光纤陀螺采集姿态信息。
6.根据权利要求2所述的导航装置,其特征在于,超声波模块和视觉模块采集的导航信息对惯性模块采集的导航信息进行修正。
7.根据权利要求1所述的导航装置,其特征在于,进一步包括防爆模块,防爆模块采用正压兼本质安全型的混合防爆方式。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201120237354XU CN202216696U (zh) | 2011-07-07 | 2011-07-07 | 基于信息融合的煤矿救灾机器人导航装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201120237354XU CN202216696U (zh) | 2011-07-07 | 2011-07-07 | 基于信息融合的煤矿救灾机器人导航装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN202216696U true CN202216696U (zh) | 2012-05-09 |
Family
ID=46015945
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201120237354XU Expired - Fee Related CN202216696U (zh) | 2011-07-07 | 2011-07-07 | 基于信息融合的煤矿救灾机器人导航装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN202216696U (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102288176A (zh) * | 2011-07-07 | 2011-12-21 | 中国矿业大学(北京) | 基于信息融合的煤矿救灾机器人导航***及方法 |
CN105259897A (zh) * | 2014-06-26 | 2016-01-20 | 联想(北京)有限公司 | 一种控制方法及电子设备 |
CN105411490A (zh) * | 2015-10-26 | 2016-03-23 | 曾彦平 | 移动机器人的实时定位方法及移动机器人 |
CN106444757A (zh) * | 2016-09-27 | 2017-02-22 | 成都普诺思博科技有限公司 | 基于直线特征地图的ekf‑slam算法 |
CN106909142A (zh) * | 2016-11-29 | 2017-06-30 | 攀枝花市九鼎智远知识产权运营有限公司 | 一种基于图像处理技术的井下无人矿车***及方法 |
CN107643088A (zh) * | 2017-08-10 | 2018-01-30 | 中国科学院深圳先进技术研究院 | 无人机导航方法、装置、无人机及存储介质 |
CN108345305A (zh) * | 2018-01-31 | 2018-07-31 | 中国矿业大学 | 无轨胶轮车智能车载***、井下车辆调度***和控制方法 |
CN110123334A (zh) * | 2019-05-15 | 2019-08-16 | 中国矿业大学(北京) | 一种煤矿井下人体姿态监测*** |
CN110610130A (zh) * | 2019-08-06 | 2019-12-24 | 国网智能科技股份有限公司 | 一种多传感器信息融合的输电线路机器人导航方法及*** |
WO2020135810A1 (zh) * | 2018-12-29 | 2020-07-02 | 华为技术有限公司 | 多传感器数据融合方法和装置 |
CN111580553A (zh) * | 2020-05-11 | 2020-08-25 | 桂林电子科技大学 | 一种无人机飞行控制器、无人机防疫监管***和方法 |
CN111854730A (zh) * | 2020-06-19 | 2020-10-30 | 中国煤炭科工集团太原研究院有限公司 | 一种无人驾驶轻型无轨胶轮客货车定位方法及*** |
-
2011
- 2011-07-07 CN CN201120237354XU patent/CN202216696U/zh not_active Expired - Fee Related
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102288176A (zh) * | 2011-07-07 | 2011-12-21 | 中国矿业大学(北京) | 基于信息融合的煤矿救灾机器人导航***及方法 |
CN105259897B (zh) * | 2014-06-26 | 2019-02-05 | 联想(北京)有限公司 | 一种控制方法及电子设备 |
CN105259897A (zh) * | 2014-06-26 | 2016-01-20 | 联想(北京)有限公司 | 一种控制方法及电子设备 |
CN105411490A (zh) * | 2015-10-26 | 2016-03-23 | 曾彦平 | 移动机器人的实时定位方法及移动机器人 |
CN105411490B (zh) * | 2015-10-26 | 2019-07-05 | 深圳市杉川机器人有限公司 | 移动机器人的实时定位方法及移动机器人 |
CN106444757A (zh) * | 2016-09-27 | 2017-02-22 | 成都普诺思博科技有限公司 | 基于直线特征地图的ekf‑slam算法 |
CN106444757B (zh) * | 2016-09-27 | 2020-06-30 | 成都普诺思博科技有限公司 | 基于直线特征地图的ekf-slam方法 |
CN106909142A (zh) * | 2016-11-29 | 2017-06-30 | 攀枝花市九鼎智远知识产权运营有限公司 | 一种基于图像处理技术的井下无人矿车***及方法 |
CN107643088A (zh) * | 2017-08-10 | 2018-01-30 | 中国科学院深圳先进技术研究院 | 无人机导航方法、装置、无人机及存储介质 |
CN108345305A (zh) * | 2018-01-31 | 2018-07-31 | 中国矿业大学 | 无轨胶轮车智能车载***、井下车辆调度***和控制方法 |
WO2020135810A1 (zh) * | 2018-12-29 | 2020-07-02 | 华为技术有限公司 | 多传感器数据融合方法和装置 |
US11353553B2 (en) | 2018-12-29 | 2022-06-07 | Huawei Technologies Co., Ltd. | Multisensor data fusion method and apparatus to obtain static and dynamic environment features |
CN110123334A (zh) * | 2019-05-15 | 2019-08-16 | 中国矿业大学(北京) | 一种煤矿井下人体姿态监测*** |
CN110610130A (zh) * | 2019-08-06 | 2019-12-24 | 国网智能科技股份有限公司 | 一种多传感器信息融合的输电线路机器人导航方法及*** |
CN111580553A (zh) * | 2020-05-11 | 2020-08-25 | 桂林电子科技大学 | 一种无人机飞行控制器、无人机防疫监管***和方法 |
CN111854730A (zh) * | 2020-06-19 | 2020-10-30 | 中国煤炭科工集团太原研究院有限公司 | 一种无人驾驶轻型无轨胶轮客货车定位方法及*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102288176B (zh) | 基于信息融合的煤矿救灾机器人导航***及方法 | |
CN202216696U (zh) | 基于信息融合的煤矿救灾机器人导航装置 | |
CN105043396B (zh) | 一种移动机器人室内自建地图的方法和*** | |
Kriegman et al. | A mobile robot: Sensing, planning and locomotion | |
CN106313086B (zh) | 一种煤矿救援机器人远程控制***和控制方法 | |
CN113189977B (zh) | 一种用于机器人的智能导航路径规划***及方法 | |
CN104236548A (zh) | 一种微型无人机室内自主导航方法 | |
CN106370189A (zh) | 一种基于多传感器融合的室内导航装置及方法 | |
CN113325837A (zh) | 一种用于多信息融合采集机器人的控制***及方法 | |
CN107966989A (zh) | 一种机器人自主导航*** | |
CN102768361A (zh) | 基于遗传粒子滤波与模糊神经网络的gps/ins组合定位方法 | |
CN112518739A (zh) | 履带式底盘机器人侦察智能化自主导航方法 | |
CN104848867A (zh) | 基于视觉筛选的无人驾驶汽车组合导航方法 | |
CN107014375B (zh) | 超低部署的室内定位***及方法 | |
CN115256414B (zh) | 矿用钻孔机器人及其与地质、巷道模型的耦合作业方法 | |
CN103400416B (zh) | 一种基于概率多层地形的城市环境机器人导航方法 | |
CN113050685B (zh) | 一种煤矿井下无人机自主巡检的方法 | |
EP3799618B1 (en) | Method of navigating a vehicle and system thereof | |
Mueller et al. | GIS-based topological robot localization through LIDAR crossroad detection | |
CN109975817A (zh) | 一种变电站巡检机器人定位导航方法及*** | |
CN106898249A (zh) | 一种针对地震灾区通信失效区域的地图构建***及其构建方法 | |
CN103309351A (zh) | 一种检修机器人避碰规划方法 | |
Zhang et al. | Unmanned aerial vehicle navigation in underground structure inspection: A review | |
CN114527763A (zh) | 基于目标检测和slam构图的智能巡检***及方法 | |
Moon et al. | A uav based 3-d positioning framework for detecting locations of buried persons in collapsed disaster area |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120509 Termination date: 20120707 |