基于声源定位、ins的爬壁机器人导航定位系统及方法

文档序号:9248095阅读:728来源:国知局
基于声源定位、ins的爬壁机器人导航定位系统及方法
【技术领域】
[0001]本发明涉及定位导航与控制技术专利应用技术领域,尤其涉及一种基于声源定位、INS的爬壁机器人导航定位系统及方法。
【背景技术】
[0002]机器人是当代自动化技术和人工智能技术发展的典型体现,也代表着制造技术发展的新水平。机器人尤其是极限爬壁工作机器人的广泛应用,极大地提高了生产力。要提高爬壁机器人作业的智能化水平,必须完善机器人的导航系统,而定位定向是导航的关键冋题。
[0003]国内大部分爬壁机器人的定位和位姿信息仅采用简单的姿态传感器和航位推算法粗略表示,无法满足机器人在壁面精确作业的任务需要。特别是应用于飞机表面蒙皮损伤检测的爬壁机器人的定位控制。因此,需要通过改善机器人精确定位定向的导航系统来提高机器人的本体智能。
[0004]惯性导航(i ner t i a I nav i gat i on ),是依据牛顿惯性原理,利用惯性元件(加速度计)来测量运载体本身的加速的,经过积分和运算得到速度和位置,从而达到对运载体导航定位的目的。组成惯性导航系统(INS,Inertial Navigat1n System)的设备工作时不依赖外界信息,也不向外界辐射能量,不易受到干扰,是一种自助式定位系统。但惯性导航即使导航状态的初始化估计精度很高,当由包含漂移或偏差误差和噪声的惯性测量数据,积分求解导航状态时,仍会有误差积累。
[0005]声源定位是指由若干声源接收装置按一定的方式布置在空间的不同位置组成阵列,对采集的声音信号进行分析和处理在空间定出一个或多个声源坐标,得到声源的位置。但受仪器采样速度、波速测量误差、定位区域局部结构的影响,要通过声源定位系统实现机器人精确的定位,还需要依靠辅助装置在必要时进行定位辅助。
[0006]从上述的分析,声源定位系统、INS (Inertial Navigat1n System)在特殊工作环境下单独应用具有较大的局限性,通过对上述不同感知系统信息的融合处理可以解决两者对应的缺陷,无疑可以提高系统导航精度和可靠性。

【发明内容】

[0007]本发明所要解决的技术问题是针对【背景技术】中所涉及到的缺陷,提供一种基于声源定位、INS的爬壁机器人导航定位系统及方法,利用声源定位子系统对机器人携带的高低音频声源信号进行定位定向,以辅助INS组合定位。该方法可以整合多个子导航信息,克服了声源定位系统易受采样频率的影响计INS的导航定位误差随时间延续不断增大的缺陷。
[0008]本发明为解决上述技术问题采用以下技术方案:
基于声源定位、INS的爬壁机器人导航定位系统,包括INS、INS处理单元、低音频发声装置、高音频发声装置、麦克风声源接收阵列、信号调理模块和中央处理模块;
所述INS通过INS处理单元相连和中央处理模块相连,所述麦克风声源接收阵列通过信号调理模块和中央处理模块相连;
所述INS用于测量爬壁机器人的惯性数据并输出给INS处理单元;
所述INS处理单元用于根据接收到的惯性数据计算得到爬壁机器人的位置数据、速度数据和姿态数据;
所述低音频发声装置、高音频发声装置对称安装在爬壁机器人的两侧,分别用于发出低音和高音;
所述麦克风声源接收阵列的连线中心为机器人重心,用于接收所述低音频发声装置、高音频发声装置的声源模拟信号,并将其输出给所述信号调理模块;
所述信号调理模块用于对接收到的声源模拟信号进行放大和偏置,并将其传递给所述中央处理模块;
所述中央处理模块包含数据采集卡和卡尔曼滤波模块;
所述数据采集卡用于将经过放大和偏置后的声源模拟信号转化为声源数字信号,并将其传递给所述卡尔曼滤波模块;
所述卡尔曼滤波模块用于根据接收到的声源数字信号对机器人的位置数据、速度数据、姿态数据进行校正,获得爬壁机器人的定位导航信息。
[0009]作为本发明基于声源定位、INS的爬壁机器人导航定位系统进一步的优化方案,所述麦克风声源接收阵列采用四元十字阵列。
[0010]作为本发明基于声源定位、INS的爬壁机器人导航定位系统进一步的优化方案,所述INS包括三轴正交安装的陀螺仪和三轴正交安装的加速度计,所述陀螺仪用于提供三轴角速度测量值,所述加速度计用于提供三轴加速度测量值。
[0011]作为本发明基于声源定位、INS的爬壁机器人导航定位系统进一步的优化方案,所述陀螺仪采用光钎陀螺仪。
[0012]作为本发明基于声源定位、INS的爬壁机器人导航定位系统进一步的优化方案,所述加速度计采用娃微加速度计。
[0013]基于声源定位、INS的爬壁机器人导航定位方法,包含以下步骤:
步骤1),利用INS获取爬壁机器人的惯性数据;
步骤2),根据爬壁机器人的惯性数据进行导航积分计算,获得爬壁机器人的INS位置数据、INS速度数据和INS姿态数据;
步骤3),在爬壁机器人两侧分别设置高音频发声装置和低音频发声装置,并控制其以IHZ地频率播放高低频率声音;
步骤4),采用麦克风四元阵列收集四组高低频率声音信号;
步骤5),对四组高低频率声音信号进行放大和偏置后,将其分离为四组高频率声音信号和四组低频率声音信号;
步骤6),根据四组高频率声音信号和四元阵列模型下的几何定位公式,计算出高音频发声装置的位置信息;
步骤7),根据四组低频率声音信号和四元阵列模型下的几何定位公式,计算出低音频发声装置的位置信息;
步骤8),根据高音频发声装置和低音频发声装置的位置信息计算出爬壁机器人的声源定位位置数据和声源定位姿态数据; 步骤9),对爬壁机器人的INS位置数据、声源定位位置数据进行滤波融合计算,获得爬壁机器人的最终位置数据;
步骤10),对爬壁机器人的INS姿态数据、声源定位姿态数据进行滤波融合计算,获得爬壁机器人的最终姿态数据;
步骤11),将爬壁机器人的最终位置数据、INS速度数据和最终姿态数据作为其导航定位信息输出。
[0014]本发明采用以上技术方案与现有技术相比,具有以下技术效果:
1.通过利用卡尔曼滤波对INS导航及声音定位信息进行融合,有效的提高了爬壁机器人组合导航定位的精度;
2.通过利用声源定位子系统对爬壁机器人携带的不同频率的声源进行定位。由于爬壁机器人工作区域环境模型已知,因此可以通过分析计算不同声源的坐标得到爬壁机器人相对壁面的俯仰角、方位角信息。
【附图说明】
[0015]图1是本发明一种组合定位系统组成框图;
图2是本发明组合导航定位系统信息融合算法框图。
【具体实施方式】
[0016]下面结合附图对本发明的技术方案做进一步的详细说明:
如图1所示,本发明公开了一种基于声源定位、INS的爬壁机器人导航定位系统,包括INS、INS处理单元、低音频发声装置、高音频发声装置、麦克风声源接收阵列、信号调理模块和中央处理模块;
所述INS通过INS处理单元相连和中央处理模块相连,所述麦克风声源接收阵列通过信号调理模块和中央处理模块相连;
所述INS用于测量爬壁机器人的惯性数据并输出给INS处理单元;
所述INS处理单元用于根据接收到的惯性数据计算得到爬壁机器人的位置数据、速度数据和姿态数据;
所述低音频发声装置、高音频发声装置对称安装在爬壁机器人的两侧,分别用于发出低音和高音;
所述麦克风声源接收阵列的连线中心为机器人重心,用于接收所述低
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1