基于改进免疫算法的装填机械手轨迹规划.pdf

52/2023 年第 17 期王国涛，高崇仁，黄江涛，等.基于改进免疫算法的装填机械手轨迹规划 J.起重运输机械，2023（17）：52-57.引 用 格 式基于改进免疫算法的装填机械手轨迹规划王国涛 高崇仁 黄江涛 田星宇太原科技大学机械工程学院 太原 030024摘 要：针对于自主设计的自动装填机械手速度和加速度会出现突变，这样会对机械手各关节造成很大的冲击；而且该机械手运行时间也没有达到最优，这样会使得整个自动装填系统工作时间较长。免疫算法是基于免疫系统运行机理衍生出来的智能算法，接下来对免疫算法进行改进，并对比改进前后的免疫算法性能，最后基于改进后的免疫算法结合七次多项式插值计算方法对装填机械手的运行轨迹进行规划。对该机械手轨迹规划的过程中，通过 Matlab 进行仿真实验并得到仿真结果。仿真实验结果表明，改进后的免疫算法向着最优粒子靠近的速度更快，效率更高，且各关节的速度、加速度随时间变化曲线平滑，完成轨迹的时间明显变少了。关键词：装填机械手；轨迹规划；七次多项式；改进免疫算法；Matlab 仿真实验中图分类号：TP 241.2 文献标识码：A 文章编号：1001-0785（2023）17-0052-06Abstract:Considering that the sudden change of the speed and acceleration of the self-designed automatic loading manipulator will have a great impact on all joints of the manipulator;Moreover,the running time of the manipulator has not been optimized,which leads to a long working time of the whole automatic loading system.Immune algorithm is an intelligent algorithm based on the operating mechanism of immune system.The immune algorithm was modified,and the performance of the immune algorithm before and after the modification was compared.Finally,the trajectory of the loading manipulator was planned based on the modified immune algorithm and the septic polynomial interpolation calculation method.In the process of trajectory planning of the manipulator,the simulation experiment was carried out by Matlab and the simulation results were obtained.The simulation results show that the improved immune algorithm is faster and more efficient to approach the optimal particle,and the curves of velocity and acceleration of each joint with time are smooth,and the time to complete the trajectory is obviously reduced.Keywords:loading manipulator;trajectory planning;septic polynomial;modified immune algorithm;Matlab simulation experiment0 引言机械手轨迹规划的意义在于确定机械手的运动路径，使其能够完成预定的任务，通过高效、连续且准确的轨迹规划，可使得运行时间达到最优，运行指标更加合理，还可保证机械手的安全性，避免与人员或其他设备发生碰撞，防止事故发生，故对于机械手的研究来说轨迹规划是至关重要的一部分1。随着对机械手轨迹规划研究的逐渐深入，出现了更多高效的优化方法。李骏等2研究自主设计的油茶花粉采摘机械臂，提出一种改进粒子群算法，并结合5-5-5多项式插值计算方法对该机械臂进行轨迹规划，验证了改进后算法的适用性和高效性；段倩倩等3提出一种改进混合粒子群算法对某六自由度机械手轨迹规划问题进行研究，使用 5-7-5 插值多项式构造轨迹曲线，改进后的算法运行时间短，稳定性更强；代瑞恒等4采用七次多项式插值对机器人关节轨迹进行优化，提出一种改进量子遗传算法，引入正态分布概率密度函数以改进量子门旋转角步长策略，对关节运行轨迹进行最短时间优化，有效缩短了机械臂关节运动时间；綦慧等5提出一种改进鲸鱼算法，并采用五次样条函数拟合关节轨迹，验证了改进鲸鱼算法对解决机械臂轨迹规划多目标ANALYSIS RESEARCH分析研究532023 年第 17 期/优化问题的有效性；李纯艳等6提出一种改进麻雀搜索算法用于解决机器人能耗最优轨迹规划问题，采用七次B 样曲线构造机器人在关节空间的轨迹，并通过仿真验证改进后算法的优越性和实用性。在轨迹规划过程中不仅要保证位移连续，还要实现速度和加速度的连续，防止出现由于运动突变而对机械手造成损害。针对该装填机械手的轨迹规划是为了使得该机械手在约束条件下以运行时间为优化目标，并使得各关节的速度、加速度随时间变化的曲线平滑且没有突变。文中提出基于免疫算法结合七次多项式插值计算方法对自主设计的装填机械手进行轨迹规划，使得该装填机械手运行时间达到最优，各关节速度、加速度曲线平滑且连续。1 装填机械手介绍使用五自由度装填机械手去完成目标工作任务。该机械手的样机模型如图 1 所示，关节最大速度不超过 2/3 rad/s，关节最大加速度不超过/2 rad/s2。图 1 装填机械手样机模型针对于该机械手有 5 个自由度，分别是关节 1 和关节 5 的回转以及关节 2、关节 3、关节 4 的旋转。对于该机械手来说，末端执行器的抓、放动作和推进动作不会对该装填机械手末端执行器的位姿产生影响，故末端执行器的抓、放和推进不属于该机械手的自由度。该装填机械手的各关节变量范围如表 1 所示。本文对装填机械手的轨迹规划是对该机械手末端执行器在运行过程中的轨迹规划，不需要考虑末端执行器的抓、放以及推进。为了保证该装填机械手运行的平稳性，即机械手各关节位移连续，各关节速度和加速度平滑且没有突变，需要运用合适的方法对其速度和加速度进行规划；为了实现该装填机械手运行时间达到最优，需要以运行时间为优化目标结合智能算法来实现。表 1 各关节变量范围 （）对装填机械手进行轨迹规划必须要知道装填机械手的抓取位置和最终位置这 2 个关键位置。该装填机械手关键位置如图 2 所示。（a）抓取位置（b）最终位置图 2 关键位置示意图2 基本方法选择根据轨迹规划所处空间的差异性，可把机械手轨迹规划的方法划分为关节空间轨迹规划和笛卡儿空间轨迹规划。对于该装填机械手而言，由于自由度相对较多，如果在笛卡儿空间进行轨迹规划，运算量会很大，可能导关节编号变量范围关节 1-180 0关节 2-180 -90关节 3-85 85关节 4-150 60关节 5-180 -18ANALYSIS RESEARCH分析研究54/2023 年第 17 期致控制间隔较长，也会使得控制过程复杂程度高。而在关节空间轨迹规划计算简单且不会发生机构的奇异性，故对于该机械手的轨迹规划选择在关节空间内进行。考虑该装填机械手运行要求，在轨迹规划过程中需考虑减小各关节的冲击。为减小各关节的冲击，需保证该装填机械手运行过程中速度、加速度不产生突变，故选择七次多项式插值计算方法在关节空间对该机械手进行轨迹规划。对于七次多项式插值来说，基本是在轨迹规划过程中用到的最高项插值计算方法，因为随着次数的增高，所得到的插值结果也会出现与原函数偏离的现象。在使用七次多项式插值对该装填机械手进行轨迹规划时得到其位移表达式为 23456701234567taata ta ta ta ta ta t （1）多项式系数满足 8 个约束条件000102234101 12 13 14 15675 16 17 1234201 22 23 24 25675 26 27 2234f01 f2 f3 f4 f5675 f6 f7 f2f12 f3 f2 234aaaaata ta ta ta ta ta taata ta ta ta ta ta taata ta ta ta ta ta taa ta ta34 f4565 f6 f7 f2f23 f4 f3455 f6 f7 f 5672612 203042ta ta ta taa ta ta ta ta t （2）式中：0为取弹、取药位置的关节角，f为最终位置的关节角，0 为取弹、取药位置的角速度，f 为最终位置的角速度，0 为取弹、取药位置的角加速度，f 为最终位置的角加速度。转换为矩阵形式从而得到=Ma，计算出 M-1即可求得各关节的位置，也就求出了末端执行器的运动轨迹方程。3 改进免疫算法3.1 免疫算法为了实现该装填机械手运行时间达到最优，需要以运行时间为优化目标结合智能算法来实现，文中基于免疫算法对该装填机械手的轨迹进行规划，使其运行时间达到最优。免疫算法启发于生物免疫学，其主要是通过对抗有害物质进化出相应的免疫系统，模仿了生物免疫系统中的免疫生成行为，即模拟了生物免疫系统抗原识别、选择、突变、克隆等的行为，以合理提取疫苗为核心，该算法具有较强的全局搜索能力、多样性、强鲁棒性等特点，但是免疫算法也存在一些缺陷。在实际运用中，免疫算法变异方向通常具有随机性，会在个体染色体上随机选择位置并将该位置的基因值进行随机改变，可能会导致迭代速度比较慢，另外对于免疫算法相似度阈值通常设置为定值，相似度阈值的设置对该算法的性能有很大影响，如果相似度阈值设置得太小，会导致抗体群体过于分散，搜索效率低下；如果相似度阈值设置得太大，会导致抗体群体过于集中，可能会出现“早熟”的问题。免疫算法的流程：1）抗原识别 即了解该装填机械手的运行轨迹，分析轨迹的可行性，提取先验知识，构造亲和度函数，制定约束条件。2）产生初始群体 通过代码把轨迹的可行解表示为求解空间的抗体，在该空间内随机产生一个初始群体。3）计算种群中每一个可行解的亲和度。4）判断是否满足终止条件 如果满足终止条件，则可以终止算法并输出结果；否则，需要继续进行运算直到满足终止条件为止。终止条件通常包括达到最大迭代次数、目标函数值不再变化或接近某个预定阈值等。5）计算抗体浓度和激励度。6）进行免疫处理 包括免疫选择（筛选高质量的抗体并使其活化）、克隆（复制活化抗体）、变异（对克隆后的副本进行变异操作，使其发生亲和度突变）和克隆抑制（对变异结果进行选择，保留亲和度高的抗体）。ANALYSIS RESEARCH分析研究552023 年第 17 期/7）种群刷新 用随机生成的新抗体代替激励度较低的抗体，形成新群体，继续计算每一个可行解的亲和度，并不断循环该操作，直至满足终止条件输出结果。基于免疫算法在关节空间内对该装填机械手进行轨迹规划的过程中，抗原识别的过程即是对该装填机械手运行轨迹的了解过程，抗体生成的过程即是对该装填机械手运行寻求最优解的过程。免疫算法流程图如图 3 所示。图 3 免疫算法流程图3.2 免疫算法的改进针对免疫算法变异方向的随机性以及相似度阈值为定值这2点所引起的算法性能较低，本文做出了如下改进。1）改进 1 基于变异方向的改进，改进前免疫方向随机，改进过后使得变异朝着最优粒子方向变异，增大了优质粒子的生成概率，提升了前期迭代速度。改进前的公式为 0.5CdCdranddead （3）改进后的公式为 0.55randCdCdranddead （4）式中：rand 为 0，1 中的随机数。通过对比改进前后，粒子向着最优粒子方向靠近的速度，对比如图 4 所示，可以明显看出改进后的粒子向着最优粒子靠近的速度更快。图 4 改进变异方向前后对比2）改进 2 基于相似度阈值的改进，改进前相似度阈值为定值，改进后变为随迭代次数而改变。改进后的相似度阈值随着迭代次数的增加而减小，前期可以保证粒子种类的多样性，避免“早熟”，后期可以保证寻找收敛的快速性，提高寻优能力。改进后的公式为 exp1002gendeadsdeads （5）式中：exp表示e的次方，如exp（a）表示e的a次方。改进后的相似度阈值变化曲线如图 5 所示。可以看出在迭代初期采用了较大阈值，这样会增加粒子的多样性，而随着迭代次数的增加，相似度阈值变小，这样就会增加寻找最优粒子的速度。改进后的免疫算法将实现对该装填机械手运行时间最优的。图 5 改进后相似度阈值变化曲线ANALYSIS RESEARCH分析研究56/2023 年第 17 期4 仿真结果及分析轨迹规划是在对该装填机械手运动学分析的基础上完成的，本章轨迹规划是对该装填机械手从取弹、取药位置到最终位置过程中末端执行器的运动轨迹进行规划，根据该装填机械手的工作流程安排，明确该装填机械手末端执行器在取弹、取药位置和最终位置时的位姿。由于该装填关节 2 仰起是一个单一的过程，所以在对该自动装填机械手的轨迹规划初位置是该机械手关节2 仰起以后的位置，关节 2 先仰起是为了防止在机械手运行过程与药筒产生干涉或碰撞。轨迹规划初位置各关节角度为：关节 1：1=0；关节 2：2=-144.7；关节 3：3=-51.58；关节 4：4=43.2；关节 5：5=0。轨迹规划最终位置各关节角度：关节 1：1=-180；关 节 2：2=-144.7；关 节 3：3=41.4；关 节 4：4=-133；关节 5：5=180。用改进前与改进后的免疫算法分别对该自动装填机械手进行时间最优轨迹规划，通过仿真实验得到对比图如图 6 所示。图 6 算法改进前后对比图可以看出改进后的免疫算法要优于改进前的免疫算法，改进后的算法向着最优粒子靠近的速度更快，效率更高，性能更好。基于改进后的免疫算法结合七次多项式插值计算方法对该自动装填机械手进行轨迹规划，通过仿真实验得到该机械手各关节位移、速度、加速度随时间变化的曲线如图 7 所示。由所得的曲线可以看出该装填机械手的位移连续且满足该机械手的运行要求，该机械手各关节速度及加速度均不超过关节最大允许量。（a）位移随时间变化的曲线（b）速度随时间变化的曲线（c）加速度随时间变化的曲线图 7 优化后关节运动轨迹ANALYSIS RESEARCH分析研究572023 年第 17 期/该装填机械手在运动学约束满足的前提下，基于改进过后的免疫算法结合七次多项式插值计算方法对该机械手的运行轨迹进行规划，完成规划过程所用的时间从5.51 s 减少到 3.703 s，使该机械手在整个工作过程中时间缩短。缩短了该装填机械手的运行时间，提高了该装填机械手的工作效率，验证了基于改进免疫算法的时间最优装填机械手轨迹规划方法的可行性与高效性。最后得到该装填机械手在三维空间内的末端执行器的运动轨迹如图 8 所示。图 8 装填机械手运动轨迹5 结论针对自主设计的自动装填机械手轨迹规划问题，以运行时间为优化目标提出一种改进的免疫算法，并基于改免疫算法结合七次多项式插值计算方法对该自动装填机械手进行轨迹规划，结合 Matlab 仿真实验得到以下结论。针对免疫算法方向变异的随机性和相似度阈值为定值引起的弊端，文中做出 2 点改进。基于变异方向的改进使变异朝着最优粒子方向变异和基于相似度阈值改进使其随着迭代次数的增加而减小，使该算法向着最优粒子靠近的速度更快，效率更高，提高了算法的性能；以自主设计的自动装填机械手关节动作最优时间为优化目标，仿真结果显示优化前后时间缩短了 32.79%，提高了机械手的运行效率，验证了算法的有效性。参考文献1 蔡自兴机器人学基础(第二版)M北京：机械工业 出版社，20152 李骏，赵青，李立君，等基于改进粒子群算法的油茶花 粉采摘机械臂轨迹规划 J机械传动，2023，47(2)：86-923 段倩倩，辛绍杰基于改进混合粒子群算法的机器人轨迹 规划 J机床与液压，2022，50(17)：50-564 代瑞恒，杨先海，孙阳，等基于改进量子遗传算法的机 器人关节轨迹优化 J机床与液压，2022，50(5)：6-105 綦慧，胡天莹基于改进鲸鱼算法的机械臂轨迹优化 J工业控制计算机，2022，35(1)：91-946 李纯艳，晁永生，陈帅，等基于改进麻雀搜索算法的机 器人能耗最优轨迹规划 J组合机床与自动化加工技术，2022，580(6)：180-182，187作 者：王国涛电子邮箱：收稿日期：2023-04-14本刊邮发代号：国内 2-323，国外 M365ANALYSIS RESEARCH分析研究