一种6自由度机械臂逆运动学求解方法技术

本发明专利技术公开了一种6自由度机械臂逆运动学求解方法，涉及工业机器人领域，本方法首先利用蒙特卡洛方法，为机械臂关节空间赋予一定数量的随机样本，通过计算每个样本对应的机械臂末端位置，选取其中满足目标位置条件的样本作为遗传算法初始种群的一部分；遗传算法初始种群的另外部分由随机个体组成，再通过遗传算法求解机械臂的运动学逆解。本发明专利技术一方面通过蒙特卡洛方法优化遗传算法的初始种群，有效提高遗传算法的搜索速度与搜索成功率；另一方面通过随机个体的加入保证了遗传种群的多样性，提高了遗传算法的全局搜索能力。

【技术实现步骤摘要】
一种6自由度机械臂逆运动学求解方法
本专利技术涉及工业机器人领域，尤其涉及一种基于蒙特卡洛方法与遗传算法相结合的混合求解多自由度机械臂逆运动学求解方法。
技术介绍
机械臂的逆运动学求解是工业机器人应用的基础，是机械臂控制的先决条件，直接关系到机器人离线编程、轨迹规划、实时控制等任务。运动学逆解在机器人学中占有重要地位，只有将空间位姿转换为关节变量，才能实现对机器人末端执行器按空间位姿进行编程控制。串联机械臂的运动学逆解较为困难，各国学者进行了大量的探索和研究。运动学逆解的求解方法主要分为解析法、数值法、几何法等。如解析方法简单直观，运算速度快，但是只有满足特定几何条件的机械臂结构才能使用解析法求解：即后3个关节轴相交于一点或有3个关节轴相互平行。通过学者Doty的分析，24类6自由度正交机械臂结构，只有5类有解析解，其余结构是否有解析解尚不能确定。雅可比矩阵求解关节变量的迭代算法是数值法的基本思想，多种非线性优化方法被应用于逆解的数值方法，但是普遍存在运算量大，收敛速度慢的特点。近年来，有学者采用解析与数值计算相结合的方法，在一定程度上提高了计算速度。上述方法涉及矩阵的逆运算和反三角函数的运算，计算量及限制条件等方面存在不足。运动学逆解的另外一类流派是采用智能算法进行求解，如遗传算法、粒子群算法、神经网络等。智能算法求解运动学逆解，限制条件少、适用范围广，但是存在收敛慢，陷于局部极小致使结果的精度无法保证等缺陷。此类方法通过一组随机的初始关节角度作为初始种群，通过不断迭代更新，使得每次迭代的结果逐渐向真实解收敛。但是相关算法对初始种群的选择依赖较高，初始种群的好坏直接影响到计算结果。D-H矩阵(D-H方法)是Denavit和Hartenberg两位学者在1955年提出一种通用的位姿计算方法。这种方法在机器人的每个连杆上都固定一个坐标系，然后用4×4的齐次变换矩阵来描述相邻两连杆的空间关系。通过依次变换可最终推导出末端执行器相对于基坐标系的位姿，从而建立机器人的运动学方程。对于6自由度机械臂而言，D-H矩阵可标识为如下形式，其中Ai为第i个连杆的变换矩阵，R为3*3的旋转矩阵，P为1*3的位置矩阵，I通常为1，6自由度机械臂的变换矩阵T6为：
技术实现思路
本专利技术的目的在于提供一种6自由度机械臂逆运动学求解方法，从而解决了现有运动学逆解求解速度慢、精度不高的缺点。为实现上述目的，本专利技术提供了一种6自由度机械臂逆运动学求解方法，包括以下步骤：S1、根据机械臂的参数建立机械臂的D-H矩阵；S2、根据机械臂的结构和机械臂的参数，确定S3的阈值，即机械臂末端位置与目标位置PE的最大距离；S3、采用蒙特卡洛方法为机械臂全部关节赋予随机角度生成随机样本，通过所述D-H矩阵计算每个所述随机样本对应的机械臂末端位置，保留满足条件的机械臂末端位置为样本；S4、以S3保留的样本为种群组，增加新的随机种群组合成遗传算法的初始种群，利用遗传算法求得运动学逆解。进一步的，所述机械臂的参数包括：每个所述机械臂的长度、扭转角度、偏移量及关节角度。进一步的，所述S3具体包括以下步骤：S31、为机械臂全部关节赋予随机角度，生成随机样本；S32、将所述随机样本代入S1的D-H矩阵，计算对应的机械臂末端的位置S33、判断保留PM同时满足如下条件，如公式(1)所示；式(1)中，thx，thx，thx为所述阈值在x，y，z三个方向的标识；S34、若所述随机样本对应的末端位置PM满足S33的条件，则将所述对应样本保存至种群数组D1；S35、循环S32-S34的操作，直至完成全部随机样本的计算；S36、循环结束，得到种群数组D1。进一步的，所述S4具体包括以下步骤：S40、在种群数组D1的基础，增加新的关节角度的随机样本组D2，组成遗传算法的初始种群D；S41、为初始种群D编码；S42、设定遗传算法的参数；S43、计算种群中每个个体的对应的机械臂末端位姿矩阵的适应度函数值；S44、根据S43的适应度函数值，对S41种群中的个体进行遗传选择；S45、判断S44得到的遗传选择的个体是否满足交叉概率，如果所述遗传选择的个体满足交叉概率，则进行遗传交叉并保存到新的种群中；如果所述遗传选择的个体不满足交叉概率，则进入S46；S46、判断不满足交叉概率的遗传选择的个体是否满足变异概率，如果满足变异概率，则进行变异交叉并保存到新的种群中，否则去除；S47、在经过S45和S46操作得到的新种群的基础上增加新的随机个体，使得新种群保持原有种群的规模；S48、判断S47得到的种群是否达到完成条件，完成条件包括种群中最佳个体的适应度函数值Fit<ε或者S43-S47循环的次数在100-300次内，达到任意一个条件均视为达到完成条件，ε的取值范围为1*10-7-2*10-7；若没有达到完成条件，则用S47所得新种群替换前一次迭代的种群，重复S43-S47的操作；若达到完成条件则退出；S49、输出结果，即运动学逆解。进一步的，所述S41的编码方式为实数编码。进一步的，所述S44中的选择采用竞赛选择法，舍弃适应度函数值过大的个体。进一步的，所述S45交叉选用多点交叉。进一步的，所述S40中，设定种群D中个体的数量为T，随机种群D2中个体的数量T2的计算公式为：式(2)中，T1为S36所得的种群数组D1中个体的数量。进一步的，所述S44中的适应度的函数的构造如公式(3)所示：Fit＝|ΔP|+|ΔO|(3)式(3)中，|ΔP|为位置偏移量，|ΔO|为姿态偏移量；式(4)中，为遗传个体对应的机械臂末端位置，为遗传个体对应的机械臂末端位置的x，y，z坐标，PE为机械臂末端的目标位置；式(5)中，为遗传个体对应的机械臂末端姿态矩阵的第j列第i行，为机械臂末端目标体姿态矩阵的第j列第i行。与现有的技术相比，本专利技术具有如下有益效果：1、本专利技术所提供的6自由度机械臂逆运动学求解方法避免了计算矩阵的逆以及反三角函数，运算量小，且没有限制条件。2、本专利技术所提供的6自由度机械臂逆运动学求解方法，通过蒙特卡洛方法优化遗传算法的初始样本，能够有效提高遗传算法的搜索速度与搜索成功率，同时保留部分随机样本保持种群的多样性，保证算法的全局搜索能力。3、本专利技术所提供的6自由度机械臂逆运动学求解方法简单，误差小于1％，可操作性强。附图说明为了更清楚地说明本专利技术的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一个实施例，对于本领域普通技术人员来说，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。图1是UR5机器人的结构示意图；图2是遗传算法的编码格式；图3是S3的流程图；图4是S4的流程图；图5是本专利技术的运动学逆解求解结果示意图；图6是本专利技术一种6自由度机械臂逆运动学求解方法的流程图。具体实施方式下面结合本专利技术实施例中的附图，对本专利技术中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动的前提下所获得的所有其他实施例，都属于本专利技术保护的范围。本专利技术的实施例以UR5机器人(6自由度机械臂)为例对本专利技术的6自由度机械臂逆运本文档来自技高网...

【技术保护点】
1.一种6自由度机械臂逆运动学求解方法，其特征在于：包括以下步骤：S1、根据机械臂的参数建立机械臂的D‑H矩阵；S2、根据机械臂的结构和机械臂的参数，确定S3的阈值，即机械臂末端位置与目标位置PE的最大距离；S3、采用蒙特卡洛方法为机械臂全部关节赋予随机角度生成随机样本，通过所述D‑H矩阵计算每个所述随机样本对应的机械臂末端位置，保留满足条件的机械臂末端位置为样本；S4、以S3保留的样本为种群组，增加新的随机种群组合成遗传算法的初始种群，利用遗传算法求得运动学逆解。

【技术特征摘要】
1.一种6自由度机械臂逆运动学求解方法，其特征在于：包括以下步骤：S1、根据机械臂的参数建立机械臂的D-H矩阵；S2、根据机械臂的结构和机械臂的参数，确定S3的阈值，即机械臂末端位置与目标位置PE的最大距离；S3、采用蒙特卡洛方法为机械臂全部关节赋予随机角度生成随机样本，通过所述D-H矩阵计算每个所述随机样本对应的机械臂末端位置，保留满足条件的机械臂末端位置为样本；S4、以S3保留的样本为种群组，增加新的随机种群组合成遗传算法的初始种群，利用遗传算法求得运动学逆解。2.根据权利要求1所述的6自由度机械臂逆运动学求解方法，其特征在于：所述机械臂的参数包括：每个所述机械臂的长度、扭转角度、偏移量及关节角度。3.根据权利要求1所述的6自由度机械臂逆运动学求解方法，其特征在于：所述S3具体包括以下步骤：S31、为机械臂全部关节赋予随机角度，生成随机样本；S32、将所述随机样本代入S1的D-H矩阵，计算对应的机械臂末端的位置S33、判断保留PM同时满足如下条件，如公式(1)所示；式(1)中，thx，thx，thx为所述阈值在x，y，z三个方向的标识；S34、若所述随机样本对应的末端位置PM满足S33的条件，则将所述对应样本保存至种群数组D1；S35、循环S32-S34的操作，直至完成全部随机样本的计算；S36、循环结束，得到种群数组D1。4.根据权利要求1所述的6自由度机械臂逆运动学求解方法，其特征在于：所述S4具体包括以下步骤：S40、在种群数组D1的基础，增加新的关节角度的随机样本组D2，组成遗传算法的初始种群D；S41、为初始种群D编码；S42、设定遗传算法的参数；S43、计算种群中每个个体的对应的机械臂末端位姿矩阵的适应度函数值；S44、根据S43的适应度函数值，对S41种群中的个体进行遗传选择；S45、判断S44得到的遗传选择的个体是否满足交叉概率，如果所述遗传选择的个体满足交叉概率，则进行遗传交叉并保存...

【专利技术属性】
技术研发人员：张明，李春泉，尚玉玲，党选举，黄红艳，李彩林，
申请(专利权)人：桂林电子科技大学，
类型：发明
国别省市：广西,45