煤矿蛇形探测机器人位姿控制方法研究

来源 :西安科技大学 | 被引量 : 6次 | 上传用户:tianyawoaiai
下载到本地 , 更方便阅读
声明 : 本文档内容版权归属内容提供方 , 如果您对本文有版权争议 , 可与客服联系进行内容授权或下架
论文部分内容阅读
当煤矿井下发生灾害后,救援机器人可以替代救援人员在第一时间进入灾区实施搜救工作,迅速探明现场环境、及时发现被困矿工,为快速救援提供科学依据。然而,灾后的煤矿井下环境异常复杂且未知,因此,要求救援机器人应具备环境识别、规划决策、运动控制等能力,以保证其在煤矿井下顺利完成救援任务。本文提出并构建煤矿蛇形测机器人系统,针对该机器人的位姿控制所涉及到的关键科学问题进行研究,包括机人器的相对定位、运动姿态的控制、自主越障的最优控制、对所处环境的有效辨识和自主避障等内容,并研制出一台用于灾后煤矿井下环境探测的蛇形机器人,旨在提高煤矿蛇形探测机器人智能控制和局部自主能力。在分析灾后井下现场环境的基础上,针对探测机器人的功能需求,设计并研制一种多关节蛇形机器人。该机器人机械本体采用正交关节连接,移动机构釆用自制叶片轮驱动。控制系统由硬件平台和软件系统组成,硬件平台为三层次分布式结构,由环境感知层、规划决策层和动作执行层构成。软件系统为功能模块化体系结构,包括环境探测系统、定位系统、姿态控制系统、越障避障模块、通讯系统和上位机系统六个功能模块。该蛇形机器人可为论文的理论及方法验证奠定基础。针对在煤矿井下封闭式复杂环境下的蛇形机器人定位问题,提出利用机器人运动轨迹曲率与航向角进行估计的方法代替传统的对巷道内复杂地面参数估计的思路,建立基于转向时蛇形探测机器人的定位模型。在此基础上,提出一种卡尔曼滤波算法和深度学习算法相结合的煤矿蛇形探测机器人航位推算的定位方法,该方法采用卡尔曼滤波算法对机器人航向角信号中的高斯白噪声进行剔除,再针对航向角信号中来自低频段的各种漂移,建立基于LSTM(LongShortTermMemory)深度祌经网络的陀螺仪输出值预测模型,对未来一段时间内陀螺仪的输出值进行预测,从而实现航位推算的相对定位。实验表明,该方法可以实现蛇形探测机器人的航位推算定位,机器人位置的最小相对误差为3,299×l0-12cm,航向角最小误差为2.173×10-5rad。针对煤矿井下不平整地面环境的机器人姿态控制问题,运用D-H(Denavit-Hartenberg)分析法对正交连接的蛇形机人进行运动学机理分析,构建两连杆三关节机构模型,可避免建立蛇形机器人运动学模型的复杂性。进而提出基于简化Serpenoid曲线的改进的运动控制函数方法,引入曲率误差,建立蛇形机器人蜿蜒、伸缩、抬头不同运动姿态的数学模型,推导不同运动姿态时蛇形机器人的偏转角、俯仰角和相对转角的控制函数,并将仿真得到最优参数运用到机器人的运动控制中,以实现适应复杂地面的蛇形机器人运动姿态的控制,为机器人实现自主越障和避障功能奠定理论基础。针对机器人在自主越障过程中对关节俯仰角如何确定的问题,提出改进的粒子群优化权系数的极限学习机(Particle Swarm Optimization Extreme Learning Machine,PSOELM)位姿控制算法,该算法推导出动态的惯性系数,利用改进粒子群算法优化极限学习机的隐层矩阵权系数,欲达到优化隐层矩阵的目的,以克服传统极限学习机由于隐层节点参数随机选择而导致网络性能达不到最优的缺点。仿真实验表明,PSOELM算法不仅延续了ELM快速学习的特点,而且在控制精度、快速寻优特性及稳定性方面比ELM更好,可以实现对机器人关节俯仰角的最优控制。针对在未知环境下机器人环境辨识建模问题,提出基于遗传算法的变结构模糊神经网络(Genetic Algorithm variable structure fuzzy neural network,GAVSFNN)多传感器数据融合算法,该算法将神经网络引入到模糊规则的推理中,建立基于概率论的改进模糊控制规则,通过改变与简化神经网络结构来调整模糊规则库,实现模糊隶属函数的自学习和模糊规则的优先提取。采用遗传算法优化变结构模糊神经网络的学习参数,以克服常规BP算法易陷入局部最优的缺点,实现参数的快速和全局寻优。实验结果表明,相比较VSFNN算法,GAVSFNN可以获得对环境模型更高的辨识精度,平均误差为2.725′10-3。在此基础上,建立基于知识库的机器人自主避障系统软模型,以产生避障行为命令对机器人的偏转角进行控制,实现自主避障功能。以研制的多关节蛇形机器人为平台,与论文提出的几种算法结合,组成煤矿蛇形探测机器人实验系统,在西安科技大学实训基地模拟煤矿巷道中进行现场实验,实验表明,本文所提出的理论和方法可为煤矿蛇形探测机器人在灾后井下非结构化复杂环境中的位姿控制提供理论支撑,也为蛇形机器人在其它灾害环境的位姿控制研究奠定基础。
其他文献
<正> 微量元素与人体健康的关系正引起人们的普遍重视。近两年来,我们对厌食症患儿头发作了多种微量元素检测,初步发现某些微量元素的含量与中医辨证分型之间存在一定关系,现
两岸开启民间交流大门30年来,对国家统一模式的探索持续深化。笔者认为,大陆对台战略的路径,也从交流开启前的"招安型统一",转向"融合型统一"。本文拟从1988年以前的对台战略
背景:儿童支气管哮喘具有病程长,易复发,治疗周期长的发病特点,严重影响患者心理和生理健康,如何减少哮喘发作频率,提高哮喘控制水平及患儿生命质量已成为目前儿童哮喘研究亟
本文试从中国经济师职业价值现状切入,希望能够探讨到使经济师职业价值回归到设立经济师制度之目标的途径。
笔痕特征用于文件检验的理论研究和实践已产生许多成果,有着广阔的应用前景和良好发展趋势。在对笔痕检验尚存在的三个问题研究的基础上,分析了签字笔笔痕特征种类,探讨了其
虽然蔡英文当局南海政策的文字表述前后存在差异,但其固守太平岛、投靠美国以及利用南海问题推行"台独"路线的核心政策始终没有变化。蔡英文当局的南海政策不仅与马英九当局
<正>英国学者古德温与惠内尔编著的《电视的真相:电视文化批评入门》,被编者自称为“第一本介绍有关电视机构、文本和观众全貌的电视入门教材”,也
<正> 一、教材中存在问题分析人教版九年级化学(2006年)第15面图1-19通过"对着干燥的玻璃片呼气",比较吸入的空气和呼出气体中所含水蒸气的多少,该"活动与探究"存在以下问题:
由尚德义作曲、宋斌作词的《七月的草原》是一首具有浓郁新疆民族风格的花腔女高音艺术歌曲,同时也是一首著名的民族声乐作品。《七月的草原》具有十分清晰的画面感,颇具诗意
本文借鉴思想史研究的"去熟悉化"一概念,指出新闻史研究中至少有以下几种相互联系的"熟悉化"策略,一为后见之明,以历史的结果来倒推历史的原因。二是系统化和逻辑化。三是以"