qq_47239867的博客

原创 A star算法在三维避障路径规划的应用

A star算法在三维避障路径规划的应用前言前言在实际工程应用中,运动目标的外形、大小直接影响到路径选择,针对三维复杂场景的碰撞检测和路径规划问题,提出了一种基于层次包围盒碰撞检测的实时路径规划优化算法.该优化算法在进行碰撞检测时,通过预碰撞筛选检测和精细碰撞检测的方法来规避根本不会碰撞的物体,只检测与视点小半径球有碰撞可能性的物体;在进行路径规划时,在传统A*算法进行路径规划的基础上,结合“粗试探和精搜索”的思想,最终完成路径规划…% A* algorithm实现clc; clear; c.