一种多奇异点处理方法、系统和工业机器人技术方案

本申请公开了一种多奇异点处理方法、系统和工业机器人，该方法和系统应用于具有多个关节的工业机器人，具体为根据工业机器人的多个关节的实时运动数据和预设的奇异值计算公式，对该工业机器人是否处于多奇异点状态进行判断；当判定所述工业机器人处于所述多奇异点状态时，对奇异值总量进行计算；最后根据得到奇异值总量对多个关节进行控制，以此避免多个奇异点同时出现，也就不会出现关节运动骤然变大现象的发生，从而能够避免工业机器人因关节运动速度骤然变大而出现停机或生产安全问题。

【技术实现步骤摘要】
一种多奇异点处理方法、系统和工业机器人
本申请涉及机器人
，更具体地说，涉及一种多奇异点处理方法、系统和工业机器人。
技术介绍
工业机器人是工业自动化系统中重要的部件之一。当前，多个国家在工业机器人技术上已经树立了各自的领先优势，尤其是在机器人本体的设计上，相关的基础技术已经比较成熟，因而各个厂家开始在机器人应用领域投入更多的精力。工业机器人的奇异点处理方法是机器人应用领域中主要的技术难点之一。奇异点问题是工业机器人必然遇到的技术点，其与结构有关，是一个无法回避的问题。以当前最常见的6关节工业机器人为例，其起码包括三种奇异点，分别为腕部奇异点、肘部奇异点和肩部奇异点。当第四和第六关节同轴时会出现腕部奇异点；当第二、第三和第五关节同轴时会出现肘部奇异点；而当第一和第六关节同轴时则会出现肩部奇异点。且当工业机器人运动至某一位姿时，甚至可能会遇到多个奇异点同时出现的状况，这时关节运动的速度会发生骤然变大的现象，从而导致机器人停机甚至带来生产安全问题。
技术实现思路
有鉴于此，本申请提供一种多奇异点处理方法、系统和工业机器人，用于解决当多关节工业机器人遇到多个奇异点同时，由于关节运动速度的骤然变大导致的停机或生产安全问题。为了实现上述目的，现提出的方案如下：一种多奇异点处理方法，应用于具有多个关节的工业机器人，包括步骤：根据所述多个关节的实时运动数据和预设的奇异值计算公式，对所述工业机器人是否处于多奇异点状态进行判断；当判定所述工业机器人处于所述多奇异点状态时，对奇异值总量进行计算；根据所述奇异值总量对所述多个关节进行控制。可选的，所述根据所述多个关节的实时运动数据和预设的奇异值计算公式，对所述工业机器人是否处于多奇异点状态进行判断，包括：获取所述多个关节的实时运动数据；计算所述工业机器人在多个类型奇异点的奇异值等价公式；根据所述奇异值等价公式和所述实时运动数据，对所述工业机器人是否处于多奇异点状态进行判断；可选的，所述实时运动数据包括实时关节角度和实时时间。一种多奇异点处理系统，应用于具有多个关节的工业机器人，包括：实时监控模块，用于根据所述多个关节的实时运动数据和预设的奇异值计算公式，对所述工业机器人是否处于多奇异点状态进行判断；多奇异点计算模块，用于当所述实时监控模块判定所述工业机器人处于所述多奇异点状态时，对奇异值总量进行计算；多奇异点处理模块，用于根据所述奇异值总量对所述多个关节进行控制。可选的，所述实时监控模块包括：实时检测单元，用于获取所述多个关节的实时运动数据；阈值计算单元，用于计算所述工业机器人在多个类型奇异点的奇异值等价公式；奇异点判断单元，用于根据所述奇异值等价公式和所述实时运动数据，对所述工业机器人是否处于多奇异点状态进行判断；可选的，所述实时运动数据包括实时关节角度和实时时间。从上述的技术方案可以看出，本申请公开了一种多奇异点处理方法、系统和工业机器人，该方法和系统应用于具有多个关节的工业机器人，具体为根据工业机器人的多个关节的实时运动数据和预设的奇异值计算公式，对该工业机器人是否处于多奇异点状态进行判断；当判定所述工业机器人处于所述多奇异点状态时，对奇异值总量进行计算；最后根据得到奇异值总量对多个关节进行控制，以此避免多个奇异点同时出现，也就不会出现关节运动骤然变大现象的发生，从而能够避免工业机器人因关节运动速度骤然变大而出现停机或生产安全问题。附图说明为了更清楚地说明本申请实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本申请的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。图1为本申请实施例提供的一种多奇异点处理方法的流程图；图2为本申请提供的一种工业机器人的D-H模型示意图；图3为本申请另一实施例提供的一种多奇异点处理系统的结构框图。具体实施方式下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本申请一部分实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本申请保护的范围。实施例一图1为本申请实施例提供的一种多奇异点处理方法的流程图。本实施例提供的多奇异点处理方法应用于具有多个关节的工业机器人，本实施例以具有6个关节的工业机器人为例对本申请提供的技术方案进行说明。工业机器人通常是用D-H模型进行结构建模，每两个关节之间的位置及姿态变换都可以使用四个参数的D-H矩阵进行模拟计算。因此，本申请中的具有6个关节的工业机器人结构如图2所示，并且可以用六个D-H关节变换矩阵来表示：其中，ci＝cos(θi),si＝sin(θi),i＝1,2,...,5,6，θi为第i关节的关节转动角度，ai为关节i到关节i+1之间的连杆长度，di为关节i-1到关节i之间的连杆偏距。通过计算矩阵乘法可以得到机器人基座到机器人末端的变换矩阵：本申请中的多奇异点处理方法具体包括如下步骤，如图1所示。S101：根据多个关节的实时运动数据和预设的奇异值计算公式，对工业机器人是否处于多奇异点状态进行判断。具体对机器人是否处于多奇异点状态进行判断包括如下子步骤:步骤1：获取工业机器人的多个关节的实时运动数据。实时运动数据包括反映工业机器人当前状态的实时关节角度θi，以及用于反映当前时刻的实时时间t。步骤2：计算工业机器人在多个类型奇异点的奇异值等价公式。根据工业机器人的雅克比矩阵计算出工业机器人不同种类奇异点的奇异值等价公式，具体包括腕部奇异点、肘部奇异点和肩部奇异点，分别如下：腕部奇异点：kw＝θ5肘部奇异点：ke＝a2s2+a3c2c3-a3s2s3+d4s2c3+d4c2s3肩部奇异点：ks＝a3c3+d4s3步骤3：根据奇异值等价公式和实时运动数据，对工业机器人是否处于多奇异点状态进行判断。针对三种奇异点分别选取奇异点阈值Tw、Te、Ts，那么进行判断：在取奇异点阈值Tw、Te、Ts时，求解θi，选取最大值作为关节角度阈值：(θi)max＝max{θi(Tw),θi(Te),θi(Ts)}奇异点阈值处理单元检测flagw、flage、flags的值，当判断公式为：flagw&flagw&flagw＝0时，此时，工业机器人运动将遇到多奇异点问题，从而判定工业机器人。S102：当工业机器人处于多奇异点状态时，计算奇异值总量。当判断出工业机器人遇到奇异点问题后，需要对不同奇异点的影响程度进一步计算，以便多奇异点处理模块进行进一步处理。设定奇异值总量：P＝kw2+ke2+ks2对奇异值总量P取微分：其中，当m＝0，n＝0时，奇异值总量P取极值，解出(θ2)min和(θ3)min。然后根据解出的结果计算奇异值总量Pmin。采用DLS(阻尼最小方差)算法进行奇异值控制：J'＝JT(JJT+ρ2I)-1其中，J为机器人雅克比矩阵，J'为加入阻尼因子后的雅克比矩阵，ρ2为阻尼因子。代入(θi)max，可计算得到Pmax：Pmax＝P((θi)max)对阻尼因子的控制中加入奇异值总量控制：S103：根据奇异值总量对多个关节进行控制。根据解本文档来自技高网...

【技术保护点】
一种多奇异点处理方法，应用于具有多个关节的工业机器人，其特征在于，包括步骤：根据所述多个关节的实时运动数据和预设的奇异值计算公式，对所述工业机器人是否处于多奇异点状态进行判断；当判定所述工业机器人处于所述多奇异点状态时，对奇异值总量进行计算；根据所述奇异值总量对所述多个关节进行控制。

【技术特征摘要】
1.一种多奇异点处理方法，应用于具有多个关节的工业机器人，其特征在于，包括步骤：根据所述多个关节的实时运动数据和预设的奇异值计算公式，对所述工业机器人是否处于多奇异点状态进行判断；当判定所述工业机器人处于所述多奇异点状态时，对奇异值总量进行计算，所述奇异值总量为所述多个关节的奇异值的平方和；根据所述奇异值总量对所述多个关节进行控制。2.如权利要求1所述的多奇异点处理方法，其特征在于，所述根据所述多个关节的实时运动数据和预设的奇异值计算公式，对所述工业机器人是否处于多奇异点状态进行判断，包括：获取所述多个关节的实时运动数据；计算所述工业机器人在多个类型奇异点的奇异值等价公式；根据所述奇异值等价公式和所述实时运动数据，对所述工业机器人是否处于多奇异点状态进行判断。3.如权利要求2所述的多奇异点处理方法，其特征在于，所述实时运动数据包括实时关节角度和实时时间。4.一种多奇异点处理...

【专利技术属性】
技术研发人员：王业率，边慧杰，赵天光，
申请(专利权)人：珠海格力电器股份有限公司，
类型：发明
国别省市：广东;44