工业机器人奇异点规避方法、装置及拖动示教系统制造方法及图纸

本发明专利技术提供了一种工业机器人奇异点规避方法、装置及拖动示教系统，解决机器人遇到奇异点时无法求解出期望关节角的问题。方法包括：步骤S1：计算机器人末端的目标位姿矩阵；步骤S2：根据机器人当前关节角计算当前位姿矩阵；步骤S3：根据当前位姿矩阵和目标位姿矩阵计算第一偏差量；步骤S4：根据第一偏差量、当前关节角和阻尼系数计算第一候选关节角；步骤S5：根据第一候选关节角和目标位姿矩阵计算第二偏差量；步骤S6：判断第二偏差量是否小于第一偏差量，如果是，进入步骤S7；步骤S7：减小阻尼系数并将第一候选关节角替换为当前关节角；步骤S8：判断是否满足停止条件，如果是，将停止时的候选关节角作为期望关节角。时的候选关节角作为期望关节角。时的候选关节角作为期望关节角。

【技术实现步骤摘要】
工业机器人奇异点规避方法、装置及拖动示教系统


[0001]本专利技术主要涉及工业机器人
，尤其涉及一种工业机器人奇异点规避方法、装置及拖动示教系统。

技术介绍

[0002]大部分6轴关节型机器人，由于机械限位或软限位的限制，在其运动空间中会出现逆运动学无解的情况，也就是基于坐标的规划运动无法明确地逆向转化为机器人各个关节轴的旋转角度。在机器人工作空间中这些逆运动学无解的点就被称为“奇异点”。
[0003]在工业机器人领域，工作空间的拖动示教可以替代离线编程示教方式完成指定位置和特定轨迹的移动，并记录位姿数据，减少离线编程从而提高效率。在工业机器人的作业空间拖动示教过程中，若接近奇异点位置，则需要停止示教模式。通过控制机器人跨过奇异点之后，再重新进入拖动示教模式，这样拖动示教的过程效率会大打折扣。另一种方式就是限制工作空间，虽然这种限制工作空间的方式可以避开奇异点问题，但这样并不能满足所有工作空间内的作业。
[0004]因此，亟需一种工业机器人奇异点规避方法、装置及拖动示教系统，从而实现在作业空间内可自由拖动示教。

技术实现思路

[0005]本专利技术要解决的技术问题是提供一种工业机器人奇异点规避方法、装置及拖动示教系统，解决机器人遇到奇异点时无法求解出期望关节角的问题。
[0006]为解决上述技术问题，本专利技术提供了另一种工业机器人奇异点规避方法，包括：
[0007]步骤S1：根据基坐标下当前的机器人末端速度和机器人末端角速度计算机器人末端的目标位姿矩阵；/>[0008]步骤S2：根据机器人当前关节角计算当前位姿矩阵；
[0009]步骤S3：根据所述当前位姿矩阵和所述目标位姿矩阵计算第一偏差量；
[0010]步骤S4：根据所述第一偏差量、所述当前关节角和阻尼系数计算第一候选关节角；
[0011]步骤S5：根据所述第一候选关节角和所述目标位姿矩阵计算第二偏差量；
[0012]步骤S6：判断所述第二偏差量是否小于所述第一偏差量，如果是，则进入步骤S7，如果否，则增大阻尼系数并重复执行步骤S4～S6；
[0013]步骤S7：减小阻尼系数并将所述第一候选关节角替换为所述当前关节角；
[0014]步骤S8：判断是否满足停止条件，如果是，则进入步骤S9；如果否，则重复执行步骤S2～S8；
[0015]步骤S9：将停止时的候选关节角作为期望关节角。
[0016]为解决上述技术问题，本专利技术提供了一种工业机器人奇异点规避方法，包括：根据机器人当前时刻各关节的关节角度和连杆偏距确定奇异参数，所述奇异参数包括肩关节奇异参数、肘关节奇异参数和腕关节奇异参数；判断所述奇异参数是否位于奇异区域，如果
是，采用近似参数替换所述奇异参数，根据所述机器人末端速度、所述机器人末端角速度和所述近似参数计算前三轴关节速度和后三轴关节速度；如果否，根据所述机器人末端速度、所述机器人末端角速度和所述奇异参数计算前三轴关节速度和后三轴关节速度；对所述前三轴关节速度和所述后三轴关节速度进行积分得到期望关节角。
[0017]可选地，采用近似参数替换所述奇异参数包括：采用替换其中K
i
为第i个奇异参数，λ
i
表示第i个阻尼系数，i＝1,2,3。
[0018]为解决上述技术问题，本专利技术提供了一种机器人拖动示教系统，包括：力传感器，用于采集力数据；数据处理模块，用于对所述力数据进行处理获得末端力，所述处理包括重力及负载补偿处理；导纳模块，用于根据所述末端力计算出机器人末端速度和机器人末端角速度；奇异点规避模块，配置为执行如上所述的工业机器人奇异点规避方法计算出期望关节角；伺服模块，用于根据所述期望关节角控制机器人运动到示教位置。
[0019]可选地，系统还包括：超速和限位保护模块，用于对所述期望关节角进行超速保护处理和限位保护处理，得到最终给定关节角；其中，所述伺服模块还用于根据所述最终给定关节角控制机器人运动到示教位置。
[0020]为解决上述技术问题，本专利技术提供了一种工业机器人奇异点规避装置，包括：存储器，用于存储可由处理器执行的指令；处理器，用于执行所述指令以实现如上所述的方法。
[0021]为解决上述技术问题，本专利技术提供了一种存储有计算机程序代码的计算机可读介质，所述计算机程序代码在由处理器执行时实现如上所述的方法。
[0022]与现有技术相比，本专利技术具有以下优点：
[0023]本专利技术的一种工业机器人奇异点规避方法通过增大或减小阻尼系数调节关节角增量，使得候选关节角的位姿与目标位姿矩阵接近，从而获得避开奇异点的期望关节角。
[0024]本专利技术的另一种工业机器人奇异点规避方法通过机器人末端速度、机器人末端角速度和奇异参数计算前三轴关节速度和后三轴关节速度，对位于奇异区域的奇异参数采用近似参数进行替换，从而获得避开奇异点的期望关节角。
[0025]另外，本专利技术的机器人拖动示教系统通过奇异点规避模块执行工业机器人奇异点规避方法获得避开奇异点的期望关节角，可以使得工业机器人在示教时避开奇异点，从而不需要停下示教或限制空间，实现在作业空间内自由拖动示教。
附图说明
[0026]包括附图是为提供对本申请进一步的理解，它们被收录并构成本申请的一部分，附图示出了本申请的实施例，并与本说明书一起起到解释本专利技术原理的作用。附图中：
[0027]图1是根据本专利技术一实施例的工业机器人奇异点规避方法的流程图；
[0028]图2是图1中步骤S3一实施例的流程图；
[0029]图3是图1中步骤S4一实施例的流程图；
[0030]图4是图3中步骤S41一实施例的流程图；
[0031]图5是根据本专利技术另一实施例的工业机器人奇异点规避方法的流程图；
[0032]图6是图5中步骤S51一实施例的流程图；
[0033]图7是图5方法不同参数对应的效果图；
[0034]图8是根据本专利技术一实施例的工业机器人奇异点规避装置的系统框图；
[0035]图9是根据本专利技术一实施例的机器人拖动示教系统的系统框图。
具体实施方式
[0036]为了更清楚地说明本申请的实施例的技术方案，下面将对实施例描述中所需要使用的附图作简单的介绍。显而易见地，下面描述中的附图仅仅是本申请的一些示例或实施例，对于本领域的普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图将本申请应用于其他类似情景。除非从语言环境中显而易见或另做说明，图中相同标号代表相同结构或操作。
[0037]如本申请和权利要求书中所示，除非上下文明确提示例外情形，“一”、“一个”、“一种”和/或“该”等词并非特指单数，也可包括复数。一般说来，术语“包括”与“包含”仅提示包括已明确标识的步骤和元素，而这些步骤和元素不构成一个排它性的罗列，方法或者设备也可能包含其他的步骤或元素。
[0038]除非另外具体说明，否则在这些实施例中阐述的部件和步骤的相本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种工业机器人奇异点规避方法，其特征在于，包括：步骤S1：根据基坐标下当前的机器人末端速度和机器人末端角速度计算机器人末端的目标位姿矩阵；步骤S2：根据机器人当前关节角计算当前位姿矩阵；步骤S3：根据所述当前位姿矩阵和所述目标位姿矩阵计算第一偏差量；步骤S4：根据所述第一偏差量、所述当前关节角和阻尼系数计算第一候选关节角；步骤S5：根据所述第一候选关节角和所述目标位姿矩阵计算第二偏差量；步骤S6：判断所述第二偏差量是否小于所述第一偏差量，如果是，则进入步骤S7，如果否，则增大阻尼系数并重复执行步骤S4～S6；步骤S7：减小阻尼系数并将所述第一候选关节角替换为所述当前关节角；步骤S8：判断是否满足停止条件，如果是，则进入步骤S9；如果否，则重复执行步骤S2～S8；步骤S9：将停止时的候选关节角作为期望关节角。2.如权利要求1所述的方法，其特征在于，步骤S3包括：步骤S31：根据所述当前位姿矩阵和所述目标位姿矩阵计算位姿矩阵增量；步骤S32：将所述位姿矩阵增量转换为笛卡尔空间的第一偏差量。3.如权利要求1所述的方法，其特征在于，步骤S4包括：步骤S41：根据所述第一偏差量和所述阻尼系数计算关节角增量；步骤S42：根据所述关节角增量和所述当前关节角计算所述第一候选关节角。4.如权利要求3所述的方法，其特征在于，步骤S41包括：步骤S411：将基坐标系下的当前位姿下的第一雅可比矩阵转换到机器人末端坐标系下的第二雅可比矩阵；步骤S412：根据所述第二雅可比矩阵、第一偏差量和阻尼系数构建优化目标函数；步骤S413：对所述优化目标函数采用最小化准则计算出所述关节角增量。5.如权利要求4所述的方法，其特征在于，通过如下公式计算所述关节角增量：其中，dq为所述关节角增量，J
e
为所述第二雅可比矩阵，λ为所述阻尼系数，e为所述第一偏差量。6.如权利要求5所述的方法，其特征在于，还包括：减小阻尼系数包括将λ减小为增大阻尼系数包括将λ增大为2λ。7.如权利要求1所述的方法，其特征在于，判断是否满足停止条件包括：判断循环次数是否达到预设次数，如果是，则满足停止条件。8.如权利要求1所述的方法，其特征在于，判断是否满足停止条件包括：判断所述第二偏差量是否小于等于误差容许范围，如果是，则满足停止条件。9.一种工业机器人奇异点规避方法，其特征在于，包括：根据机器人当前时刻各关节的关节角度和连杆偏距确定奇异参数，所述奇异参数包括
肩关节奇异参数、肘关节奇异参数和腕关节奇异参数；判断所述奇异参数是否位于奇异区域，如果是，采用近似参数替换所述奇异参数，根据所述机器人末端速度、所述机器人末端角速度和所述近似参数计算前三轴关节速度和后三轴关节速度；如果否，根据所述机器人末端速度、所述机器人末端角速度和所述奇异参数计算前三轴关节速度和后三轴关节速度；对所述前三轴关节速度和所述后三轴关节速度进行积分得到期望关节角。10.如权利要求9所述的方法，其特征在于，采用近似参数替换所述奇异参数包括：采用替换其中K
i
为第i个奇异参数，λ
i
表示第i个阻尼系数，i＝1,2,3。11.如权利要求10所述的方法，...

【专利技术属性】
技术研发人员：李栋，李睿钦，钱进，王乾，
申请(专利权)人：实时侠智能控制技术有限公司，
类型：发明
国别省市：