煤矿探测机器人姿态控制与局部路径规划分析-attitude control and local path planning analysis of coal mine detection robot.docx

论文题目：煤矿探测机器人姿态控制与局部路径规划研究 专 业：安全技术及工程 博 士 生：李晓鹏 (签名) 指导教师：马宏伟 (签名) 摘 要 救援机器人已经成为灾难救援的重要设备，但大多数救援机器人仍依赖操作人员遥 控。本课题研究团队提出了由运载机器人和探测机器人构建的煤矿救援机器人系统，旨 在实现救援机器人系统的自主导航与智能控制。本文针对煤矿探测机器人在煤矿井下事 故现场未知环境中的姿态控制与局部路径规划进行了深入研究。 首先分析了事故后的煤矿井下环境，结合煤矿探测机器人任务需求，提出了煤矿探 测机器人三层分布式模块化控制结构。导航控制体系的核心决策规划系统采用分布式递 阶结构，各个功能分布式模块按照机器人的行为决策过程递阶分布，各模块间按照反应 式的行为准则相互协调配合，完成探测机器人的决策与控制过程。该系统具有较好的自 主性、实时性与开放性，能够满足机器人在复杂环境下自主控制的需求。 提出将煤矿探测机器人的并联肢体履带式运动机构通过运动学等效变形，消除非完 整约束条件，进而分析等效并联机器人位姿运动学的方法。采用这种方法将探测机器人 运动机构等效成 4—PPSR 并联机器人，并利用旋量理论对等效并联机器人动平台的姿 态进行运动学建模。分析了在运动学模型基础上的机器人静态稳定性，得出了基于几何 分析的投影稳定锥静态稳定性判定原理；通过对倾覆过程的重力势能变化分析，得到了 机器人动态稳定性和运行速度关系，对这两种稳定性的分析为煤矿探测机器人运行姿态 稳定性控制提供了重要依据。针对煤矿探测机器人的驱动行为、姿态控制行为、越障行 为和路径规划行为等四种基本行为的协调问题，提出了基于专家逻辑系统的反应式煤矿 探测机器人行为协调器。分析了煤矿探测机器人在井下行驶时针对不同路面环境的驱 动、姿态控制及越障的行为模式，重点对运行过程中的机器人姿态控制进行了研究，提 出了基于模糊控制算法的煤矿探测机器人反应式姿态控制方法，并验证了该方法对复杂 地面环境有良好的适应性。 针对未知环境中煤矿探测机器人局部路径规划问题，提出了方向寻优人工势场滚动 窗口局部路径规划算法。这种方法摒弃了传统人工势场法将全局环境仅归结为单一势场 力的处理思想，针对煤矿探测机器人对障碍物检测的特点，提出在机器人全部可行驶方 向中搜索合力最大的最优行驶方向的改进人工势场方法，并结合滚动窗口思想，提出了 机器人反应式路径规划算法。针对反应式路径规划方法存在的规划陷阱问题，提出了煤 矿探测机器人的慎思式局部路径规划算法。慎思规划过程需要对机器人游历场景建立局 部环境地图，为此本文提出了探测机器人游历场景栅格拓扑地图的建立方法，并利用提 出的主动生长元栅格拓扑地图 Voronoi 图分析算法对该地图进行可行路径分析，可生成 Voronoi 节点和边构成的无碰路径网络，利用 Floyd 最短路搜索方法找到逃逸目标节点和 全局目标节点之间的最短路径。融合两种路径规划算法，提出了煤矿探测机器人的反应 ——慎思式的混合局部路径规划算法。实验表明该算法不仅有效解决机器人路径规划过 程中的规划陷阱问题，而且对煤矿井下未知复杂环境具有良好的适应性。 以课题组研发的煤矿探测机器人本体和控制系统为平台，以本文提出的姿态控制算 法和局部路径规划算法为基础，借助于 VC++，开发了机器人软件系统，分别在实验室 和模拟实验巷道进行了行驶实验，结果证明本文提出的煤矿探测机器人路径规划算法和 开发的控制系统能够保证机器人在未知环境中进行环境理解和路径规划，并在非结构化 路面条件下保持良好的行驶姿态。 关 键 词：煤矿探测机器人；控制系统；姿态控制；局部路径规划 研究类型：基础研究 Subject ：Study on Posture Control and Local Path Planning for Coal Mine Detection Robot Specialty ：Safety Techniques and Engineering Name ：Xiaopeng Li （Signature） Instructor：Hongwei Ma （Signature） ABSTRACT Rescue robot has become an important mean in the process of disaster succoring, but most rescue robots still rely on remote operation for motion control. Our research team of Xian University of Science Technology proposed that the coal mine rescue robot