一种串联机器人六维力传感器受力感知算法制造技术

一种串联机器人六维力传感器受力感知算法，通过先在标定过程中将外界环境施加的力视为0，得到六维力传感器实际反馈的力/力矩，基于传感器坐标系描述的六维力传感器末端及载荷的重力作用和将力传感器坐标系{S}与机器人末端坐标系{E}之间有Z方向的安装偏差考虑在内，得到最终的

【技术实现步骤摘要】
一种串联机器人六维力传感器受力感知算法


[0001]本专利技术涉及串联机器人六维力传感器力控
，尤其涉及一种串联机器人六维力传感器受力感知算法。

技术介绍

[0002]在串联机器人末端法兰安装六维力传感器进行相关力控的应用中，需要实时的计算六维力传感器所受的外力。该外力不是简单的从六维力传感器反馈的力直接读取的，因为六维力传感器实际反馈的力或力矩中，主要由三部分组成：1)传感器自身的误差(零漂)；2)传感器末端及附加载荷的重力作用；3)外界环境施加的力。而外力感知其指的是外界环境施加的力，因此传感器标定指的是进行传感器自身的误差(零漂)和传感器末端及附加载荷的重力作用的标定。
[0003]在当前串联机器人六维力传感器标定算法中，主流的做法是通过机器人法兰上的机械定位进行六维力传感器的安装，以此来假设末端法兰坐标系与传感器坐标系是对齐的状态。但是通过机械定位总是存在微小的误差，而常见的标定算法中，并没有考虑该误差；除此之外，对于外力的感知，需要精确的传感器参数的标定，而当前常见的标定算法处理方式是一次性通过最小二乘法将所需的参数都辨识出来，这样的处理会导致辨识的参数结果误差较大，间接的导致传感器受力感知的计算误差增大。

技术实现思路

[0004]根据以上存在的技术问题，本专利技术提高一种在算法上补偿传感器与法兰安装角度定位的微小误差和分步辨识标定参数来提升计算出受力的精确度。
[0005]本专利技术提供一种串联机器人六维力传感器受力感知算法，具体技术步骤如下：
[0006]步骤1：根据六维力传感器实际反馈的力/力矩中由传感器自身的误差、传感器末端及附加载荷的重力作用和外界环境施加的力组成，得出外界环境施加的力为：
[0007]S
F
extenal
＝
S
F
feedback
‑
S
F
offset
‑
S
G
ꢀꢀ
(1)
[0008]式中：
[0009]S
F
extenal
——基于传感器坐标系描述的外界环境施加的力/力矩
[0010]S
F
feedback
——基于传感器坐标系描述的实际反馈的力/力矩
[0011]S
F
offset
——基于传感器坐标系描述的传感器自身的误差(零漂)
[0012]S
G——基于传感器坐标系描述的传感器末端及附加载荷的重力作用标定过程中将
S
F
extenal
视为0，即标定的过程中外界环境施加的力为0，得到六维力传感器实际反馈的力/力矩为：
[0013]S
F
feedback
＝
S
G+
S
F
offset (5)
[0014]在步骤1中，已知：
[0015]S
F
feedback
＝[
S
F
X S
F
Y S
F
Z S
M
X S
M
Y S
M
Z
]T (2)
[0016]S
F
offset
＝[
S
F
offsetX S
F
offsetY S
F
offsetZ S
M
offsetX S
M
offsetY S
M
offsetZ
]T (3)
[0017]S
G＝[
S
F
G S
M
G
]T
＝[
S
F
GX S
F
GY S
F
GZ S
M
GX S
M
GY S
M
GZ
]T (4)
[0018]将式(2)、式(3)和式(4)代入式式(5)中得到：
[0019][0020]步骤2：基于传感器坐标系描述的六维力传感器末端及载荷的重力作用，将传感器末端及附加载荷的重力作用的质心在传感器坐标系的描述为(
S
P
X
,
S
P
Y
,
S
P
Z
)，通过式(7)计算得到重力G作用在X,Y,Z轴上的力矩为：
[0021][0022]将正负考虑进去进一步推导式(7)为：
[0023][0024]步骤3：已知的六维力传感器末端及载荷的重力作用G是基于世界坐标系{W}进行描述的，G在世界坐标系中的描述如下：
[0025]W
F
G
＝[0 0
ꢀ‑
G]T (9)
[0026]式(9)即表示重力G只在世界坐标系{W}的Z负方向上有力的作用，需将式(9)转换到力传感器坐标系中进行描述，假设机器人基座坐标系{B}绕世界坐标系{W}的X轴转动的角度记为Rx，绕Y轴转动的角度记为Ry；进一步假设六维力传感器与机器人末端安装法兰的安装面是平行且贴合的，因此只存在力传感器坐标系{S}与机器人末端坐标系{E}之间有Z方向的安装偏差，记为角度Rz。则此时重力G在力传感器坐标系{S}的描述为：
[0027][0028]在步骤3中，其中的值分别如下：
[0029][0030]通过串联机器人的运动学推导得到旋转算子的具体值，在此记：
[0031][0032][0033]步骤4：结合式(8)和式(10)得到最终的
S
G为：
[0034][0035]步骤5：结合式(5)和式(14)可得无外界环境施加力情况下的力传感器的反馈值为：
[0036][0037]将式(3)、式(11)、式(12)以及式(13)带入到式(15)中，可得：
[0038][0039]式(16)中的6个方程我们可以得知，六维力传感器需要标定的参数有
[0040]{G,P
x
,P
y
,P
z
,
S
F
offsetX
,
S
F
ofsetY
,
S
F
offsetZ
,
S
M
offsetX
,
S
M
offsetY
,
S
M
offsetZ
,sinR
z
,cosR
z
}这12个，采用分步辨识法，优先辨识部分参数，再将辨识得到的结果用在后续的辨识过程中。在步骤5中，所述分步辨识法包含如下三步：
[0041]第一步：辨识G,...

【技术保护点】

【技术特征摘要】
1.一种串联机器人六维力传感器受力感知算法，具体技术步骤如下：步骤1：根据六维力传感器实际反馈的力/力矩中由传感器自身的误差、传感器末端及附加载荷的重力作用和外界环境施加的力组成，得出外界环境施加的力为：
S
F
extenal
＝
S
F
feedback
‑
S
F
offset
‑
S
G
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)式中：
S
F
extenal
——基于传感器坐标系描述的外界环境施加的力/力矩
S
F
feedback
——基于传感器坐标系描述的实际反馈的力/力矩
S
F
offset
——基于传感器坐标系描述的传感器自身的误差(零漂)
S
G——基于传感器坐标系描述的传感器末端及附加载荷的重力作用标定过程中将
S
F
extenal
视为0，即标定的过程中外界环境施加的力为0，得到六维力传感器实际反馈的力/力矩为：
S
F
feedback
＝
S
G+
S
F
offset
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(5)；步骤2：基于传感器坐标系描述的六维力传感器末端及载荷的重力作用，将传感器末端及附加载荷的重力作用的质心在传感器坐标系的描述为(
S
P
X
,
S
P
Y
,
S
P
Z
)，通过式(7)计算得到重力G作用在X,Y,Z轴上的力矩为：将正负考虑进去进一步推导式(7)为：步骤3：已知的六维力传感器末端及载荷的重力作用G是基于世界坐标系{W}进行描述的，G在世界坐标系中的描述如下：
W
F
G
＝[0 0
ꢀ‑
G]
T
ꢀꢀꢀꢀ
(9)式(9)即表示重力G只在世界坐标系{W}的Z负方向上有力的作用，需将式(9)转换到力传感器坐标系中进行描述，假设机器人基座坐标系{B}绕世界坐标系{W}的X轴转动的角度记为Rx，绕Y轴转动的角度记为Ry；进一步假设六维力传感器与机器人末端安装法兰的安装面是平行且贴合的，因此只存在力传感器坐标系{S}与机器人末端坐标系{E}之间有Z方向的安装偏差，记为角度Rz。则此时重力G在力传感器坐标系{S}的描述为：步骤4：结合式(8)和式(10)得到最终的
S
G为：
步骤5：结合式(5)和式(14)可得无外界环境施加力情况下的力传感器的反馈值为：采用分步辨识法辨识需要标定的参数；步骤6：将分步辨识计算得数据代入，结合机器人的姿态描述矩阵即可完成六维力传感器的标定，此时得到无外界环境施加力时
S
G+
S
F
offset
的值，所以当存在外界环境施加的力情况时，已知
S
F
feedback
，还已知
S
G+
S
F
offset
的值，所以通过式(1)即可计算得到外界环境施加的力，由此完成外力精确感知的算法。2.根据权利要求1所述的一种串联机器人六维力传感器受力感知算法，其特征在于，在步骤1中，已知：
S
F
feedback
＝[
S
F
XS
F
YS
F

【专利技术属性】
技术研发人员：甘中学，黄尧，
申请(专利权)人：上海智殷自动化科技有限公司，
类型：发明
国别省市：