基于改进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%,危险节点数减少86.67%与33.33%。真实水域试验表明:改进A*算法的迭代次数比传统A*算法和陆空A*算法减少84.89%与83.78%,路径长度减少12%与0.6%,总转角减小73.21%与22.1%,危险节点数84.62%与80%,可规划出通过多个目标点的安全、平滑路径,有效提高水质检测效率,为多栖机器人自主导航提供参考。

       

      Abstract: In order to realize a safer and more efficient water quality inspection operation of an aquatic-air amphibious robot arriving at multiple target points across a pond, and in order to reduce the time as well as the economic cost of the traditional water quality inspection mode, it is very important for people to plan a reasonable path for the robot. The traditional A * algorithm, as a widely used classic algorithm, but it has some shortcomings when facing the complex environment of multi habitat robot operations, so aiming at the traditional A* algorithm path zigzagging, low search efficiency, and unable to consider the different constraint characteristics of multi-amphibious robots, this study proposes a path planning algorithm for water-air amphibious robots that improves the A* algorithm. Firstly, the algorithm needs to collect the distribution of obstacles and the different height information of obstacles by using binocular camera, and use the collected information to create a 2.5-dimensional grid map of multiple water bodies using a computer; secondly, the different speed and energy consumption ratios of the robot were measured through real machine experiments in both flight and ship modes, then the evaluation function of A* algorithm adds different energy consumption, time and safety cost of amphibious robots, and adjusts the different weights between them to obtain the different initial paths accordingly; and then dynamically allocates the weights between energy consumption, time and safety cost to improve the path planning of A* algorithm. Then, the heuristic function of A* algorithm is improved by dynamically allocating the weights of energy consumption, time and safety cost to speed up the search efficiency of A* algorithm, grouping water quality detection target points located in different water bodies and the target cost function is used to prioritize all water quality detection targets, so as to realize the path planning of multiple target points in a partitioned fishpond; then the paper optimizes the initial paths by adding additional airborne mode-switching paths, deleting the redundant paths, and adopting the B-spline algorithm to optimize the initial paths, and finally generates a path that can connect multiple waters. Finally, the initial path is optimized by adding additional airborne mode switching path points, removing redundant path points and using the B-spline algorithm to generate a three-dimensional smooth trajectory that can be connected to multiple waters and contains multiple water quality inspection points. The simulation test results show that compared with the traditional A * algorithm and the land air A * algorithm, iteration times of the improved A* algorithm are reduced by 70.04% and 68.07%, and the path length is reduced by 35.44% and 7.6%, the total turning angle is reduced by 83.63% and 8.65%, and the number of dangerous nodes is reduced by 86.67% and 33.33% compared with the traditional A* algorithm and the land-air A* algorithm. The real waterway experiment shows that the iteration times of the improved A* algorithm are reduced by 84.89% and 83.78% compared with the traditional A* algorithm and the air-land A* algorithm, the path length is reduced by 12% and 0.6%, the total turning angle is reduced by 73.21% and 22.1%, the number of dangerous nodes is reduced by 84.62% and 80% compared with the traditional A* algorithm and the land-air A* algorithm. The improved A* algorithm proposed in this paper can plan a safe and smooth path through multiple target points in multiple pieces of water, which can effectively improve the efficiency of water quality detection in partitioned fishponds in comparison with the traditional approach and the traditional water quality testing vessel, it can also provide a reference for the research on the autonomous navigation of the multi-habitat robot.

       

    /

    返回文章
    返回