一种基于群体智能算法的工业机器人作业点序列及轨迹规划方法，它主要解决现有技术中对工业机器人作业点序列及轨迹规划方法存在自动化程度不高和科学合理性不足的问题。本发明专利技术的离散序列相似度指标（SD）用来表征序列规划中个体之间的差异（距离）；构造了一种碰撞评价指标（O），用来避免工业机器人与障碍物及机器人关节杆之间发生碰撞；对于约束条件，采用罚函数处理，引入约束惩罚项C，使工业机器人的动力学特性满足裕度要求。本发明专利技术基于上述评价指标和改进的群体智能算法，获取工业机器人的最优作业点序列及相应的最优轨迹，可以有效的提高工业机器人的执行效率和运行性能，降低成本，符合实际生产的需要。
【技术实现步骤摘要】
本专利技术涉及调度及轨迹规划领域，更具体地，涉及一种基于群体智能算法的工业 机器人作业点序列及轨迹规划方法。
技术介绍
工业机器人在工作中往往要经过若干个作业点，工业机器人从当前作业点对工件 进行操作后再移动到下一个作业点继续工作，直到完成所有作业点的工作。机器人作业点 序列是指工业机器人在工作中经过各个作业点并在作业点对工件进行操作的先后顺序。机 器人作业点序列的选择直接影响到机器人工作过程中所用时间、机器人所走轨迹和消耗的 能量等。机器人作业点序列规划问题在数学上是一个NP-hard组合优化问题，一般而言，随 着工件中作业点数量的增加，机器人作业点序列方案的求解空间也会迅速复杂起来。由于 工件的表面一般比较复杂，需要对工件进行操作的作业点数量较大，目前大多数由人工确 定机器人对工件各个作业点进行操作的顺序，耗时较长且缺乏科学合理性。而机器人从作 业点到达另一个作业点的轨迹规划是机器人执行效率和运行性能的的基础。机器人轨迹规 划对机器人高效、稳定的运行有重要影响，通过轨迹规划是机器人运动平滑、稳定，减少冲 击和振动，对提高机器人的稳定性、可靠性、工作效率有重要意义。在轨迹规划中要充分考 虑机器人及其周围环境，根据作业任务的要求，规划出一条无碰撞、动力学特性满足裕度要 求、轨迹长度和运动时间较短、能耗较少的理想轨迹。由于轨迹规划考虑的因素众多且比较 复杂，难以由人工得到比较合理的轨迹。 综上所述，为了提高机器人的工作效率，寻找一条遍历所有作业点并且运行时间 最短、运行轨迹最短、运行轨迹光滑且机器人能耗最小的机器人作业点序列及轨迹十分必 要。【
技术实现思路
】 为了解决上述问题，本专利技术旨在公开一种基于群体智能算法的工业机器人作业点 序列及轨迹规划方法，尤指一种基于群体智能算法并对算法做出改进的一种能够遍历所有 作业点并且运行时间最短、作业点间运行轨迹最短、运行轨迹光滑且机器人能耗最小的工 业机器人作业点序列及轨迹规划方法。 为实现上述目的，本专利技术所采用的技术方案主要包括以下步骤： 步骤1、基于群体智能算法，若群体智能算法只适用于连续问题，则需将算法通过 以下步骤应用于离散问题：重新定义个体的位置和两个个体之间的距离，以及重新定义个 体的移动规则。 定义1)个体的位置：每个个体的位置对应一条作业点序列，第i个个体的位置表 示为&=T，表示机器人的工作过程是按照作业点Pi, P2，…，？"的 顺序进行的，其中n为个体i的维数或作业点总数，Xu为个体i的第j维元素或第j个作 业点pj; 定义2)个体i，j之间的距离rij按以下式取得： =n-SD (1) 式中SD为序列相似度指标，按以下规则取值：逐个将个体Xi(i = 1，2,…，M)的第 1至n维元素Xiik(k = 1，2,…，n)分别与个体Xj(j = 1，2,…，M且j乒i)的第1至n维元 素Xu(l = l，2，...，n)比较，如果UPXu相等，而且满足X j，"（或XLl+1)和Xlik+1相等， 则相似度SD加1，直到遍历完个体i的所有维元素，得到个体i对应的序列Xi与个体j对 应的序列\的总相似度SD ;其中M为种群容量。 定义3)个体i向更优的个体j移动规则：综合考虑个体i和j分别在位置&和 Xj的适应度函数值Fd匕及个体i与个体j之间的距离r ^，若个体j的适应度函数值匕优 于个体i的适应度函数值Fi，则个体与个体X j的距离r ^减小的方向移动；否则个体 &保持不动；若适应度函数值？1= F j，则对个体&的任意两维元素进行互换。 步骤2、建立适应度函数，适应度函数F由工业机器人在当前作业点序列规划的轨 迹下的最短运行时间T_、作业点间最短轨迹长度L_、最小轨迹光滑度5_和机器人的最小 能耗￡_四部分加权构成，建立其数学模型如下： F = Wi ? T_+w2 ? L_+w3 ? S_+w4 ? E_ (2) 式中￥1、'\￥2、'\￥3、'\￥ 4分别为1'_、1^、3_、￡_四个评价指标的权值；进行工业机器人 轨迹规划求解上述评价指标，具体步骤包括： 1)工业机器人从当前作业点运动到下一个作业点经过m个中间点，采用四次-四 次-…四次-五次样条插值函数生成样条插值曲线并连接机器人运动过程中经过的中间 点，四次-四次-…四次-五次样条插值函数为： 其中，j为第j个关节（j = 1，2,…，J)，J为关节总数，为各关节在第i个中间点 和第i+1中间点之间的轨迹的运行时间，&+1(/)，& +1(如分别是关节j 在第i个中间点和第i+1中间点之间t时刻的位移、速度、加速度和二次加速度。 分别为关节j在第i个中间点的位移、速度和加速度；i = 〇或m+1分别表示起始点和终止 点。 2)对于一个经过m个中间节点并具有J个自由度的工业机器人，算法的优化对象 为： 3)工业机器人从当前作业点运动到下一个作业点的过程中，一般期望机器人运动 时间最短、轨迹最短、轨迹最平滑、能耗最小。定义如下的优化目标： (1)T为工业机器人沿轨迹0 (t)运动的时间； (2)L为工业机器人运动轨迹0 (t)在笛卡尔空间中的长度。已知工业机器人的运 动轨迹0 (t)则依据机器人正运动学方程可求得其末端的空间位姿： 式中rd(或Rd)和sd(或Sd)分别为设定的障碍回避阈值和安全距离，rd彡sd， Rd多Sd。其中障碍物被包络在以sd为半径的球内。复杂形状的障碍物可由一系列球近似 的组合包络而成。d_为工业机器人沿轨迹0 (t)运动时障碍物中心到工业机器人关节杆 的最小距离；D_为工业机器人沿轨迹0 (t)运动时工业机器人关节杆到其余关节杆的最 小距离。 (6)对于约束条件，采用罚函数处理，C为约束惩罚项。 C = Ci+C^^+Q+Cg, (11) 其中 式中A應、今max、易麵、辱岫和丁_分别是关节j的位移、速度、加速度、二次 加速度和力矩的约束，j = 1，2,…，J，i = 1，2,…，m。 工业机器人从当前作业点运动到下一个作业点的轨迹规划中建立适应度函数，适 应度函数f?由运行时间T、轨迹长度L、轨迹光滑度S、机器人消耗的能量E、发生碰撞的评价 值0和约束惩罚项C六部分加权构成，建立其数学模型如下： f = r: ? T+r2 ? L+r3 ? S+r4 ? E+r5 ? 0+r6 ? C (12) 式中n、r2、r3、r4、r 5、1~6分别为T、L、S、E、0、C三个评价指标的权值； 4)采用适用于连续问题的群体智能算法求解上述工业机器人轨迹规划的数学模 型式（12)，得到工业机器人从当前作业点Pi运动到下一个作业点P 1+1的过程的机器人最短 运动时间^，最短轨迹长度1^，最小轨迹平滑度Si，最小能耗Ei及相应的最优轨迹0 (t); 5)工业机器人在任务空间内按照当前作业点序列从初始位姿运动到各个作业点， 完成作业后返回初始位姿的整个过程中计算工业机器人最短运行时间^^，作业点间最短 轨迹长度L_，最小轨迹平滑度S_，机器人最小能耗E_。 步骤3、进行工业机器人作业点序列及轨迹规划，参考图1，具体步骤包括： 1)适用于离散问题的群体智能算法参数初始化：设定群体智能算法的基本参数 以本文档来自技高网...
【技术保护点】
一种基于群体智能算法的工业机器人作业点序列及轨迹规划方法，其特征在于：具体包括以下步骤：步骤1、适用于离散问题的群体智能算法参数初始化：设定群体智能算法的基本参数以及种群容量M，个体维数即作业点总数n，最大迭代次数；步骤2、随机初始化个体的位置，即生成M个n维作业点序列，并且每个序列的n维元素互不相同；步骤3、更新个体的适应度函数值F：首先采用适用于连续问题的群体智能算法对工业机器人轨迹规划的数学模型进行优化，得到工业机器人从作业点Pi运动到下一个作业点Pi+1的过程的机器人最短运动时间Ti，最短轨迹长度Li，最小轨迹平滑度Si，最小能耗Ei及相应的最优轨迹θ(t)，i＝0,1,2,…,n；然后计算工业机器人在任务空间内按照当前作业点序列从初始位姿运动到各个作业点，完成作业后返回初始位姿的整个过程的机器人最短运行时间最短轨迹长度最小轨迹平滑度最小能耗计算个体的适应度函数值F；步骤4、个体的位置移动；步骤5、更新个体的适应度函数值F；步骤6、当达到最大迭代次数则转7)；否则，迭代次数增加1，转4)；步骤7、输出最优个体的位置即最优作业点序列及其相应的工业机器人最短运行时间Tmin，最短轨迹长度Lmin，最小轨迹平滑度Smin，最小能耗Emin及相应的最优轨迹θ(t)。...
【技术特征摘要】
【专利技术属性】
技术研发人员：李明富，李俊渊，罗龙健，
申请(专利权)人：湘潭大学，
类型：发明
国别省市：湖南;43
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。