基于改进A*算法的水空两栖机器人多目标路径规划

    Multi-objective path planning of water-air amphibious robots based on improved A* algorithm

    • 摘要: 实现水空两栖机器人安全、高效进行多目标点跨塘水质检测作业,减少传统水质检测模式时间及经济成本,合理的路径规划十分重要。针对传统A*算法路径曲折、搜索效率低、无法考虑多栖机器人约束特性等问题,该研究提出一种改进A*的水空两栖机器人路径规划算法。首先采集障碍物分布情况和高度信息,建立多水域2.5维栅格地图;其次在A*算法评价函数中加入能耗、时间及安全代价,通过调节不同权重获取相应初始路径;然后通过动态分配权重改进启发式函数,加快搜索效率,并利用目标成本函数对所有目标进行优先级判定,实现多目标路径规划;最后通过增加空中模态切换点、删除冗余点及采用B样条曲线优化路径,生成可连接多水域多水质检测点的三维平滑轨迹。仿真试验结果表明:与传统A*算法和陆空A*算法相比,改进A*算法迭代次数分别减少70.04%与68.07%,路径长度分别减少35.44%与7.6%,总转角分别减小83.63%与8.65%,危险节点数分别减少80.67%与33.33%。真实水域试验表明:改进A*算法的迭代次数比传统A*算法和陆空A*算法减少84.89%与83.78%,路径长度分别减少12%与0.6%,总转角分别减小73.21%与22.1%,危险节点数分别减少84.62%与80%,可规划出通过多个目标点的安全、平滑路径,有效提高水质检测效率,为多栖机器人自主导航提供参考。

       

      Abstract: A safer and more efficient inspection of water quality is highly required in an aquatic-air amphibious robot. However, the traditional inspection mode of water quality cannot fully arrive at multiple target points over a pond. It is very necessary to plan a reasonable path for the robot, in order to reduce the dwelling time with cost saving. Particularly, the traditional path zigzagging of A* algorithm cannot consider the different constraints of multi-amphibious robots. In this study, an improved A* algorithm of path planning was proposed for the high search efficiency in the water-air amphibious robots. Firstly, the distribution and height information of the obstacles was collected using the improved A* algorithm. A 2.5-dimensional raster map was then established to contain the multiple water areas; Secondly, the evaluation function of A* algorithm was used to add the different energy consumption, time, and safety costs of amphibious robots. The different weights were then adjusted to obtain the initial paths; The weights among energy consumption, time, and safety costs were also dynamically allocated to improve the path planning of A* algorithm. The heuristic function of A* algorithm was then improved to speed up the search efficiency. The target cost function was used to prioritize all detection targets of water quality, in order to realize the path planning of multiple target points in a partitioned fishpond; Finally, the initial paths were optimized to add the additional airborne mode-switching, thus deleting the redundant points. The B-spline algorithm was adopted to generate a three-dimensional smooth trajectory. As such, an optimal path was obtained to connect the multiple inspection points of water quality. Simulation results show that the number of iterations of the improved A* algorithm was reduced by 70.04% and 68.07%, respectively, compared with the traditional and land-air A* algorithms; while the length of the path was reduced by 35.44% and 7.6%, respectively; the total angle of turn was reduced by 83.63% and 8.65%, respectively; and the number of dangerous nodes was reduced by 80.67% and 33.33%, respectively. The real water test showed that the number of iterations of the improved A* algorithm was reduced by 84.89% and 83.78%, respectively; the length of the path was reduced by 12% and 0.6%, respectively; the total angle of turn was reduced by 73.21% and 22.1%, respectively; and the number of dangerous nodes was reduced by 84.62% and 80%, respectively. The improved A* algorithm was achieved in the safe and smooth path, according to the multiple target points in multiple pieces of water. The efficiency of water quality detection was effectively improved in the partitioned fishponds, compared with the traditional approach. The finding can also provide a strong reference for the autonomous navigation of multi-habitat robots.

       

    /

    返回文章
    返回