申请/专利权人:中国矿业大学
申请日:2022-11-17
公开(公告)日:2023-10-27
公开(公告)号:CN115755908B
主分类号:G05D1/02
分类号:G05D1/02
优先权:
专利状态码:有效-授权
法律状态:2023.10.27#授权;2023.03.24#实质审查的生效;2023.03.07#公开
摘要:本发明公开了一种基于JPS引导HybridA*的移动机器人路径规划方法,在经典HybridA*算法的基础上利用JPS算法的扩展特点进行优化,在二维网格下考虑hcollision_avoidance1启发值时,用JPS算法代替A*算法进行长度计算;在计算gextend函数值中加入pbias惩罚项,用JPS算法遍历获得引导路径点集合。本发明方法相比于经典HybridA*算法,在遍历速度,迭代次数及路径长度上提升效果显著。
主权项:1.一种基于JPS引导HybridA*的移动机器人路径规划方法,其特征在于,包括如下步骤:步骤1:全局地图初始化;其方法为:进行环境建模并建立二维坐标系,对环境中的所有障碍物进行离散化并用均匀分布的点集合来表示,设障碍物数量为k,组成障碍物集合为{OBSi},即i=1,…,k;步骤2:参数初始化;其方法为:在地图中设置初始位姿Startxinit,yinit,θinit,终点位姿Goalxend,yend,θend,构建节点采样函数Expansion_pattern、待探索列表Openlist、已探索列表Closedlist,以及移动机器人运动学模型;其中,x*,y*为移动机器人运动学模型的质心在*条件下绝对坐标系下的坐标,θ*表示在*条件下移动机器人航向角;步骤3:从待探索列表Openlist中选择代价值最小的节点作为当前节点,通过前向模拟寻找下一个扩展结点,判断扩展节点与终点的距离是否小于阈值,若是,则继续步骤6,否则继续步骤4;步骤4:计算起始点到扩展结点的代价值gextend以及扩展结点位姿到终点位姿并同时考虑移动机器人运动学约束及避障条件的启发值hextend,并计算扩展节点的总代价值fextend;步骤5:将扩展结点与其总代价值fextend放入待探索列表Openlist中,返回步骤3继续;步骤6:使用Reeds-Sheep曲线将扩展结点与终点连接,同时判断曲线上是否有障碍物,若是,则返回步骤3继续;否则,返回路径点集合;步骤7:对路径点集合进行重采样,输出优化路径;所述步骤2中,构建节点采样函数Expansion_pattern的具体过程为:算法先在φ∈{-φmax,0,φmax},v∈{-vmax,vmax}的范围内进行均匀采样获得采样值,然后在单位时间内按照采样值[v,φ]前向模拟移动机器人前进过程来判断该采样值是否符合碰撞条件;其中,v为前行速度,φ为移动机器人前轮偏转角,φmax为移动机器人前轮的最大偏转角,vmax为最大前行速度;所述步骤3中,前向模拟寻找扩展结点的具体过程为:通过前向模拟计算公式扩展当前节点,并用Reeds-Sheep曲线将节点相连;当前节点位姿为Ncurrentxcurrent,ycurrent,θcurrent,扩展节点位姿为Nexpendxexpend,yexpend,θexpend,前向模拟计算公式如下所示:xexpend=xcurrent+cosθcurrentvdtyexpend=ycurrent+cosθcurrentvdt 式中,Lw为移动机器人运动学模型前后轴的距离;N为常数;所述步骤4中,计算扩展结点的总代价值fextend的具体过程为:fextend=gextend+hextend其中:gextend=gcurrent+Csimu+pbias+pv_change+pv_reverse+pphy_change式中,gcurrent为起始点扩展到当前节点的代价值,Csimu为每次扩展子节点时叠加的前向模拟代价值,pbias为扩展结点偏离引导路径的惩罚,pv_change为移动机器人前行速度v改变时引入的惩罚,pv_reverse为移动机器人前行速度v方向改变时引入的惩罚,pphy_change为改变移动机器人前轮偏转角φ时引入的惩罚;hextend=β*maxhnonholonomics,maxhcollision_avoidance1,hcollision_avoidance2式中,β为启发值的权重系数,hnonholonomics为使用Reeds-Sheep曲线在不考虑避障条件下估算从扩展结点位姿到终点位姿的启发值,hcollision_avoidance1为JPS算法在二维网格下从扩展结点到终点的启发值,hcollision_avoidance2为扩展结点到终点的曼哈顿距离。
全文数据:
权利要求:
百度查询: 中国矿业大学 一种基于JPS引导Hybrid A*的移动机器人路径规划方法
免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。