机械臂的控制方法、装置及电子设备制造方法及图纸

本申请涉及机械臂控制技术领域，公开了一种机械臂的控制方法、装置及电子设备，该机械臂包括末端和多个关节，该机械臂的控制方法，包括：修正第一雅可比矩阵，得到第二雅可比矩阵；基于最小二乘法，根据第二雅克比矩阵，计算机械臂的关节期望速度；根据最大约束速度阈值，对关节期望速度进行修正，得到第一修正结果；根据末端的运动方向与当前期望速度方向，对第一修正结果进行修正，得到第二修正结果；根据第二修正结果，得到修正后的关节期望速度，以控制机械臂的运动，本申请能够通过雅可比矩阵做最小二乘法计算，计算出最优的机械臂各关节的期望速度，进而使机械臂具有穿越奇异点的能力，在机械臂出现故障时也能够对机械臂进行遥控。进行遥控。进行遥控。

【技术实现步骤摘要】
机械臂的控制方法、装置及电子设备


[0001]本申请实施方式涉及机械臂控制
，特别是涉及一种机械臂的控制方法、装置及电子设备。

技术介绍

[0002]机械臂遥控功能作为机械臂控制
的一个基础功能一直备受重视。借助遥控功能，操作人员可以控制机械臂以预期的运动方式到达期望的位置。机械臂遥控技术一般有两种实现方式：在关节空间实现的机械臂遥控技术、在笛卡尔空间实现的机械臂遥控技术。
[0003]在关节空间实现的机械臂遥控技术的原理较为简单，只要控制关节转动到指定的角度即可，但这种遥控方式不符合人的直觉，而且无法满足笛卡尔空间的作业要求。在笛卡尔空间实现的机械臂遥控技术可以控制机械臂的末端在笛卡尔空间运动到指定的位置，更符合人的直觉，也可以满足笛卡尔空间的作业要求。但这种遥控方式缺乏对异常情况的适应能力，因为在笛卡尔空间控制机械臂需要求机械臂逆运动学的解，而出现下述状况时机械臂逆运动学是无解的。
[0004](1)机械臂处于奇异点；
[0005](2)机械臂中若干个关节出现故障，无法移动。

技术实现思路

[0006]本申请实施例提供一种机械臂的控制方法、装置及电子设备，通过雅可比矩阵做最小二乘法计算，计算出最优的机械臂各关节的期望速度，进而使机械臂具有穿越奇异点的能力，在机械臂出现故障时也能够对机械臂进行遥控。
[0007]本申请实施例提供以下技术方案：
[0008]第一方面，本申请实施例提供一种机械臂的控制方法，该机械臂包括末端和多个关节，该机械臂的控制方法，包括：
[0009]获取机械臂的各个关节的当前期望速度和关节角度；
[0010]基于机械臂微分运动学原理，得到第一雅可比矩阵；
[0011]修正第一雅可比矩阵，得到第二雅可比矩阵；
[0012]基于最小二乘法，根据第二雅克比矩阵，计算机械臂的关节期望速度；
[0013]根据最大约束速度阈值，对关节期望速度进行修正，得到第一修正结果；
[0014]根据末端的运动方向与当前期望速度方向，对第一修正结果进行修正，得到第二修正结果；
[0015]根据第二修正结果，得到修正后的关节期望速度，以控制机械臂的运动。
[0016]在一些实施例中，基于机械臂微分运动学原理，得到第一雅可比矩阵，包括：
[0017]基于机械臂微分运动学原理，根据机械臂的当前期望速度和关节角度，计算机械臂的当前雅可比矩阵；
[0018]将当前雅可比矩阵确定为第一雅可比矩阵。
[0019]在一些实施例中，修正第一雅可比矩阵，得到第二雅可比矩阵，包括：
[0020]将当前期望速度为零的关节确定为故障关节；
[0021]若存在故障关节，则将故障关节对应的列从第一雅可比矩阵中删除，得到第二雅可比矩阵，其中，每一关节一一对应第一雅克比矩阵中的一个列；
[0022]若不存在故障关节，则将第一雅可比矩阵确定为第二雅可比矩阵。
[0023]在一些实施例中，基于最小二乘法，根据第二雅克比矩阵，计算机械臂的关节期望速度，包括：
[0024]根据第二雅可比矩阵和第二雅可比矩阵的伪逆，确定第二雅可比矩阵的投影矩阵，具体包括：
[0025][0026]其中，为第二雅可比矩阵的投影矩阵，J
a
为第二雅可比矩阵，为第二雅可比矩阵的伪逆矩阵，U为第二雅可比矩阵进行奇异值分解得到的第一正交矩阵，V为第二雅可比矩阵进行奇异值分解得到的第二正交矩阵，Σ为第二雅可比矩阵进行奇异值分解得到的对角矩阵，U
T
为第一正交矩阵的转置矩阵，V
T
为第二正交矩阵的转置矩阵，Σ
+
为对角矩阵的伪逆矩阵；
[0027]根据第二雅可比矩阵的投影矩阵和当前期望速度，计算当前期望速度在第二雅可比矩阵列空间中的投影向量，具体包括：
[0028][0029]其中，为当前期望速度在第二雅可比矩阵列空间中的投影向量，为第二雅可比矩阵的投影矩阵，为当前期望速度；
[0030]基于最小二乘法，结合投影向量、第二雅可比矩阵和期望速度，计算关节期望速度，具体包括：
[0031][0032]其中，当时，则取得最小值，此时，得到关节期望速度等于
[0033]在一些实施例中，根据最大约束速度阈值，对关节期望速度进行修正，得到第一修正结果，包括：
[0034]设置最大约束速度阈值；
[0035]若存在若干个关节的关节期望速度大于最大约束速度阈值，则计算若干个关节的关节期望速度与最大约束速度阈值的比值，得到若干个比值；
[0036]将若干个比值中的最大比值确定为第一比值，并确定第一关节期望速度；
[0037]若所有的关节期望速度均小于或等于最大约束速度阈值，则将关节期望速度确定为第一关节期望速度；
[0038]将第一关节期望速度确定为第一修正结果；
[0039]将若干个比值中的最大比值确定为第一比值，并确定第一关节期望速度，具体包
括：
[0040]根据第一比值，确定第一关节期望速度，具体包括：
[0041][0042]其中，为第一关节期望速度，为关节期望速度，r为第一比值。
[0043]在一些实施例中，机械臂包括末端，根据末端的运动方向与当前期望速度方向，对第一修正结果进行修正，得到第二修正结果，包括：
[0044]计算末端的运动方向与当前期望速度方向的余弦值，计算公式为：
[0045][0046][0047]其中，cosα为末端的运动方向与当前期望速度方向的余弦值，为末端的速度，为当前期望速度，J
a
为第二雅可比矩阵，为第一修正结果；
[0048]根据末端的运动方向与当前期望速度方向的夹角的余弦值，计算夹角的角度；
[0049]设置夹角的最大阈值；
[0050]若角度大于或等于夹角的最大阈值，则将机械臂的关节期望速度置为零，以停止机械臂运动；
[0051]若角度小于夹角的最大阈值，则将第一修正结果确定为第二修正结果。
[0052]在一些实施例中，在得到第二修正结果之后，方法还包括：
[0053]根据第二修正结果，计算末端修正后的运动速度，计算公式为：
[0054][0055]其中，为末端修正后的运动速度，J
a
为第二雅可比矩阵，为第二修正结果。
[0056]在一些实施例中，根据第二修正结果，得到修正后的关节期望速度，包括：
[0057]将第二修正结果确定为修正后的关节期望速度；
[0058]方法还包括：
[0059]获取刷新频率；
[0060]根据刷新频率，计算控制周期，计算公式为：
[0061][0062]其中，Δt为控制周期，f
c
为刷新频率；
[0063]根据控制周期和第二修正结果，计算修正后的关节位置，计算公式为：
[0064][0065]本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种机械臂的控制方法，其特征在于，所述机械臂包括末端和多个关节，所述方法包括：获取所述机械臂的各个关节的当前期望速度和关节角度；基于机械臂微分运动学原理，得到第一雅可比矩阵；修正所述第一雅可比矩阵，得到第二雅可比矩阵；基于最小二乘法，根据所述第二雅克比矩阵，计算所述机械臂的关节期望速度；根据最大约束速度阈值，对所述关节期望速度进行修正，得到第一修正结果；根据所述末端的运动方向与当前期望速度方向，对所述第一修正结果进行修正，得到第二修正结果；根据第二修正结果，得到修正后的关节期望速度，以控制所述机械臂的运动。2.根据权利要求1所述的方法，其特征在于，所述基于机械臂微分运动学原理，得到第一雅可比矩阵，包括：基于机械臂微分运动学原理，根据所述机械臂的当前期望速度和所述关节角度，计算所述机械臂的当前雅可比矩阵；将所述当前雅可比矩阵确定为第一雅可比矩阵。3.根据权利要求2所述的方法，其特征在于，所述修正所述第一雅可比矩阵，得到第二雅可比矩阵，包括：将当前期望速度为零的关节确定为故障关节；若存在所述故障关节，则将所述故障关节对应的列从第一雅可比矩阵中删除，得到第二雅可比矩阵，其中，每一所述关节一一对应所述第一雅克比矩阵中的一个列；若不存在所述故障关节，则将所述第一雅可比矩阵确定为第二雅可比矩阵。4.根据权利要求3所述的方法，其特征在于，所述基于最小二乘法，根据所述第二雅克比矩阵，计算所述机械臂的关节期望速度，包括：根据所述第二雅可比矩阵和所述第二雅可比矩阵的伪逆，确定所述第二雅可比矩阵的投影矩阵，具体包括：其中，为第二雅可比矩阵的投影矩阵，J
a
为第二雅可比矩阵，为所述第二雅可比矩阵的伪逆矩阵，U为第二雅可比矩阵进行奇异值分解得到的第一正交矩阵，V为第二雅可比矩阵进行奇异值分解得到的第二正交矩阵，Σ为第二雅可比矩阵进行奇异值分解得到的对角矩阵，U
T
为第一正交矩阵的转置矩阵，V
T
为第二正交矩阵的转置矩阵，Σ
+
为对角矩阵的伪逆矩阵；根据所述第二雅可比矩阵的投影矩阵和所述当前期望速度，计算所述当前期望速度在第二雅可比矩阵列空间中的投影向量，具体包括：其中，为所述当前期望速度在第二雅可比矩阵列空间中的投影向量，为第二雅可比矩阵的投影矩阵，为所述当前期望速度；基于最小二乘法，结合所述投影向量、第二雅可比矩阵和期望速度，计算所述关节期望
速度，具体包括：其中，当时，则取得最小值，此时，得到所述关节期望速度等于5.根据权利要求3所述的方法，其特征在于，所述根据最大约束速度阈值，对所述关节期望速度进行修正，得到第一修正结果，包括：设置最大约束速度阈值；若存在若干个关节的关节期望速度大于所述最大约束速度阈值，则计算若干个所述关节的关节期望速度与最大约束速度阈值的比值，得到若干个比值；将若干个所述比值中的最大比值确定为第一比值，并确定第一关节期望速度；若所有的关节期望速度均小于或等于所述最大约束速度...

【专利技术属性】
技术研发人员：刘聪，
申请(专利权)人：深圳亿嘉和科技研发有限公司，
类型：发明
国别省市：