一种融合工艺知识的双向RRT-connect算法实现了工业机器人快速路径规划制造技术

本发明专利技术提出一种融合工艺知识的双向RRT

【技术实现步骤摘要】
一种融合工艺知识的双向RRT
‑
connect算法实现了工业机器人快速路径规划


[0001]本专利技术涉及工艺机器人的运动规划领域，尤其涉及一种融合工艺知识的双向RRT
‑
connect算法实现了工业机器人快速路径规划。

技术介绍

[0002]工业机器人广泛应用于工业生产、军事等各个领域，在这个领域里，路径规划发挥着重大的作用。目前常见的路径规划算法主要有三种：以A*算法为主的在地图上直接进行搜索的直接搜索算法；以蚁群算法，遗传算法为主的启发式算法；以RRT、PRM为主的基于采样策略的算法等。前两种策略虽然可以找到全局最优解，但是不能满足复杂环境和高维空间的路径规划要求，1988年，La Valle提出快速扩展随机树算法(rapidly exploring random tree,RRT)，此种方法适用于高维空间下的机器人运动规划问题，具有概率完整性，快速的探索速度，但RRT算法的搜索具有盲目性，收敛速度慢，随机采样生成的路径会产生许多不必要节点，从而导致路径不平滑且不连续。此外，由于工艺约束导致现有的路径搜索算法的求解结果难以直接应用于实际制造生产中。随着2035年制造业将普及数字化，因此，提出一种融合工艺知识的基于改进快速扩展树(RRT)算法的工业机器人运动规划方法。

技术实现思路

[0003]本专利技术的目的在于提出一种融合工艺知识的改进RRT
‑
connect算法的工业机器人运动规划方法。该方法适用于各种工业现场，同时，针对现有技术的不足，从质量和效率两个方向对RRT进行了改进，改进后的算法在规划时间以及各种路径代价上都优于传统RRT算法，同时提高了机械臂的平稳性。
[0004]为达到上述目的，本专利技术提出一种融合工艺知识的双向RRT
‑
connect算法实现了工业机器人快速路径规划，包括以下步骤：
[0005]S101：基于工艺知识，确定机械臂初始位姿与目标姿态可行解集、障碍物信息以及工业机械臂的参数信息；
[0006]S102：基于动态碰撞检测算法对机械臂始末点位姿集合内两两姿态进行碰撞检测，若存在无冲突的轨迹则选取时间最短的姿态作为最终的始末姿态，若不存在无冲突的轨迹则转到S103；
[0007]S103：首先以传统RRT
‑
connect算法作为基础，设置搜索步长作为每一步扩展的根据，设置终止阈值作为起点和终点两棵随机树的最终连接范围；然后基于专家机制快速筛选出搜索空间中的新节点；
[0008]S104：工业机器人按照上述策略分别从初始位置和终点位置出发，生成两棵随机树，之后依据终止阈值判断这两棵随机树是否处于可直接连接的范围，若低于终止阈值，停止搜索，将其连接，否则机械臂仍按照上述策略继续执行，直至低于终止阈值；
[0009]S105：按照次序从初始位置开始输出各路径点的位置和姿态作为一条无碰路径。
[0010]进一步的，所述S101是基于机器人末端所搭载的不同工具对不同类型的工艺规范，确定不同工业特征的最佳角度(特征量在Z轴的矢量)和第二矢量(特征量在Y轴的矢量)；对于规划的起始位置，分别基于逆运动学和碰撞检测算法求解无碰的可行位姿W和相应的旋转矩阵T；
[0011]为了保证传感器能够采集相应数据，计算T的第3列与工艺特征第二矢量(Y轴)之间的夹角θ，若θ在满足的工艺角度范围内，则保存此姿态，若不满足，舍弃此姿态；最终确定满足特定工艺要求的起始位姿的集合start、goal。
[0012]进一步的，在所述S102中，将满足工艺要求的机械臂始末位姿集合，进行两两组合，进一步通过五次多项式拟合得到机器人运动轨迹并离散成多组构型，最终基于碰撞检测算法确定两姿态间是否发生冲突；若存在无冲突的轨迹则选取时间最短的始末姿态作为无冲突的轨迹姿态，反之，则转到S103。
[0013]进一步的，在所述S103中，直接在笛卡尔坐标系下对采样点(x,y,z,i,j,k)进行搜索；为了降低搜索空间的搜索量，将采样点分解为两个搜索空间—坐标空间(x,y,z)和姿态空间(i,j,k)；并采用随机采样的方式对坐标空间值进行搜索；为了保障采样点的有效性，将随机采样和专家机制采样相融合，实现对于姿态空间的选取；专家机制的采样值可设置为：(1,0,0),(
‑
1，0，0)，(0，1，0)，(0，
‑
1，0),(0，0，1)，(0，0，
‑
1)，((i1+i2)/2,(j1+j2)/2,(k1+k2)/2)，)/2)，并根据概率选取相应的采样点。
[0014]进一步的，在所述S104中，将确定的start和goal位姿作为RRT
‑
connect算法运动规划的起始姿态，最后，利用双向RRT进行规划，包括以下步骤：
[0015]步骤1：在初始化的基础上，分别从起始点向目标点构建扩展树tree1，从目标点向起始点构建扩展树tree2；
[0016]步骤2：在搜索空间上选择点q
rand1
和q
rand2
，如果q
rand1
和q
rand2
落在无障碍区间，那么遍历tree1和tree2找到离随机点最近的节点q
nearest1
和q
nearest2
；
[0017]步骤3：判断q
rand1
和q
nearest1
，q
rand2
与q
nearest2
连线上是否会发生碰撞:；如果连线之间不会发生碰撞，那么，判断q
rand1
和q
nearest1
，q
rand2
与q
nearest2
之间的距离是否小于扩展步长，如果q
nearest
和q
rand
之间的欧式距离小于扩展步长，则将随机点q
rand
添加到扩展树上；反之，在最近节点和随机节点的方向上取扩展步长长度的点q
new
添加到扩展树上，之后将q
rand
添加到扩展树上；如果q
rand1
和q
nearest1
，q
rand2
与q
nearest2
连线上发生碰撞，则执行步骤2；同时，为了获取低成本的初始路径，计算路径与其成本C：
[0018]C＝q
nearest1
·
cost+q
nearest2
·
cost+Cost(q
rand1
，q
nearest1
)+Cost(q
rand1
，q
nearest2
)
[0019]当C>Cmax时，q
rand
被拒绝，重新进行采样，执行本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种融合工艺知识的双向RRT
‑
connect算法实现了工业机器人快速路径规划，其特征在于，包括以下步骤：S101：基于工艺知识，确定机械臂初始位姿与目标姿态可行解集、障碍物信息以及工业机械臂的参数信息；S102：基于动态碰撞检测算法对机械臂始末点位姿集合内两两姿态进行碰撞检测，若存在无冲突的轨迹则选取时间最短的姿态作为最终的始末姿态，若不存在无冲突的轨迹则转到S103；S103：首先以传统RRT
‑
connect算法作为基础，设置搜索步长作为每一步扩展的根据，设置终止阈值作为起点和终点两棵随机树的最终连接范围；然后基于专家机制快速筛选出搜索空间中的新节点；S104：工业机器人按照上述策略分别从初始位置和终点位置出发，生成两棵随机树，之后依据终止阈值判断这两棵随机树是否处于可直接连接的范围，若低于终止阈值，停止搜索，将其连接，否则机械臂仍按照上述策略继续执行，直至低于终止阈值；S105：按照次序从初始位置开始输出各路径点的位置和姿态作为一条无碰路径。2.根据权利要求1所述的融合工艺知识的双向RRT
‑
connect算法实现了工业机器人快速路径规划，其特征在于，所述S101是基于机器人末端所搭载的不同工具对不同类型的工艺规范，确定不同工业特征的最佳角度(特征量在Z轴的矢量)和第二矢量(特征量在Y轴的矢量)；对于规划的起始位置，分别基于逆运动学和碰撞检测算法求解无碰的可行位姿W和相应的旋转矩阵T；为了保证传感器能够采集相应数据，计算T的第3列与工艺特征第二矢量(Y轴)之间的夹角θ，若θ在满足的工艺角度范围内，则保存此姿态，若不满足，舍弃此姿态；最终确定满足特定工艺要求的起始位姿的集合start、goal。3.根据权利要求2所述的融合工艺知识的双向RRT
‑
connect算法实现了工业机器人快速路径规划，其特征在于，在所述S102中，将满足工艺要求的机械臂始末位姿集合，进行两两组合，进一步通过五次多项式拟合得到机器人运动轨迹并离散成多组构型，最终基于碰撞检测算法确定两姿态间是否发生冲突；若存在无冲突的轨迹则选取时间最短的始末姿态作为无冲突的轨迹姿态，反之，则转到S103。4.根据权利要求3所述的融合工艺知识的双向RRT
‑
connect算法实现了工业机器人快速路径规划，其特征在于，在所述S103中，直接在笛卡尔坐标系下对采样点(x,y,z,i,j,k)进行搜索；为了降低搜索空间的搜索量，将采样点分解为两个搜索空间—坐标空间(x,y,z)和姿态空间(i,j,k)；并采用随机采样的方式对坐标空间值进行搜索；为了保障采样点的有效性，将随机采样和专家机制采样相融合，实现对于姿态空间的选取；专家机制的采样值可设置为：(1,0,0),(
‑
1，0，0)，(0，1，0)，(0，
‑
1，0),(0，0，1)，(0，0，
‑
1)，((i1+i2)/2,(j1+j2)/2,(k1+k2)/2)，)/2)，并根据概率选取相应的采样点。5.根据权利要求4所述的融合工艺知识的双向RRT
‑
connect算法实现了工业机器人快速路径规划...

【专利技术属性】
技术研发人员：刘银华，杨玉芳，赵文政，李晓甜，许郭樑，王雪琪，
申请(专利权)人：上汽通用汽车有限公司，
类型：发明
国别省市：