一种机械臂避障路径规划方法技术

本发明专利技术公开了一种机械臂避障路径规划方法，包括以下步骤：S1、获取轨迹规划所需要的参数信息；S2、采用均匀Logistic混沌序列采样器生成随机点X

【技术实现步骤摘要】
一种机械臂避障路径规划方法


[0001]本专利技术属于机械臂路径规划
，具体涉及一种机械臂避障路径规划方法。

技术介绍

[0002]机械臂路径规划算法自从上世纪被提出来，便得到了快速发展和广泛应用，现在机械臂路径规划算法的算法性能以及十分高效，但在某些方面仍存在着一定的不足，例如全局规划难度大、实时性低等缺点。针对路径规划的问题，曾提出去多算法，如栅格法、蚁群算法、人工势场法、A*算法、快速随机扩展树算法等。其中，人工势场法是依靠机器人对障碍物的排斥力和目标点的吸引力的共同作用进行避障和路径规划，但在规划的过程中存在局部极小的陷阱，当排斥力和吸引力相互抵消时便不能找出路径。
[0003]快速随机扩展树算法自从提出便被广泛应用于机械臂的路径规划，其通过随机的采样与障碍物进行碰撞检测，简化了路径规划的算法模型和空间模型。但也快速随机扩展树算法也存在自己的缺点，由于采样点随机分布会导致无法找出合理路径，并且会产生很多无用节点，最终生成的路径会有很多转折并不平滑，将导致机械臂运动过程中震动加大、摩擦加剧。

技术实现思路

[0004]本专利技术的目的是解决上述问题，提供一种运动平稳，摩擦小，避障效果好的机械臂避障路径规划方法。
[0005]为解决上述技术问题，本专利技术的技术方案是：一种机械臂避障路径规划方法，包括以下步骤：
[0006]S1、获取轨迹规划所需要的参数信息，包括轨迹规划的空间范围X，以及X内的障碍物信息，机械臂的起始点X
init
以及目标点X/>goal
；以起始点X
init
以及目标点X
goal
为根节点分别初始化随机树T1和T2，给定扩展步长L，最大迭代次数Max；
[0007]S2、采用均匀Logistic混沌序列采样器生成随机点X
rand
；
[0008]S3、找到随机树上和点X
rand
最近的点X
nearest
，然后X
nearest
向X
rand
延伸一定距离L得到下一个拓展点X
new
，判断X
nearest
和X
new
之间的连线是否发生碰撞，若没有发生碰撞，则将X
new
加入随机树中；
[0009]S4、以步骤S3中的X
new
为圆心，以一定的半径作圆，将随机树上落在圆内的节点作为潜在父节点形成集合Q
near
，然后对从起始节点开始并经过集合Q
near
内潜在父节点到X
new
的路径长度与从起始点开始经过X
nearest
到X
new
的路径长度相比较，最终选择路径长度最小的节点作为X
new
的父节点，然后将新的路径添加进随机树并删除原X
nearest
与X
new
连接路径。
[0010]S5、起始点X
init
和目标点X
goal
同时向对方搜索，在两颗随机树搜索空间X1和X2中，X
r
是起始点随机树T1的一个拓展节点，T2随机树将向随机树T1拓展到X
r
，然后利用路径代价函数进行选择，代价函数如下所示：
[0011][0012]最后通过代价判断得到最优节点Xr，将两颗随机树连接完成路径搜索；
[0013]S6、基于滑动平均平滑算法对S5中生成的路径进行平滑处理，获得适合机械臂运行的实际路径。
[0014]进一步地，所述步骤S1中，机械臂的起始点X
init
以及目标点X
goal
的确定方法是，根据内置信息和机械臂传输过来的相关信息初始化机械臂路径地图信息，包括地图的边界以及障碍物信息，同时利用地图信息技术构建地图模型，并在地图中确定机械臂的起始点X
init
以及目标点X
goal
，采样区域为全地图。
[0015]进一步地，所述步骤S2中的均匀Logistic混沌序列采样器，其中均匀Logistic混沌序列采样器生成的采样点Xrand由下面的公式确定：
[0016]x
i+1
＝μ
xi
(1
‑
x
i
)
ꢀꢀ
(1)
[0017][0018]其中μ(0≤μ≤4)是混沌系统的李雅普诺夫指数，x
i
(0＜x
i
＜1)是混沌变量,根据混沌动力系统的研究，这里取μ取4，当i＝0时，x0取0.630；
[0019]使用式(1)和式(2)相结合生成均匀分布Logistic混沌序列，这样生成随机采样点便具有均匀性的特点。
[0020]进一步地，所述步骤S2中，生成随机点X
rand
时，先判断采样次数是否超过最大采样次数Max，如果超过结束采样，如果没有最大采样次数则采样次数加一，然后获取扩展采样点X
rand
，采样过程为：基于初始化均匀Logistic混沌序列采样器在0
‑
1内进行一次随机数生成，然后计算采样点X
rand
是否在可行空间内，如果采样点X
rand
有效则进行下一步。
[0021]进一步地，所述随机树T1和T2均采用上面步骤S1到步骤S4的过程进行拓展。
[0022]进一步地，所述步骤S6中基于滑动平均平滑算法对步骤S5中生成的路径进行平滑处理，其中基于滑动平均平滑算法由下面的公式确定：
[0023]设置滑动平均平滑算法的控制点为X
j
,j＝0，1，2，
…
，滑动平均平滑算法的基函数表示为y
i
,则滑动平均平滑算法的数学描述函数记为：
[0024][0025]其中N表示当前节点进行平均平滑处理所使用相邻左右节点的个数；当N取3时如下所示：
[0026]y
a
(1)＝y(1)
[0027]y
a
(2)＝(y(1)+y(2)+y(3))/3
[0028]y
a
(3)＝(y(1)+y(2)+y(3)+y(4)+y(5))/5
[0029]y
a
(4)＝(y(1)+y(2)+y(3)+y(4)+y(5)+y(6)+y(7))/7)
[0030]y
a
(5)＝(y(2)+y(3)+y(4)+y(5)+y(6)+y(7)+y(8))/7)；
[0031]将上面得到的平滑路径的数据传输给机械臂，机械臂根据得到的数据运动到目标点抓取目标物，然后再经过路径规划将目标物放置到指定位置。
[0032]本专利技术的有益效果是：本专利技术所提供的一种机械臂避障路径规划方法，步骤本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种机械臂避障路径规划方法，其特征在于，包括以下步骤：S1、获取轨迹规划所需要的参数信息，包括轨迹规划的空间范围X，以及X内的障碍物信息，机械臂的起始点X
init
以及目标点X
goal
；以起始点X
init
以及目标点X
goal
为根节点分别初始化随机树T1和T2，给定扩展步长L，最大迭代次数Max；S2、采用均匀Logistic混沌序列采样器生成随机点X
rand
；S3、找到随机树上和点X
rand
最近的点X
nearest
，然后X
nearest
向X
rand
延伸一定距离L得到下一个拓展点X
new
，判断X
nearest
和X
new
之间的连线是否发生碰撞，若没有发生碰撞，则将X
new
加入随机树中；S4、以步骤S3中的X
new
为圆心，以一定的半径作圆，将随机树上落在圆内的节点作为潜在父节点形成集合Q
near
，然后对从起始节点开始并经过集合Q
near
内潜在父节点到X
new
的路径长度与从起始点开始经过X
nearest
到X
new
的路径长度相比较，最终选择路径长度最小的节点作为X
new
的父节点，然后将新的路径添加进随机树并删除原X
nearest
与X
new
连接路径；S5、起始点X
init
和目标点X
goal
同时向对方搜索，在两颗随机树搜索空间X1和X2中，X
r
是起始点随机树T1的一个拓展节点，T2随机树将向随机树T1拓展到X
r
，然后利用路径代价函数进行选择，代价函数如下所示：最后通过代价判断得到最优节点Xr，将两颗随机树连接完成路径搜索；S6、基于滑动平均平滑算法对S5中生成的路径进行平滑处理，获得适合机械臂运行的实际路径。2.根据权利要求1所述的一种机械臂避障路径规划方法，其特征在于：所述步骤S1中，机械臂的起始点X
init
以及目标点X
goal
的确定方法是，根据内置信息和机械臂传输过来的相关信息初始化机械臂路径地图信息，包括地图的边界以及障碍物信息，同时利用地图信息技术构建地图模型，并在地图中确定机械臂的起始点X
init
以及目标点X
goal

【专利技术属性】
技术研发人员：孟祥印，金腾飞，于新善，罗锦泽，
申请(专利权)人：西南交通大学，
类型：发明
国别省市：