一种基于图像处理的移动机器人的路径规划与优化方法技术

本发明专利技术公开了一种基于图像处理的移动机器人路径规划与优化方法。方法包括：使用投影变换法将二值化环境静态图像中的障碍物区域投影至投影变换图像，通过最近邻插值法获得真实环境图像；利用栅格化建模获得地图环境模型，利用A*算法获取移动机器人的初始路径；通过轮廓处理将障碍物区域的外轮廓线段拟合，从而获得环境障碍物模型；建立目标函数和环境障碍物约束；利用交替最小化方法对目标函数进行优化，获得最终优化路径作为移动机器人的目标路径。本发明专利技术根据图片信息实现对障碍物的自主分析，能够有效将复杂的障碍物简化。路径经过优化，缩短了整体路径长度并提升了路径质量，生成一条能与障碍物保持安全距离且路径长度接近最优的移动路径。接近最优的移动路径。接近最优的移动路径。

【技术实现步骤摘要】
一种基于图像处理的移动机器人的路径规划与优化方法


[0001]本专利技术涉及了一种路径规划与优化方法，具体涉及一种基于图像处理的移动机器人的路径规划与优化方法。

技术介绍

[0002]地面移动机器人结合了移动平台与操作手臂的优点，能在平面环境自由移动作业，可以有效扩大机器人的作业范围。目前在工业生产、仓储物流、科学探索等领域得到广泛的运用，随着移动机器人的运用环境日益复杂，路径规划的实时性与路径质量有了更高的要求。
[0003]在移动机器人的作业过程中，需要解决的问题包括环境感知与建模，路径规划与优化。利用各类相机进行摄影是一种经济方便的环境感知方法。利用图片信息，在环境障碍物复杂的情况下，对环境进行快速的感知、建模，进行路径规划与优化，是一个重要的难点问题。
[0004]通常，移动机器人的路径规划面向点到点的轨迹问题。需要在整体环境已知的情况下，从给定的起始位置出发运动到目标位置，并避开途中所有的障碍物。在目前的路径规划中，以栅格化环境为环境建模基础的A*算法能在该环境中找到一条距离最优的解。该路径与全局路径最优路径较为接近，但受栅格化环境的限制，存在较为尖锐的棱角与更长的路径长度。目前技术中仅提出一种在栅格中任意角度路径规划的方法，优化了A*算法所得的路径，但路径仍受到栅格环境的限制。

技术实现思路

[0005]为了解决
技术介绍
中存在的问题，本专利技术提供一种基于图像处理的移动机器人的路径规划与优化方法。在第一阶段，利用投影变换将图片中的机器人运动空间内的障碍物转换至真实环境图像中，用A*算法寻找一条可行路径。在第二阶段，提出一种障碍物图形识别方法，将环境中障碍物的不规则形状近似为直线，大大简化障碍物约束。以路径节点为变量，构建目标函数对问题进行描述求解，并提出使用交替极小化方法来有效地求解。
[0006]本专利技术采用的技术方案是：
[0007]本专利技术移动机器人的路径规划与优化方法包含如下步骤：
[0008]步骤100，拍摄获取移动机器人周围的环境静态图像，对环境静态图像进行二值化预处理，获得二值化环境静态图像，二值化环境静态图像中包括若干障碍物区域。
[0009]步骤200，使用投影变换法将二值化环境静态图像中的各个障碍物区域投影至投影变换图像，再通过最近邻插值法将投影变换图像中的各个障碍物区域进行插值处理，获得真实环境图像。
[0010]步骤300，利用栅格化对真实环境图像进行建模获得地图环境模型，在地图环境模型中利用A*算法获取移动机器人的初始路径。
[0011]步骤400，通过轮廓处理将步骤200中的真实环境图像中的每个障碍物区域的外轮
廓均进行线段拟合，从而获得环境障碍物模型。
[0012]步骤500，根据步骤300中的移动机器人的初始路径建立目标函数，并通过步骤400中的环境障碍物模型建立目标函数的环境障碍物约束。
[0013]利用交替最小化方法对目标函数进行优化，获得最终优化路径作为移动机器人的目标路径。
[0014]所述的步骤100中，二值化预处理具体为通过图像滤波法和灰度阈值法处理环境静态图像，获得二值化环境静态图像，并将二值化环境静态图像中灰度值高于预设灰度阈值的若干相间隔的区域均作为障碍物区域，即获得若干障碍物区域。
[0015]所述的步骤300中，将真实环境图像进行栅格化获得大小一致的若干栅格，由大小一致的若干栅格构成了地图环境模型；根据移动机器人的初始位置和预设目标位置，结合地图环境模型，利用A*算法，获得移动机器人从初始位置出发至预设目标位置的初始路径P
(0)
，使得初始路径P
(0)
不与地图环境模型中的各个障碍物区域重合，其中，分别为初始路径的第一个、第二个、...第N个初始路径点位置，为移动机器人的初始位置，为移动机器人的预设目标位置，均分别位于地图环境模型中的栅格的顶点。
[0016]初始路径P
(0)
中任意两个相邻初始路径点位置之间的连线为移动机器人在初始路径P
(0)
中移动的其中一条初始子路径，即初始路径P
(0)
是由N
‑
1条初始子路径依次连接构成的折线。
[0017]所述的步骤400中，使用连通块处理，将步骤200中的真实环境图像的各个障碍物区域单独分离；针对每个障碍物区域，获取障碍物区域的外轮廓，通过轮廓处理将外轮廓进行线段拟合，具体如下：
[0018]1)将障碍物区域的外轮廓均匀划分为I个轮廓点，依次为第一个轮廓点g1、第二个轮廓点g2、
…
、第I个轮廓点g
I
，依次连接I个轮廓点并形成闭环，构成I条轮廓向量线段，依次为第一条轮廓向量线段s1、第二条轮廓向量线段s2、
…
、第I条轮廓向量线段s
I
。
[0019]2)依次遍历计算第一条轮廓向量线段s1与该条轮廓向量线段之后的若干轮廓向量线段之间的夹角，每条轮廓向量线段计算夹角时以该条轮廓向量线段的连线方向作为轮廓向量线段的方向，夹角计算具体如下：
[0020]若依次连续遍历计算获得的所有夹角均小于等于预设阈值角度ψ，则不进行操作，直接将第一条轮廓向量线段s1作为第一拟合线段。
[0021]否则，直至第i次计算时，当次计算获得的第一条轮廓向量线段s1与第i条轮廓向量线段s
i
之间的夹角大于预设阈值角度ψ，则将第一条轮廓向量线段s1至第i条轮廓向量线段s
i
之间的所有轮廓向量线段进行直线线段拟合合并作为第一拟合线段，即将第一个轮廓点g1与第i+1个轮廓点g
i+1
直接连接形成的直线段作为第一拟合线段，停止当前遍历计算，其中，1<i<I。
[0022]3)依次将第一拟合线段之后的若干轮廓向量线段均进行上述步骤2)中的第一条轮廓向量线段s1的相同的操作，依次获得第二拟合线段、第三拟合线段、
…
、第j拟合线段，其中，1<i<j≤I。
[0023]4)依次遍历计算第一拟合线段与该条拟合线段之后的若干拟合线段各自的线段长度：
[0024]若依次遍历计算获得的线段长度均大于预设长度μ，则不进行操作，将第一拟合线段、第二拟合线段、
…
、第j拟合线段分别直接作为第一边界线段L1、第二边界线段L2、
…
、第j边界线段L
j
，将障碍物区域的外轮廓替换为由第一边界线段L1、第二边界线段L2、
…
、第j边界线段L
j
围成的轮廓。
[0025]若直至第k次计算时，当次计算获得的第k拟合线段的线段长度小于等于预设长度μ，第k拟合线段之前的各条拟合线段的线段长度均大于预设长度μ，则将第一拟合线段、第二拟合线段、
…
、第k
‑
1拟合线段分别直接作为第一边界线段L1、第二边界本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于图像处理的移动机器人的路径规划与优化方法，其特征在于：包含如下步骤：步骤100，拍摄获取移动机器人周围的环境静态图像，对环境静态图像进行二值化预处理，获得二值化环境静态图像，二值化环境静态图像中包括若干障碍物区域；步骤200，使用投影变换法将二值化环境静态图像中的各个障碍物区域投影至投影变换图像，再通过最近邻插值法将投影变换图像中的各个障碍物区域进行插值处理，获得真实环境图像；步骤300，利用栅格化对真实环境图像进行建模获得地图环境模型，在地图环境模型中利用A*算法获取移动机器人的初始路径；步骤400，通过轮廓处理将步骤200中的插值投影图像中的每个障碍物区域的外轮廓均进行线段拟合，从而获得环境障碍物模型；步骤500，根据步骤300中的移动机器人的初始路径建立目标函数，并通过步骤400中的环境障碍物模型建立目标函数的环境障碍物约束；利用交替最小化方法对目标函数进行优化，获得最终优化路径作为移动机器人的目标路径。2.根据权利要求1所述的一种基于图像处理的移动机器人的路径规划与优化方法，其特征在于：所述的步骤100中，二值化预处理具体为通过图像滤波法和灰度阈值法处理环境静态图像，获得二值化环境静态图像，并将二值化环境静态图像中灰度值高于预设灰度阈值的若干相间隔的区域均作为障碍物区域，即获得若干障碍物区域。3.根据权利要求2所述的一种基于图像处理的移动机器人的路径规划与优化方法，其特征在于：所述的步骤300中，将真实环境图像进行栅格化获得大小一致的若干栅格，由大小一致的若干栅格构成了地图环境模型；根据移动机器人的初始位置和预设目标位置，结合地图环境模型，利用A*算法，获得移动机器人从初始位置出发至预设目标位置的初始路径P
(0)
，使得初始路径P
(0)
不与地图环境模型中的各个障碍物区域重合，其中，分别为初始路径的第一个、第二个、...第N个初始路径点位置，为移动机器人的初始位置，为移动机器人的预设目标位置，均分别位于地图环境模型中的栅格的顶点；初始路径P
(0)
中任意两个相邻初始路径点位置之间的连线为移动机器人在初始路径P
(0)
中移动的其中一条初始子路径，即初始路径P
(0)
是由N
‑
1条初始子路径依次连接构成的折线。4.根据权利要求2所述的一种基于图像处理的移动机器人的路径规划与优化方法，其特征在于：所述的步骤400中，使用连通块处理，将步骤200中的真实环境图像的各个障碍物区域单独分离；针对每个障碍物区域，获取障碍物区域的外轮廓，通过轮廓处理将外轮廓进行线段拟合，具体如下：
1)将障碍物区域的外轮廓均匀划分为I个轮廓点，依次为第一个轮廓点g1、第二个轮廓点g2、
…
、第I个轮廓点g
I
，依次连接I个轮廓点并形成闭环，构成I条轮廓向量线段，依次为第一条轮廓向量线段s1、第二条轮廓向量线段s2、
…
、第I条轮廓向量线段s
I
；2)依次遍历计算第一条轮廓向量线段s1与该条轮廓向量线段之后的若干轮廓向量线段之间的夹角，每条轮廓向量线段计算夹角时以该条轮廓向量线段的连线方向作为轮廓向量线段的方向，夹角计算具体如下：若依次连续遍历计算获得的所有夹角均小于等于预设阈值角度ψ，则不进行操作，直接将第一条轮廓向量线段s1作为第一拟合线段；否则，直至第i次计算时，当次计算获得的第一条轮廓向量线段s1与第i条轮廓向量线段s
i
之间的夹角大于预设阈值角度ψ，则将第一条轮廓向量线段s1至第i条轮廓向量线段s
i
之间的所有轮廓向量线段进行直线线段拟合合并作为第一拟合线段，即将第一个轮廓点g1与第i+1个轮廓点g
i+1
直接连接形成的直线段作为第一拟合线段，停止当前遍历计算，其中，1<i<I；3)依次将第一拟合线段之后的若干轮廓向量线段均进行上述步骤2)中的第一条轮廓向量线段s1的相同的操作，依次获得第二拟合线段、第三拟合线段、
…
、第j拟合线段，其中，1<i<j≤I；4)依次遍历计算第一拟合线段与该条拟合线段之后的若干拟合线段各自的线段长度：若依次遍历计算获得的线段长度均大于预设长度μ，则不进行操作，将第一拟合线段、第二拟合线段、
…
、第j拟合线段分别直接作为第一边界线段L1、第二边界线段L2、
…
、第j边界线段L
j
，将障碍物区域的外轮廓替换为由第一边界线段L1、第二边界线段L2、
…
、第j边界线段L
j
围成的轮廓；若直至第k次计算时，当次计算获得的第k拟合线段的线段长度小于等于预设长度μ，第k拟合线段之前的各条拟合线段的线段长度均大于预设长度μ，则将第一拟合线段、第二拟合线段、
…
、第k
‑
1拟合线段分别直接作为第一边界线段L1、第二边界线段L2、
…
、第k
...

【专利技术属性】
技术研发人员：黄方昊，张敏捷，陈正，孙向伟，聂勇，唐建中，
申请(专利权)人：浙江大学，
类型：发明
国别省市：