1.一种基于栅格地图的一种改进的路径规划搜索算法,其特征在于,包括以下步骤:S1设计栅格地图节点的存储数据结构,采用位域存储表示栅格地图节点的特征信息,得到最终栅格地图;
S2对所述最终栅格地图进行预处理,得到预处理栅格地图;
S3设计代价函数,得到改进算法;
S4基于所述预处理栅格地图和所述改进算法设计搜索流程;
所述对所述最终栅格地图进行预处理,得到初始化节点信息值,包括:S21将所述最终栅格地图每个节点8个方向上的值都置为-1,且设定倍增值k=0;
S22开始遍历所有的节点,忽视所有的障碍节点,更新非障碍节点8个方向上的值,如果对应方向上存在相邻节点且该节点不是障碍点,则将该方向上的值置为0;
S23遍历所有的节点,忽视所有的障碍节点;对于当前非障碍当前节点P,更新其8个方向上的值;若p某一方向上的值小于k值则无视,若等于k值且该方向上移动步后的存在非障碍节点q,q在该方向上的值也不小于k,则将p在该方向上的值更新为k+1;
S24将k的值加一;
S25重复步骤S23-S24,直到有哪一次遍历后,所述最终栅格地图上任何节点的任何方向上的值都没有改变,结束预处理,得到预处理栅格地图;
所述基于所述预处理栅格地图和所述改进算法设计搜索流程,包括:S41将所述预处理栅格地图加载到内存中,然后确定寻路的起点和终点,并将所述起点的信息放入所述改进算法的Open列表中,开始寻路;
S42若Open列表中的节点不为空,则根据Open列表中的节点信息,取出其中GVal最小的当前节点P,将当前节点P的信息放入Closed列表中,并基于当前节点P确定终点和所述终点的靠近点,并将所述靠近点加入Open列表中;
S43在Closed列表中查看所述终点是否存在,若存在,则从所述终点开始回溯路径,否则确定从起点没有可以到达终点的路径,寻路结束。
2.如权利要求1所述的基于栅格地图的一种改进的路径规划搜索算法,其特征在于,所述设计代价函数,得到改进算法,包括:
S31在启发式代价函数中引入权重因子,得到修改代价函数;
S32增加所述修改代价函数的权重,得到改进算法。
3.如权利要求2所述的基于栅格地图的一种改进的路径规划搜索算法,其特征在于,所述启发式代价函数采用对角线距离计算公式。
4.如权利要求1所述的基于栅格地图的一种改进的路径规划搜索算法,其特征在于,所述根据Open列表中的节点信息,取出其中GVal最小的当前节点P,将当前节点P的信息放入Closed列表中,并基于当前节点P确定终点和所述终点的靠近点,并将所述靠近点加入Open列表中,包括:S421根据Open列表中的节点信息,取出其中GVal最小的当前节点P;
S422将当前节点P的信息放入Closed列表中,同时记录到达当前节点P的上一个节点S;
S423判断当前节点P是否是终点,若当前节点P是终点,则执行步骤S43,否则进行步骤S423;
S424找出当前节点P周围8个相邻的节点中未加入Open列表和Closed列表的节点加入Open列表中;
S425找到当前节点P到达终点的相对方向,然后将所述相对方向和相邻的两个方向确定为搜索方向;
S436根据所述搜索方向和当前节点P的倍增信息找出终点靠近点加入Open列表中;
S436循环步骤S421-SS436,直至步骤S423判断出终点。