一种行进路径、智能设备行进路径规划方法和装置

摘要

本发明公开了一种行进路径、智能设备行进路径规划方法和装置，行进规划方法中，采集目标范围的环境数据，先将环境数据先转化为栅格地图，再将栅格地图转化为代价地图，在代价地图中截取所需多边形区域，在所需多边形区域用灰度代表障碍物栅格、非障碍物栅格、边界栅格，选一个非障碍物栅格为当前栅格，计算当前栅格与最近障碍物栅格的距离，并基于此计算当前栅格周边非障碍物栅格的障碍距离，连线障碍距离相等的非障碍物栅格，得到等距线。计算所需多边形区域内所有非障碍物栅格的等距线。以障碍距离大于智能设备宽度一半的非障碍物栅格周边的等距线规划路径。本申请基于等距线生成规划路径，避开了行进路径中的障碍物，保证了行进安全。