CN101751008B - 一种数控插补方法 - Google Patents

一种数控插补方法 Download PDF

Info

Publication number
CN101751008B
CN101751008B CN 200810072393 CN200810072393A CN101751008B CN 101751008 B CN101751008 B CN 101751008B CN 200810072393 CN200810072393 CN 200810072393 CN 200810072393 A CN200810072393 A CN 200810072393A CN 101751008 B CN101751008 B CN 101751008B
Authority
CN
China
Prior art keywords
definition
coordinate
field
function
value
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.)
Expired - Fee Related
Application number
CN 200810072393
Other languages
English (en)
Other versions
CN101751008A (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.)
Individual
Original Assignee
Individual
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 Individual filed Critical Individual
Priority to CN 200810072393 priority Critical patent/CN101751008B/zh
Publication of CN101751008A publication Critical patent/CN101751008A/zh
Application granted granted Critical
Publication of CN101751008B publication Critical patent/CN101751008B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Complex Calculations (AREA)

Abstract

本发明公开一种数控插补方法,针对正弦函数类所需路径或轮廓线,包括正弦曲线、椭圆曲线、圆弧曲线,通过算术运算的递推公式准确确定曲线中间点位置坐标值增量。所述方法运算简单,对于同样的分段段数,完成运算所需时间少,相当于提高了插补运算速度;或者,在同等的运算时间内,允许增加曲线分段段数,从而提高折线拟合曲线的精度。由于运算简单,这种方法可在单片计算机上实现,从而降低了插补器的成本。因此,这种插补方法速度快,精度高,装置成本低。

Description

一种数控插补方法
【技术领域】
本发明属于计算机数控领域,尤其是涉及一种控制物体运动轨迹的插补方法。 
【背景技术】
(1)插补的任务 
数控系统广泛应用于机械运动轨迹的控制,可以控制机床、机器人、缝纫机、焊接机等的运动轨迹。所需路径或轮廓线的“插补”是数控技术的关键。 
插补的任务就是在所需轨迹或说所需路径或轮廓线Q的二个已知点间插入若干个中间点,并确定所述中间点的位置坐标值。 
插补所得结果将依次送给直线插补器;对应一组相邻二点的位置坐标值,直线插补器产生一组分布均匀的脉冲序列,并通过步进马达或伺服系统控制受控对象运动,产生一个直线段的运动轨迹。或者,插补所得结果直接以数值方式依次送给伺服系统,控制受控对象运动;对应一组相邻二点的位置坐标值,产生一个直线段的运动轨迹。受控对象整个运动轨迹将是一个由上述首尾相接的直线段构成的折线,折线的起点、终点、中间点与所需路径或轮廓线Q的对应起点、终点、中间点重合。换句话说,在所需路径或轮廓线Q的二个端点间插入若干个中间点,将曲线Q上相邻二点以直线段连接,这些首尾相接的直线段构成的折线就是受控对象的运动轨迹。 
插补的目的就是确定受控对象的运动轨迹,使之尽可能接近所需路径或轮廓线Q;或者说,插补的目的就是确定所述的折线,也即受控对象的运动轨迹,以此拟合所需路径或轮廓线Q,且拟合误差不超过允许值。 
(2)现状 
对于常见的正弦曲线、椭圆、圆弧等所需路径或轮廓线,准确确定所述中间点位置坐标值的运算涉及三角函数等比较复杂的计算。这样的计算,靠单片计算机很难完成,而由PC级计算机采用高级语言不难完成。在运动控制装置中,如果作为整个装置的控制核心配置PC级计算机,直接由之承担插补的实时运算将占用大量资源,从而影响整个装置工作;如果专为插补工作配置PC级计算机,将导致装置成本提高。 
当前,运动控制技术已广泛应用于各领域,甚至将进入普通家庭,如家用机器人等;基于现有插补方法的产品难以适应、满足市场的需求。 
可是,可以在单片计算机上快速、准确实现的插补方法,至今未见在公开资料上发表或在产品中使用。 
【发明内容】
本发明的目的是针对正弦函数类所需路径或轮廓线,包括正弦曲线、椭圆曲线、圆弧曲线,提出一种通过算术运算的递推公式准确确定曲线中间点位置坐标值增量的插补方法。所述方法运算简单,对于同样的分段段数,完成运算所需时间少,相当于提高了插补运算速度;或者,在同等的运算时间内,允许增加曲线分段段数,从而提高折线拟合曲线的精度。由于运算简单,这种方法可在单片计算机上实现,从而降低了插补器的成本。因此,这种插补方法速度快,精度高,装置成本低。 
本发明的目的是按如下技术方案实现的: 
1、本发明所述的一种数控插补方法,其所针对的所需路径或轮廓线Q的位置坐标ΩP(p=1、2、3、……、mΩ)中包括有一个或若干个坐标Ψk(k=1、2、3、……、mΨ),对应所述一个或若干个坐标Ψk(k=1、2、3、……、mΨ)的坐标函数分别可以表示为以参数t为自变量、幅值分别为Hk(k=1、2、3、……mΨ)、初始相位分别为αk(k=1、2、3、……、mΨ)、周期相同为(2π/ω)的正弦函数,其表达式为
ψk(t)=Hksin(ωt+αk),(k=1、2、3、……、mψ)。(1-1) 
所述曲线Q对应坐标ψk(k=1、2、3、……、mψ)的坐标函数指的是描述所述曲线Q上的点的位置坐标ψk(k=1、2、3、……、mψ)变化的以参数t为自变量的函数。 
参数t可以是该曲线Q位置坐标ΩP(p=1、2、3、……、mΩ)中的一个坐标,也可以是这些坐标之外的另一个参数。 
所述的所需路径或轮廓线Q指的是二个已知点间的曲线段。所述曲线Q各坐标函数的定义域相同,定义域的二个端点分别与曲线Q二个已知点对应着相同的t值。 
某一t值所对应的所需路径或轮廓线Q上的点的位置坐标值,就是同一t值所对应的所述坐标函数的函数值。针对所需路径或轮廓线Q的插补就是针对其坐标函数ΩP(t)(p=1、2、3、……、mΩ)的插补,就是在其各个坐标函数ΩP(t)(p=1、2、3、……、mΩ)的定义域二个端点间插入若干个中间点并确定所述中间点的坐标函数值。插补中确定的中间点将所述定义域分成分段,每个分段定义域将对应一个线性函数,所述各个分段定义域的端点所对应的线性函数值与坐标函数值相等,整个定义域将对应一个由各个分段定义域对应的线性函数组成的分段线性函数ψLk(t)(k=1、2、3、……、mψ),而坐标函数ψk(t)(k=1、2、3、……、mψ)将以分段线性函数ψLk(t)(k=1、2、3、……、mψ)拟合。 
申请人注意到,所述曲线Q二个端点间的中间点的位置坐标值,可依据与之相邻的前一个中间点或所述曲线Q的起点其位置坐标值与位置坐标值增量之和决定;因此,插补中确定了中间点的位置坐标值增量,也就确定了相应中间点的位置坐标值。或者说,插补中确定了定义域中间点坐标函数值增量,也就确定了定义域相应中间点的坐标函数值。 
针对坐标函数ψk(t)(k=1、2、3、……、mψ)的插补,其步骤包括, 
(1)确定坐标函数ψk(t)(k=1、2、3、……、mψ)定义域二个端点间的中间点,包括, 
①确定所述中间点所对应的参数t的值或其增量Δt的值, 
②确定所述中间点的个数, 
(2)确定所述中间点的坐标函数值或其增量值, 
(3)存储/输出运算结果。 
本发明提出的插补方法,其特征在于: 
(1)将对应所述坐标ψk(k=1、2、3、……、mψ)的各坐标函数ψk(t)(k=1、2、3、……、mψ)定义域等分,以等分分段的交点作为定义域的中间点, 
(2)所述中间点所对应的坐标函数值增量ΔΨk(t)(k=1、2、3、……、mΨ)按下述公式确定, 
ΔψΛ(tu+1)=ΔψΛ(tu)cosΔTΛ+ΔΦΛ(tu)sinΔTΛ,(1-2) 
ΔΦΛ(tu+1)=ΔΦΛ(tu)cosΔTΛ-ΔψΛ(tu)sinΔTΛ,(1-3) 
式中,①ψΛ表示所述坐标ψk(k=1、2、3、……、mψ)中的某个坐标,Λ为序号k(k=1、2、3、……、mψ)中的某个序号, 
②u+1为坐标函数ΨΛ(t)定义域二个端点间的某个中间点的序号,u就是与之相邻的前一个中间点或定义域起点的序号, 
以nΛ表示坐标函数ψΛ(t)定义域等分分段的段数,以iΛ(iΛ=1、2、3、……、nΛ)作为分段的序号,以iΛ(iΛ=1、2、3、……、nΛ,nΛ+1)作为包括定义域的二个端点及二个端点间的中间点在内的点的序号,二个端点分别对应着序号1及nΛ+1,二个端点间的中间点分别对应着序号iΛ(iΛ=2、3、……、nΛ),u+1就是序号iΛ(iΛ=2、3、……、nΛ)中的某一个序号,u就是序号iΛ(iΛ=1,2、3、……、nΛ)中与u+1相邻的前一个中间点或定义域起点的序号,u+2就是序号iΛ(iΛ=1,2、3、……、nΛ,nΛ+1)中与u+1相邻的后一个中间点或定义域终点的序号, 
所述定义域起点指的是与所需路径或轮廓线Q起点对应的定义域的端点,所述定义域终点指的是与所需路径或轮廓线Q终点对应的定义域的端点, 
③tu+1为坐标函数ψΛ(t)定义域二个端点间序号为u+1的中间点所对应的参数t的值, 
tu为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的参数t的值, 
tu+2为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的参数t的值, 
t1为坐标函数ψΛ(t)定义域起点所对应的参数t的值, 
t(nΛ+1)为坐标函数ψΛ(t)定义域终点所对应的参数t的值, 
④ΔTΛ为坐标函数ψΛ(t)定义域各等分分段起点所对应的参数t的等效增量,或说是坐标函数ψΛ(t)定义域中序号为iΛ(iΛ=1、2、3、……、nΛ)的点所对应的参数t的等效增量,或说是坐标函数ψΛ(t)定义域各等分分段所对应的参数t的等效增量,其数值为所述参数t的增量ΔτΛ的ω倍,是常数, 
ΔTΛ=ωΔτΛ=常数,(1-4) 
Figure G2008100723931D00031
(iΛ=1、2、3、……、nΛ),(1-5) 
其中,t(iΛ+1)(iΛ=1、2、3、……、nΛ)为序号为(iΛ+1)(iΛ=1、2、3、……、nΛ)的点对应的参数t的值, 
t(iΛ)(iΛ=1、2、3、……、nΛ)为序号为iΛ(iΛ=1、2、3、……、nΛ)的点对应的参数t的值, 
⑤ΔΨΛ(tu+1)为坐标函数ΨΛ(t)定义域中序号为u+1的中间点所对应的坐标函数值增量, 
ΔψΛ(tu+1)=ψΛ(tu+2)-ψΛ(tu+1),(1-6) 
其中,ψΛ(tu+2)为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的坐标函数值, 
ψΛ(tu+1)为序号为u+1的中间点所对应的坐标函数值, 
⑥ΔψΛ(tu)为坐标函数ψΛ(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的坐标函数值增量, 
ΔψδΛ(tu)=ψΛ(tu+1)-ψΛ(tu),(1-7) 
其中,ψΛ(tu+1)为序号为u+1的中间点所对应的坐标函数值, 
ψΛ(tu)为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的坐标函数值, 
⑦ΔΦδΛ(tu+1)为坐标函数ΨΛ(t)定义域中序号为u+1的中间点所对应的虚拟坐标函数值增量, 
ΔΦΛ(tu+1)=ΦΛ(tu+2)-ΦΛ(tu+1),(1-8) 
其中,ΦΛ(tu+2)为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的虚拟坐标函数值, 
ΦΛ(tu+1)为序号为u+1的中间点所对应的虚拟坐标函数值, 
③ΔΦΛ(tu)为坐标函数ψΛ(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的虚拟坐标函数值增量, 
ΔΦΛ(tu)=ΦΛ(tu+1)-ΦΛ(tu),(1-9) 
其中,ΦΛ(tu+1)为序号为u+1的中间点所对应的虚拟坐标函数值, 
ΦΛ(tu)为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的虚拟坐标函数值, 
⑨sinΔTΛ为对应ΔTΛ的正弦函数值,cosΔTΛ为对应ΔTΛ的余弦函数值,上述⑦、⑧中所述的虚拟坐标函数ΦΛ(t)是为简化公式(1-2)、(1-3)的表述设定的函数,ψΛ(t)与ΦΛ(t)是一组具有相同幅值HΛ、相同周期(2π/ω)、相同初始相位αΛ及相同定义域的正弦函数与余弦函数,其表达式为 
ΨΛ(t)=HΛsin(ωt+αΛ),                             (1-10) 
ΦΛ(t)=HΛcos(ωt+αΛ)。(1-11) 
说明: 
(1)参见图2,如果所需路径或轮廓线的位置坐标只包括了二个个坐标t和ψA,且坐标轴t和ψA构成了直角坐标系tOψA,则所需路径或轮廓线就是平面tOψA上幅值为HA、初始相位为αA、周期为(2π/ω)的的正弦曲线段ZA。 
(2)参见图5,以序号为A的坐标函数ψA(t)为例,坐标轴ψA和ΦA构成了虚拟直角坐标系ΦAA,坐标函数ψA(t)与虚拟坐标函数ΦA(t)在ΦAA虚拟平面上的图形即为圆心在坐标轴原点O、半径为HA的圆弧段CA。圆弧段CA上的点与圆心O的连线相对轴ΦA的夹角即为(ωt+αA)。坐标函数ΦA(t)定义域的端点与中间点对应着圆弧段CA相应的端点与中间点。图中CA是第一象限的圆弧段。 
(3)公式(1-2)、(1-3)的依据是: 
参见图6,以序号为A的坐标函数ψA(t)为例,坐标函数ψA(t)定义域中序号为i(i=2、3、……、n)的中间点对应着圆弧段CA上相应的中间点,这些中间点将圆弧段CA等分成序号为i(i=1、2、3、……、n)n个分段。圆弧段CA的等分分段对应的圆心角即为ΔTA。以lA表示圆弧段CA一个分段的内接弦的长度,对应于tu有 
Δ Ψ A ( t u ) = l A cos [ ω ( t u + Δ τ A 2 ) + α A ] = l A cos ( ω t u + Δ T A 2 + α A ) , - - - ( 1 - 12 )
Δ Φ A ( t u ) = - l A sin [ ω ( t u + Δ τ A 2 ) + α A ] = - l A sin ( ω t u + Δ T A 2 + α A ) , - - - ( 1 - 13 )
式中,ΔTA=ωΔτA,(1-14) 
以u+1表示所述的某个中间点的序号,则 
Δ Ψ A ( t u + 1 ) = l A cos ( ω t u + Δ T A 2 + Δ T A + α A ) =
= l A cos ( ω t u + Δ T A 2 + α A ) cos Δ T A - l A sin ( ω t u + Δ T A 2 + α A ) sin Δ T A ,
= Δ Ψ A ( t u ) cos Δ T A + Δ Φ A ( t u ) sin Δ T A , - - - ( 1 - 15 )
Δ Φ A ( t u + 1 ) = - l A sin ( ω t u + Δ T A 2 + Δ T A + α A ) =
= - l A sin ( ω t u + Δ T A 2 + α A ) cos Δ T A - l A cos ( ω t u + Δ T A 2 + α A ) sin Δ T A ,
= Δ Φ A ( t u ) cos Δ T A - Δ Ψ A ( t u ) sin Δ T A . - - - ( 1 - 16 )
(4)对应所述坐标ψΛ的坐标函数ψΛ(t)其定义域等分分段起点所对应的参数t等效增量ΔTΛ的正弦函数值sinΔTΛ与余弦函数值cosΔTΛ,可按下述公式确定, 
sin Δ T Λ = Δ T Λ - 1 6 × ( Δ T Λ ) 3 + · · · · · · + 1 v ′ ! [ d v ′ d t v ′ sin t ] t = 0 ( Δ T Λ ) v ′ + R S , - - - ( 1 - 17 )
cos Δ T Λ = 1 - 1 2 ( Δ T Λ ) 2 + 1 24 ( Δ T Λ ) 4 + · · · · · · + 1 v ′ ′ ! [ d v ′ ′ d t v ′ ′ cos t ] t = 0 ( Δ T Λ ) v ′ ′ + R C , - - - ( 1 - 18 )
其中, R S = 1 ( v ′ + 1 ) ! [ d v ′ + 1 d t v ′ + 1 sin t ] t = γ ′ ( Δ T Λ ) v ′ + 1 , - - - ( 1 - 19 )
R C = 1 ( v ′ ′ + 1 ) ! [ d v ′ ′ + 1 d t v ′ ′ + 1 cos t ] t = γ ′ ′ ( Δ T Λ ) v ′ ′ + 1 , - - - ( 1 - 20 )
式中,①v′+2为正整数,数值等于等式(1-17)右边部分的项数, 
v′≥0,(1-21) 
②γ′的取值范围为 
0≤γ′≤ΔTΛ,(1-22) 
③v″+2为正整数,数值等于等式(1-18)右边部分的项数 
v″≥0,(1-23) 
④γ″的取值范围为 
0≤γ″≤ΔTΛ。(1-24) 
按公式(1-17)、(1-18)确定sinΔTΛ、cosΔTΛ时,可以将RS、RC取值为0。sinΔTΛ、cosΔTΛ数值精度由舍去的RS、RC数值决定,而RS、RC数值由ΔTΛ及v′、v″决定。v′、v″的选择可参见实施例。 
公式(1-17)、(1-18)的依据是: 
sin Δ T Λ = sin ( 0 + Δ T Λ ) =
= [ sin t ] t = 0 + [ d dt sin t ] t = 0 ( Δ T Λ ) + 1 2 [ d 2 d t 2 sin t ] t = 0 ( Δ T Λ ) 2 + 1 3 ! [ d 3 d t 3 sin t ] t = 0 ( Δ T Λ ) 3 +
+ · · · · · · + 1 v ′ ! [ d v ′ d t v ′ sin t ] t = 0 ( Δ T Λ ) v ′ + R S =
= sin 0 + ( cos 0 ) ( Δ T Λ ) - 1 2 ( sin 0 ) ( Δ T Λ ) 2 - 1 3 ! ( cos 0 ) ( Δ T Λ ) 3 + · · · · · · +
+ 1 v ′ ! [ d v ′ d t v ′ sin t ] t = 0 ( Δ T Λ ) v ′ + R S =
= 0 + ( Δ T Λ ) - 0 - 1 6 × ( Δ T Λ ) 3 + 0 + · · · · · · + 1 v ′ ! [ d v ′ d t v ′ sin t ] t = 0 ( Δ T Λ ) v ′ + R S ,
= Δ T Λ - 1 6 × ( Δ T Λ ) 3 + · · · · · · + 1 v ′ ! [ d v ′ d t v ′ sin t ] t = 0 ( Δ T Λ ) v ′ + R S , - - - ( 1 - 25 )
其中, R S = 1 ( v ′ + 1 ) ! [ d v ′ + 1 d t v ′ + 1 sin t ] t = γ ′ ( Δ T Λ ) v ′ + 1 , - - - ( 1 - 19 )
cos Δ T Λ = cos ( 0 + Δ T Λ ) =
= [ cos t ] t = 0 + [ d dt cos t ] t = 0 ( Δ T Λ ) + 1 2 [ d 2 d t 2 cos t ] t = 0 ( Δ T Λ ) 2 + 1 3 ! [ d 3 d t 3 cos t ] t = 0 ( Δ T Λ ) 3 +
+ · · · · · · + 1 v ′ ′ ! [ d v ′ ′ d t v ′ ′ cos t ] t = 0 ( Δ T Λ ) v ′ + R C =
= cos 0 - ( sin 0 ) ( Δ T Λ ) - 1 2 ( cos 0 ) ( Δ T Λ ) 2 + 1 3 ! ( sin 0 ) ( Δ T Λ ) 3 + · · · · · · +
+ 1 v ′ ′ ! [ d v ′ ′ d t v ′ ′ cos t ] t = 0 ( Δ T Λ ) v ′ + R C
= 1 - 0 - 1 2 × ( Δ T Λ ) 2 + 0 + 1 4 ! × 1 × ( Δ T Λ ) 4 + · · · · · · + 1 v ′ ′ ! [ d v ′ ′ d t v ′ ′ cos t ] t = 0 ( ΔT Λ ) v ′ ′ + R C ,
= 1 - 1 2 ( Δ T Λ ) 2 + 1 24 ( ΔT Λ ) 4 + · · · · · · + 1 v ′ ′ ! [ d v ′ ′ d t v ′ ′ cos t ] t = 0 ( Δ T Λ ) v ′ ′ + R C , - - - ( 1 - 26 )
其中, R C = 1 ( v ′ ′ + 1 ) ! [ d v ′ ′ + 1 d t v ′ ′ + 1 cos t ] t = r ′ ′ ( Δ T Λ ) v ′ ′ + 1 . - - - ( 1 - 20 )
(5)公式(1-2)、(1-3)中对应所述坐标ψΛ的坐标函数ψΛ(t)定义域起点的函数值增量ΔψΛ(t1)、ΔΦΛ(t1),可按下述公式确定, 
ΔψΛ(t1)=ψΛ(t1)cosΔTΛΛ(t1)sinΔTΛΛ(t1),(1-27) 
ΔΦΛ(t1)=ΦΛ(t1)cosΔTΛΛ(t1)sinΔTΛΛ(t1)。(1-28) 
其依据是: 
ΔψΛ(t1)=ψΛ(t1+Δt1)-ψΛ(t1)= 
          =HΛsin(ω(t1+Δt1)+αΛ)-ψΛ(t1)= 
          =HΛsin(ωt1Λ+ΔTΛ)-ψΛ(t1)= 
          =HΛ[sin(ωt1Λ)cosΔTΛ+cos(ωt1Λ)sinΔTΛ]-ψΛ(t1)= 
          =ψΛ(t1)cosΔTΛΛ(t1)sinΔTΛΛ(t1),(1-29) 
ΔΦΛ(t1)=ΦA(t1+Δt1)-ΦΛ(t1)= 
          =HΛcos(ω(t1+Δt1)+αΛ)-ΦΛ(t1)= 
          =HΛcos(ωt1Λ+ΔTΛ)-ΦΛ(t1)= 
          =HΛ[cos(t1Λ)cosΔTΛ-sin(t1Λ)sinΔTΛ]-ΦΛ(t1)= 
          =ΦΛ(t1)cosΔTΛΛ(t1)sinΔTΛΛ(t1)。(1-30) 
2、如第1点所述的一种插补方法,其特点为:所述坐标Ψk(k=1、……、mΨ)共有二个坐标Ψk(k=1、2)或Ψ1、Ψ2,对应Ψ1、Ψ2的坐标函数Ψ1(t)、Ψ2(t)可以表示为一组幅值分别为H1、H2、周期相同为(2π/ω)、初始相位相同为α0的余弦函数与正弦函数,其表达式为 
Ψ 1 ( t ) = H 1 sin ( ωt + α 1 ) = H 1 sin ( ωt + α 0 + π 2 ) = H 1 cos ( ωt + α 0 ) , - - - ( 2 - 1 )
ψ2(t)=H2sin(ωt+α2)=H2sin(ωt+α0),(2-2) 
式中, α 1 = α 0 + π 2 , - - - ( 2 - 3 )
α2=α0。(2-4) 
坐标函数ψ1(t)、ψ2(t)具有相同的定义域。 
参见图7。如果所需路径或轮廓线的位置坐标只包括了二个个坐标ψ1和ψ2,且坐标轴ψ1和ψ2构成了直角坐标系ψ12,则所需路径或轮廓线即为ψ12平面上中心在坐标轴原点O的椭圆弧段ZE。图中ZE是一个第一象限的椭圆弧段。其在直角坐标系ψ12下的曲线方程为 
Ψ 1 2 H 1 2 + Ψ 2 2 H 2 2 = 1 , - - - ( 2 - 5 )
式中,H1和H2为椭圆的半轴。 
椭圆弧段ZE上的点与坐标轴原点O的连线相对ψ1轴的夹角即为(ωt+α0)。 
当H1=H2=R0,(2-6) 
所述的椭圆弧段ZE即成为半径为R0的圆弧段ZC。 
3、如第2点所述的一种插补方法,其特点为: 
(1)对应所述坐标ψ1、ψ2的坐标函数ψ1(t)、ψ2(t)具有相同幅值R0,函数ψ1(t)、ψ2(t)的 表达式为 
Ψ 1 ( t ) = H 1 sin ( ωt + α 1 ) = R 0 sin ( ωt + α 0 + π 2 ) = R 0 cos ( ωt + α 0 ) , - - - ( 3 - 1 )
ψ2(t)=H2sin(ωt+α2)=R0sin(ωt+α0),(3-2) 
式中,H1=H2=R0,(3-3) 
α 1 = α 0 + π 2 , - - - ( 3 - 4 )
α2=α0,(3-5) 
(2)对应所述坐标Ψ1、Ψ2的坐标函数Ψ1(t)、Ψ2(t)定义域等分为相同的nC个分段,或者说,坐标函数Ψ1(t)、Ψ2(t)定义域各分段起点对应相同的参数t的增量ΔτC或等效增量ΔTC, 
n1=n2=nC,(3-6) 
Δτ1=Δτ2=ΔτC,(3-7) 
ΔT1=ΔT2=ΔTC。(3-8) 
由所述特点可知, 
①在按第1点所述的公式(1-2)、(1-3)确定坐标函数值增量时,对应于坐标函数ψ2(t)的虚拟坐标函数Φ2(t)就是坐标函数ψ1(t), 
Φ2(t)=R0cos(ωt+α0)=ψ1(t),(3-9) 
因此,在确定Δψ1(t)、Δψ2(t)过程中,无需为ψ1(t)、ψ2(t)另设虚拟坐标函数。 
②如果所需路径或轮廓线的位置坐标只包括了二个个坐标ψ1和ψ2,且坐标轴ψ1和ψ2构成了直角坐标系ψ12,则所需路径或轮廓线即为ψ12平面上圆心在坐标轴原点O、半径为R0的圆弧段ZC。圆弧段ZC上的点与圆心O的连线相对轴ψ1的夹角即为(ωt+α0)。每个等分圆弧段所对应的圆心角为 
ΔTC=ωΔτC。(3-10) 
曲线在直角坐标系ψ12下的方程为 
ψ1 22 2=R0 2。(3-11) 
所述圆弧段ZC可参见图5,ψ1、ψ2、R0、α0、t、ZC分别对应图中的ΦA、ψA、HA、αA、t、CA;图中CA是一个第一象限的圆弧段。 
4、如第1至3点中任何一点所述的一种插补方法,其特点为:对应所述坐标其坐标函数定义域等分分段起点所对应的参数t的等效增量的取值及坐标函数定义域等分分段段数的取值满足下述公式, 
| Δ T A | 8 ϵ A H A × | sin ( ωt + α A ) | MAX , - - - ( 4 - 1 )
n ≥ ω | t n + 1 - t 1 | × H A × | sin ( ωt + α A ) | MAX 8 ϵ A , - - - ( 4 - 2 )
式中,①ψA表示所述坐标中的某一个坐标,A是序号k(k=1、2、3、……、mψ)中的某个序号,对应坐标ψA的坐标函数为 
ψA(t)=HAsin(ωt+αA),(4-3) 
②ΔTA为坐标函数ψA(t)定义域等分分段起点所对应的参数t的等效增量,其数值为所述参数t的增量ΔτA的ω倍, 
ΔTA=ωΔτA,(4-4) 
③n表示坐标函数ψA(t)定义域等分分段的段数, 
④t1为坐标函数ψA(t)定义域起点所对应的参数t的值, 
tn+1为坐标函数ψA(t)定义域终点所对应的参数t的值, 
⑤|sin(ωt+αA)|MAX为对应坐标函数ψA(t)定义域|sin(ωt+αA)|的最大值, 
⑥εA为以分段线性函数ψLA(t)拟合坐标函数ψA(t)的误差绝对值|δψL-A(t)|的允许值, 
δψL=A(t)=ψLA(t)-ψA(t),(4-5) 
对应坐标函数ψA(t)第i个分段定义域,所述的分段线性函数ψLA(t)表达式为 
Ψ LA ( t ) = Ψ A ( t i ) + Δ Ψ A ( t i ) Δ τ A ( t - t i ) , , ( i = 1,2,3 , · · · · · · , n ) , - - - ( 4 - 6 )
式中,(a)i(i=1、2、3、……、n)为坐标函数ψA(t)定义域n个等分分段的序号,等分分段的交点就是定义域的中间点,以i(i=1、2、3、……、n、n+1)作为包括定义域的二个端点及二个端点间的中间点在内的点的序号,二个端点分别对应着序号1及n+1,二个端点间的中间点分别对应着序号i(i=2、3、……、n), 
(b)ti(i=1、2、3、……、n、n+1)为坐标函数ψA(t)定义域序号为i(i=1、2、3、……、n、n+1)的点所对应的参数t的值, 
(c)ΔΨA(ti)(i=1、2、3、……、n)为坐标函数ΨA(t)定义域序号为i(i=1、2、3、……、n)的点所对应的坐标函数值增量, 
ΔψA(ti)=ψA(ti+1)-ψA(ti),(i=1、2、3、……、n),(4-7) 
其中,ψA(ti+1)(i=1、2、3、……、n)为坐标函数ψA(t)定义域中与序号为i(i=1、2、3、……、n)的点相邻的后一个点所对应的坐标函数值, 
ψA(ti)(i=1、2、3、……、n)为坐标函数ψA(t)定义域序号为i(i=1、2、3、……、n)的点所对应的坐标函数值。 
满足公式(4-1)、(4-2)的|ΔTA|、n取值,将使得所述的拟合误差|δψL-A(t)|不超过允许值εA, 
参见图2。如果所需路径或轮廓线的位置坐标只包括了二个个坐标t和ΨA,且坐标轴t和ΨA构成了直角坐标系tOΨA;则所需路径或轮廓线即为平面tOΨA上幅值为HA、初始相位为αA的正弦曲线段ZA。参见图3,分段线形函数ΨLA(t)的图形就是由正弦曲线段ZA的n个首尾相连的内接弦构成的折线ZLA。以ΨLA(t)拟合ΨA(t),即相当于以折线ZLA拟合ZA。正弦曲线段ZA分段的交点即为需要设定的正弦曲线段ZA的中间点,i(i=1、2、3、……、n、n+1)就是包括正弦曲线段ZA的二个端点及二个端点间的中间点在内的点的序号。 
根据公式(4-1)、(4-2)确定|ΔTA|及n的取值的依据是: 
(A)以ψLA(t)拟合ψA(t)的误差 
①以ψLA(t)拟合ψA(t),其拟合误差记以δψL=A(t), 
δΨL=A(t)=ΨLA(t)-ΨA(t)。                         (4-8) 
②参见图2至图6。在tOΨA平面上,将ΨA(t)所对应的正弦曲线段ZA定义域分成序号为i(i=1、2、3、……、n)的n个等分分段,在虚拟ΦAA平面上,将ΨA(t)与ΦA(t)所对应的圆弧段CA分成相同的n个等分分段。序号相同的ZA分段端点与CA分段端点对应相同的t值,都是ti(i=1、2、3、……、n、n+1),ZA分段与CA分段对应相同的参数t的增量ΔτA或等效增量ΔTA。以ZA的内接弦构成的折线拟合ZA,其拟合误差为δΨL=A(t);以CA的内接弦构成的折线拟合CA,在中点处其对应坐标轴ΨA拟合误差等于内接弦径向误差在坐标轴ΨA上的投影值δHA,Ψ(tM)。图6中,以tM,u表示一个分段中点处的参数t的值,对应tM,u的所述径向误差绝对值在坐标轴上的投影值即为|δHA,Ψ(tM,u)|。 
③以CA的内接弦构成的折线拟合CA,其径向误差绝对值的最大值|δHA|发生在内接弦的中点tM处,且 
| δ H A | = 1 8 H A ( Δ T A ) 2 , - - - ( 4 - 9 )
其在坐标轴ψA上的投影为 
|δHA,Ψ(tM)|=|δHA|×|sin(ωtMA)|。                         (4-10) 
④相应地认为,一个分段内在中点tM处,以正弦曲线段ZA的内接弦拟合正弦曲线段ZA的误差绝对值|δψL-A(tM.)|也是最大;且|δψL-A(tM)|的值等于对应tM处|δHA|在坐标轴ψA上的投影, 
|δΨL-A(tM.)|=|δHA,Ψ(tM)|=|δHA|×|sin(ωtMA)|。         (4-11) 
⑤在定义域范围内,|δψL-A(tM.)|的最大值|δψL-A(tM.)|MAX为 
|δψL-A(tM.)|MAX=|δHA|×|sin(ωtMA)|MAX,(4-12) 
式中,|sin(ωtMA)|MAX为对应坐标函数ψA(t)定义域|sin(ωtMA)|的最大值, 
由于|ΔTA|或说|ΔτA|很小,可以认为 
|sin(ωtMA)|MAX=|sin(ωt+αA)|MAX,(4-13) 
式中,|sin(ωt+αA)|MAX为对应坐标函数ψA(t)定义域|sin(ωt+αA)|的最大值, 
因此,式(4-12)可以改写为 
|δψL-A(tM.)|MAX=|δHA|×|sin(ωt+αA)|MAX。(4-14) 
(B)ΔTA、n的取值 
ΔTA、n的取值应使得ΨLA(t)拟合ΨA(t)的误差绝对值|δΨL-A(t)|的最大值|δΨL-A(tM.)|MAX不超过允许值εA, 
|δΨL-A(tM.)|MAX≤εA。                    (4-15) 
①由公式(4-9)、(4-14)、(4-15),坐标函数ψA(t)定义域等分分段对应的参数t的等效增量|ΔTA|的取值应满足下述公式, 
| Δ T A | 8 ϵ A H A × | sin ( ωt + α A ) | MAX , - - - ( 4 - 16 )
或,所述参数t的增量ΔτA应满足 
| Δ τ A | 1 ω × 8 ϵ A H A × | sin ( ωt + α A ) | MAX , - - - ( 4 - 17 )
|ΔTA|或|ΔτA|的最大允许取值为 
| Δ T A | = | Δ T A | MAX = 8 ϵ A H A × | sin ( ωt + α A ) | MAX , - - - ( 4 - 18 )
| Δ τ A | = | Δ τ A | MAX = 1 ω × 8 ϵ A H A × | sin ( ωt + α A ) | MAX . - - - ( 4 - 19 )
②坐标函数ψA(t)定义域等分分段段数n应满足下述公式, 
n ≥ ω | t n + 1 - t 1 | × H A × | sin ( ωt + α A ) | MAX 8 ϵ A . - - - ( 4 - 20 )
③如果对坐标函数ψA(t)的任何可能的定义域,上述公式中的|sin(ωt+αA)|MAX都以1替换, 
| Δ T A | 8 ϵ A H A , - - - ( 4 - 21 )
|ΔTA|或|ΔτA|的最大允许取值为 
| Δ T A | = | Δ T A | MAX = 8 ϵ A H A , - - - ( 4 - 22 )
| Δ τ A | = | Δ τ A | MAX = 1 ω × 8 ϵ A H A . - - - ( 4 - 23 )
此时,对任何可能的定义域,都可做到ψLA(t)拟合ψA(t)的误差的绝对值|δψL-A(t)|不超过允许值εA。 
5、如第4点所述的一种插补方法,其特点为:对应所述坐标ψA确定ΔTA、n所应满足的公式中的正弦函数绝对值的最大值|sin(ωt+αA)|MAX以1替换。 
相应地,ΔTA及n的取值满足下述公式, 
| Δ T A | 8 ϵ A H A , - - - ( 5 - 1 )
n ≥ ω | t n + 1 - t 1 | × H A 8 ϵ A . - - - ( 5 - 2 )
满足公式(5-1)、(5-2)的|ΔTA|、n的取值,可以使得对任何可能的定义域,都可做到,以分段线性函数ψLA(t)拟合坐标函数ψA(t)的误差绝对值|δψL-A(t)|不超过允许值εA。 
6、如第1至3点或第5至9点中任何一点所述的一种插补方法,其特点为:对应所述坐标的坐标函数中 
ω=1。(6-1) 
也就是说,所述坐标对应的正弦坐标函数的周期为2π。此时,所述坐标对应的坐标函数定义域各等分分段起点所对应的参数t的等效增量,等于所述参数t的增量;以ψA表示各点所述坐标中的某一个坐标,则有 
ΔTA=ΔτA。(6-2) 
7、如第4点所述的一种插补方法,其特点为:对应所述坐标的坐标函数中 
ω=1。(7-1) 
也就是说,所述坐标对应的正弦坐标函数的周期为2π。此时,所述坐标函数ψA(t)定义域各等分分段起点所对应的参数t的等效增量ΔTA,等于所述参数t的增量ΔτA, 
ΔTA=ΔτA。(7-2) 
值得注意的是,如果一个坐标函数是由若干个函数之和构成,则该坐标函数的插补结果等于构成该坐标函数的各个函数各自的插补结果之和。特别是构成该坐标函数的某个函数如果是常量,则该常量不会影响该函数的增量值。此外,所需路径或轮廓线其所在的直角坐标系坐标轴平移时,也不影响其位置坐标值增量的数值。 
本发明的有益效果为:本发明针对正弦函数类所需路径或轮廓线,包括正弦曲线、椭圆曲线、圆弧曲线,提出一种通过算术运算的递推公式准确确定曲线中间点位置坐标值增量的插补方法。所述方法运算简单,对于同样的分段段数,完成运算所需时间少,相当于提高了插补运算速度;或者,在同等的运算时间内,允许增加曲线分段段数,从而提高折线拟合曲线的精度。由于运算简单,这种方法可在单片计算机上实现,从而降低了插补器的成本。因此,这种插补方法速度快,精度高,装置成本低。 
【附图说明】
图1是本发明的坐标函数ψΛ(t)插补的程序流程图, 
图2是本发明的正弦曲线示意图, 
图3是本发明的分段线性函数示意图, 
图4是本发明的正弦曲线段局部示意图, 
图5是本发明的圆弧曲线示意图, 
图6是本发明的圆弧曲线局部示意图, 
图7是本发明的椭圆曲线示意图。 
【具体实施方式】
一、参见图1,这是针对坐标函数ψΛ(t)插补的程序流程图。所述的坐标函数为 
ψΛ(t)=HΛsin(ωt+αΛ),(J1-1) 
程序由步骤(1)至步骤(8)组成: 
(1)确定坐标函数ψΛ(t)定义域起点及中间点所对应的参数t的等效增量ΔTΛ,其数值为所述参数t的增量ΔτΛ的ω倍,是常数, 
ΔTΛ=ωΔτΛ=常数,(J1-2) 
(2)确定坐标函数ψΛ(t)定义域中间点的个数nΛ-1,以iΛ(iΛ=1、2、3、……、nΛ、nΛ+1) 表示包括定义域端点与中间点在内的点的序号,中间点的序号为iΛ(iΛ=2、3、……、nΛ), 
(3)初始化iΛ值,即将iΛ设置为2, 
2→iΛ,(J1-3) 
(4)确定序号为iΛ的中间点所对应的坐标函数值增量ΔψΛ(t)的值, 
(5)存储/输出运算结果, 
(6)判定 
iΛ=nΛ?(J1-4) 
若iΛ≠nΛ,表明插补尚未完成,则转至步骤(7), 
若iΛ=nΛ,则转至步骤(8), 
(7)将iΛ加1,并保存, 
iΛ+1→iΛ,(J1-5) 
再转至步骤(4),继续进行插补, 
(8)插补完成。 
二、参见图2,这是正弦曲线示意图。在直角坐标系tOψA下的一个幅值为HA、初始相位为αA的正弦曲线QA,其坐标函数为 
ψA(t)=HAsin(ωt+αk)。(J2-1) 
对应于所需路径或轮廓线,坐标函数ψA(t)定义域为[t1,tn+1],该定义域对应的正弦曲线段记以ZA。 
三、参见图3,这是等分分段线性函数示意图。在直角坐标系tOψA下的正弦曲线段ZA,其坐标函数为 
ψA(t)=HAsin(ωt+αk),(J3-1) 
n是坐标函数ψA(t)定义域的等分分段数。正弦曲线段ZA的n个等分分段的内接弦构成折线ZLA,相应的分段线性函数ψLA(t)为 
Ψ LA ( t ) = Ψ A ( t i ) + Δ Ψ A ( t i ) Δ τ A ( t - t i ) , , ( t i t t i + 1 ) ,
(i=1、2、3、……、n),(J3-2) 
式中,①i(i=1、2、3、……、n)是坐标函数ψA(t)定义域n个等分分段的序号,等分分段的交点就是定义域的中间点,以i(i=1、2、3、……、n、n+1)作为包括定义域的二个端点及二个端点间的中间点在内的点的序号,二个端点分别对应着序号1及n+1,二个端点间的中间点分别对应着序号i(i=2、3、……、n), 
②ti(i=1、2、3、……、n、n+1)是坐标函数ψA(t)定义域序号为i(i=1、2、3、……、n、n+1)的点所对应的参数t的值, 
t1是坐标函数ψA(t)定义域起点所对应的参数t的值, 
tn+1是坐标函数ψA(t)定义域终点所对应的参数t的值, 
[t1、tu+1]是坐标函数ψA(t)的定义域, 
③ΔτA是坐标函数ΨA(t)定义域各等分分段起点所对应的参数t的增量,ΔτA的ω倍等于所述参数t的等效增量ΔTA, 
ΔTA=ωΔτA=常数,                   (J3-3) 
④ΔψA(ti)(i=1、2、3、……、n)是坐标函数ψA(t)定义域序号为i(i=1、2、3、……、n)的点所对应的坐标函数值的增量, 
ΔψA(ti)=ψA(ti+1)-ψA(ti),(i=1、2、3、……、n),(J3-4) 
其中,ψA(ti+1)(i=1、2、3、……、n)是坐标函数ψA(t)定义域中与序号为i(i=1、2、3、……、n)的点相邻的后一个点所对应的坐标函数值, 
ψA(ti)(i=1、2、3、……、n)是坐标函数ψA(t)定义域序号为i(i=1、2、3、……、n)的点所对应的坐标函数值。 
四、参见图4,这是正弦曲线段局部示意图。示意图表示相应于定义域[t1,tn+1]的一个分段,正弦曲线段ZA与由ZA内接弦构成的折线ZLA之间的关系。图中以u表示所示分段的序号,该分段对应的参数t的区间为[tu,tu+1],[tu,tu+1]的中点以tM,u表示,ψA(tM,u)、ψLA(tM,u)分别是对应于tM,u函数ψA(t)、ψLA(t)的值,δψL-A(tM,u)是对应于点tM,u以ψLA(t)拟合ψA(t)的误差δψL=A(t), 
δψL-A(tM,u)=ψLA(tM,u)-ψA(tM,u)。(J4-1) 
五、参见图5,这是圆弧曲线示意图。在直角坐标系ΦAA下的一个圆心在坐标轴原点O、半径为HA的圆弧曲线QC,其曲线方程为 
ΦA 2A 2=HA 2。(J5-1) 
曲线的坐标函数为 
ψA(t)=HAsin(ωt+αA),(J5-2) 
ΦA(t)=HAcos(ωt+αA)。(J5-3) 
圆弧QC上的点与圆心O的连线相对轴ΦA的夹角即为(ωt+αA)。 
坐标函数ψA(t)、ΦA(t)定义域为[t1,tn+1],该定义域对应的圆弧曲线段记以CA;图中CA是一个第一象限的圆弧段。 
六、参见图6,这是圆弧曲线局部示意图。示意图表示圆弧段CA在第一象限的一个分段与其内接弦之间的关系。 
①表明以圆弧段CA内接弦构成的折线拟合圆弧段CA的关系。 
②以tM,u表示一个分段中点处的参数t的值,对应tM,u,所述CA内接弦拟合CA的径向误差绝对值在坐标轴ΨA上的投影值即为|δHA,Ψ(tM,u)|。 
③圆弧段CA的等分分段对应的圆心角为ΔTA。以lA表示圆弧段CA一个分段的内接弦的长度,对应于tu有 
Δ Ψ A ( t u ) = l A cos [ ω ( t u + Δ τ A 2 ) + α A ] = l A cos ( ω t u + Δ T A 2 + α A ) , - - - ( J 6 - 1 )
Δ Φ A ( t u ) = - l A sin [ ω ( t u + Δ τ A 2 ) + α A ] = - l A sin ( ω t u + Δ T A 2 + α A ) , - - - ( J 6 - 2 )
式中,ΔTA=ωΔτA。(J6-3) 
七、参见图7,这是椭圆曲线示意图。在直角坐标系ψ12下的中心在坐标轴原点O的椭圆曲线QE,其曲线方程为 
Ψ 1 2 H 1 2 + Ψ 2 2 H 2 2 = 1 - - - ( J 7 - 1 )
式中:H1和H2为椭圆的半轴。 
曲线的坐标函数为 
Ψ 1 ( t ) = H 1 sin ( ωt + α 1 ) = H 1 sin ( ωt + α 0 + π 2 ) = H 1 cos ( ωt + α 0 ) , - - - ( J 7 - 2 )
ψ2(t)=H2sin(ωt+α2)=H2sin(ωt+α0),(J7-3) 
式中, α 1 = α 0 + π 2 , - - - ( J 7 - 4 )
α2=α0,(J7-5) 
椭圆曲线QE上的点与坐标轴原点O的连线相对ψX轴的夹角即为(ωt+α0)。坐标函数ψ1(t)、ψ2(t)定义域所对应的椭圆曲线段记以ZE,图中ZE是一个第一象限椭圆弧段。 
八、实施例 
所需路径或轮廓线是在直角坐标平面ψXY上的圆心在坐标轴原点O、半径为R0的第一象限圆弧段ZC,其曲线方程为 
ψX 2Y 2=R0 2。(L-1) 
曲线的坐标函数为 
ψX(t)=R0cost,(L-2) 
ψY(t)=R0sint,(L-3) 
R0=50000。(L-5) 
圆弧段ZC上的点与圆心O的连线相对轴ψX的夹角即为参数t。 
要求以折线拟合圆弧段ZC的最大径向误差绝对值不超过εC, 
εC=0.5。(L-6) 
参见图5,ΨX、ΨY、R0、t、ZC分别对应图中的ΦA、ΨA、HA、ωt、CA。 
以圆弧段ZC等分分段的内接弦拟合圆弧段ZC。其插补过程如下: 
1、确定内接弦对应的圆心角ΔTC与圆弧段ZC的分段 
(1)确定ΔTC
将圆弧段ZC等分,以ΔTC表示圆弧段ZC各等分分段起点所对应的参数t的等效增量,ΔTC也就是圆弧段ZC内接弦对应的圆心角。对于本例,ΔTC等于所述参数t的增量ΔτC, 
ΔTC=ΔτC。(L-7) 
如果要求ZC内接弦拟合ZC的径向误差绝对值的最大值|δR0|不超过0.5,则 
| δ R 0 | = 1 8 R 0 ( Δ T C ) 2 ϵ C = 0.5 , - - - ( L - 8 )
相应地, 
Δ T C 8 × ϵ C R 0 = 8 × 0.5 50000 = 0.00894 , - - - ( L - 9 )
取ΔTC=0.00894。(L-10) 
(2)确定圆弧段ZC分段 
依据式(L-10)确定的ΔTC值对圆弧段ZC进行分段,其分段段数理论值应为 
n CL = π 2 × Δ T C = 175.62 . - - - ( L - 11 )
分段段数只能是整数,取分段段数的实际值为 
nC=176。(L-12) 
相应的ΔTC取值为 
Δ T C = π 2 × n C = 0.00892 , - - - ( L - 13 )
此时,拟合的径向误差误差绝对值的最大值 
| δ R 0 | = 1 8 R 0 ( Δ T C ) 2 = 0.498 ϵ C = 0.5 . - - - ( L - 14 )
2、确定坐标函数定义域中间点的位置坐标值 
以iC(iC=1、2、3、……、176、177)表示构成拟合圆弧ZC的折线的176个内接弦的起点及最后一个内接弦的终点在内的各点的序号,也就是坐标函数ψX(t)、ψY(t)定义域的二个端点及二个端点间的中间点在内的点的序号,二个端点分别对应着序号1及177,二个端点间的中间点分别对应着序号 
iC=2、3、……、176。(L-15) 
(1)当iC=1,即圆弧段ZC起点,其位置坐标值为已知 
ψX,1=R0=50000,(L-16) 
ψY,1=0。(L-17) 
(2)当iC=2~175,以v+1表示iC(iC=2、3、……、nC-1)中的某个中间点的序号,v代表与之相邻的前一个点的序号.,根据第3点的说明可知,ψX(t)可视为ψY(t)的虚拟坐标函数,因此,可根据公式(1-2)、(1-3)确定圆弧段各中间点的坐标函数值增量, 
ΔψX(tV+1)=ΔψX(tV)cosΔTC-ΔψY(tV)sinΔTC,(L-18) 
ΔψY(tV+1)=ΔψY(tV)cosΔTC+ΔψX(tV)sinΔTC。(L-19) 
相应的各中间点的位置坐标值ψX(th+1)、ψY(th+1)由下式确定 
ψX(tV+1)=ψX(tV)+ΔψX(tV),(L-20) 
ψY(tV+1)=ψY(tV)+ΔψY(tV)。(L-21) 
式(L-18)、(L-19)中, 
①根据公式(1-17)、(1-18),sinΔTC、cosΔTC可按下式确定, 
sin Δ T C = Δ T C - 1 6 × ( Δ T C ) 3 , - - - ( L - 22 )
cos Δ T C = 1 - 1 2 ( Δ T C ) 2 + 1 24 ( Δ T C ) 4 , - - - ( L - 23 )
②根据公式(1-27)、(1-28),圆弧段ZC起点的位置坐标值增量ΔψX(t1)、ΔψY(t1)可按下式确定, 
ΔψX(t1)==ψX,1cosΔTCY,1sinΔTCX,1,(L-24) 
ΔψY(t1)==ψY,1cosΔTCX,1sinΔTCY,1。(L-25) 
(3)当iC=176,即对应最后一个中间点,其相应的位置坐标值增量ΔψX,176、ΔψY,176无需计 算,因为最后一个内接弦的终点即所需圆弧段ZC的终点,其位置坐标值已给定, 
ψX,177=0,(L-26) 
ψY,177=50000。(L-27) 
由于第一象限的1/4圆弧相对角ψXY的平分线是对称的;因此,插补可以只针对圆心角为0~π/4部分的圆弧进行就可以了。圆心角为π/4~π/2部分的圆弧的位置坐标值或其增量可利用所述的对称性获得,计算量可以节省50%。 

Claims (7)

1.一种数控插补方法,其所针对的所需路径或轮廓线Q上的点的mΩ个位置坐标ΩP(p=1、2、3、……、mΩ)中包括有mΨ个坐标Ψk(k=1、2、3、……、mΨ),对应所述坐标Ψk(k=1、2、3、……、mΨ)的坐标函数分别可以表示为以参数t为自变量、幅值分别为Hk(k=1、2、3、……mΨ)、初始相位分别为αk(k=1、2、3、……、mΨ)、周期相同为2π/ω的正弦函数,其表达式为 
Ψk(t)=Hk sin(ωt+αk),(k=1、2、3、……、mΨ), 
所需路径或轮廓线Q对应坐标Ψk(k=1、2、3、……、mΨ)的坐标函数指的是描述所需路径或轮廓线Q上的点的位置坐标Ψk(k=1、2、3、……、mΨ)变化的以参数t为自变量的函数,参数t或说是所需路径或轮廓线Q上的点的位置坐标ΩP(p=1、2、3、……、mΩ)中的一个坐标,或说是这些坐标之外的另一个参数, 
各坐标函数的定义域相同,定义域的二个端点分别与所需路径或轮廓线Q二个已知点对应着相同的t值, 
针对所需路径或轮廓线Q的插补就是针对其坐标函数ΩP(t)(p=1、2、3、……、mΩ)的插补, 
针对坐标函数Ψk(t)(k=1、2、3、……、mΨ)的插补步骤包括, 
(1)确定坐标函数Ψk(t)(k=1、2、3、……、mΨ)定义域二个端点间的中间点,包括, 
①确定所述中间点所对应的参数t的值或其增量Δt的值, 
②确定所述中间点的个数, 
(2)确定所述中间点的坐标函数值或其增量值, 
(3)存储/输出运算结果, 
输出的运算结果将依次送给直线插补器,对应所需路径或轮廓线Q一组相邻二点的位置坐标值,直线插补器产生一组分布均匀的脉冲序列,并通过步进马达或伺服系统控制受控对象运动,产生一个直线段的运动轨迹,或者,输出的运算结果直接以数值方式依次送给伺服系统,控制受控对象运动,对应所需路径或轮廓线Q一组相邻二点的位置坐标值,产生一个直线段的运动轨迹,受控对象整个运动轨迹将是一个由上述直线段构成的折线,折线的起点、终点、中间点与所需路径或轮廓线Q的对应起点、终点、中间点重合, 
插补中确定的中间点将所述定义域分成分段,每个分段定义域将对应一个线性函数,所述各个分段定义域的端点所对应的线性函数值与坐标函数值相等,整个定义域将对应一个由各个分段定义域对应的线性函数组成的分段线性函数ΨLk(t)(k=1、2、3、……、mΨ),而坐标函数Ψk(t)(k=1、2、3、……、mΨ)将以分段线性函数ΨLk(t)(k=1、2、3、……、mΨ)拟合;其特征在于: 
(1)将对应所述坐标Ψk(k=1、2、3、……、mΨ)的各坐标函数Ψk(t)(k=1、2、3、……、mΨ)定义域等分,以等分分段的交点作为定义域的中间点, 
(2)所述中间点所对应的坐标函数值增量ΔΨk(t)(k=1、2、3、……、mΨ)按下述公式确定, 
ΔΨΛ(tu+1)=ΔΨΛ(tu)cosΔTΛ+ΔΦΛ(tu)sinΔTΛ, 
ΔΦΛ(tu+1)=ΔΦΛ(tu)cosΔTΛ-ΔΨΛ(tu)sinΔTΛ, 
式中,①ΨΛ表示所述坐标Ψk(k=1、2、3、……、mΨ)中的某个坐标,Λ为序号k(k=1、2、3、……、mΨ)中的某个序号, 
②u+1为坐标函数ΨΛ(t)定义域二个端点间的某个中间点的序号,u就是与之相邻的前一个中间点或定义域起点的序号, 
以nΛ表示坐标函数ΨΛ(t)定义域等分分段的段数,以iΛ(iΛ=1、2、3、……、nΛ)作为分段的序号,以iΛ(iΛ=1、2、3、……、nΛ,nΛ+1)作为包括定义域的二个端点及二个端点间的中间点在内的点的序号,二个端点分别对应着序号1及nΛ+1,二个端点间的中间点分别对应着序号iΛ(iΛ=2、3、……、nΛ),u+1就是序号iΛ(iΛ=2、3、……、nΛ)中的某一个序号,u就是序号iΛ(iΛ=1,2、3、……、nΛ)中与u+1相邻的前一个中间点或定义域起点的序号,u+2就是序号iΛ(iΛ=1,2、3、……、nΛ,nΛ+1)中与u+1相邻的后一个中间点或定义域终点的序号, 
所述定义域起点指的是与所需路径或轮廓线Q起点对应的定义域的端点, 
所述定义域终点指的是与所需路径或轮廓线Q终点对应的定义域的端点, 
③tu+1为坐标函数ΨΛ(t)定义域二个端点间序号为u+1的中间点所对应的参数t的值, 
tu为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的参数t的值, 
tu+2为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的参数t的值, 
t1为坐标函数ΨΛ(t)定义域起点所对应的参数t的值, 
t(nΛ+1)为坐标函数ΨΛ(t)定义域终点所对应的参数t的值, 
④ΔTΛ为坐标函数ΨΛ(t)定义域各等分分段起点所对应的参数t的等效增量,或说是坐标函数ΨΛ(t)定义域中序号为iΛ(iΛ=1、2、3、……、nΛ)的点所对应的参数t的等效增量,或说是坐标函数ΨΛ(t)定义域各等分分段所对应的参数t的等效增量,其数值为所述参数t的增量ΔτΛ的ω倍,是常数, 
ΔTΛ=ωΔτΛ=常数, 
Figure FSB00001046411900021
           (iΛ=1、2、3、……、nΛ), 
其中,t(iΛ+1)(iΛ=1、2、3、……、nΛ)为序号为(iΛ+1)(iΛ=1、2、3、……、nΛ)的点对应的参数t的值, 
t(iΛ)(iΛ=1、2、3、……、nΛ)为序号为iΛ(iΛ=1、2、3、……、nΛ)的点对应的参数t的值, 
⑤ΔΨΛ(tu+1)为坐标函数ΨΛ(t)定义域中序号为u+1的中间点所对应的坐标函数值增量, 
   ΔΨΛ(tu+1)=ΨΛ(tu+2)-ΨΛ(tu+1), 
其中,ΨΛ(tu+2)为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的坐标函数值, 
ΨΛ(tu+1)为序号为u+1的中间点所对应的坐标函数值, 
⑥ΔΨΛ(tu)为坐标函数ΨΛ(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的坐标函数值增量, 
   ΔΨΛ(tu)=ΨΛ(tu+1)-ΨΛ(tu), 
其中,ΨΛ(tu+1)为序号为u+1的中间点所对应的坐标函数值, 
ΨΛ(tu)为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的坐标函数值, 
⑦ΔΦΛ(tu+1)为坐标函数ΨΛ(t)定义域中序号为u+1的中间点所对应的虚拟坐标函数值增量, 
ΔΦΛ(tu+1)=ΦΛ(tu+2)-ΦΛ(tu+1), 
其中,ΦΛ(tu+2)为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的虚拟坐标函数值, 
ΦΛ(tu+1)为序号为u+1的中间点所对应的虚拟坐标函数值, 
⑧ΔΦΛ(tu)为坐标函数ΨΛ(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的虚拟坐标函数值增量, 
ΔΦΛ(tu)=ΦΛ(tu+1)-ΦΛ(tu), 
其中,ΦΛ(tu+1)为序号为u+1的中间点所对应的虚拟坐标函数值, 
ΦΛ(tu)为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的虚拟坐标函数值, 
⑨sinΔTΛ为对应ΔTΛ的正弦函数值,cosΔTΛ为对应ΔTΛ的余弦函数值, 
上述⑦、⑧中所述的虚拟坐标函数ΦΛ(t)是一个与坐标函数ΨΛ(t)对应的函数,ΨΛ(t)与ΦΛ(t)是一组具有相同幅值HΛ、相同周期2π/ω、相同初始相位αΛ及相同定义域的正弦函数与余弦函数, 
ΨΛ(t)=HΛsin(ωt+αΛ), 
ΦΛ(t)=HΛcos(ωt+αΛ)。                 
2.如权利要求1所述的一种插补方法,其特征在于:所述坐标Ψk(k=1、……、mΨ)共有二个坐标Ψk(k=1、2)或Ψ1、Ψ2,对应Ψ1、Ψ2的坐标函数Ψ1(t)、Ψ2(t)可以表示为一组幅值分别为H1、H2、周期相同为2π/ω、初始相位相同为α0的余弦函数与正弦函数,其表达式为 
Figure FSB00001046411900031
Ψ2(t)=H2sin(ωt+α2)=H2sin(ωt+α0), 
式中,
Figure FSB00001046411900032
α2=α0。 
3.如权利要求2所述的一种插补方法,其特征在于: 
(1)对应所述坐标Ψ、Ψ的坐标函数Ψ1(t)、Ψ2(t)具有相同幅值R0,函数Ψ1(t)、Ψ2(t)的表达式为 
Figure FSB00001046411900033
Ψ2(t)=H2sin(ωt+α2)=R0sin(ωt+α0), 
式中,H1=H2=R0, 
Figure FSB00001046411900034
α2=α0, 
(2)对应所述坐标Ψ1、Ψ2的坐标函数Ψ1(t)、Ψ2(t)定义域等分为相同的nC个分段;或者说, 坐标函数Ψ1(t)、Ψ2(t)定义域各分段起点对应相同的参数t的增量ΔτC或等效增量ΔTC, 
n1=n2=nC, 
Δτ1=Δτ2=ΔτC, 
ΔT1=ΔT2=ΔTC。 
4.如权利要求1至3项中任何一项权利要求所述的一种插补方法,其特征在于:对应所述坐标其坐标函数定义域等分分段起点所对应的参数t的等效增量的取值及坐标函数定义域等分分段段数的取值满足下述公式, 
Figure FSB00001046411900041
式中,①ΨA表示所述坐标中的某一个坐标,A是序号k(k=1、2、3、……、mΨ)中的某个序号,对应坐标ΨA的坐标函数为 
ΨA(t)=HA sin(ωt+αA), 
②ΔTA为坐标函数ΨA(t)定义域等分分段起点所对应的参数t的等效增量,其数值为所述参数t的增量ΔτA的ω倍, 
ΔTA=ωΔτA, 
③n表示坐标函数ΨA(t)定义域等分分段的段数, 
④t1为坐标函数ΨA(t)定义域起点所对应的参数t的值, 
tn+1为坐标函数ΨA(t)定义域终点所对应的参数t的值, 
⑤|sin(ωt+αA)|MAX为对应坐标函数ΨA(t)定义域|sin(ωt+αA)|的最大值, 
⑥εA为以分段线性函数ΨLA(t)拟合坐标函数ΨA(t)的误差绝对值|δΨL-A(t)|的允许值, 
δΨL-A(t)=ΨLA(t)-ΨA(t), 
对应坐标函数ΨA(t)第i(i=1、2、3、……、n)个分段定义域,所述的分段线性函数ΨLA(t)表达式为 
Figure FSB00001046411900043
(i=1、2、3、……、n), 
式中,(a)i(i=1、2、3、……、n)为坐标函数ΨA(t)定义域n个等分分段的序号,等分分段的交点就是定义域的中间点,以i(i=1、2、3、……、n、n+1)作为包括定义域的二个端点及二个端点间的中间点在内的点的序号,二个端点分别对应着序号1及n+1,二个端点间的中间点分别对应着序号i(i=2、3、……、n), 
(b)ti(i=1、2、3、……、n、n+1)为坐标函数ΨA(t)定义域序号为i(i=1、2、3、……、n、n+1)的点所对应的参数t的值, 
(c)ΔΨA(ti)(i=1、2、3、……、n)为坐标函数ΨA(t)定义域序号为i(i=1、2、3、……、n)的点所对应的坐标函数值增量, 
ΔΨA(ti)=ΨA(ti+1)-ΨA(ti),(i=1、2、3、……、n), 
其中,ΨA(ti+1)(i=1、2、3、……、n)为坐标函数ΨA(t)定义域中与序号为i(i=1、2、3、……、n)的点相邻的后一个点所对应的坐标函数值, 
ΨA(ti)(i=1、2、3、……、n)为坐标函数ΨA(t)定义域序号为i(i=1、2、3、……、n)的点所对应的坐标函数值。 
5.如权利要求4所述的一种插补方法,其特征在于:对应所述坐标ΨA的坐标函数ΨA(t)定义域|sin(ωt+αA)|的最大值|sin(ωt+αA)|MAX以1替换。 
6.如权利要求1至3或权利要求5中任何一项权利要求所述的一种插补方法,其特征在于:对应所述坐标的坐标函数中 
ω=1。 
7.如权利要求4所述的一种插补方法,其特征在于:对应所述坐标的坐标函数中 
ω=1。 
CN 200810072393 2008-12-18 2008-12-18 一种数控插补方法 Expired - Fee Related CN101751008B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN 200810072393 CN101751008B (zh) 2008-12-18 2008-12-18 一种数控插补方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN 200810072393 CN101751008B (zh) 2008-12-18 2008-12-18 一种数控插补方法

Publications (2)

Publication Number Publication Date
CN101751008A CN101751008A (zh) 2010-06-23
CN101751008B true CN101751008B (zh) 2013-06-05

Family

ID=42478074

Family Applications (1)

Application Number Title Priority Date Filing Date
CN 200810072393 Expired - Fee Related CN101751008B (zh) 2008-12-18 2008-12-18 一种数控插补方法

Country Status (1)

Country Link
CN (1) CN101751008B (zh)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102012782B (zh) * 2010-09-17 2013-06-05 深圳市融创天下科技股份有限公司 一种拖动移向判断的方法和系统
CN104166376A (zh) * 2013-05-18 2014-11-26 刘希汉 复合插补法及其系统软件
CN106078009B (zh) * 2016-06-29 2017-10-27 成都熊谷加世电器有限公司 焊接参数预置和实时调节精确控制方法
CN107186753B (zh) * 2017-05-17 2020-10-09 上海电器科学研究所(集团)有限公司 工业机器人性能测试的工作空间确定方法
CN107932509A (zh) * 2017-11-20 2018-04-20 广东大黄蜂机器人有限公司 一种用于机器人控制系统的spta加减速插补控制方法
CN113791585B (zh) * 2021-08-16 2023-09-22 上海瑞盛联信息科技有限公司 一种圆弧轨迹速度自适应控制方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1858668A (zh) * 2005-05-02 2006-11-08 发那科株式会社 曲线插补方法
CN101256405A (zh) * 2007-12-19 2008-09-03 陈学恭 一种直线插补方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1858668A (zh) * 2005-05-02 2006-11-08 发那科株式会社 曲线插补方法
CN101256405A (zh) * 2007-12-19 2008-09-03 陈学恭 一种直线插补方法

Also Published As

Publication number Publication date
CN101751008A (zh) 2010-06-23

Similar Documents

Publication Publication Date Title
CN101751008B (zh) 一种数控插补方法
CN111061213B (zh) 一种基于Bezier曲线转角平滑过渡算法的加工方法
CN106826829B (zh) 一种可控误差的工业机器人光顺运动轨迹生成方法
CN105710881B (zh) 一种机器人末端连续轨迹规划过渡方法
CN104615084B (zh) 加工进给速度优化的刀轨曲线轮廓误差补偿方法
CN102269984B (zh) 五轴联动数控加工的后置处理方法
CN101881954A (zh) 一种设定替代曲线的新插补方法
CN110716493B (zh) 一种五轴微线段加工路径光顺方法
CN106078359A (zh) 一种龙门式多主轴制孔组合机床的零点定义与标定方法
CN106959664B (zh) 基于五轴双转台在线非线性误差补偿方法
CN106874596A (zh) 一种尼曼蜗轮的精确建模方法
CN102371504B (zh) 一种五轴数控侧铣加工用刀具半径补偿方法
CN109947049A (zh) 一种基于摆动误差的刀具姿角可行域求解方法
CN106647623A (zh) 一种几何精度及衔接速度最优化的五轴联动平滑插补方法
CN108195321B (zh) 一种滚珠直线导轨副滚道平行度在线测量方法
CN105549535A (zh) 五轴摇篮式数控机床未变形切屑的三维几何建模方法
CN103676787A (zh) 一种用于运动控制系统的圆心模式空间圆弧插补方法
CN101751006A (zh) 一种插补方法
CN103149879B (zh) 一种基于弧长的数控系统椭圆插补方法
MX9800307A (es) Mejoras en y relacionadas a maquinas herramientas.
CN106944680B (zh) 一种盘类齿轮成型磨齿自适应加工方法
CN105867298B (zh) 螺旋曲面展成加工中确定刀具廓形的点矢量二次包络法
CN101881953B (zh) 一种控制物体运动轨迹的插补方法
CN108108555A (zh) 一种装配尺寸链计算方法、装置及设备
CN109991926A (zh) 刀具中心点控制中单轴加速度约束的转角速度计算方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20100623

Assignee: Fuzhou Lizhiyuan Electronic Technology Development Co.,Ltd.

Assignor: Chen Xuegong

Contract record no.: 2015350000063

Denomination of invention: Digital interpolation method

Granted publication date: 20130605

License type: Common License

Record date: 20150717

LICC Enforcement, change and cancellation of record of contracts on the licence for exploitation of a patent or utility model
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20130605