[发明专利]一种基于优化的机器人A*避障路径规划方法

说明书

本发明涉及一种基于优化的机器人A*避障路径规划方法，为降低空间在轨服务机械臂长期运行而造成磨损，提出一种优化的A*路径规划，因为在工程中机械臂末段每经过一个节点机械臂需要停止和启动一次，这样加大了对机械臂的磨损，本方法提到的方法可以减少搜索路径中的节点，增加机械臂末端路径的平滑性，减少机械臂停止与开始的频率，该方法映射到关节空间，减少关节速度变化的频率，减少关节的磨损，增加机械臂的使用寿命。同时其中还提出一种改进的长方体包络障碍物碰撞检测方法和圆柱型包络机械臂连杆自身碰撞检测方法，该方法减少计算复杂度，提高计算效率，减少碰撞检测时间，优先提高碰撞检测的实时性。

技术领域

本发明属于机器人及遥操作技术领域，基于七自由度拟人机械臂验证优化的A*路径规划规划，涉及一种基于优化的机器人A*避障路径规划方法。

背景技术

随着空间探索的深入,空间在轨服务和维修越来越加频繁,其中空间机械臂在空间 站的建设和维护中显得尤其重要，空间机械臂应用技术已经成为空间技术的重要研究方向。空间机械臂代替宇航员完成空间作业任务，如组装与搭建空间站、释放与回收 卫星、维护空间设备以及完成空间科学试验等，大大减小了宇航员舱外作业的风险， 因此空间机械臂应用技术受到国内外专家的高度重视。在微重力环境下，空间机械臂 系统处于自由漂浮状态，使得机械臂控制变量与非独立变量之间存在强烈的运动耦合， 运动控制难度加大，从而空间机械臂的路径规划变得特别复杂此外，由于空间环境中 的空间碎片，空间舱体外设试验装置等都有可能成为空间机械臂在轨操作过程中的障 碍，因此为了顺利完成在轨操作任务，开展空间机械臂避障路径规划研究十分重要， 但空间机械臂设计具有工作空间大、运动灵活、使用寿命长、可靠性和控制精度要求 高等要求，本专利基于此背景提出了一种改进的长方体包络法结合圆柱包络法进行碰 撞检测,此方法增加了碰撞检测的计算速度,提高了路径规划的实时性，同时提出一种 优化的A*算法可以有效增加机械臂末端运动轨迹的平滑性，不但减少机械臂关节角速 度变化的频率，而且可以减少机械臂关节运动停止与启动次数，有效降低机械臂的磨 损，延长了机械臂使用寿命；最后在unity与visual studio2010平台上进行仿真研究,验 证了该方法的有效性和实用价值。

发明内容

要解决的技术问题

为了避免现有技术的不足之处，本发明提出一种基于优化的机器人A*避障路径规划方法

技术方案

一种基于优化的机器人A*避障路径规划方

法，其特征在于步骤如下：

步骤1、采用改进A*路径规划算法计算出路径：

a1：首先采用栅格法对环境进行建模，分成n×n×n个边长为适当长度的立方体，然后以估价函数为每一个立方体赋值f(n)＝g(n)+h(n)，并计算f(n)、g(n)、h(n)值； 所述环境为起始点至目标节点的一个立体空间；所述g(n)为起始点至当前节点的欧式 距离；所述h(n)当前节点至目标节点的欧式距离；

a2：将起始点加入到Open链表中，并把起始点当作当前节点；

a3：将立方体中当前节点的26临域加入Open链表中，并把当前节点作为其父节点；

在Open集中选f(n)值最小的节点作为当前节点；

并且将当前节点添加到Close链表中，且在Open链表中移除；

若终点添加到Open链表中即结束搜索，否则转下一步骤；

a4：若当前节点的26临域不在Open链表中时，将当前节点的26临域加入Open 链表中，并计算f(n)＝g(n)+h(n)中的f(n)、g(n)、h(n)值；若在Open链表中，重新 计算g(n)值，若比先前g(n)值小，则更新g(n)值和父节点，重复步骤a 3；