搜索

x

面向狭窄养殖通道的安全代价约束改进RRT路径规划算法

An improved RRT path planning algorithm with safety cost constraints for narrow aquaculture channels

  • 摘要: 针对室内海水养殖狭窄通道场景中投喂机器人路径规划存在的搜索盲目、路径贴障和转折冗余问题,本文提出一种基于安全代价约束的改进快速扩展随机树(rapidly-exploring random tree, RRT)路径规划算法。首先,基于占据栅格地图构建安全代价模型,在节点扩展与连接中引入安全代价约束,并结合父节点重选与邻域重连,引导随机树向低风险区域扩展,提高路径安全裕度;其次,采用目标偏置采样,增强随机树向目标区域的收敛能力,减少无效搜索;最后,基于可达性检测对初始路径进行回溯优化,删除冗余节点并降低路径累计偏转角。基于RK3568嵌入式平台,从规划实时性、路径安全性和路径平滑性3个方面进行实验验证。结果表明:改进RRT算法的平均规划耗时分别比标准RRT算法和A*算法的平均规划耗时降低75.5%和80.8%;改进RRT算法的安全入侵率为0%;相较于标准RRT算法,改进RRT算法的路径节点数平均值由38.2个降至8.1个,累计偏转角由13.9 rad降至3.2 rad。

     

    Abstract: To address the problems of blind search, obstacle-adjacent paths, and redundant turns in the path planning of feeding robots in narrow indoor marine aquaculture channels, an improved rapidly-exploring random tree (RRT) path planning algorithm with safety cost constraints is proposed. First, a safety cost model is constructed based on the occupancy grid map, and obstacle-distance constraints are incorporated into the node expansion and parent node selection processes, guiding the random tree to expand toward low-risk regions and thereby improving the safety margin of the planned path. Second, goal-biased sampling is employed to enhance the convergence of the random tree toward the target region and reduce ineffective search. Finally, reachability-detection-based path backtracking optimization is performed on the initial path to remove redundant intermediate nodes and reduce the cumulative heading deflection angle. Experiments are conducted on an RK3568 embedded platform to evaluate the algorithm in terms of real-time planning performance, path safety, and path smoothness. The results show that the average planning time of the improved RRT algorithm is 75.5% and 80.8% lower than that of the standard RRT and A* algorithms, respectively. The improved RRT algorithm achieves a safety intrusion rate of 0%. Compared with the standard RRT algorithm, the improved RRT algorithm reduces the average number of path nodes from 38.2 to 8.1 and the cumulative heading deflection angle from 13.9 rad to 3.2 rad.

     

/

返回文章
返回