CN106325207B - 一种五轴数控制齿机床几何误差实际逆向运动学补偿方法 - Google Patents
一种五轴数控制齿机床几何误差实际逆向运动学补偿方法 Download PDFInfo
- Publication number
- CN106325207B CN106325207B CN201610878411.XA CN201610878411A CN106325207B CN 106325207 B CN106325207 B CN 106325207B CN 201610878411 A CN201610878411 A CN 201610878411A CN 106325207 B CN106325207 B CN 106325207B
- Authority
- CN
- China
- Prior art keywords
- axis
- error
- formula
- motion
- refer
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 24
- 230000033001 locomotion Effects 0.000 claims abstract description 80
- 230000003068 static effect Effects 0.000 claims abstract description 3
- 239000011159 matrix material Substances 0.000 claims description 28
- 230000002596 correlated effect Effects 0.000 claims description 21
- 238000004458 analytical method Methods 0.000 claims description 13
- 230000009466 transformation Effects 0.000 claims description 13
- 238000003754 machining Methods 0.000 claims description 11
- 238000013519 translation Methods 0.000 claims description 9
- 230000014616 translation Effects 0.000 claims description 9
- 230000000875 corresponding effect Effects 0.000 claims description 4
- 230000002441 reversible effect Effects 0.000 claims description 4
- 238000012546 transfer Methods 0.000 claims description 2
- 238000012545 processing Methods 0.000 abstract description 7
- 230000001419 dependent effect Effects 0.000 abstract 1
- 238000004364 calculation method Methods 0.000 description 4
- 241000208340 Araliaceae Species 0.000 description 2
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 2
- 235000003140 Panax quinquefolius Nutrition 0.000 description 2
- 235000008434 ginseng Nutrition 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 238000000638 solvent extraction Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000009347 mechanical transmission Effects 0.000 description 1
- 230000010534 mechanism of action Effects 0.000 description 1
- 238000005192 partition Methods 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
- 230000001737 promoting effect Effects 0.000 description 1
- 238000007493 shaping process Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37068—Setting reference coordinate frame
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37581—Measuring errors
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
Abstract
本发明提出一种五轴数控制齿机床几何误差实际逆向运动学补偿方法,首先基于齐次坐标变换矩阵建立包含位置无关误差和位置相关误差的空间几何误差模型,根据齐次坐标变换矩阵的特性,由空间几何误差模型推导得到含几何误差的加工代码解析表达式。由刀具相对于工件的12项位姿偏差(6项静态位姿偏差,6项运动位姿偏差)修正理论刀位数据。将位置无关误差、位置相关误差以及修正后的刀位数据代入到机床几何误差补偿的加工代码解析表达式中,可实现机床几何误差的补偿,同时修正刀具相对于工件的12项位姿偏差。本发明误差补偿方法补偿过程简单、易懂,计算量小,补偿效率高,应用范围广,其基本补偿思想适用于各种类型的数控机床。
Description
技术领域
本发明属于机床几何误差补偿领域,,具体是一种五轴数控制齿机床几何误差实际逆向运动学补偿方法,是一种通过对制齿机床几何误差进行补偿来提高齿轮加工精度的方法。
背景技术
在机床加工过程中,几何误差时刻影响着零件的加工精度,机床几何误差的补偿是提升加工精度的有效措施。机床加工误差的产生,最直接的原因是刀具与工件之间的理想相互位姿关系产生了变化,研究机床各轴误差对加工精度的影响,实质就是研究机床各轴误差对刀具和工件的相对位姿产生的影响。
齿轮作为机械传动的关键基础件,为了降低噪音,减少振动,延长机械传动部件的使用寿命,ISO标准严格规定了齿轮的各项误差指标项,由于齿轮精度评价的特殊性,刀具/齿轮相对位姿偏差对齿轮误差的影响是复杂多样的,传统刀具/工件位姿偏差对加工精度的作用机理并不适用于齿轮,因此建立刀具/工件位姿偏差与齿轮误差的耦合映射关系并解耦修正,能够有效提高齿轮加工精度。
现有刀具/工件位姿偏差是由运动轴误差正向求解计算得到,并没有建立运动轴误差与齿轮加工误差的映射关系,因此不能准确适用于齿轮加工误差的修正。同时现有运动轴误差补偿方法计算繁琐、计算量大、耗时长,有微分法、或者迭代、递归方法,难以满足实时补偿的需求,因此亟需一种适用于面向齿轮高精度加工的、满足实时补偿要求的误差补偿方法。
发明内容
为了能够满足快速补偿齿轮加工误差的需求,本发明提出了一种五轴数控制齿机床几何误差实际逆向运动学补偿方法,该补偿方法利用矩阵分块计算原理,分层求和算法以及运动轴特征元素分离法将机床几何误差与运动轴代码进行解耦,得到补偿后的运动代码与机床几何误差之间的解析关系式,该方法具有简单、计算量小、补偿效率高、精度损失少以及应用范围广等优点。
一种五轴数控制齿机床几何误差实际逆向运动学补偿方法,包括如下步骤:
(1)设定机床局部坐标系,确定各运动轴之间的相互耦合关系和运动传递链,建立机床运动学模型。
(2)将加工轨迹刀位数据表示为(x,y,z,i,j,k),其中x、y、z指加工轨迹的位置坐标,i、j、k指加工轨迹的方向坐标,由逆向运动学算法求得对应X轴、Y轴、Z轴、A轴和C轴的理想加工代码X、Y、Z、A、C,并换算到机床坐标系下。
(3)将辨识得到的机床位置相关误差与机床坐标系下运动轴位置X、Y、Z、A、C拟合得到对应的机床位置相关误差与运动轴位置之间的函数关系δXx(X)、δXy(X)、δXz(X)、αX(X)、βX(X)、γX(X),δYx(Y)、δYy(Y)、δYz(Y)、αY(Y)、βY(Y)、γY(Y),δZx(Z)、δZy(Z)、δZz(Z)、αZ(Z)、βZ(Z)、γZ(Z),δAx(A)、δAy(A)、δAz(A)、αA(A)、βA(A)、γA(A),δCx(C)、δCy(C)、δCz(C)、αC(C)、βC(C)、γC(C),由X、Y、Z、A、C预测待补偿的机床位置相关误差。
(4)建立齿轮/刀具24项位姿偏差与齿轮误差的耦合映射关系并进行解耦,以工件坐标系为基准,将齿轮/刀具的24项位姿偏差转化为刀具相对于工件的12项位姿偏差x/y/z/α/β/γ方向6项静态位姿偏差和6项运动位姿偏差:Δx,Δx(p),Δy,Δy(p),Δz,Δz(p),Δi,Δi(p),Δj,Δj(p),Δk,Δk(p),p指机床运动轴位置X、Y、Z、A、C;根据理想刀位数据与刀具相对于齿轮的位姿偏差,求得修正后的刀位数据(x’,y’,z’,i’,j’,k’)=(x-Δx-Δx(p),y-Δy-Δy(p),z-Δz-Δz(p),i-Δi-Δi(p),j-Δj-Δj(p),k-Δk-Δk(p));
(5)建立机床空间几何误差模型,确定含误差的实际刀具坐标系与实际工件坐标系之间的变换矩阵
(6)实际逆向运动学算法具体是应用齐次坐标变换矩阵的可逆特性、乘法结合律、矩阵分块计算原理、运动变换不变特征将误差模型中机床运动代码X、Y、Z、A、C与机床几何误差进行解耦,得到修正后的机床运动代码解析表达式;
(7)将修正后的刀位数据(x’,y’,z’,i’,j’,k’)、机床几何误差δXx(X)、δXy(X)、δXz(X)、αX(X)、βX(X)、γX(X),δYx(Y)、δYy(Y)、δYz(Y)、αY(Y)、βY(Y)、γY(Y),δZx(Z)、δZy(Z)、δZz(Z)、αZ(Z)、βZ(Z)、γZ(Z),δAx(A)、δAy(A)、δAz(A)、αA(A)、βA(A)、γA(A),δCx(C)、δCy(C)、δCz(C)、αC(C)、βC(C)、γC(C),δCx、δCy、αCY、βCX,δAy、δAz、γAY、βAZ,γYX,αZY、βZX代入上述推导得到的解析表达式中,可求得补偿后的运动代码,实现机床几何误差的补偿,对刀具/齿轮位姿偏差进行修正。
所述步骤(6)中求得补偿后的运动代码与修正的刀位数据、机床几何误差项的解析函数关系式为:
所述步骤(6)中考虑旋转轴运动与直线轴运动之间的耦合关系,首先对旋转轴运动代码解析表达式进行推导得到:
式中:
再对直线轴运动代码解析表达式进行推导得到:
Z'=z'+δWz-δAz-L+δCz(C)+δXz(X)-δYz(Y)-δZz(Z)+(αW+αC(C))y'-(βW+βC(C))x'+
(αCY+αX(X))y'cos(C')-(βCX+βX(X))x'cos(C')+(αCY+αX(X))x'sin(C')+
(βCX+βX(X))y'sin(C')-(δTy-δAy+δAy(A)+(αA(A)+αY(Y)+αZY+αZ(Z))L)sin(A')+
(L+δAz-δTz-δAz(A))cos(A')
Y'=(δTz-δAz-L+δAz(A))sin(A')+δCy-δAy+δXy(X)-δYy(Y)-δZy(Z)+(αY(Y)+αZY+αZ(Z))L-
(δTy-δAy+δAy(A)+(αA(A)+αY(Y)+αZY+αZ(Z))L)cos(A')-(αCY+αX(X))z'+
(δWy+δCy(C)+y'-(αW+αC(C))z'+(γW+γC(C)+γX(X))x')cos(C')+
(δWx+δCx(C)+x'+(βW+βC(C))z'-(γW+γC(C)+γX(X))y')sin(C')+(αY(Y)+αZY)Z'
X'=-{(βAZ+βY(Y)+βZX+βZ(Z))Lcos(A')+δCx-δTx-δAx(A)+δXx(X)-δYx(Y)-δZx(Z)+
(βA(A)-βAZ-βY(Y)-βZX-βZ(Z))L+(βCX+βX(X))z'+
(δWx+δCx(C)+x'+(βW+βC(C))z'-(γW+γC(C)+γX(X))y')cos(C')-
(δWy+δCy(C)+y'-(αW+αC(C))z'+(γW+γC(C)+γX(X))x')sin(C')+
(γAY+γYX+γY(Y)+γZ(Z))Lsin(A')}+(βY(Y)+βZX)Z'-γYXY'
所述步骤(5)中指C轴实际坐标系到工件实际坐标系的运动变换;
指含C轴位置无关误差δCx、δCy、αCY、βCX及位置相关误差δCx(C)、δCy(C)、δCz(C)、αC(C)、βC(C)、γC(C)的X轴实际坐标系到实际C轴实际坐标系的运动变换;
指含X轴位置相关误差δXx(X)、δXy(X)、δXz(X)、αX(X)、βX(X)、γX(X)的参考坐标系到X轴实际坐标系的运动变换;
指含Y轴、X轴垂直度误差γYX及Y轴位置相关误差δYx(Y)、δYy(Y)、δYz(Y)、αY(Y)、βY(Y)、γY(Y)的参考坐标系到Y轴实际坐标系的运动变换;
指含Z轴、Y轴,Z轴、X轴垂直度误差αZY、βZX以及Z轴位置相关误差δZx(Z)、δZy(Z)、δZz(Z)、αZ(Z)、βZ(Z)、γZ(Z)的Y轴实际坐标系到Z轴实际坐标系的运动变换;
指的是含A轴位置无关误差δAy、δAz、γAY、βAZ及位置相关误差δAx(A)、δAy(A)、δAz(A)、αA(A)、βA(A)、γA(A)的Z轴实际坐标系到A轴实际坐标系的运动变换;
指A轴实际坐标系到刀具实际坐标系的运动变换。
所述步骤(6)中最终推导得到误差补偿的运动解析表达式,具体步骤如下:
假设修正后的刀位数据为(x’、y’、z’、i’、j’、k’),几何误差补偿后的机床运动代码为(X’,Y’,Z’,A’,C’),则根据式(1)可建立如下关系式:
[i';j';k';0]=(RBX(X')·XBC(C')·CBW)-1 RBY(Y')·YBZ(Z')·ZBA(A')·ABT·[0;0;1;0]
(2)
[x';y';z';1]=(RBX(X')·XBC(C')·CBW)-1 RBY(Y')·YBZ(Z')·ZBA(A')·ABT·[0;0;0;1]
(3)
其中[0;0;1;0]指实际刀具坐标系下的刀轴矢量齐次坐标,[0;0;0;1]指实际刀具坐标系下的刀具中心点位置齐次坐标。
考虑到所有平动变换不会对矢量方向产生影响,在求解旋转轴运动代码解析表达式时,将所有平动值设为零,同时将式(2)推导转换到如式(4)、式(5)所示的方程形式,我们发现方程左右两侧计算结果均为一个4×1的实数矩阵,同时观察到式(4)左侧第3行元素是不含C轴运动的,式(5)右侧第一行元素是不含A轴运动的,这是由于仅有C轴旋转运动不会对变换前后的Z轴坐标有任何影响,同样仅有A轴旋转运动,不会对变换前后的X轴坐标有任何影响(这一原理同样适用于B轴的旋转运动),可根据这一特征,将特征元素A’,C’分离开来,得到仅关于A’或者仅关于C’的超越方程,从而可求得其解析表达式。
直线轴代码解析表达式的求解主要运用齐次变换矩阵分块计算原理推导得到:
式中R3×1,I3×1均指3×1实数矩阵,指平动齐次变换矩阵,I3×3指3×3单位矩阵,利用上式计算原理、矩阵乘法结合律以及齐次变换矩阵均可逆的性质,可将式(3)推导为如下形式:
由式(6)将直线轴运动代码分离开来,进而得到关于直线轴运动代码的简单线性方程组。忽略高阶项,则由式(4)、(5)、(6)推导得到的运动轴代码解析表达式为:
式中:
本发明的有益效果是:
本发明建立了机床几何误差、补偿后的机床运动代码以及12项位姿偏差修正后的刀位数据之间的映射模型,将机床运动代码与机床几何误差、修正后的刀位数据进行解耦,求得机床运动代码解析表达式,代入机床几何误差即可计算机床几何误差补偿后的机床运动代码,用来修正刀具/工件位姿偏差。避免了耗时较长的微分计算、迭代计算以及广义求逆等复杂运算,提高了计算效率,有助于开发实时补偿系统。同时所发明的实际逆向运动学方法,其基本思想适用于各种类型的数控机床,适用范围广。
附图说明
图1为本发明的实际逆向运动学补偿方法流程图。
图2为实施例的五轴数控制齿机床运动链示意图。
具体实施方式
为使本发明的技术方案更加清楚明白,以下结合附图对本发明技术内容作说明。应当理解,此处所描述的实施例仅仅用以解释本发明,并非对本发明的构思及应用范围进行限定。
本发明通过建立机床误差运动学模型,根据齐次变换矩阵的可逆计算,结合律,分块计算等原理,将误差模型中的运动轴代码与机床几何误差元素、修正后的刀位数据进行解耦,分步求解得到旋转轴及直线轴代码解析表达式,实现制齿机床几何误差的快速补偿。
如图2所示的机床轴配置,以X轴作为参考坐标系,则含几何误差的工件坐标系到刀具坐标系的运动变换为:
(RBX·XBC·CBW)-1 RBY·YBZ·ZBA·ABT
(1)
其中
指C轴实际坐标系到工件实际坐标系的运动变换;
指含C轴位置无关误差δCx、δCy、αCY、βCX及位置相关误差δCx(C)、δCy(C)、δCz(C)、αC(C)、βC(C)、γC(C)的X轴实际坐标系到实际C轴实际坐标系的运动变换;
指含X轴位置相关误差δXx(X)、δXy(X)、δXz(X)、αX(X)、βX(X)、γX(X)的参考坐标系到X轴实际坐标系的运动变换;
指含Y轴、X轴垂直度误差γYX及Y轴位置相关误差δYx(Y)、δYy(Y)、δYz(Y)、αY(Y)、βY(Y)、γY(Y)的参考坐标系到Y轴实际坐标系的运动变换;
指含Z轴、Y轴,Z轴、X轴垂直度误差αZY、βZX以及Z轴位置相关误差δZx(Z)、δZy(Z)、δZz(Z)、αZ(Z)、βZ(Z)、γZ(Z)的Y轴实际坐标系到Z轴实际坐标系的运动变换;
指的是含A轴位置无关误差δAy、δAz、γAY、βAZ及位置相关误差δAx(A)、δAy(A)、δAz(A)、αA(A)、βA(A)、γA(A)的Z轴实际坐标系到A轴实际坐标系的运动变换;
指A轴实际坐标系到刀具实际坐标系的运动变换。
假设修正后的刀位数据为(x’,y’,z’,i’,j’,k’),几何误差补偿后的运动轴代码为(X’,Y‘,Z’,A’,C’),则根据式(1)可建立如下成形函数:
[i';j';k';0]=(RBX(X')·XBC(C')·CBW)-1 RBY(Y')·YBZ(Z')·ZBA(A')·ABT·[0;0;1;0] (2)
[x';y';z';1]=(RBX(X')·XBC(C')·CBW)-1 RBY(Y')·YBZ(Z')·ZBA(A')·ABT·[0;0;0;1]
(3)
其中[0;0;1;0]指实际刀具坐标系下的刀轴矢量齐次坐标,[0;0;0;1]指实际刀具坐标系下的刀具中心点位置齐次坐标。
考虑到所有平动变换不会对矢量方向产生影响,在求解旋转轴代码解析表达式时,将所有平动值设为零,同时将式(2)推导转换到如式(4)、式(5)所示的方程形式,我们发现方程左右两侧计算结果均为一个4×1的实数矩阵,同时观察到式(4)左侧第3行元素是不含C轴运动的,式(5)右侧第一行元素是不含A轴运动的,这是由于仅有C轴旋转运动不会对变换前后的Z轴坐标有任何影响,同样仅有A轴旋转运动,不会对变换前后的X轴坐标有任何影响(这一原理同样适用于B轴的旋转运动),可根据这一特征,将特征元素A’,C‘分离开来,得到仅关于A’或者仅关于C‘的超越方程,从而可求得其解析表达式。
直线轴代码解析表达式的求解主要运用齐次变换矩阵分块计算原理推导得到:
式中R3×1,I3×1均指3×1实数矩阵,指平动齐次变换矩阵,I3×3指3×3单位矩阵,利用上式计算原理、矩阵乘法结合律以及齐次变换矩阵均可逆的性质,可将式(3)推导为如下形式:
由式(6)将直线轴代码分离开来,进而得到关于直线轴代码的简单线性方程组。忽略高阶项,则由式(4)、(5)、(6)推导得到的运动轴代码解析表达式为:
式中:
将修正后的刀位数据(x’,y’,z’,i’,j’,k’)、机床几何误差δXx(X)、δXy(X)、δXz(X)、αX(X)、βX(X)、γX(X),δYx(Y)、δYy(Y)、δYz(Y)、αY(Y)、βY(Y)、γY(Y),δZx(Z)、δZy(Z)、δZz(Z)、αZ(Z)、βZ(Z)、γZ(Z),δAx(A)、δAy(A)、δAz(A)、αA(A)、βA(A)、γA(A),δCx(C)、δCy(C)、δCz(C)、αC(C)、βC(C)、γC(C),δCx、δCy、αCY、βCX,δAy、δAz、γAY、βAZ,γYX,αZY、βZX代入上述推导得到的解析表达式中,可求得补偿后的运动代码,实现机床几何误差的补偿,对刀具/齿轮位姿偏差进行修正。
以上所述的实施例仅仅是对本发明的较佳实例进行描述,并非用于限制本发明,在不脱离本发明补偿方法及思路的前提下,本领域中工程技术人员对本发明的技术方案作出的各种变形和改进,均应落入本发明的保护范围。
Claims (4)
1.一种五轴数控制齿机床几何误差实际逆向运动学补偿方法,其特征在于,包括以下步骤:
(1)设定机床局部坐标系,确定各运动轴之间的相互耦合关系和运动传递链,建立机床运动学模型;
(2)将加工轨迹刀位数据表示为(x,y,z,i,j,k),其中x、y、z指加工轨迹的位置坐标,i、j、k指加工轨迹的方向坐标,由逆向运动学算法求得对应X轴、Y轴、Z轴、A轴和C轴的理想加工代码X、Y、Z、A、C,并换算到机床坐标系下;
(3)将辨识得到的机床位置相关误差与机床坐标系下运动轴位置X、Y、Z、A、C拟合得到对应的机床位置相关误差与运动轴位置之间的函数关系δXx(X)、δXy(X)、δXz(X)、αX(X)、βX(X)、γX(X),δYx(Y)、δYy(Y)、δYz(Y)、αY(Y)、βY(Y)、γY(Y),δZx(Z)、δZy(Z)、δZz(Z)、αZ(Z)、βZ(Z)、γZ(Z),δAx(A)、δAy(A)、δAz(A)、αA(A)、βA(A)、γA(A),δCx(C)、δCy(C)、δCz(C)、αC(C)、βC(C)、γC(C),由X、Y、Z、A、C预测待补偿的机床位置相关误差;
(4)建立齿轮/刀具24项位姿偏差与齿轮误差的耦合映射关系并进行解耦,以工件坐标系为基准,将齿轮/刀具的24项位姿偏差转化为刀具相对于工件的12项位姿偏差x/y/z/α/β/γ方向6项静态位姿偏差和6项运动位姿偏差:Δx,Δx(p),Δy,Δy(p),Δz,Δz(p),Δi,Δi(p),Δj,Δj(p),Δk,Δk(p),p指机床运动轴位置X、Y、Z、A、C;根据理想刀位数据与刀具相对于齿轮的位姿偏差,求得修正后的刀位数据(x’,y’,z’,i’,j’,k’)=(x-Δx-Δx(p),y-Δy-Δy(p),z-Δz-Δz(p),i-Δi-Δi(p),j-Δj-Δj(p),k-Δk-Δk(p));
(5)建立机床空间几何误差模型,确定含误差的实际刀具坐标系与实际工件坐标系之间的变换矩阵(RBX·XBC·CBW)-1 RBY·YBZ·ZBA·ABT (1);
(6)实际逆向运动学算法具体是应用齐次坐标变换矩阵的可逆特性、乘法结合律、矩阵分块计算原理、运动变换不变特征将误差模型中机床运动代码X、Y、Z、A、C与机床几何误差进行解耦,得到修正后的机床运动代码解析表达式;
(7)将修正后的刀位数据(x’,y’,z’,i’,j’,k’)、机床几何误差δXx(X)、δXy(X)、δXz(X)、αX(X)、βX(X)、γX(X),δYx(Y)、δYy(Y)、δYz(Y)、αY(Y)、βY(Y)、γY(Y),δZx(Z)、δZy(Z)、δZz(Z)、αZ(Z)、βZ(Z)、γZ(Z),δAx(A)、δAy(A)、δAz(A)、αA(A)、βA(A)、γA(A),δCx(C)、δCy(C)、δCz(C)、αC(C)、βC(C)、γC(C),δCx、δCy、αCY、βCX,δAy、δAz、γAY、βAZ,γYX,αZY、βZX代入上述推导得到的解析表达式中,可求得补偿后的运动代码,实现机床几何误差的补偿,对刀具/齿轮位姿偏差进行修正;
所述步骤(5)中指C轴实际坐标系到工件实际坐标系的运动变换;
指含C轴位置无关误差δCx、δCy、αCY、βCX及位置相关误差δCx(C)、δCy(C)、δCz(C)、αC(C)、βC(C)、γC(C)的X轴实际坐标系到实际C轴实际坐标系的运动变换;
指含X轴位置相关误差δXx(X)、δXy(X)、δXz(X)、αX(X)、βX(X)、γX(X)的参考坐标系到X轴实际坐标系的运动变换;
指含Y轴、X轴垂直度误差γYX及Y轴位置相关误差δYx(Y)、δYy(Y)、δYz(Y)、αY(Y)、βY(Y)、γY(Y)的参考坐标系到Y轴实际坐标系的运动变换;
指含Z轴、Y轴,Z轴、X轴垂直度误差αZY、βZX以及Z轴位置相关误差δZx(Z)、δZy(Z)、δZz(Z)、αZ(Z)、βZ(Z)、γZ(Z)的Y轴实际坐标系到Z轴实际坐标系的运动变换;
指的是含A轴位置无关误差δAy、δAz、γAY、βAZ及位置相关误差δAx(A)、δAy(A)、δAz(A)、αA(A)、βA(A)、γA(A)的Z轴实际坐标系到A轴实际坐标系的运动变换;
指A轴实际坐标系到刀具实际坐标系的运动变换。
2.根据权利要求1所述的一种五轴数控制齿机床几何误差实际逆向运动学补偿方法,其特征在于所述步骤(6)中求得补偿后的运动代码与修正的刀位数据、机床几何误差项的解析函数关系式为:
3.根据权利要求2所述的一种五轴数控制齿机床几何误差实际逆向运动学补偿方法,其特征在于所述步骤(6)中考虑旋转轴运动与直线轴运动之间的耦合关系,首先对旋转轴运动代码解析表达式进行推导得到:
式中:
再对直线轴运动代码解析表达式进行推导得到:
Z'=z'+δWz-δAz-L+δCz(C)+δXz(X)-δYz(Y)-δZz(Z)+(αW+αC(C))y'-(βW+βC(C))x'+
(αCY+αX(X))y'cos(C')-(βCX+βX(X))x'cos(C')+(αCY+αX(X))x'sin(C')+
(βCX+βX(X))y'sin(C')-(δTy-δAy+δAy(A)+(αA(A)+αY(Y)+αZY+αZ(Z))L)sin(A')+
(L+δAz-δTz-δAz(A))cos(A')
Y'=(δTz-δAz-L+δAz(A))sin(A')+δCy-δAy+δXy(X)-δYy(Y)-δZy(Z)+(αY(Y)+αZY+αZ(Z))L-
(δTy-δAy+δAy(A)+(αA(A)+αY(Y)+αZY+αZ(Z))L)cos(A')-(αCY+αX(X))z'+
(δWy+δCy(C)+y'-(αW+αC(C))z'+(γW+γC(C)+γX(X))x')cos(C')+
(δWx+δCx(C)+x'+(βW+βC(C))z'-(γW+γC(C)+γX(X))y')sin(C')+(αY(Y)+αZY)Z'
X'=-{(βAZ+βY(Y)+βZX+βZ(Z))Lcos(A')+δCx-δTx-δAx(A)+δXx(X)-δYx(Y)-δZx(Z)+
(βA(A)-βAZ-βY(Y)-βZX-βZ(Z))L+(βCX+βX(X))z'+
(δWx+δCx(C)+x'+(βW+βC(C))z'-(γW+γC(C)+γX(X))y')cos(C')-
(δWy+δCy(C)+y'-(αW+αC(C))z'+(γW+γC(C)+γX(X))x')sin(C')+
(γAY+γYX+γY(Y)+γZ(Z))Lsin(A')}+(βY(Y)+βZX)Z'-γYXY'。
4.根据权利要求1所述的一种五轴数控制齿机床几何误差实际逆向运动学补偿方法,其特征在于所述步骤(6)中最终推导得到误差补偿的运动解析表达式,具体步骤如下:
假设修正后的刀位数据为(x’,y’,z’,i’,j’,k’),几何误差补偿后的机床运动代码为(X’,Y’,Z’,A’,C’),则根据式(1)可建立如下关系式:
[i';j';k';0]=(RBX(X')·XBC(C')·CBW)-1 RBY(Y')·YBZ(Z')·ZBA(A')·ABT·[0;0;1;0] (2)
[x';y';z';1]=(RBX(X')·XBC(C')·CBW)-1 RBY(Y')·YBZ(Z')·ZBA(A')·ABT·[0;0;0;1] (3)
其中[0;0;1;0]指实际刀具坐标系下的刀轴矢量齐次坐标,[0;0;0;1]指实际刀具坐标系下的刀具中心点位置齐次坐标;
考虑到所有平动变换不会对矢量方向产生影响,在求解旋转轴运动代码解析表达式时,将所有平动值设为零,同时将式(2)推导转换到如式(4)、式(5)所示的方程形式,我们发现方程左右两侧计算结果均为一个4×1的实数矩阵,同时观察到式(4)左侧第3行元素是不含C轴运动的,式(5)右侧第一行元素是不含A轴运动的,这是由于仅有C轴旋转运动不会对变换前后的Z轴坐标有任何影响,同样仅有A轴旋转运动,不会对变换前后的X轴坐标有任何影响,这一原理同样适用于B轴的旋转运动,可根据这一特征,将特征元素A’,C’分离开来,得到仅关于A’或者仅关于C’的超越方程,从而可求得其解析表达式:
直线轴代码解析表达式的求解主要运用齐次变换矩阵分块计算原理推导得到:
式中R3×1,I3×1均指3×1实数矩阵,指平动齐次变换矩阵,I3×3指3×3单位矩阵,利用上式计算原理、矩阵乘法结合律以及齐次变换矩阵均可逆的性质,可将式(3)推导为如下形式:
由式(6)将直线轴运动代码分离开来,进而得到关于直线轴运动代码的简单线性方程组;忽略高阶项,则由式(4)、(5)、(6)推导得到的运动轴代码解析表达式为:
式中:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610878411.XA CN106325207B (zh) | 2016-10-08 | 2016-10-08 | 一种五轴数控制齿机床几何误差实际逆向运动学补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610878411.XA CN106325207B (zh) | 2016-10-08 | 2016-10-08 | 一种五轴数控制齿机床几何误差实际逆向运动学补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106325207A CN106325207A (zh) | 2017-01-11 |
CN106325207B true CN106325207B (zh) | 2019-03-12 |
Family
ID=57820946
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610878411.XA Active CN106325207B (zh) | 2016-10-08 | 2016-10-08 | 一种五轴数控制齿机床几何误差实际逆向运动学补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106325207B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110370083A (zh) * | 2019-08-27 | 2019-10-25 | 南京工业大学 | 一种强力剐齿加工工件位姿误差测量的方法 |
Families Citing this family (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107479497B (zh) * | 2017-09-11 | 2019-06-21 | 大连理工大学 | 一种五轴加工轨迹轮廓误差双闭环补偿方法 |
CN107703744B (zh) * | 2017-09-19 | 2020-07-14 | 浙江大学 | 考虑非线性误差和广义模态的数控机床运动链设计方法 |
CN107748539B (zh) * | 2017-09-25 | 2020-09-15 | 电子科技大学 | 基于rtcp误差特征识别的五轴机床多轴联动误差溯源方法 |
CN107553496B (zh) * | 2017-09-29 | 2020-09-22 | 南京阿凡达机器人科技有限公司 | 机械臂逆运动学求解方法误差的确定及校正方法和装置 |
CN107966957B (zh) * | 2017-11-27 | 2019-10-18 | 重庆大学 | 一种数控蜗杆砂轮磨齿机空间误差解耦补偿方法 |
CN108279643B (zh) * | 2018-01-29 | 2020-08-07 | 西南交通大学 | 一种基于测量点与自适应差分进化算法的工件姿态调整方法 |
CN108253911B (zh) * | 2018-01-29 | 2019-10-11 | 西南交通大学 | 一种基于测量点几何特征迭代配准的工件位姿调整方法 |
CN108415371B (zh) * | 2018-01-31 | 2020-09-22 | 西北工业大学 | 一种通用五轴数控机床几何误差补偿方法 |
CN109014437B (zh) * | 2018-06-15 | 2019-08-06 | 重庆大学 | 基于齿面误差模型的成形磨齿机关键几何误差筛选方法 |
CN108829038B (zh) * | 2018-08-02 | 2020-09-25 | 北京理工大学 | 一种刀尖运动轨迹控制算法 |
CN109471408B (zh) * | 2018-11-01 | 2021-03-23 | 西北工业大学 | 基于nc代码重构的三轴机床几何误差补偿方法 |
CN109521729B (zh) * | 2018-11-14 | 2020-05-29 | 内蒙古工业大学 | 一种三轴数控机床可补偿及不可补偿几何误差分离方法 |
CN110045681B (zh) * | 2019-03-12 | 2020-10-23 | 浙江大学 | 一种基于位置预测的数控机床位置相关型误差的外置补偿方法 |
TWI710748B (zh) | 2019-04-15 | 2020-11-21 | 財團法人工業技術研究院 | 輪廓精度量測系統及量測方法 |
CN110597183B (zh) * | 2019-08-15 | 2020-07-28 | 重庆大学 | 一种磨齿关键误差高效补偿方法 |
CN110587038B (zh) * | 2019-09-17 | 2021-05-18 | 南京工业大学 | 一种刮齿加工齿廓误差补偿方法 |
CN110977613B (zh) * | 2019-12-13 | 2021-05-25 | 宁波大学 | 基于试件自标定的五轴数控机床几何误差辨识方法 |
CN112051798B (zh) * | 2020-08-17 | 2021-07-20 | 扬州大学 | 一种可计算的可重构机床几何位姿误差定义方法 |
CN112526927B (zh) | 2021-02-18 | 2021-06-08 | 成都飞机工业(集团)有限责任公司 | 面向五轴数控机床旋转轴空间定位误差快速优化补偿方法 |
CN114690707B (zh) * | 2021-12-01 | 2023-08-18 | 南京工业大学 | 一种基于改进bp神经网络的数控成形磨齿机直线轴几何综合误差辨识方法 |
CN117455837A (zh) * | 2023-09-22 | 2024-01-26 | 苏州诺克汽车工程装备有限公司 | 一种基于深度学习的高反光汽车零件识别上料方法与系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012033203A (ja) * | 2011-11-14 | 2012-02-16 | Makino Milling Mach Co Ltd | 数値制御工作機械 |
CN102426436A (zh) * | 2011-10-24 | 2012-04-25 | 华中科技大学 | 考虑机床结构误差的多轴数控加工后置处理方法 |
CN103616851A (zh) * | 2013-12-04 | 2014-03-05 | 天津大学 | 数控机床的几何误差旋量理论建模方法 |
CN104057363A (zh) * | 2014-06-10 | 2014-09-24 | 浙江大学 | 一种基于工件模型重建的三轴数控机床几何误差补偿方法 |
CN105717864A (zh) * | 2016-03-16 | 2016-06-29 | 四川大学 | 基于修改nc程序的数控机床综合误差三阶优化补偿方法 |
-
2016
- 2016-10-08 CN CN201610878411.XA patent/CN106325207B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102426436A (zh) * | 2011-10-24 | 2012-04-25 | 华中科技大学 | 考虑机床结构误差的多轴数控加工后置处理方法 |
JP2012033203A (ja) * | 2011-11-14 | 2012-02-16 | Makino Milling Mach Co Ltd | 数値制御工作機械 |
CN103616851A (zh) * | 2013-12-04 | 2014-03-05 | 天津大学 | 数控机床的几何误差旋量理论建模方法 |
CN104057363A (zh) * | 2014-06-10 | 2014-09-24 | 浙江大学 | 一种基于工件模型重建的三轴数控机床几何误差补偿方法 |
CN105717864A (zh) * | 2016-03-16 | 2016-06-29 | 四川大学 | 基于修改nc程序的数控机床综合误差三阶优化补偿方法 |
Non-Patent Citations (2)
Title |
---|
A positionindependentgeometricerrorsidentification and correction method for five-axis serial machines based on screw theory;Jixiang Yang 等;《InternationalJournalofMachineTools&Manufacture》;20151231;第52-66页 |
Actual inverse kinematics for position-independent and position-dependent geometric error compensation of five-axis machine tools;Shuang Ding 等;《International Journal of Machine Tools & Manufacture》;20161006;第55-62页 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110370083A (zh) * | 2019-08-27 | 2019-10-25 | 南京工业大学 | 一种强力剐齿加工工件位姿误差测量的方法 |
CN110370083B (zh) * | 2019-08-27 | 2021-07-20 | 南京工业大学 | 一种强力剐齿加工工件位姿误差测量的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106325207A (zh) | 2017-01-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106325207B (zh) | 一种五轴数控制齿机床几何误差实际逆向运动学补偿方法 | |
CN111590594A (zh) | 基于视觉引导的机器人轨迹跟踪控制方法 | |
Fu et al. | Product-of-exponential formulas for precision enhancement of five-axis machine tools via geometric error modeling and compensation | |
Peng et al. | Total differential methods based universal post processing algorithm considering geometric error for multi-axis NC machine tool | |
CN109765848B (zh) | 五轴机床运动轴几何误差贡献值计算及影响评估方法 | |
CN110287553A (zh) | 一种基于拟蒙特卡洛模拟的加工误差模型全局灵敏度分析方法 | |
CN104057363B (zh) | 一种基于工件模型重建的三轴数控机床几何误差补偿方法 | |
CN110597183B (zh) | 一种磨齿关键误差高效补偿方法 | |
Li et al. | A sensitivity method to analyze the volumetric error of five-axis machine tool | |
Givi et al. | Volumetric error formulation and mismatch test for five-axis CNC machine compensation using differential kinematics and ephemeral G-code | |
Gong et al. | Accurate spiral tool path generation of ultraprecision three-axis turning for non-zero rake angle using symbolic computation | |
CN108549319B (zh) | 一种双转台五轴数控机床通用后处理方法 | |
CN103616851A (zh) | 数控机床的几何误差旋量理论建模方法 | |
CN111273606B (zh) | 一种五轴机床几何误差补偿的刀具姿态优化方法 | |
Zuo et al. | Integrated geometric error compensation of machining processes on CNC machine tool | |
Li et al. | Tool path optimization in postprocessor of five-axis machine tools | |
Xu et al. | Active precision design for complex machine tools: methodology and case study | |
Yun et al. | A geometric postprocessing method for 5-axis machine tools using locations of joint points | |
Marinescu et al. | Adaptive dimensional control based on in-cycle geometry monitoring and programming for CNC turning center | |
CN109521729B (zh) | 一种三轴数控机床可补偿及不可补偿几何误差分离方法 | |
Kirichek et al. | Geometric accuracy of the machines with strut-type structures | |
CN114063564A (zh) | 一种数控机床空间误差补偿方法 | |
CN114001683A (zh) | 一种基于坐标原点平移的复杂构件加工剩余壁厚自适应补偿方法 | |
Yusubov | Matrix models of the accuracy in multitool two-support setup | |
Ramos et al. | Application of the Denavit-Hartenberg method to estimate the positioning errors of an automated XYZ cartesian table |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20220708 Address after: 210000 No. 18, Qing'an Road, Jiangbei new area, Nanjing, Jiangsu Patentee after: NANJING GONGDA CNC TECHNOLOGY Co.,Ltd. Address before: 211800 No. 30 South Pearl Road, Pukou District, Jiangsu, Nanjing Patentee before: Nanjing Tech University Patentee before: NANJING GONGDA CNC TECHNOLOGY Co.,Ltd. |