一种实际环境下机器人路径规划方法及系统技术方案

本发明专利技术提供一种实际环境下机器人路径规划方法及系统，属于智能仓储领域。为解决现有机器人路径规划中，未考虑机器人在实际环境下的自身大小，造成工业或生产损失问题。包括对当前节点判断其相邻节点是否在开放列表中，若在则记录相邻节点中g值最小节点，若不在则加入开放列表并判断是否为目标节点，若是则结束循环，若不是在将当前节点移入关闭列表，计算相邻节点的f值选择f值最小的节点作为下一当前节点，重复上述操作至开放列表为空，保存可用路径后在最小安全距离下进行再处理，得到最终路径。更符合实际情况下的机器人运行，避免由于自身体型差异而导致的损伤货物或自身，提高机器人工作效率，保证了仓储中工作的高效性与安全。与安全。与安全。

【技术实现步骤摘要】
一种实际环境下机器人路径规划方法及系统


[0001]本专利技术涉及机器人智能仓储
，具体而言，涉及一种实际环境下机器人路径规划方法及系统。

技术介绍

[0002]在机器人智能仓储领域，单机器人全局路径规划算法是至关重要的。随着物流和供应链业的发展，仓储成为了重要的环节之一。传统的仓储方式已经无法满足快速、高效和智能的要求。而AI技术的发展，为仓储行业的升级换代提供了新的思路和解决方案，特别是机器人智能仓储技术推动了仓储业的智能化进程。机器人智能仓储技术是利用自动化、智能化、信息化等技术手段，将机器人应用于实现仓储操作的自动化与智能化。
[0003]机器人智能仓储系统不仅能够提高工作效率，同时还可以减轻人力负担，降低成本，提高安全性。因此，机器人智能仓储技术在仓储行业具有广阔的应用前景。在实际应用中，机器人需要以较快的速度完成货物存放和取出任务，同时还需要保证运动过程中的安全性。然而，由于机器人在移动时有时会碰到障碍物，这是由于现有的机器人路径规划方法中，未考虑实际情况下机器人本身的大小差异，导致机器人在按照规划路线行走时，可能会发生机器人与障碍物发生碰撞，导致损伤货物或机器人自身，给工业、生产等带来一定的损失。

技术实现思路

[0004]本专利技术要解决的技术问题是：
[0005]为了解决现有的机器人路径规划方法中，未考虑机器人在实际环境下的自身形状大小，可能会在行走过程中损坏货物或自身，造成工业或生产损失的问题。
[0006]本专利技术为解决上述技术问题所采用的技术方案：
[0007]本专利技术提供了一种实际环境下机器人路径规划方法，包括以下步骤：
[0008]步骤一、获取并输入起始点、目标节点和地图信息，将起始点添加进开放列表；
[0009]步骤二、获取路径，包括：
[0010]从起始点开始，即第一个当前节点为起始点，判断当前节点的相邻节点是否在开放列表中：若在，记录相邻节点中最小g值的节点，将当前节点作为该最小g值相邻节点的父节点；若不在，将该相邻节点加入开放列表并判断该相邻节点是否为目标节点，如果为目标节点，结束当前循环；如果不为目标节点，将当前节点作为该节点的父节点；
[0011](2)将(1)中得到的当前节点移入关闭列表；
[0012](3)采用改进的评价函数计算相邻节点的f值；
[0013](4)选择开放列表中f值最小的节点，作为下一当前节点；
[0014]当开放列表不为空时重复上述步骤，否则跳到步骤三；
[0015]步骤三，若目标节点在关闭列表中，则从目标节点开始，沿着每一节点的父节点回溯到起始节点，保存路径；若目标节点不在关闭列表中，则无法找到路径；
[0016]步骤四、对路径点进行判断，若存在路径点与障碍物之间的最小距离小于最小安全距离则路径无效，否则保存路径，将保存的路径作为初次规划得到路径，最小安全距离定义为机器人中心到其最远边缘的距离；
[0017]步骤五：对初次规划得到路径进行再处理，在保证路径与障碍物之间的距离大于最小安全距离的情况下，去除路径中的第一类和第二类节点，得到最终路径。
[0018]进一步地，在步骤二(3)中，改进后的评价函数如式(1)所示，
[0019]f(n)＝g(n)+h(n)+5.1/o(n)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)
[0020]o(n)的计算公式如式(2)和(3)所示：
[0021]o(n)＝min(dist)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(2)
[0022][0023]其中，f(n)代表评价函数；g(n)为起始点到当前节点n的观测评估值；h(n)为当前节点n到终点的估计评估值；o(n)为当前节点n与障碍物之间的最小距离，dist为当前节点与障碍物之间的距离；(x
n
,y
n
)为当前节点n的坐标；(x
o
(i),y
o
(i))为第i个障碍物的坐标；i为障碍物的数量。
[0024]进一步地，在步骤四中，最小安全距离的条件式如式(4)所示，
[0025]o(p)≥机器人中心至最远边缘距离
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(4)
[0026]其中，p为路径点。
[0027]进一步地，在步骤五中，判断路径点是否为第一类节点的方法是，计算该节点前一段路径和后一段路径的斜率是否相同，设待判定路径点C的坐标为(x
C
,y
C
)，其前一个路径点P1的坐标为(x
p1
,y
p1
)，后一个路径点P2的坐标为(x
p2
,y
p2
)，则这两段路径的斜率K1和K2分别为如式(5)和(6)所示：
[0028][0029][0030]若K1与K2相同则判定该路径点为第一类节点，将其去除，若K1与K2不同，则保留该节点。
[0031]进一步地，在步骤五中，判断去除第一类路径点后保留下来的路径点是否为第二类节点的方法为，首先将起始点与目标节点相连得到直线l
1n
，若该直线未经过障碍物并且直线l
1n
路径与障碍物的距离大于等于最小安全距离，则判定起始点与目标节点之间的路径点为第二类节点，保留直线l
1n
作为最终路径；若该直线经过障碍物，则将起始点与倒数第二个路径点相连得到直线l
1n
‑1，若直线l
1n
‑1未经过障碍物且与障碍物的距离大于等于最小安全距离，则判定起始点与倒数第二个路径点之间的路径点为第二类节点，将其去除，再将倒数第二个节点与目标点相连，确定最终路径；若直线l
1n
‑1经过障碍物，则将起始点与倒数第三个路径点相连，以此类推，直到将起始点与目标节点无障碍的连接起来，去除第二类节点后得到的路径为最终路径。
[0032]进一步地，第一类节点的去除与否不影响最终路径，第二类节点的去除用于避免机器人与障碍物发生碰撞，且路径长度缩短，转弯次数减少。
[0033]进一步地，在步骤二(1)中，在判断当前节点的相邻节点是否在开放列表中前，需
要判断其是否存在以下三种情况，即是否为被障碍物占据、处于关闭列表中、与目标节点方向不一致，若是则需要忽略该节点，若不是则继续步骤二(1)的操作。
[0034]一种实际环境下机器人路径规划系统，该系统具有与上述步骤对应的程序模块，运行时执行上述的实际环境下机器人路径规划方法中的步骤。
[0035]一种计算机可读存储介质，所述计算机可读存储介质存储有计算机程序，所述计算机程序配置为由处理器调用时实现实际环境下机器人路径规划方法的步骤。
[0036]相较于现有技术，本专利技术的有益效果是：
[0037]本专利技术一种实际环境下机器人路径规划方法及系统，包括将起始点加入开放本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种实际环境下机器人路径规划方法，其特征在于，包括以下步骤：步骤一、获取并输入起始点、目标节点和地图信息，将起始点添加进开放列表；步骤二、获取路径，包括：从起始点开始，即第一个当前节点为起始点，判断当前节点的相邻节点是否在开放列表中：若在，记录相邻节点中最小g值的节点，将当前节点作为该最小g值相邻节点的父节点；若不在，将该相邻节点加入开放列表并判断该相邻节点是否为目标节点，如果为目标节点，结束当前循环；如果不为目标节点，将当前节点作为该节点的父节点；(2)将(1)中得到的当前节点移入关闭列表；(3)采用改进的评价函数计算相邻节点的f值；(4)选择开放列表中f值最小的节点，作为下一当前节点；当开放列表不为空时重复上述步骤，否则跳到步骤三；步骤三、若目标节点在关闭列表中，则从目标节点开始，沿着每一节点的父节点回溯到起始节点，保存路径；若目标节点不在关闭列表中，则无法找到路径；步骤四、对路径点进行判断，若存在路径点与障碍物之间的最小距离小于最小安全距离则路径无效，否则保存路径，将保存的路径作为初次规划得到路径，最小安全距离定义为机器人中心到其最远边缘的距离；步骤五：对初次规划得到路径进行再处理，在保证路径与障碍物之间的距离大于最小安全距离的情况下，去除路径中的第一类和第二类节点，得到最终路径。2.根据权利要求1所述的一种实际环境下机器人路径规划方法，其特征在于：在步骤二(3)中，改进后的评价函数如式(1)所示，f(n)＝g(n)+h(n)+5.1/o(n) (1)o(n)的计算公式如式(2)和(3)所示：o(n)＝min(dist) (2)其中，f(n)代表评价函数；g(n)为起始点到当前节点n的观测评估值；h(n)为当前节点n到终点的估计评估值；o(n)为当前节点n与障碍物之间的最小距离，dist为当前节点与障碍物之间的距离；(x
n
,y
n
)为当前节点n的坐标；(x
o
(i),y
o
(i))为第i个障碍物的坐标；i为障碍物的数量。3.根据权利要求2所述的一种实际环境下机器人路径规划方法，其特征在于：在步骤四中，最小安全距离的条件式如式(4)所示，o(p)≥机器人中心至最远边缘距离
ꢀꢀꢀꢀꢀꢀꢀꢀ
(4)其中，p为路径点。4.根据权利要求3所述的一种实际环境下机器人路径规划方法，其特征在于：在步骤五中，判断路径点是否为第一类节点的方法是，计算该节点前一段路径和后一段路径的斜率是否相同，设待判定路径点C的坐标为(x
C

【专利技术属性】
技术研发人员：焉晓贞，周新悦，罗清华，丁若晨，王晨旭，周志权，贾广乐，
申请(专利权)人：哈尔滨工业大学威海，
类型：发明
国别省市：