论文部分内容阅读
煤矿井下发生事故后,救援机器人已经成为实施灾难援救工作的主要设备之一,但多数的救援机器人仍依靠于救援人员的远程控制,其实时性和精确性与操作人员的熟练度密切相关,机器人的自主性受到很大限制。因此,本文提出并构建的煤矿蛇形搜寻机器人系统,研究蛇形搜寻机器人在煤矿井下事故现场局部未知环境中的姿态控制与路径规划,目的是实现煤矿蛇形搜寻机器人系统的自主导航与控制,对于解决煤矿搜寻机器人在井下局部未知的环境中自主运动控制问题具有重要的意义。针对本文提出并构建的蛇形搜寻机器人体系结构的设计问题,在对其功能分析的基础上对系统的整体方案进行设计,通过对比,确定机械材料的使用及处理器的类型,设计整个控制系统的硬件电路和软件程序,完成实验样机的制作。针对蛇形搜寻机器人的控制问题,以PC机作为上位机、STM32F407ZET6作为下位机的控制器,上位机主要起监控作用,通过无线通讯遥控蛇形搜寻机器人的运动方式并接收机器人采集到的各种传感信息。针对蛇形搜寻机器人的姿态控制问题,通过对其运动关节机构的运动学分析,提出将多自由度高度冗余的蛇形机器人抽象为空间连杆结构,构建了两连杆之三关节的结构模型,并在此基础上建立了正交连接的蛇形搜寻机器人的D-H坐标系。针对在煤矿井下不确定路况下的蛇形搜寻机器人的姿态控制问题,研究了机器人应对多种不同路况的运动控制函数;设计并提出了基于改进Serpenoid曲线的煤矿蛇形搜寻机器人姿态行为控制方法,使其针对不同的路况条件能作出相应的姿态运动。仿真实验表明采用该姿态控制算法后机器人的越障过程稳定性明显提高。针对煤矿井下环境的地图构建问题,结合激光雷达获取障碍信息的数据特点,提出一种基于栅格拓扑地图的局部未知障碍物几何特征地图匹配的方法(Geometric Map Matching Algorithm for Local Unknown Obstacles based on Grid Topology Map,GMA-LUO-GTM),该方法以栅格拓扑地图作为搜寻机器人的局部未知障碍物环境的地图模型;利用几何特征地图匹配的方法,寻找出障碍物与机器人之间相对的位形关系,并解析出机器人在当前位置的可行路径网络,通过激光雷达对多种障碍物的检测及实验表明,其位姿横纵坐标及朝向角(xL,yL,ψ)的标准差分别为(1.45,1.01,0.1),表明该方法可实现对机器人的精确定位。针对蛇形搜寻机器人的全局路径规划问题,提出基于优化人工势场栅格蚁群算法(Optimization of Artificial Potential Field Grid Ant Colony Algorithm,OAPF-GACA)的路径规划方法。首先依据矿井实际环境利用栅格生成地图模型,再采用优化的人工势场法对蚁群算法的信息素进行初始化,使其在起始时刻就有好的引导作用,算法在前期的收敛速度有了较大提升,并采用参数可自动调节的蚁周模型,避免了算法易陷入局部最小和过早停滞的状况。最后,对在栅格地图上产生的算法路径再优化,使路径的距离和转角得到明显的改善,更适合机器人去追随。实验证明,与传统的蚁群算法对比,其收敛迭代次数减少了 50%,优化后的路径长度缩短了 18.7%。基于OAPF-GACA的路径的规划方法可以在不同的障碍环境中实现机器人的全局的路径规划。针对蛇形搜寻机器人的未知局部环境中的路径规划问题,基于对栅格地图的分析,提出了可插入多个局部目标点的改进人工势场算法(Improved Artificial Potential Field Algorithm for Inserting Multiple Local Target Points,IAPF-IMLTP)。该算法在OAPF-GACA得到的全局优化路径的基础上,插入了多个不同的局部的目标点,每次迭代只有靠机器人最近且在其前方的局部的目标点起作用,再通过改进其引力势函数,可以使机器人贴合规划路径行进。实验表明,IAPF-IMLTP算法生成的路径的与规划路径相比平均误差只有4.9%。针对环境中障碍物为动态的避障路径规划行为,提出了具有参数自适应调整的多目标点牵引的人工势场算法(Artificial Potential Field Algorithm for Multi Target Traction with Parameter Adaptive Adjustment,APF-MTT-PAA)的局部路径规划方法,该算法采用斥力参数自适应调整策略,并通过赋予障碍物一个虚拟速度的方法,消除了机器人易进入局部的最小值的状态。大量的实验仿真和实测实验表明,该算法可以使搜寻机器人在不同的障碍环境中迅速抵达目标。与传统的人工势场法相比,其避障速度快,可寻最优路径,无局部不可达的情况。实验及测试表明,所研制的蛇形搜寻机器人具有不错的实时性和自主性,能够满足搜寻机器人在较为复杂的环境下的自主控制的需求。本文提出的路径规划算法可为煤矿搜寻机器人在未知障碍环境中的路径规划提供理论支撑,也对机器人在高危环境的导航策略研究奠定了基础。