CN107038275A - 一种机械臂误差分析方法 - Google Patents
一种机械臂误差分析方法 Download PDFInfo
- Publication number
- CN107038275A CN107038275A CN201611176391.8A CN201611176391A CN107038275A CN 107038275 A CN107038275 A CN 107038275A CN 201611176391 A CN201611176391 A CN 201611176391A CN 107038275 A CN107038275 A CN 107038275A
- Authority
- CN
- China
- Prior art keywords
- error
- joint
- mechanical arm
- tail end
- arm tail
- 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
Links
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/30—Circuit design
- G06F30/36—Circuit design at the analogue level
- G06F30/367—Design verification, e.g. using simulation, simulation program with integrated circuit emphasis [SPICE], direct methods or relaxation methods
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
Landscapes
- Engineering & Computer Science (AREA)
- Computer Hardware Design (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Evolutionary Computation (AREA)
- Microelectronics & Electronic Packaging (AREA)
- Mechanical Engineering (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Robotics (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种机械臂误差分析方法,在机械臂运动模型的基础上,分析各运动学参数误差对机械臂末端位置精度的敏感性和影响规律,为机械臂的设计、加工、装配时的精度分配提供依据。其分析步骤为:(1)利用指数积方法建立机械臂的运动学模型;(2)根据运动学模型建立机械臂末端位置误差模型;(3)分析各关节误差和初始位姿误差对机械臂末端位置精度的敏感性;(4)分析关节各项误差随各关节角变化时对机械臂末端位置精度的影响规律;(5)根据各误差的敏感性和影响规律,指导机械臂的精度分配。本发明具有计算精确,操作方便,分析全面等优点。
Description
技术领域
本发明涉及机械臂误差分析,具体是对影响机械臂末端位置精度的各误差的敏感性和影响规律分析。
背景技术
随着机械臂应用领域的扩展,人们对机械臂的性能要求日益提高,机械臂正朝着智能化、高精度方向发展。精度是评价机械臂性能的重要性能之一,经过许多年的发展如今已能够达到很高的重复定位精度,但是其绝对定位精度还很低。由于机械臂的设计制造和装配误差、控制系统和工作环境因素的影响,机械臂控制器中的运动学模型与机械臂实际模型存在差异,因此造成机械臂的工作精度低。
根据研究表明,由于机械臂制造、装配误差引起的末端执行器位姿误差占误差的90%左右。知道影响各运动学参数误差对机械臂末端位置精度的敏感性和影响规律,可合理地对误差进行分配,提高机械臂末端的位置精度。
发明内容
针对上述问题,本发明的目的在于提供一种计算精确,操作方便,分析全面的机械臂误差分析方法,用来分析各运动学参数误差对机械臂末端位置精度的敏感性和影响规律,指导机械臂的精度分配。
本发明为实现上述目的所采用的技术方案是:一种机械臂误差分析方法,包括以下步骤:
步骤1:利用指数积方法建立机械臂的运动学模型;
步骤2:根据运动学模型建立机械臂末端位置误差模型;
步骤3:分析机械臂末端位置误差模型的各关节误差和初始位姿误差对机械臂末端位置精度的敏感性,得到各关节误差和初始位姿误差敏感性比值;
步骤4:分析机械臂末端位置误差模型的关节各项误差随各关节角变化时对机械臂末端位置精度的影响规律;
步骤5:根据得到的敏感性比值和影响规律,指导机械臂的精度分配。
所述利用指数积方法建立机械臂的运动学模型,包括以下步骤:
通过关节轴线方向的单位矢量w和关节轴线上的一点r计算得到关节的运动旋量ξ:
其中,w=(w1,w2,w3)T,r=(r1,r2,r3)T;
那么,每个关节的转换矩阵为:
其中,θ表示关节角度,旋转矩阵通下式计算得到:
机械臂末端坐标系{T}相对于基坐标系{S}的初始位姿为:
其中,R0表示坐标系{T}在基坐标系{S}中的初始姿态,P0表示坐标系{T}原点在基坐标系{S}中的初始位置;
机械臂运动学模型为多个关节的转换矩阵与初始位姿相乘,即可得到机械臂末端的位姿如下:
其中,θ=(θ1,θ2,…,θi,…,θn)T为关节角向量,n为关节的个数,θi为第i个关节的关节角;R表示坐标系{T}在基坐标系{S}中的姿态,P表示表示坐标系{T}原点在基坐标系{S}中的位置。
所述根据运动学模型建立机械臂末端位置误差模型,包括以下步骤:
从机械臂运动学模型公式(1)得到引起机械臂末端位置误差的有:关节角θ的误差、关节运动旋量ξ的误差、初始位姿的误差;所述关节运动旋量ξ的误差包括关节轴方向w的误差、关节轴位置r的误差;并且,关节新的运动旋量应满足关节约束条件:||w'||=1、w'Tv'=0;
所以引入误差后的运动学参数可以表示为:
θ'=θ+Δθ
w'=RZ(Δα)RY(Δβ)RX(Δγ)w
r'=r+Δr
v'=r'×w'
其中,Δθ表示关节角误差,Δα、Δβ、Δγ表示关节轴方向或末端坐标系{T}的旋转角度误差,RZ(Δα)、RY(Δβ)、RX(Δγ)为误差转换矩阵,Δr表示关节轴上一点的位置误差,ΔP0表示末端坐标系{T}的原点位置误差;
那么,根据机械臂运动学模型,即可得到存在误差时机械臂末端的实际位姿为:
则机械臂末端位置误差模型为:
ΔP=P'-P。 (2)
所述分析机械臂末端位置误差模型的各关节误差和初始位姿误差对机械臂末端位置精度的敏感性,得到各关节误差和初始位姿误差敏感性比值,包括以下步骤:
4-1:当所有关节的关节角θ、关节运动旋量ξ和初始位姿同时存在误差时,将存在误差的实际的运动学参数代入机械臂末端位置误差模型公式(2),随机产生K组关节角向量θ=(θ1,θ2,…,θi,…,θn)T形成K个位姿;计算出机械臂末端位置误差{ΔP总 1,…,ΔP总 X,…ΔP总 K},得到机械臂末端位置总误差的平均值和最大值
4-2:当只有第i个关节的关节角θi和关节旋量ξi存在误差误差,其余关节和初始位姿均不存在误差时,将存在误差的实际的运动学参数代入机械臂末端位置误差模型公式(2),随机产生K组关节角向量θ=(θ1,θ2,…,θi,…,θn)T形成K个位姿,计算出机械臂末端位置误差{ΔPi 1,…,ΔPi X,…ΔPi K},得到机械臂末端位置误差的平均值和最大值
|ΔPi|最大=max(|ΔPi 1|,…,|ΔPi X|,…,|ΔPi K|),n个关节,共得到n个平均值:
|ΔP1|平均,…,|ΔPi|平均,…,|ΔPn|平均与最大值:|ΔP1|最大,…,|ΔPi|最大,…,|ΔPn|最大;
4-3:当只有初始位姿存在误差,所有关节角和关节运动旋量均不存在误差时,将存在误差后实际的运动学参数代入机械臂末端位置误差模型公式(2),随机产生K组关节角向量θ=(θ1,θ2,…,θi,…,θn)T形成K个位姿,计算出机械臂末端位置误差{ΔPst 1,…,ΔPst X,…ΔPst K},得到机械臂末端位置误差的平均值和最大值
4-4:计算各关节误差和初始位姿敏感性比值:|ΔPi|平均/|ΔP总|平均、|ΔPi|最大/|ΔP总|最大、|ΔPst|平均/|ΔP总|平均、|ΔPst|最大/|ΔP总|最大;其中,i=1,…,n。
所述分析机械臂末端位置误差模型的关节各项误差随各关节角变化时对机械臂末端位置精度的影响规律,包括以下步骤:
5-1:在某一关节角向量θ=(θ1,θ2,…,θi,…,θn)T下,依次转动关节1至n,分别得到n幅与关节角误差相关联的机械臂末端位置误差的影响规律曲线图,所述每幅中包含n条曲线,所述每条曲线表示每个关节角误差Δθi随当前转动关节变化对机械臂末端位置误差的影响;
得到关节角误差随每个关节角变化时对机械臂末端误差的影响规律:关节角误差对造成的机械臂末端位置误差与其轴线到机械臂末端的距离成正比;第i个关节转动时,第1至(i-1)个关节角误差造成的机械臂末端位置误差会随第i个关节角变化,但最后一个关节转动时,各误差造成的影响不变;
5-2:在某一关节角向量θ=(θ1,θ2,…,θi,…,θn)T下,依次转动关节1至n,分别得到n幅与关节轴方向误差相关联的机械臂末端位置误差的影响规律曲线图,所述每幅中包含n条曲线,所述每条曲线表示每个关节轴方向误差随当前转动关节变化对机械臂末端位置误差的影响;所述每个关节轴方向误差通过Δαi、Δβi、Δγi计算得到;
得到关节轴方向误差随每个关节角变化时对机械臂末端误差的影响规律:第i个关节转动时,第1~i个关节轴方向误差造成的机械臂末端位置误差会随第i个关节角变化;某个关节角为零时,该关节轴方向误差不会对机械臂末端位置造成影响;
5-3:在某一关节角向量θ=(θ1,θ2,…,θi,…,θn)T下,依次转动关节1至n,分别得到n幅与关节轴位置误差向关联的机械臂末端位置误差的影响规律曲线图,所述每幅中包含n条曲线,所述每条曲线表示每个关节轴位置误差Δri随当前转动关节变化对机械臂末端位置误差的影响;
得到关节轴位置误差随每个关节角变化时对机械臂末端误差的影响规律:第i个关节轴位置误差造成的机械臂末端位置误差只与第i个关节角有关。
所述根据得到的敏感性比值和影响规律,指导机械臂的精度分配,包括:
根据各关节和初始位姿敏感性比值,比值越大表示机械臂末端位置误差对该关节或初始位姿的运动参数越敏感;根据关节角误差和关节轴方向误差随关节离机械臂末端的距离增加而变大;而关节轴位置误差对机械臂末端位置的影响等效;
在机械臂制造和装配过程中,提高关节角和关节轴方向的精度,以及提高各关节误差和初始位姿误差敏感性比值大的关节或初始位姿的精度,来提高机械臂末端的位置精度。
本发明具有以下有益效果及优点:
1.本发明利用指数积方法建立机械臂的运动学模型,该模型用运动旋量来对每个关节进行描述,只需要建立惯性坐标系和工具坐标系,关节量的改变非常平缓,克服了奇异性问题,并且可以对平移关节与旋转关节进行统一描述。
2.本发明建立误差模型时,实际的运动旋量满足关节约束条件,误差模型简单、精度高。
3.本发明对各误差分别进行分析,并分析其随着关节角的变化对机械臂末端的位置精度的影响,并通过图表展现出来,效果直观,分析全面具体。
4.本发明通过分析各误差的敏感性和影响规律,指导机械臂的误差分配,有效提高机械臂末端的位置精度。
附图说明
图1为本发明方法的流程示意图;
图2为本发明方法的六自由度机械臂模型图;
图3为本发明方法的机械臂末端位置误差图;
图4为本发明方法的各关节角误差随关节1变化的影响规律图;
图5为本发明方法的各关节角误差随关节2变化的影响规律图;
图6为本发明方法的各关节角误差随关节3变化的影响规律图;
图7为本发明方法的各关节角误差随关节4变化的影响规律图;
图8为本发明方法的各关节角误差随关节5变化的影响规律图;
图9为本发明方法的各关节角误差随关节6变化的影响规律图;
图10为本发明方法的各关节轴方向误差随关节1变化的影响规律图;
图11为本发明方法的各关节轴方向误差随关节2变化的影响规律图;
图12为本发明方法的各关节轴方向误差随关节3变化的影响规律图;
图13为本发明方法的各关节轴方向误差随关节4变化的影响规律图;
图14为本发明方法的各关节轴方向误差随关节5变化的影响规律图;
图15为本发明方法的各关节轴方向误差随关节6变化的影响规律图;
图16为本发明方法的各关节轴位置误差随关节1变化的影响规律图;
图17为本发明方法的各关节轴位置误差随关节2变化的影响规律图;
图18为本发明方法的各关节轴位置误差随关节3变化的影响规律图;
图19为本发明方法的各关节轴位置误差随关节4变化的影响规律图;
图20为本发明方法的各关节轴位置误差随关节5变化的影响规律图;
图21为本发明方法的各关节轴位置误差随关节6变化的影响规律图。
图4-图21中的曲线1,2,3,4,5,6分别代表关节1、关节2、关节3、关节4、关节5、关节6存在误差时的误差变化规律曲线。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
如图1所示,在具体应用实例中,本发明的详细步骤为:
(1)利用指数积方法建立机械臂的运动学模型
选取图2所示的6自由度机械臂作为实例,其中包括机械臂的初始构型、连杆参数、基坐标系和工具坐标系。该机械臂6个关节的运动范围分别为-180°~180°、-90°~90°、-90°~90°、-180°~180°、-90°~90°、-180°~180°。根据运动旋量的定义,根据各关节轴的方向和其通过一点的位置,可得到机械臂各关节的运动旋量如表1所示:
表1机械臂各关节的运动旋量
根据机械臂的初始构型,可得到机械臂末端坐标系{T}相对于基坐标系{S}的初始位姿矩阵为:
得到关节的运动旋量后,可得到其转换矩阵为:
其中旋转矩阵可通下式计算得到:
机械臂运动学模型为多个关节的转换矩阵与初始位姿相乘,即可得到机械臂末端的位姿如下:
其中,θ=(θ1,θ2,θ3,θ4,θ5,θ6)T为关节角向量。
(2)根据运动学模型建立机械臂末端位置误差模型
从机械臂运动学模型可以看出,引起机械臂末端位置误差的有:关节角θ的误差、关节运动旋量ξ的误差(包括关节轴方向w的误差、关节轴位置r的误差)、初始位姿的误差。而关节新的运动旋量应满足关节约束条件(||w'||=1、w'T v'=0),所以引入误差后的运动学参数可以表示为:
θ'=θ+Δθ
w'=RZ(Δα)RY(Δβ)RX(Δγ)w
r'=r+Δr
v'=r'×w'
其中Δθ表示关节角误差,Δα、Δβ、Δγ表示关节轴方向或末端坐标系{T}的旋转角度误差,RZ(Δα)、RY(Δβ)、RX(Δγ)为误差转换矩阵,Δr表示关节轴上一点的位置误差,ΔP0表示末端坐标系{T}的原点位置误差。
那么,根据机械臂运动学模型,即可得到存在误差时机械臂末端的实际位姿为:
则机械臂末端位置误差模型为:
ΔP=P'-P
(3)分析各关节误差和初始位姿误差对机械臂末端位置精度的敏感性
首先假设各关节角均存在0.01°的误差,各关节轴线绕基坐标系X、Y、Z轴分别有0.01°的误差,各关节轴线上一点的位置在基坐标系X、Y、Z轴方向上都有0.1mm的误差,机械臂末端位置与工具坐标系的姿态无关,则假设初始位置在基坐标系X、Y、Z轴方向上分别存在0.1mm的误差。将存在误差后实际的运动学参数代入机械臂末端位置误差模型,随机产生1万组关节角向量θ=(θ1,θ2,…,θi,…,θn)T形成1万个位姿,将存在误差后实际的运动学参数代入机械臂末端位置误差模型,计算出一组机械臂末端位置误差{ΔP总 1,…,ΔP总 X,…ΔP总 10000},得到机械臂末端位置总误差的平均值|ΔP总|平均=0.276mm和最大值|ΔP总|最大=0.506mm。
当只有关节i的关节角θi和关节旋量ξi存在误差误差时,其余关节和初始位姿均不存在误差,将存在误差后实际的运动学参数代入机械臂末端位置误差模型,随机产生1万组关节角向量θ=(θ1,θ2,θ3,θ4,θ5,θ6)T形成1万个位姿,将存在误差后实际的运动学参数代入机械臂末端位置误差模型,计算出一组机械臂末端位置误差{ΔPi 1,…,ΔPi X,…ΔPi 10000},得到机械臂末端位置误差的平均值|ΔPi|平均和最大值|ΔPi|最大,6个关节最终得到6个平均值|ΔP1|平均=0.251mm|ΔP2|平均=0.139mm、|ΔP3|平均=0.115mm、|ΔP4|平均=0.184mm、|ΔP5|平均=0.104mm、|ΔP6|平均=0.184mm与最大值|ΔP1|最大=0.453mm、|ΔP2|最大=0.291mm、|ΔP3|最大=0.115mm、|ΔP4|最大=0.301mm、|ΔP5|最大=0.201mm、|ΔP6|最大=0.289mm。
当只有初始位姿存在误差时,所有关节的转角和运动旋量均不存在误差,将存在误差后实际的运动学参数代入机械臂末端位置误差模型,随机产生1万组关节角向量θ=(θ1,θ2,θ3,θ4,θ5,θ6)T形成1万个位姿,将存在误差后实际的运动学参数代入机械臂末端位置误差模型,计算出一组机械臂末端位置误差{ΔPst 1,…,ΔPst X,…ΔPst 10000},得到机械臂末端位置误差的平均值|ΔPst|平均=0.173mm和最大值|ΔPst|最大=0.173mm。
将每个关节误差和初始位姿误差产生的机械臂末端位置误差的平均值与最大值整理,可得到图3所示的机械臂末端位置误差图。对比各误差的平均值与总误差的平均值的比值|ΔPi|平均/|ΔP总|平均和各误差的最大值与总误差的最大值得比值|ΔPi|最大/|ΔP总|最大,结果如表2所示。得到各关节误差和初始位姿误差的敏感性,比值越大表示机械臂末端位姿误差对该关节或初始位姿的运动参数越敏感。
表2各误差与总误差比值
工具坐标系初始位姿对机械臂末端造成误差的平均值与最大值一样,可知工具坐标系的位姿对机械臂末端位置精度影响一致,不会随机械臂关节角向量的变化而变化。
各关节误差对机械臂末端位置精度的敏感性,关节1最大,其次是关节4与关节6,并且两个关节造成的影响一样,然后依次是关节2、关节3、关节5。其中关节1、4、6的运动范围为-180°~180°,关节2、3、5的运动范围为-90°~90°,关节4、5、6的轴线相交于一点。通过分析可知关节距离机械臂末端越远,其敏感性越大;关节的运动范围越大,其敏感性越大。
(4)分析关节各项误差随各关节角变化时对机械臂末端位置精度的影响规律。
在初始关节角向量为θ=(0°,90°,-90°,0°,90°,0°)T下,转动关节1,得到每个关节角误差Δθi为0.01°时随着关节1变化对机械臂末端位置误差的影响规律曲线,共6条曲线,得到各关节角误差随关节1变化的影响规律图,如图4所示。同理也可以得到各关节角误差随关节2、……关节6变化的影响规律图,分别如图5-图9所示。
再转动关节1,得到每个关节轴方向误差Δαi、Δβi、Δγi都为0.01°时随着关节1变化对机械臂末端位置误差的影响规律曲线,共6条曲线,得到各关节轴方向误差随关节1变化的影响规律图,如图10所示。同理也可以得到各关节轴方向误差随关节2、……关节6变化的影响规律图,分别如图11-图15所示。
最后转动关节1,得到每个关节轴位置误差Δri在基坐标系X、Y、Z轴方向上都有0.1mm时随着关节1变化对机械臂末端位置误差的影响规律曲线,共6条曲线,得到各关节轴位置误差随关节1变化的影响规律图,如图16所示。同理也可以得到各关节轴位置误差随关节2、……关节6变化的影响规律图,分别如图17-图21所示。
分析图4-图9,可以看出关节角误差随着每个关节角变化时对机械臂末端误差的影响规律,每个关节角误差对造成的机械臂末端位置误差与其轴线到机械臂末端的距离成正比,所以第i个关节转动时,其前面的1~(i-1)个关节轴线离机械臂末端的位置会发生变化,因此第1~(i-1)个关节角误差造成的机械臂末端位置误差会随第i个关节角变化,最后一个关节转动时,机械臂末端位置不变,各误差造成的影响不变。
分析图10-图15,可以看出关节轴方向误差随着每个关节角变化时对机械臂末端误差的影响规律,第i个关节转动时,第1~i个关节轴方向误差造成的机械臂末端位置误差会随第i个关节角变化。但是某个关节角位零时,该关节轴方向误差不会对机械臂末端位置造成影响,也不会随其他关节角的变化而变化。
分析图6-图17,可以看出关节轴位置误差随着每个关节角变化时对机械臂末端误差的影响规律,第i个关节轴位置误差造成的机械臂末端位置误差只与第i个关节角位置有关,不会随其他关节角变化而变化,且关节轴位置误差在各关节轴对机械臂末端位置造成的影响一样。
(5)根据各误差的敏感性和影响规律,指导机械臂的精度分配。
根据步骤(3)和(4),可以得到各运动学参数误差对机械臂末端位置精度的敏感性和影响规律。从各误差的敏感性来看,敏感性比值越大的关节敏感性越高。从各误差的影响规律来看,关节角误差和关节轴方向误差会随着关节离机械臂末端的距离增加而变大,对误差有放大作用,而关节轴位置误差对机械臂末端位置的影响等效,不具有放大作用。因此,在机械臂制造和装配过程中,提高关节角和关节轴方向的精度,以及提高各关节误差和初始位姿误差敏感性比值大的关节或初始位姿的精度,来提高机械臂末端的位置精度。
Claims (6)
1.一种机械臂误差分析方法,其特征在于,包括以下步骤:
步骤1:利用指数积方法建立机械臂的运动学模型;
步骤2:根据运动学模型建立机械臂末端位置误差模型;
步骤3:分析机械臂末端位置误差模型的各关节误差和初始位姿误差对机械臂末端位置精度的敏感性,得到各关节误差和初始位姿误差敏感性比值;
步骤4:分析机械臂末端位置误差模型的关节各项误差随各关节角变化时对机械臂末端位置精度的影响规律;
步骤5:根据得到的敏感性比值和影响规律,指导机械臂的精度分配。
2.按照权利要求1所述一种机械臂误差分析方法,其特征在于,所述利用指数积方法建立机械臂的运动学模型,包括以下步骤:
通过关节轴线方向的单位矢量w和关节轴线上的一点r计算得到关节的运动旋量ξ:
其中,w=(w1,w2,w3)T,r=(r1,r2,r3)T;
那么,每个关节的转换矩阵为:
其中,θ表示关节角度,旋转矩阵通下式计算得到:
机械臂末端坐标系{T}相对于基坐标系{S}的初始位姿为:
其中,R0表示坐标系{T}在基坐标系{S}中的初始姿态,P0表示坐标系{T}原点在基坐标系{S}中的初始位置;
机械臂运动学模型为多个关节的转换矩阵与初始位姿相乘,即可得到机械臂末端的位姿如下:
其中,θ=(θ1,θ2,…,θi,…,θn)T为关节角向量,n为关节的个数,θi为第i个关节的关节角;R表示坐标系{T}在基坐标系{S}中的姿态,P表示表示坐标系{T}原点在基坐标系{S}中的位置。
3.按照权利要求1所述一种机械臂误差分析方法,其特征在于,所述根据运动学模型建立机械臂末端位置误差模型,包括以下步骤:
从机械臂运动学模型公式(1)得到引起机械臂末端位置误差的有:关节角θ的误差、关节运动旋量ξ的误差、初始位姿的误差;所述关节运动旋量ξ的误差包括关节轴方向w的误差、关节轴位置r的误差;并且,关节新的运动旋量应满足关节约束条件:||w'||=1、w' Tv'=0;
所以引入误差后的运动学参数可以表示为:
θ'=θ+Δθ
w'=RZ(Δα)RY(Δβ)RX(Δγ)w
r'=r+Δr
v'=r'×w'
其中,Δθ表示关节角误差,Δα、Δβ、Δγ表示关节轴方向或末端坐标系{T}的旋转角度误差,RZ(Δα)、RY(Δβ)、RX(Δγ)为误差转换矩阵,Δr表示关节轴上一点的位置误差,ΔP0表示末端坐标系{T}的原点位置误差;
那么,根据机械臂运动学模型,即可得到存在误差时机械臂末端的实际位姿为:
则机械臂末端位置误差模型为:
ΔP=P'-P。 (2) 。
4.按照权利要求1所述一种机械臂误差分析方法,其特征在于,所述分析机械臂末端位置误差模型的各关节误差和初始位姿误差对机械臂末端位置精度的敏感性,得到各关节误差和初始位姿误差敏感性比值,包括以下步骤:
4-1:当所有关节的关节角θ、关节运动旋量ξ和初始位姿同时存在误差时,将存在误差的实际的运动学参数代入机械臂末端位置误差模型公式(2),随机产生K组关节角向量θ=(θ1,θ2,…,θi,…,θn)T形成K个位姿;计算出机械臂末端位置误差{ΔP总 1,…,ΔP总 X,…ΔP总 K},得到机械臂末端位置总误差的平均值和最大值
4-2:当只有第i个关节的关节角θi和关节旋量ξi存在误差误差,其余关节和初始位姿均不存在误差时,将存在误差的实际的运动学参数代入机械臂末端位置误差模型公式(2),随机产生K组关节角向量θ=(θ1,θ2,…,θi,…,θn)T形成K个位姿,计算出机械臂末端位置误差{ΔPi 1,…,ΔPi X,…ΔPi K},得到机械臂末端位置误差的平均值和最大值
|ΔPi|最大=max(|ΔPi 1|,...,|ΔPi X|,...,|ΔPi K|),n个关节,共得到n个平均值:|ΔP1|平均,...,|ΔPi|平均,…,|ΔPn|平均与最大值:|ΔP1|最大,…,|ΔPi|最大,…,|ΔPn|最大;
4-3:当只有初始位姿存在误差,所有关节角和关节运动旋量均不存在误差时,将存在误差后实际的运动学参数代入机械臂末端位置误差模型公式(2),随机产生K组关节角向量θ=(θ1,θ2,…,θi,…,θn)T形成K个位姿,计算出机械臂末端位置误差{ΔPst 1,…,ΔPst X,…ΔPst K},得到机械臂末端位置误差的平均值和最大值
4-4:计算各关节误差和初始位姿敏感性比值:|ΔPi|平均/|ΔP总|平均、|ΔPi|最大/|ΔP总|最大、|ΔPst|平均/|ΔP总|平均、|ΔPst|最大/|ΔP总|最大;其中,i=1,…,n。
5.按照权利要求1所述一种机械臂误差分析方法,其特征在于,所述分析机械臂末端位置误差模型的关节各项误差随各关节角变化时对机械臂末端位置精度的影响规律,包括以下步骤:
5-1:在某一关节角向量θ=(θ1,θ2,…,θi,…,θn)T下,依次转动关节1至n,分别得到n幅与关节角误差相关联的机械臂末端位置误差的影响规律曲线图,所述每幅中包含n条曲线,所述每条曲线表示每个关节角误差Δθi随当前转动关节变化对机械臂末端位置误差的影响;
得到关节角误差随每个关节角变化时对机械臂末端误差的影响规律:关节角误差对造成的机械臂末端位置误差与其轴线到机械臂末端的距离成正比;第i个关节转动时,第1至(i-1)个关节角误差造成的机械臂末端位置误差会随第i个关节角变化,但最后一个关节转动时,各误差造成的影响不变;
5-2:在某一关节角向量θ=(θ1,θ2,…,θi,…,θn)T下,依次转动关节1至n,分别得到n幅与关节轴方向误差相关联的机械臂末端位置误差的影响规律曲线图,所述每幅中包含n条曲线,所述每条曲线表示每个关节轴方向误差随当前转动关节变化对机械臂末端位置误差的影响;所述每个关节轴方向误差通过Δαi、Δβi、Δγi计算得到;
得到关节轴方向误差随每个关节角变化时对机械臂末端误差的影响规律:第i个关节转动时,第1~i个关节轴方向误差造成的机械臂末端位置误差会随第i个关节角变化;某个关节角为零时,该关节轴方向误差不会对机械臂末端位置造成影响;
5-3:在某一关节角向量θ=(θ1,θ2,…,θi,…,θn)T下,依次转动关节1至n,分别得到n幅与关节轴位置误差向关联的机械臂末端位置误差的影响规律曲线图,所述每幅中包含n条曲线,所述每条曲线表示每个关节轴位置误差Δri随当前转动关节变化对机械臂末端位置误差的影响;
得到关节轴位置误差随每个关节角变化时对机械臂末端误差的影响规律:第i个关节轴位置误差造成的机械臂末端位置误差只与第i个关节角有关。
6.按照权利要求1所述一种机械臂误差分析方法,其特征在于,所述根据得到的敏感性比值和影响规律,指导机械臂的精度分配,包括:
根据各关节和初始位姿敏感性比值,比值越大表示机械臂末端位置误差对该关节或初始位姿的运动参数越敏感;根据关节角误差和关节轴方向误差随关节离机械臂末端的距离增加而变大;而关节轴位置误差对机械臂末端位置的影响等效;
在机械臂制造和装配过程中,提高关节角和关节轴方向的精度,以及提高各关节误差和初始位姿误差敏感性比值大的关节或初始位姿的精度,来提高机械臂末端的位置精度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611176391.8A CN107038275B (zh) | 2016-12-19 | 2016-12-19 | 一种机械臂误差分析方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611176391.8A CN107038275B (zh) | 2016-12-19 | 2016-12-19 | 一种机械臂误差分析方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107038275A true CN107038275A (zh) | 2017-08-11 |
CN107038275B CN107038275B (zh) | 2020-05-19 |
Family
ID=59531207
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611176391.8A Active CN107038275B (zh) | 2016-12-19 | 2016-12-19 | 一种机械臂误差分析方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107038275B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108038337A (zh) * | 2017-12-29 | 2018-05-15 | 中国科学院沈阳自动化研究所 | 一种自动锁紧释放机构传动链精度分析方法 |
CN108549319A (zh) * | 2018-04-02 | 2018-09-18 | 西南交通大学 | 一种双转台五轴数控机床通用后处理方法 |
CN109483529A (zh) * | 2018-10-12 | 2019-03-19 | 华南智能机器人创新研究院 | 一种基于螺旋理论的机械臂伺服控制方法、系统及装置 |
CN110757450A (zh) * | 2019-09-06 | 2020-02-07 | 南京邮电大学 | 一种肩关节康复机器人参数标定方法 |
CN110919651A (zh) * | 2019-11-26 | 2020-03-27 | 湖南工业大学 | 一种减少机器人关节结构误差对其精度影响的方法 |
CN113733104A (zh) * | 2021-10-12 | 2021-12-03 | 武汉联影智融医疗科技有限公司 | 机械臂的控制方法、计算机设备和存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103010491A (zh) * | 2012-11-30 | 2013-04-03 | 北京控制工程研究所 | 一种气浮台抓捕试验机械臂控制方法 |
CN103942427A (zh) * | 2014-04-11 | 2014-07-23 | 哈尔滨工程大学 | 一类六自由度机械臂运动学逆解的快速简便求法 |
CN104199999A (zh) * | 2014-07-17 | 2014-12-10 | 中国人民解放军国防科学技术大学 | 一种关节对中误差对多自由度机械臂末端定位精度影响的定量分析方法 |
US20160114486A1 (en) * | 2014-10-27 | 2016-04-28 | Quanta Storage Inc. | Method for automatically recalibrating a robotic arm |
US20160157949A1 (en) * | 2009-06-30 | 2016-06-09 | Intuitive Surgical Operations, Inc. | Ratcheting for master alignment of a teleoperated minimally invasive surgical instrument |
CN106166749A (zh) * | 2016-06-29 | 2016-11-30 | 北京控制工程研究所 | 一种空间移动多臂机器人的移动轨迹规划方法 |
-
2016
- 2016-12-19 CN CN201611176391.8A patent/CN107038275B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20160157949A1 (en) * | 2009-06-30 | 2016-06-09 | Intuitive Surgical Operations, Inc. | Ratcheting for master alignment of a teleoperated minimally invasive surgical instrument |
CN103010491A (zh) * | 2012-11-30 | 2013-04-03 | 北京控制工程研究所 | 一种气浮台抓捕试验机械臂控制方法 |
CN103942427A (zh) * | 2014-04-11 | 2014-07-23 | 哈尔滨工程大学 | 一类六自由度机械臂运动学逆解的快速简便求法 |
CN104199999A (zh) * | 2014-07-17 | 2014-12-10 | 中国人民解放军国防科学技术大学 | 一种关节对中误差对多自由度机械臂末端定位精度影响的定量分析方法 |
US20160114486A1 (en) * | 2014-10-27 | 2016-04-28 | Quanta Storage Inc. | Method for automatically recalibrating a robotic arm |
CN106166749A (zh) * | 2016-06-29 | 2016-11-30 | 北京控制工程研究所 | 一种空间移动多臂机器人的移动轨迹规划方法 |
Non-Patent Citations (3)
Title |
---|
GENG S: "《 Extraction of error related local field potentials from the striatum during environmental perturbations of a robotic arm》", 《INTERNATIONAL IEEE/EMBS CONFERENCE ON NEURAL ENGINEERING》 * |
TIRTH V: "《Application of Taguchi technique to reduce positional error in two degree of freedom rotary-rotary planar robotic arm》", 《 INTERNATIONAL CONFERENCE ON INDUSTRIAL & INFORMATION SYSTEMS》 * |
李云江 等: "《六自由度机械臂位置误差分析与结构优化》", 《煤矿机械》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108038337A (zh) * | 2017-12-29 | 2018-05-15 | 中国科学院沈阳自动化研究所 | 一种自动锁紧释放机构传动链精度分析方法 |
CN108038337B (zh) * | 2017-12-29 | 2020-03-31 | 中国科学院沈阳自动化研究所 | 一种自动锁紧释放机构传动链精度分析方法 |
CN108549319A (zh) * | 2018-04-02 | 2018-09-18 | 西南交通大学 | 一种双转台五轴数控机床通用后处理方法 |
CN108549319B (zh) * | 2018-04-02 | 2020-09-15 | 西南交通大学 | 一种双转台五轴数控机床通用后处理方法 |
CN109483529A (zh) * | 2018-10-12 | 2019-03-19 | 华南智能机器人创新研究院 | 一种基于螺旋理论的机械臂伺服控制方法、系统及装置 |
CN109483529B (zh) * | 2018-10-12 | 2021-02-26 | 华南智能机器人创新研究院 | 一种基于螺旋理论的机械臂伺服控制方法、系统及装置 |
CN110757450A (zh) * | 2019-09-06 | 2020-02-07 | 南京邮电大学 | 一种肩关节康复机器人参数标定方法 |
CN110757450B (zh) * | 2019-09-06 | 2022-05-17 | 南京邮电大学 | 一种肩关节康复机器人参数标定方法 |
CN110919651A (zh) * | 2019-11-26 | 2020-03-27 | 湖南工业大学 | 一种减少机器人关节结构误差对其精度影响的方法 |
CN113733104A (zh) * | 2021-10-12 | 2021-12-03 | 武汉联影智融医疗科技有限公司 | 机械臂的控制方法、计算机设备和存储介质 |
CN113733104B (zh) * | 2021-10-12 | 2023-07-21 | 武汉联影智融医疗科技有限公司 | 机械臂的控制方法、计算机设备和存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN107038275B (zh) | 2020-05-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107038275A (zh) | 一种机械臂误差分析方法 | |
CN106338990B (zh) | 基于激光跟踪仪的工业机器人dh参数标定与零位标定方法 | |
CN107175660B (zh) | 一种基于单目视觉的六自由度机器人运动学标定方法 | |
CN102601684B (zh) | 基于间接测量法的高精度制孔机器人的工具参数标定方法 | |
CN109465826B (zh) | 一种基于姿态均匀分布的工业机器人tcp标定方法 | |
CN106064379B (zh) | 一种机器人自动计算实际臂长的方法 | |
CN106799745A (zh) | 一种基于协同克里金的工业机械臂精度标定方法 | |
CN108724190A (zh) | 一种工业机器人数字孪生系统仿真方法及装置 | |
CN104858870A (zh) | 基于末端编号靶球的工业机器人测量方法 | |
CN107972071A (zh) | 一种基于末端点平面约束的工业机器人连杆参数标定方法 | |
CN110815189A (zh) | 基于混合现实的机器人快速示教系统及方法 | |
CN105865341B (zh) | 工业机器人空间位姿重复定位精度测量装置和方法 | |
CN107471257A (zh) | 基于单拉线编码器的机器人几何标定方法 | |
CN105334802B (zh) | 一种调整主轴与c轴同轴度的方法 | |
CN110815206A (zh) | 一种Stewart型并联机器人运动学标定方法 | |
CN110181558A (zh) | 一种变臂关节式坐标测量机标定机器人的装置及其方法 | |
CN107186753B (zh) | 工业机器人性能测试的工作空间确定方法 | |
CN107885916A (zh) | 一种基于cfdh法的凿岩台车钻臂运动学分析方法 | |
CN108317985A (zh) | 高精度工业机器人重复定位精度的测量装置和测量方法 | |
CN108705530A (zh) | 一种工业机器人路径自动修正的方法及系统 | |
CN109866224A (zh) | 一种机器人雅可比矩阵计算方法、装置及存储介质 | |
CN110039548A (zh) | 一种拼装机控制方法、装置及设备 | |
CN107479564A (zh) | 超冗余空间机器人利用运动学的解进行任务规划的方法 | |
CN105740511A (zh) | 机器人防护服版样自动生成系统及制作方法 | |
CN109933920A (zh) | 一种旋转轴位置偏差的误差矢量建模方法 |
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 |