[发明专利]面向多机器人路径规划的增设路径障碍方法

摘要

本发明涉及面向多机器人路径规划的增设路径障碍方法，以前一次路径规划的路径拓宽为障碍区域O，路径规划得road，当road与O没有交点时可以通行，否则将road与O在x轴上的投影值从小到大排列并取判断区间，将road内和前一次路径的所有点的横坐标的值在区间内的点分别存储于集合B和C中，C中两端的点连接得到线段D、扩展得Oi，以集合B中的点与Oi位置判断，存在交叉则淘汰路径road。本发明将前一次规划的路径拓宽，变成由若干矩形组成的近似宽曲线为障碍物O，下一机器人路径规划时必须与O无交点。本发明可有效保护可通行区域，为后续机器人的路径规划提供了更有利的可行区域，保证了后续机器人在路径规划上的优势。