CN113084812A - 一种机器人末端刚度性能评价方法 - Google Patents

一种机器人末端刚度性能评价方法 Download PDF

Info

Publication number
CN113084812A
CN113084812A CN202110391457.XA CN202110391457A CN113084812A CN 113084812 A CN113084812 A CN 113084812A CN 202110391457 A CN202110391457 A CN 202110391457A CN 113084812 A CN113084812 A CN 113084812A
Authority
CN
China
Prior art keywords
robot
axis
matrix
displacement
rigidity
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110391457.XA
Other languages
English (en)
Other versions
CN113084812B (zh
Inventor
周晓勤
高轲
冯超
刘强
韩昊忱
陈俪钊
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jilin University
Original Assignee
Jilin University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Jilin University filed Critical Jilin University
Priority to CN202110391457.XA priority Critical patent/CN113084812B/zh
Publication of CN113084812A publication Critical patent/CN113084812A/zh
Application granted granted Critical
Publication of CN113084812B publication Critical patent/CN113084812B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1653Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis

Abstract

本发明涉及一种机器人末端刚度性能评价方法,属于机器人技术领域。基于胡克定律构建机器人末端操作刚度矩阵,利用激光位移传感器获取真实虚位移量,力传感器获取六维力信息,得到在外力加载下机器人的补偿刚度矩阵、根据虚位移原理得到的机器人末端操作刚度矩阵、通过与关节空间的映射关系得到机器人关节刚度矩阵;通过机器人任意姿态下末端操作刚度矩阵建立的刚度椭球与力矢量相交的长度作为机器人末端刚度性能的评价指标。优点在于操作简便、测定速度快,减小了机器人连杆刚度、测量装置虚位移量误差和有外力加载下对机器人刚度测定误差的影响,能够准确评价机器人末端刚度性能。

Description

一种机器人末端刚度性能评价方法
技术领域
本发明涉及机器人技术领域,特别是涉及一种机器人末端刚度性能评价方法。
背景技术
机器人在机械加工中得到了愈来愈广泛的应用,与数控机床相比具有作业空间大、设备成本低以及集成化程度高等优点,但是机器人刚度和重复定位精度都非常低,使得实际得到的机械加工精度和加工表面质量都受到限制。特别是,机器人的姿态变化还将导致机器人末端操作刚度的变化,这导致在加工大型工件时加工精度和加工表面质量严重依赖机器人的姿态。为了在加工空间的不同位置对机器人姿态进行实时优化以获得最佳的机器人末端刚度性能,必须能够在加工之前快速准确测定机器人关节刚度,并根据机器人关节刚度得到任意姿态下机器人的末端刚度,从而根据机器人末端刚度构建机器人末端刚度评价指标。机器人末端刚度性能评价指标能够在机器人加工之前评价机器人末端刚度是否满足加工要求,若满足加工要求,可以进行机器人加工;若不满足加工要求,可以及时调整和优化机器人加工方案。
目前工业中机器人末端刚度性能评价方法主要是通过机器人瑞利熵进行末端刚度性能评价,评价方法复杂,不够直观,无法及时反映机器人末端刚度性能。测定机器人关节刚度的方法主要是通过激光跟踪仪测量机器人在力加载下的挠度从而辨识得到关节刚度。该方法需要购置价格昂贵的激光跟踪仪,测试过程极为繁琐、非常耗时、测试成本非常高。为了解决该问题,本发明首先提出了一种机器人末端刚度性能评价方法,基于所提出的评价方法,提出了一种采用六维力传感器和激光位移传感器测定机器人末端“位移矢量-力矢量”的关节刚度测定装置。
发明内容
本发明提供一种机器人末端刚度性能评价方法,以解决目前评价方法复杂,不够直观,无法及时反映机器人末端刚度性能、关节刚度测试成本昂贵、测试过程繁琐和耗时的问题。
本发明采取的技术方案是:包括下列步骤:
(1)基于机器人雅克比矩阵与刚度矩阵建立机器人关节刚度测定方法,步骤如下:
a)机器人关节刚度矩阵Kθ的推导:
机器人关节力矩τ与末端受力F的关系:
τ=JTF(1)
τ为机器人关节力矩,JT为机器人力雅可比矩阵,为雅克比矩阵J的转置,F为机器人末端受力;
机器人关节力矩τ与关节变形Δq的关系:
τ=KθΔq (2)
Kθ为机器人关节刚度矩阵,Kθ=diag(k1,k2,...,k6),k1,k2,...,k6为机器人各关节刚度,Δq为关节变形;
机器人末端变形ΔX与末端受力F的关系:
F=KxΔX (3)
Kx为机器人末端操作刚度矩阵,ΔX为因F产生的末端变形;
对等式(1)进行偏微分:
Figure BDA0003012574840000021
Figure BDA0003012574840000022
定义
Figure BDA0003012574840000023
为补偿刚度矩阵,表述为机器人受到外部加载或雅克比随其配置而改变的情况。
将连杆刚度矩阵KL代入等式(4)中:
(Kθ -1+KL -1)-1=JTKxJ+KC (5)
公式(5)为机器人刚度的一般形式,机器人系统的刚度由关节刚度矩阵Kθ、连杆刚度矩阵KL、末端操作刚度矩阵Kx和补偿刚度矩阵KC组成;
b)末端操作刚度矩阵Kx的求解:
Kx通过虚位移原理求解,采用一种用于测定关节刚度的装置;
机器人末端受力的变化量Δf与末端变形量Δx的关系:
Δf=KxΔx (6)
Δf=[Δfx Δfy Δfz Δmx Δmy Δmz]T,是六维力传感器的变化值,其中,Δfx为x轴力的变化值,Δfy为y轴力的变化值,Δfz为z轴力的变化值,Δmx为x轴力矩变化值,Δmy为y轴力矩变化值,Δmz为z轴力矩变化值;
Δx=[Δpx Δpy Δpz Δθx Δθy Δθz]T,是机器人真实虚位移量,其中,Δpx为x轴真实线虚位移量,Δpy为y轴真实线虚位移量,Δpz为z轴真实线虚位移量,Δθx为x轴真实转角虚位移量,Δθy为y轴真实转角虚位移量,Δθz为z轴真实转角虚位移量;
给定x方向一个微小位移x1=[p1xp1yp1zθ1xθ1yθ1z]T,其中,p1x为x轴给定线虚位移量,p1y为y轴给定线虚位移量,p1z为z轴给定线虚位移量,θ1x为x轴给定转角虚位移量,θ1y为y轴给定转角虚位移量,θ1z为z轴给定转角虚位移量;
由于关节刚度测定装置的刚度不能忽略,用激光位移传感器测量相对位移x2=[p2xp2yp2zθ2xθ2yθ2z]T,其中,p2x为x轴由激光位移传感器测量得到的线虚位移量,p2y为y轴由激光位移传感器测量得到的线虚位移量,p2z为z轴由激光位移传感器测量得到的线虚位移量,θ2x为x轴由激光位移传感器测量得到的转角虚位移量,θ2y为y轴由激光位移传感器测量得到的转角虚位移量,θ2z为z轴由激光位移传感器测量得到的转角虚位移量;
故真实虚位移量为Δx=x1-x2=[Δpx Δpy Δpz Δθx Δθy Δθz]T
Figure BDA0003012574840000031
Figure BDA0003012574840000032
其中,k11,…,k66为Kx矩阵的各元素值,以此可以求得Kx矩阵的第一列元素值,经过六次实验可以求得Kx矩阵的各列元素值;
c)补偿刚度矩阵KC的求解:
通过微分变换法求解机器人雅可比矩阵解析解J,再通过转置得到JT,F为六维力传感器初始值;
得到
Figure BDA0003012574840000041
d)连杆刚度矩阵KL的求解:
通过空间连杆间的力传递公式,计算各连杆上受到的等效力(力矩)矢量:
Figure BDA0003012574840000042
iFiiMi是各连杆外侧的力和力矩,iP是位置矢量;
根据材料力学的知识,计算单元连杆的变形:
Figure BDA0003012574840000043
其中
Figure BDA0003012574840000044
是x,y,z方向的变形,
Figure BDA0003012574840000045
是x,y,z方向的偏移;
计算变形误差矩阵:
Figure BDA0003012574840000046
其中,
Figure BDA0003012574840000047
为机器人齐次变换矩阵,
Figure BDA0003012574840000048
为误差矩阵,所需要的Δpx,Δpy,Δpz分别为x,y,z方向因位置变形引起的末端误差量;
计算转角变形量:
Figure BDA0003012574840000049
其中,Δθx,Δθy,Δθz分别为x,y,z方向的转角变形量;
得到连杆刚度矩阵:
Figure BDA00030125748400000410
其中Fx,Fy,Fz,Mx,My,Mz为六维力传感器数值。
最终得到关节刚度:
Kθ=[(JTKxJ+KC)-1-KL -1]-1 (15)
(2)机器人末端操作刚度性能评价方法,其步骤如下:
根据步骤(1)获得的机器人关节刚度矩阵Kθ是机器人的固有特性,与机器人姿态无关,而末端操作刚度矩阵Kx和机器人姿态有关,决定了机器人末端刚度性能,通过公式Kx=J-T[(Kθ -1+KL -1)-1+KC]J-1可以获得任意姿态下机器人的末端操作刚度矩阵K′x,将总柔度矩阵根据受力类型和变形类型的关系分为四个子矩阵:
Figure BDA0003012574840000051
Cfd为力-线位移柔度矩阵,Cnd为力矩-线位移柔度矩阵,C为力-角位移柔度矩阵,C为力矩-角位移柔度矩阵;
选择Cfd描述末端力矢量f与末端线变形d的关系:
d=Cfdf (17)
考虑单位线变形||d||=dTd=1
即fTCfd TCfdf=1 (18)
以(J(1,4)J(2,4)J(3,4))作为椭球中心,以Cfd TCfd特征向量方向作为椭球主轴方向,以Cfd TCfd特征值倒数的开方作为椭球的半轴长,建立力-线刚度椭球;
力传感器测得的力为(Fx,Fy,Fz),定义椭球中心为原点,过椭球中心和力的直线参数方程为:
Figure BDA0003012574840000052
代入椭球的方程
Figure BDA0003012574840000053
中,其中Rx,Ry,Rz分别为椭球x,y,z方向的半轴长;
解得参数
Figure BDA0003012574840000054
再计算交点到椭球中心的距离:
Figure BDA0003012574840000055
最终得到因外力F导致的末端线变形为:
Figure BDA0003012574840000061
δ作为系统刚度实时评价指标,δ越大表示因外力F导致的末端线变形越大,刚度性能越差,该评价指标不仅提供了一种可视化的展示,还可以实时量化系统刚度的大小以及方向,为关节型机器人加工姿态刚度优化提供了评价标准。
本发明步骤(1)中b)所述一种用于测定关节刚度的装置,包括:法兰连接件、力传感器连接法兰、激光位移传感器连接件、力传感器连接件、工作台连接件、激光位移传感器、六维力传感器和工作台,其中,法兰连接件和力传感器连接法兰通过螺栓与机器人末端法兰固定,激光位移传感器连接件与法兰连接件通过螺栓连接,力传感器固定在力传感器连接法兰上,力传感器连接件用螺栓与六维力传感器固定,工作台连接件两端分别与力传感器连接件和工作台通过T型螺栓连接;
激光位移传感器安装的三个工位,工位一测量绕y轴旋转虚位移差量,工位二测量绕x轴旋转虚位移差量和z轴平移虚位移差量,工位三测量x、y轴平移虚位移差量和绕z轴旋转虚位移差量。
本发明与现有技术相比,优点在于:
(1)实验装置简单,只需测量位移和力数值,编程简便,易于操作,显著提升测定机器人关节刚度的速度;
(2)减小了连杆刚度、虚位移量误差和有外力加载下的刚度误差的影响,显著提升机器人关节刚度测定的准确性,从而提高机器人系统的加工精度;
(3)进行了机器人刚度可视化,并提出机器人末端刚度性能评价方法,评价方法简便、准确,直观反映机器人实时刚度性能。
附图说明
图1是本发明基于机器人关节刚度测定装置的机器人末端刚度性能评价的流程图;
图2是本发明的机器人关节刚度测定装置前轴测图;
图3是本发明的机器人关节刚度测定装置后轴测图;
图4是本发明的机器人末端刚度性能评价的可视化示意图。
具体实施方式
工控机与机器人控制器通过Ethernet/IP数据连接、与六维力传感器通过TCP/IP数据连接、与激光位移传感器通过USB数据连接;得到机器人关节刚度矩阵,求解机器人雅可比矩阵并建立末端机器人刚度椭球,刚度椭球面与末端力矢量的交点和椭球中心的距离与力矢量长度的乘积作为机器人末端刚度的评价指标。
本发明所述装置中连接件和连接法兰材料均为45钢,弹性模量196-206Gpa,杨氏模量79Gpa,泊松比0.3。
以下结合附图1-4对本发明进一步详细说明:
如图1所示,是基于机器人关节刚度测定装置的机器人末端刚度性能评价的流程图。
基于机器人雅可比矩阵与刚度矩阵建立机器人关节刚度测定方案,流程图具体步骤如下:
a)机器人关节刚度矩阵Kθ的推导:
机器人关节力矩τ与末端受力F的关系:
τ=JTF (1)
τ为机器人关节力矩,JT为机器人力雅可比矩阵,为雅克比矩阵J的转置,F为机器人末端受力;
机器人关节力矩τ与关节变形Δq的关系:
τ=KθΔq (2)
Kθ为机器人关节刚度矩阵,Kθ=diag(k1,k2,...,k6),k1,k2,...,k6为机器人各关节刚度,Δq为关节变形;
机器人末端变形ΔX与末端受力F的关系:
F=KxΔX (3)
Kx为机器人末端操作刚度矩阵,ΔX为因F产生的末端变形。
对等式(1)进行偏微分:
Figure BDA0003012574840000071
Figure BDA0003012574840000072
定义
Figure BDA0003012574840000073
为补偿刚度矩阵,表述为机器人受到外部加载或雅克比随其配置而改变的情况;
将连杆刚度矩阵KL代入等式(4)中:
(Kθ -1+KL -1)-1=JTKxJ+KC (5)
公式(5)为机器人刚度的一般形式,机器人系统的刚度由关节刚度矩阵Kθ、连杆刚度矩阵KL、末端操作刚度矩阵Kx和补偿刚度矩阵KC组成;
b)末端操作刚度矩阵Kx的求解:
如图1和2所示,Kx通过虚位移原理求解,提出了一种关节刚度测定装置,包括:法兰连接件2、力传感器连接法兰3、激光位移传感器连接件7、力传感器连接件5、工作台连接件6、激光位移传感器8、六维力传感器4和工作台。其中,法兰连接件2和力传感器连接法兰3通过螺栓与机器人末端法兰1固定,激光位移传感器连接件7与法兰连接件2通过螺栓连接,力传感器固定在力传感器连接法兰3上,力传感器连接件5用螺栓与六维力传感器4固定,工作台连接件6两端分别与力传感器连接件5和工作台通过T型螺栓连接;
工位一801、工位二802和工位三803分别为激光位移传感器8安装的三个工位,工位一801测量绕y轴旋转虚位移差量,工位二802测量绕x轴旋转虚位移差量和z轴平移虚位移差量,工位三803测量x、y轴平移虚位移差量和绕z轴旋转虚位移差量;
机器人末端受力的变化量Δf与末端变形量Δx的关系:
Δf=KxΔx (6)
Δf=[Δfx Δfy Δfz Δmx Δmy Δmz]T,是六维力传感器的变化值;
Δx=[Δpx Δpy Δpz Δθx Δθy Δθz]T,是机器人真实虚位移量;
给定x方向一个微小位移x1=[p1xp1yP1zθ11yθ1z]T,由于关节刚度测定装置的刚度不能忽略,用激光位移传感器测量相对位移x2=[p2xp2yp2zθ22yθ2z]T,故真实虚位移量为Δx=x1-x2=[Δpx Δpy Δpz Δθx Δθy Δθz]T
Figure BDA0003012574840000081
Figure BDA0003012574840000091
以此可以求得Kx矩阵的第一列元素值,经过六次实验可以求得Kx矩阵的各列元素值。
c)补偿刚度矩阵KC的求解:
通过微分变换法求解机器人雅可比矩阵解析解J,再通过转置得到JT,F为六维力传感器初始值。
得到
Figure BDA0003012574840000092
d)连杆刚度矩阵KL的求解:
通过空间连杆间的力传递公式,计算各连杆上受到的等效力(力矩)矢量:
Figure BDA0003012574840000093
iFiiMi是各连杆外侧的力和力矩,iP是位置矢量;
根据材料力学的知识,计算单元连杆的变形:
Figure BDA0003012574840000094
其不
Figure BDA0003012574840000095
是x,y,z方向的变形,
Figure BDA0003012574840000096
是x,y,z方向的偏移;
计算变形误差矩阵:
Figure BDA0003012574840000097
其中,
Figure BDA0003012574840000098
为机器人齐次变换矩阵,
Figure BDA0003012574840000099
为误差矩阵;
计算转角变形量:
Figure BDA00030125748400000910
得到连杆刚度矩阵:
Figure BDA0003012574840000101
其中Fx,Fy,Fz,Mx,My,Mz为六维力传感器数值;
最终得到关节刚度:
Kθ=[(JTKxJ+KC)-1-KL -1]-1 (15)
图4所示,是基于机器人关节刚度测定装置的机器人刚度性能评价的可视化示意图。利用可视化软件对机器人末端刚度进行可视化展示,量化机器人末端刚度大小,直观反映机器人末端刚度优劣,为操作人员提供可视化的刚度性能展示平台;
Kθ为机器人的关节刚度,是机器人的固有特性,与机器人姿态无关,而末端操作刚度矩阵Kx和机器人姿态有关,决定了机器人末端刚度性能,通过Kx=J-T[(Kθ -1+KL -1)-1+KC]J-1可以求得任意姿态下的末端操作刚度矩阵K′x,便可以将总柔度矩阵根据力和变形的关系分为四个子矩阵:
Figure BDA0003012574840000102
Cfd为力-线位移柔度矩阵,Cnd为力矩-线位移柔度矩阵,C为力-角位移柔度矩阵,C为力矩-角位移柔度矩阵;
选择Cfd描述末端力矢量f与末端线变形d的关系:
d=Cfdf (17)
考虑单位线变形||d||=dTd=1
即fTCfd TCfdf=1 (18)
以(J(1,4)J(2,4)J(3,4))作为椭球中心,以Cfd TCfd特征向量方向作为椭球主轴方向,以Cfd TCfd特征值倒数的开方作为椭球的半轴长,建立力-线刚度椭球;
力传感器测得的力为(Fx,Fy,Fz),定义椭球中心为原点,过椭球中心和力的直线参数方程为:
Figure BDA0003012574840000103
代入椭球的方程
Figure BDA0003012574840000111
中,其中Rx,Ry,Rz为椭球半轴长;
解得
Figure BDA0003012574840000112
再计算交点到椭球中心的距离:
Figure BDA0003012574840000113
最终得到因外力F导致的末端线变形为:
Figure BDA0003012574840000114
δ作为系统刚度实时评价指标,δ越大表示因外力F导致的末端线变形越大,刚度性能越差,该评价指标不仅提供了一种可视化的展示,还可以实时量化系统刚度的大小以及方向,为关节型机器人加工姿态刚度优化提供了评价标准。

Claims (2)

1.一种机器人末端刚度性能评价方法,其特征在于,包括下列步骤:
(1)基于机器人雅克比矩阵与刚度矩阵建立机器人关节刚度测定方法,步骤如下:
a)机器人关节刚度矩阵Kθ的推导:
机器人关节力矩τ与末端受力F的关系:
τ=JTF (1)
τ为机器人关节力矩,JT为机器人力雅可比矩阵,为雅克比矩阵J的转置,F为机器人末端受力;
机器人关节力矩τ与关节变形Δq的关系:
τ=KθΔq (2)
Kθ为机器人关节刚度矩阵,Kθ=diag(k1,k2,…,k6),k1,k2,…,k6为机器人各关节刚度,Δq为关节变形;
机器人末端变形ΔX与末端受力F的关系:
F=KxΔX (3)
Kx为机器人末端操作刚度矩阵,ΔX为因F产生的末端变形;
对等式(1)进行偏微分:
Figure FDA0003012574830000011
Figure FDA0003012574830000012
定义
Figure FDA0003012574830000013
为补偿刚度矩阵,表述为机器人受到外部加载或雅克比随其配置而改变的情况。
将连杆刚度矩阵KL代入等式(4)中:
(Kθ -1+KL -1)-1=JTKxJ+KC (5)
公式(5)为机器人刚度的一般形式,机器人系统的刚度由关节刚度矩阵Kθ、连杆刚度矩阵KL、末端操作刚度矩阵Kx和补偿刚度矩阵KC组成;
b)末端操作刚度矩阵Kx的求解:
Kx通过虚位移原理求解,采用一种用于测定关节刚度的装置;
机器人末端受力的变化量Δf与末端变形量Δx的关系:
Δf=KxΔx (6)
Δf=[Δfx Δfy Δfz Δmx Δmy Δmz]T,是六维力传感器的变化值,其中,Δfx为x轴力的变化值,Δfy为y轴力的变化值,Δfz为z轴力的变化值,Δmx为x轴力矩变化值,Δmy为y轴力矩变化值,Δmz为z轴力矩变化值;
Δx=[Δpx Δpy Δpz Δθx Δθy Δθz]T,是机器人真实虚位移量,其中,Δpx为x轴真实线虚位移量,Δpy为y轴真实线虚位移量,Δpz为z轴真实线虚位移量,Δθx为x轴真实转角虚位移量,Δθy为y轴真实转角虚位移量,Δθz为z轴真实转角虚位移量;
给定x方向一个微小位移x1=[p1xp1yp1zθ1xθ1yθ1z]T,其中,p1x为x轴给定线虚位移量,p1y为y轴给定线虚位移量,p1z为z轴给定线虚位移量,θ1x为x轴给定转角虚位移量,θ1y为y轴给定转角虚位移量,θ1z为z轴给定转角虚位移量;
由于关节刚度测定装置的刚度不能忽略,用激光位移传感器测量相对位移x2=[p2xp2yp2zθ2xθ2yθ2z]T,其中,p2x为x轴由激光位移传感器测量得到的线虚位移量,p2y为y轴由激光位移传感器测量得到的线虚位移量,p2z为z轴由激光位移传感器测量得到的线虚位移量,θ2x为x轴由激光位移传感器测量得到的转角虚位移量,θ2y为y轴由激光位移传感器测量得到的转角虚位移量,θ2z为z轴由激光位移传感器测量得到的转角虚位移量;
故真实虚位移量为Δx=x1―x2=[Δpx Δpy Δpz Δθx Δθy Δθz]T
Figure FDA0003012574830000021
Figure FDA0003012574830000031
其中,k11,…,k66为Kx矩阵的各元素值,以此可以求得Kx矩阵的第一列元素值,经过六次实验可以求得Kx矩阵的各列元素值;
c)补偿刚度矩阵KC的求解:
通过微分变换法求解机器人雅可比矩阵解析解J,再通过转置得到JT,F为六维力传感器初始值;
得到
Figure FDA0003012574830000032
d)连杆刚度矩阵KL的求解:
通过空间连杆间的力传递公式,计算各连杆上受到的等效力(力矩)矢量:
Figure FDA0003012574830000033
iFiiMi是各连杆外侧的力和力矩,iP是位置矢量;
根据材料力学的知识,计算单元连杆的变形:
Figure FDA0003012574830000034
其中
Figure FDA0003012574830000035
是x,y,z方向的变形,
Figure FDA0003012574830000036
是x,y,z方向的偏移;
计算变形误差矩阵:
Figure FDA0003012574830000037
其中,
Figure FDA0003012574830000038
为机器人齐次变换矩阵,
Figure FDA0003012574830000039
为误差矩阵,所需要的Δpx,Δpy,Δpz分别为x,y,z方向因位置变形引起的末端误差量;
计算转角变形量:
Figure FDA0003012574830000041
其中,Δθx,Δθy,Δθz分别为x,y,z方向的转角变形量;
得到连杆刚度矩阵:
Figure FDA0003012574830000042
其中Fx,Fy,Fz,Mx,My,Mz为六维力传感器数值。
最终得到关节刚度:
Kθ=[(JTKxJ+KC)-1―KL -1]-1 (15)
(2)机器人末端操作刚度性能评价方法,其步骤如下:
根据步骤(1)获得的机器人关节刚度矩阵Kθ是机器人的固有特性,与机器人姿态无关,而末端操作刚度矩阵Kx和机器人姿态有关,决定了机器人末端刚度性能,通过公式Kx=J-T[(Kθ -1+KL -1)-1+KC]J-1可以获得任意姿态下机器人的末端操作刚度矩阵K′x,将总柔度矩阵根据受力类型和变形类型的关系分为四个子矩阵:
Figure FDA0003012574830000043
Cfd为力-线位移柔度矩阵,Cnd为力矩-线位移柔度矩阵,C为力-角位移柔度矩阵,C为力矩-角位移柔度矩阵;
选择Cfd描述末端力矢量f与末端线变形d的关系:
d=Cfdf (17)
考虑单位线变形‖d‖=dTd=1
即fTCfd TCfdf=1 (18)
以(J(1,4) J(2,4) J(3,4))作为椭球中心,以Cfd TCfd特征向量方向作为椭球主轴方向,以Cfd TCfd特征值倒数的开方作为椭球的半轴长,建立力-线刚度椭球;
力传感器测得的力为(Fx,Fy,Fz),定义椭球中心为原点,过椭球中心和力的直线参数方程为:
Figure FDA0003012574830000051
代入椭球的方程
Figure FDA0003012574830000052
中,其中Rx,Ry,Rz分别为椭球x,y,z方向的半轴长;
解得参数
Figure FDA0003012574830000053
再计算交点到椭球中心的距离:
Figure FDA0003012574830000054
最终得到因外力F导致的末端线变形为:
Figure FDA0003012574830000055
δ作为系统刚度实时评价指标,δ越大表示因外力F导致的末端线变形越大,刚度性能越差,该评价指标不仅提供了一种可视化的展示,还可以实时量化系统刚度的大小以及方向,为关节型机器人加工姿态刚度优化提供了评价标准。
2.根据权利要求1所述的一种机器人末端刚度性能评价方法,其特征在于:步骤(1)中b)所述一种用于测定关节刚度的装置,包括:法兰连接件、力传感器连接法兰、激光位移传感器连接件、力传感器连接件、工作台连接件、激光位移传感器、六维力传感器和工作台,其中法兰连接件和力传感器连接法兰通过螺栓与机器人末端法兰固定,激光位移传感器连接件与法兰连接件通过螺栓连接,力传感器固定在力传感器连接法兰上,力传感器连接件用螺栓与六维力传感器固定,工作台连接件两端分别与力传感器连接件和工作台通过T型螺栓连接;
激光位移传感器8安装三个工位,工位一测量绕y轴旋转虚位移差量,工位二测量绕x轴旋转虚位移差量和z轴平移虚位移差量,工位三测量x、y轴平移虚位移差量和绕z轴旋转虚位移差量。
CN202110391457.XA 2021-04-09 2021-04-09 一种机器人末端刚度性能评价方法 Active CN113084812B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110391457.XA CN113084812B (zh) 2021-04-09 2021-04-09 一种机器人末端刚度性能评价方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110391457.XA CN113084812B (zh) 2021-04-09 2021-04-09 一种机器人末端刚度性能评价方法

Publications (2)

Publication Number Publication Date
CN113084812A true CN113084812A (zh) 2021-07-09
CN113084812B CN113084812B (zh) 2022-06-21

Family

ID=76676355

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110391457.XA Active CN113084812B (zh) 2021-04-09 2021-04-09 一种机器人末端刚度性能评价方法

Country Status (1)

Country Link
CN (1) CN113084812B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114310888A (zh) * 2021-12-28 2022-04-12 广东省科学院智能制造研究所 一种协作机器人可变刚度运动技能学习与调控方法及系统
CN115855477A (zh) * 2023-02-27 2023-03-28 珞石(北京)科技有限公司 用于机器人关节性能测试的装置及测试方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104964877A (zh) * 2015-07-29 2015-10-07 北京汽车研究总院有限公司 一种刚度测试装置及系统
CN107545127A (zh) * 2017-10-13 2018-01-05 北京工业大学 一种考虑接触的工业机器人关节刚度建模方法
CN108387351A (zh) * 2018-02-12 2018-08-10 华中科技大学 一种肢体末端刚度测量装置及其测量方法
CN110161850A (zh) * 2019-04-24 2019-08-23 南京航空航天大学 一种工业机器人变参数刚度辨识与建模方法
CN110154022A (zh) * 2019-05-20 2019-08-23 南京航浦机械科技有限公司 一种基于定向刚度模型的机器人制孔径向定位修正方法
WO2020053195A1 (en) * 2018-09-14 2020-03-19 Universal Robots A/S Obtaining the gear stiffness of a robot joint gear of a robot arm
CN112244833A (zh) * 2020-09-27 2021-01-22 华中科技大学 一种基于协作机械臂的人体上肢多维末端刚度测量方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104964877A (zh) * 2015-07-29 2015-10-07 北京汽车研究总院有限公司 一种刚度测试装置及系统
CN107545127A (zh) * 2017-10-13 2018-01-05 北京工业大学 一种考虑接触的工业机器人关节刚度建模方法
CN108387351A (zh) * 2018-02-12 2018-08-10 华中科技大学 一种肢体末端刚度测量装置及其测量方法
WO2020053195A1 (en) * 2018-09-14 2020-03-19 Universal Robots A/S Obtaining the gear stiffness of a robot joint gear of a robot arm
CN110161850A (zh) * 2019-04-24 2019-08-23 南京航空航天大学 一种工业机器人变参数刚度辨识与建模方法
CN110154022A (zh) * 2019-05-20 2019-08-23 南京航浦机械科技有限公司 一种基于定向刚度模型的机器人制孔径向定位修正方法
CN112244833A (zh) * 2020-09-27 2021-01-22 华中科技大学 一种基于协作机械臂的人体上肢多维末端刚度测量方法

Non-Patent Citations (7)

* Cited by examiner, † Cited by third party
Title
G. ALICI ET AL.: "Enhanced stiffness modeling, identification and characterization for robot manipulators", 《IEEE TRANSACTIONS ON ROBOTICS》 *
IMIN KAO: "Stiffness control and calibration of robotic and human hands and fingers", 《PROCEEDINGS OF THE 1994 IEEE INTERNATIONAL CONFERENCE ON ROBOTICS AND AUTOMATION》 *
宋彦国等: "一种识别复杂连接结构刚度参数的实用方法", 《振动工程学报》 *
张永贵等: "6R工业机器人刚度分析", 《机械设计与制造》 *
曲巍崴等: "机器人加工系统刚度性能优化研究", 《航空学报》 *
林洁琼等: "刚度主轴方位对模态耦合再生切削系统动态响应谐参数的影响", 《振动与冲击》 *
王玉柱: "新型三维平动并联微操作机器人的分析与设计", 《中国优秀硕士论文全文电子期刊网 信息科技辑》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114310888A (zh) * 2021-12-28 2022-04-12 广东省科学院智能制造研究所 一种协作机器人可变刚度运动技能学习与调控方法及系统
CN115855477A (zh) * 2023-02-27 2023-03-28 珞石(北京)科技有限公司 用于机器人关节性能测试的装置及测试方法

Also Published As

Publication number Publication date
CN113084812B (zh) 2022-06-21

Similar Documents

Publication Publication Date Title
CN112873199B (zh) 基于运动学与空间插值的机器人绝对定位精度标定方法
CN110202582B (zh) 一种基于三坐标平台的机器人标定方法
CN113084812B (zh) 一种机器人末端刚度性能评价方法
EP1809446B1 (en) Method and system to provide imporved accuracies in multi-jointed robots through kinematic robot model parameters determination
CN107639635B (zh) 一种机械臂位姿误差标定方法及系统
Guo et al. A multilevel calibration technique for an industrial robot with parallelogram mechanism
CN113580148B (zh) 基于等效运动链的并联机器人运动学标定方法
Boby Identification of elasto-static parameters of an industrial robot using monocular camera
Liu et al. Closed-loop kinematic calibration of robots using a six-point measuring device
CN113359609B (zh) 五轴数控机床关键几何误差优化配比补偿方法
CN115294198A (zh) 一种基于视觉的机械臂全局性能测量系统及方法
Chiwande et al. Comparative need analysis of industrial robot calibration methodologies
CN112344895B (zh) 一种关节臂坐标测量机多参数模型的建立及标定方法
Sazonnikova et al. Increasing of the industrial robot movement accuracy at the incremental forming process
CN113733155B (zh) 六轴工业机器人标定装置和标定方法
CN115091455A (zh) 一种工业机器人定位误差补偿方法
KR101826577B1 (ko) 로봇의 손목 축 움직임을 이용한 툴 보정 방법
KR100263442B1 (ko) 공작물 치수정보를 이용한 로봇 셀 자체보정방법
Gu et al. A two-step self-calibration method with portable measurement devices for industrial robots based on poe formula
Mai et al. Applying a Virtual Tool Center Point Calibration and Position Teaching System of Robotic Arm to Automatically Detect Displays
CN114147726B (zh) 一种几何误差与非几何误差相结合的机器人标定方法
Gründel et al. Measurement Setup and Modeling Approach for the Deformation of Robot Bodies During Machining
CN116945235A (zh) 一种工业机器人系统刚度性能评价方法
CN114147726A (zh) 一种几何误差与非几何误差相结合的机器人标定方法
Liao et al. Error Compensation for Industrial Robots

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant