CN101881953A - 一种新插补方法 - Google Patents
一种新插补方法 Download PDFInfo
- Publication number
- CN101881953A CN101881953A CN2010101699602A CN201010169960A CN101881953A CN 101881953 A CN101881953 A CN 101881953A CN 2010101699602 A CN2010101699602 A CN 2010101699602A CN 201010169960 A CN201010169960 A CN 201010169960A CN 101881953 A CN101881953 A CN 101881953A
- Authority
- CN
- China
- Prior art keywords
- definition
- field
- sequence number
- coordinate
- 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.)
- Granted
Links
Images
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)=Hk sin(ω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值。当ω取值为1时,所述的正弦函数Ψk(t)(k=1、2、3、……、mΨ)的周期为2π。
某一t值所对应的所需路径或轮廓线Q上的点的位置坐标值,就是同一t值所对应的所述坐标函数的函数值。针对所需路径或轮廓线Q的插补也就是针对其坐标函数ΩP(t)(p=1、2、3、……、mΩ)的插补,即在其各个坐标函数ΩP(t)(p=1、2、3、……、mΩ)的定义域二个端点间插入若干个中间点并确定对应所述中间点的坐标函数值。在对坐标函数插补中确定的中间点将所述定义域分成分段,每个分段定义域将对应一个线性函数,所述各个分段定义域的端点所对应的线性函数值与所对应的坐标函数值相等,整个定义域将对应一个由各个分段定义域对应的线性函数组成的分段线性函数;而坐标函数将以分段线性函数拟合。
申请人还注意到,所述曲线Q二个端点间的中间点的位置坐标值,可依据与之相邻的前一个中间点或所述曲线的起点其位置坐标值与位置坐标值增量之和决定,因此,插补中确定了中间点的位置坐标值增量,也就确定了相应中间点的位置坐标值。或者说,插补中确定了定义域中间点坐标函数值增量,也就确定了定义域相应中间点的坐标函数值。
针对坐标函数Ψk(t)(k=1、2、3、……、mΨ)的插补步骤包括,
(1)确定坐标函数Ψk(t)(k=1、2、3、……、mΨ)定义域二个端点间的中间点,包括,
①确定所述中间点所对应的参数t的值或其增量Δt的值,
②确定所述中间点的个数,
(2)确定所述中间点的坐标函数值或其增量值,
(3)存储/输出运算结果。
本发明提出的插补方法,其特征在于:将对应所述坐标Ψk(k=1、2、3、……、mΨ)的各坐标函数Ψk(t)(k=1、2、3、……、mΨ)定义域分段,以分段的交点作为定义域的中间点,所述定义域中间点所对应的坐标函数值Ψk(t)(k=1、2、3、……、mΨ),基于泰勒公式按下述展开式确定,
式中,①ΨA表示所述坐标Ψk(k=1、2、3、……、mΨ)中的某个坐标,A为序号k(k=1、2、3、……、mΨ)中的某个序号,对应坐标ΨA的坐标函数为
ΨA(t)=HA sin(ωt+αA), (1-4)
②u+1为坐标函数ΨA(t)定义域二个端点间的某个中间点的序号,u是与之相邻的前一个中间点或定义域起点的序号,
以,n表示坐标函数ΨA(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相邻的前一个中间点或定义域起点的序号,
所述定义域起点指的是与所述曲线Q起点对应的定义域的端点,
所述定义域终点指的是与所述曲线Q终点对应的定义域的端点,
③tu+1为坐标函数ΨA(t)定义域二个端点间序号为u+1的中间点所对应的参数t的值,
tu为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的参数t的值,
t1为坐标函数ΨA(t)定义域起点所对应的参数t的值,
tn+1为坐标函数ΨA(t)定义域终点所对应的参数t的值,
④ΔTu为坐标函数ΨA(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的参数t的等效增量,其数值为相应的所述参数t的增量Δtu的ω倍,
ΔTu=ωΔtu, (1-5)
Δtu=tu+1-tu, (1-6)
⑤ΨA(tu+1))为坐标函数ΨA(t)定义域中序号为u+1的中间点所对应的坐标函数值,
⑥ΨA(tu)为坐标函数ΨA(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的坐标函数值,
⑦ΦA(tu+1)为坐标函数ΨA(t)定义域中序号为u+1的中间点所对应的虚拟坐标函数值,
⑧ΦA(tu)为坐标函数ΨA(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的虚拟坐标函数值,
⑨ν′+1为正整数,是展开式(1-2)的项数,
ν′≥0, (1-7)
⑩ν″+1为正整数,是展开式(1-3)的项数,
ν″≥0,, (1-8)
上述⑦、⑧中所述的虚拟坐标函数ΦA(t)是为简化公式表述设定的函数,ΦA(t)是一个与ΨA(t)具有相同幅值HA、相同周期(2π/ω)、相同初始相位αA及相同定义域的余弦函数,其表达式为
ΦA(t)=HA cos(ωt+αA )。 (1-9)
需要说明的是:
(1)所述方法中坐标函数定义域分段或中间点的设定及展开式项数的确定等见第3点的相关说明。
(2)展开式(1-2)、(1-3)的依据
根据泰勒公式可知,
其中,余项
式中,①τ′的取值范围为
tu≤τ′≤tu+1, (1-14)
②τ″的取值范围为
tu≤τ″≤tu+1, (1-15)略去余项,或说将余项取值为0,即得式(1-2)、(1-3)。
2、如第1点所述的插补方法,其特点为:将对应所述坐标Ψk(k=1、2、3、……、mΨ)的各坐标函数Ψk(t)(k=1、2、3、……、mΨ)定义域等分,以等分分段的交点作为定义域的中间点。
相应地,坐标函数定义域各等分分段起点所对应的参数t的等效增量或说是坐标函数定义域各等分分段所对应的参数t的等效增量是常数,其数值为所述参数t的增量的ω倍,
式中,①ΨA表示所述坐标Ψk(k=1、2、3、……、mΨ)中的某个坐标,A为序号k(k=1、2、3、……、mΨ)中的某个序号,对应坐标ΨA的坐标函数为
ΨA(t)=HA sin(ωt+αA), (2-3)
②ΔTA为坐标函数ΨA(t)定义域各等分分段起点所对应的参数t的等效增量、或说是坐标函数定义域各等分分段所对应的参数t的等效增量,其数值为所述参数t的增量ΔτA的ω倍,
③Δti为序号为i(i=1、2、3、……、n)的点对应的参数t的增量的值,
④t1(i=1、2、3、……、n)为序号为i(i=1、2、3、……、n)的点对应的参数t的值,
⑤ti+1(i=1、2、3、……、n)为序号为i+1(i=1、2、3、……、n)的点对应的参数t的值,或说是与序号为i(i=1、2、3、……、n)的点相邻的后一个点的参数t的值。
所述方法中坐标函数定义域分段或中间点的设定见第3点的相关说明。
3、如第2点所述的插补方法,其特点为:所述定义域中间点所对应的坐标函数值增量ΔΨk(t)(k=1、2、3、……、mΨ),基于泰勒公式按下述展开式确定,
同理,
式中,①ΨA表示所述坐标Ψk(k=1、2、3、……、mΨ)中的某个坐标,A为序号k(k=1、2、3、……、mΨ)中的某个序号,对应坐标ΨA的坐标函数为
ΨA(t)=HA sin(ωt+αA), (3-3)
②u+1为坐标函数ΨA(t)定义域二个端点间的某个中间点的序号,u是与之相邻的前一个中间点或定义域起点的序号,
以,n表示坐标函数ΨA(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为坐标函数ΨA(t)定义域二个端点间序号为u+1的中间点所对应的参数t的值,
tu为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的参数t的值,
tu+2为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的参数t的值,
t1为坐标函数ΨA(t)定义域起点所对应的参数t的值,
tn+1为坐标函数ΨA(t)定义域终点所对应的参数t的值,
④ΔTA为坐标函数ΨA(t)定义域等分分段起点所对应的参数t的等效增量,其数值为所述参数t的增量ΔτA的ω倍,
ΔTA=ωΔτA, (3-4)
⑤ΔΨA(tu+1)为坐标函数ΨA(t)定义域中序号为u+1的中间点所对应的坐标函数值增量,
ΔΨA(tu+1)=ΨA(tu+2)-ΨA(tu+1), (3-5)
其中,ΨA(tu+2)为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的坐标函数值,
ΨA(tu+1)为序号为u+1的中间点所对应的坐标函数值,
⑥ΔΨA(tu)为坐标函数ΨA(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的坐标函数值增量,
ΔΨA(tu)=ΨA(tu+1)-ΨA(tu), (3-6)
其中,ΨA(tu+1)为序号为u+1的中间点所对应的坐标函数值,
ΨA(tu)为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的坐标函数值,
⑦ΔΦA(tu+1)为坐标函数ΨA(t)定义域中序号为u+1的中间点所对应的虚拟坐标函数值增量,
ΔΦA(tu+1)=ΦA(tu+2)-ΦA(tu+1), (3-7)
其中,ΦA(tu+2)为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的虚拟坐标函数值,
ΦA(tu+1)为序号为u+1的中间点所对应的虚拟坐标函数值,
⑧ΔΦA(tu)为坐标函数ΨA(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的虚拟坐标函数值增量,
ΔΦA(tu)=ΦA(tu+1)-ΦA(tu), (3-8)
其中,ΦA(tu+1)为序号为u+1的中间点所对应的虚拟坐标函数值,
ΦA(tu)为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的虚拟坐标函数值,
⑨κ′+1为正整数,是展开式(3-1)的项数,
κ′≥0,(3-9)
⑩κ″+1为正整数,是展开式(3-2)的项数,
κ″≥0,(3-10)
上述⑦、⑧中所述的虚拟坐标函数ΦA(t)是为简化公式(3-1)、(3-2)的表述设定的函数,ΦA(t)是一个与ΨA(t)具有相同幅值HA、相同周期(2π/ω)、相同初始相位αA及相同定义域的正弦函数与余弦函数,其表达式为
ΦA(t)=HA cos(ωt+αA)。 (3-11)
对于上述第1、第2或第3点所述的插补方法,需要说明的是,
(1)所述方法中坐标函数定义域分段或中间点的设定可根据后述第5、6点所述的方法确定。
(2)展开式项数的确定
在按展开式(1-2)、(1-3)或(3-1)、(3-2)确定ΨA(tu+1)或ΔΨA(tu+1)时,略去了泰勒公式中的余项以简化计算。略去余项将导致插补结果误差,误差包括:
(i)略去余项将引起相应的ΨA(tu+1)、ΦA(tu+1)或ΔΨA(tu+1)、ΔΦA(tu+1)插补结果误差;
(ii)某个中间点的插补结果误差还将影响后续中间点的插补结果误差,因为后续中间点的位置坐标值或其增量是由前一个中间点的位置坐标值或其增量递推而得的。
由式(1-12)、(1-13)可知,所述展开式项数愈多,相应的余项绝对值愈小。换句话说,所述展开式项数愈多,略去余项导致的插补结果误差绝对值愈小。所述余项的数值还与ΨA(t)的幅值及中间点所对应的参数t的等效增量等有关。
①查表法确定展开式应有的项数
例如,针对定义域是等分的坐标函数,将拟合误差允许值、ΨA(t)幅值、中间点所对应的参数t的等效增量、函数值插补结果误差、展开式的项数之间的关系预先制成对应关系表。根据拟合误差允许值、ΨA(t)幅值、参数t的等效增量、函数值插补结果误差允许值,即可查表确定展开式应有的项数。
②以第3点所述的插补方法为例,坐标函数ΨA(t)表达式为
ΨA(t)=HA sin(ωt+αA), (3-12)
其定义域为[-(αA/ω)、(2π/ω)-(αA/ω)]。
所述的ΨA(t)的定义域[-(αA/ω)、(2π/ω)-(αA/ω)]对应着ΨA(t)的一个周期(2π/ω)。
将定义域分为4段,每段对应1/4周期,各段的定义域分别为[-(αA/ω),(π/2ω)-(αA/ω)]、[(π/2ω)-(αA/ω)、(π/ω)-(αA/ω)]、[(π/ω)-(αA/ω)、(3π/2ω)-(αA/ω)]、[(3π/2ω)-(αA/ω)、(2π/ω)-(αA/ω)]。4段定义域按相同方法等分,等分分段的交点即为插补中设置的中间点。第1段定义域中间点的ΨA(t)函数值增量可按照式(3-1)、(3-2)确定。根据第2、3、4段定义域相对第1段定义域[-(αA/ω),(π/2ω)-(αA/ω)]函数ΨA(t)的对称性,第2、3、4段定义域中间点的ΨA(t)函数值增量等于第1段定义域相应中间点的ΨA(t)函数值增量(或者等于第1段相应中间点函数值增量的负值),无需再作计算。此时,第1段定义域中间点ΨA(t)函数值插补结果误差绝对值的最大值,就是整个定义域中间点ΨA(t)函数值插补结果误差绝对值的最大值。因此,分析所述展开式项数的取值,只需针对1/4周期所对应的一段定义域[-(αA/ω),(π/2ω)-(αA/ω)]进行即可。
分析表明,如果
(i)根据后述的公式(6-3)由拟合误差允许值εA确定ΔTA,取
(ii)展开式(3-1)、(3-2)项数取为4,或者说,取
κ=κ′=κ″=3; (3-14)
那么,当εA=0.125、0.5、1或2,(3-15)
且 1000000≥HA≥100, (3-16)
定义域中间点ΨA(t)插补结果误差绝对值的最大值ζ的数值将比拟合误差允许值εA小一个数量级。换句话说,如果展开式项数取为4,那么,略去余项引起的误差可以忽略不计。
经分析还可以知道,如果取
κ=κ′=κ″=2, (3-17)
所述的ζ将大致与εA在同一个数量级。
③所述展开式项数也可以用其他方法确定;例如,通过插补器之外的计算机预先计算确定,然后作为已知条件提供给插补器。
(3)原理上第1、2点所述方法或第3点所述方法都可用于确定中间点的位置坐标值。但是,
①第1、2点中参与递推运算的位置坐标值,要比第3点中参与递推运算的位置坐标值增量数值上大得多,或者说,前者的字长要比后者的字长大得多;因而,前者比后者对插补器资源的要求也就高得多。
②参与运算的数的小数部分的位数有限,将导致插补结果出现误差。位置坐标值的数值比其增量数值上大得多,因而,第1或2点所述方法比第3点所述方法由于小数部分位数有限所导致的所述误差的绝对值也大得多。为减小误差,前一种方法比后一种方法需相应增多小数部分的位数,从而对插补器资源提出更高的要求。
因此,第1、2点所述方法比第3点所述方法,对插补器资源的要求要高得多。
(4)参见图2。以序号为A的坐标函数ΨA(t)为例。如果所需路径或轮廓线的位置坐标只包括了二个个坐标t和ΨA,且坐标轴t和ΨA构成了直角坐标系tOΨA;则所需路径或轮廓线就是平面tOΨA上幅值为HA、初始相位为αA、周期为(2π/ω)的的正弦曲线段ZA。(5)参见图5。以序号为A的坐标函数ΨA(t)为例,虚拟坐标轴ΦA和坐标轴ΨA构成了虚拟直角坐标系ΦAOΨA,坐标函数ΨA(t)与虚拟坐标函数ΦA(t)在ΦAOΨA虚拟平面上的图形即为圆心在坐标轴原点O、半径为HA的圆弧段CA。圆弧段CA上对应参数t的点与圆心O的连线其相对轴ΦA的夹角即为(ωt+αA)。坐标函数ΨA(t)定义域的端点与中间点对应着圆弧段CA相应的端点与中间点。图中CA是第一象限的圆弧段。
(6)如果所述坐标Ψk(k=1、……、mΨ)共有二个坐标Ψk(k=1、2)或说Ψ1、Ψ2,对应Ψ1、Ψ2的坐标函数Ψ1(t)、Ψ2(t)可以表示为一组幅值分别为H1与H2、周期相同为(2π/ω)、初始相位相同为α0的余弦函数与正弦函数,
Ψ2(t)=H2sin(ωt+α2)=H2sin(ωt+α0), (3-19)式中,
α2=α0; (3-21)
那么,参见图7,坐标函数Ψ1(t)、Ψ2(t)在直角坐标系Ψ1OΨ2下即为Ψ1OΨ2平面上中心在坐标轴原点O的椭圆弧段ZE。式中H1和H2为椭圆的半轴。椭圆弧段ZE上对应参数t的点与坐标轴原点O的连线相对Ψ1轴的夹角即为(ωt+α0)。图中ZE是一个第一象限的椭圆弧段。
当 H1=H2=R0, (3-22)
所述的椭圆弧段ZE即成为半径为R0的圆弧段ZC。
4、如第1、2或3点所述的插补方法,其特点为:
(1)所述坐标Ψk(k=1、……、mΨ)共有二个坐标Ψk(k=1、2)或说Ψ1、Ψ2,对应Ψ1、Ψ2的坐标函数Ψ1(t)、Ψ2(t)可以表示为一组幅值相同为R0、周期相同为(2π/ω)、初始相位相同为α0的余弦函数与正弦函数,其表达式为
Ψ2(t)=H2 sin(ωt+α2)=R0 sin(ωt+α0), (4-2)
式中,H1=H2=R0, (4-3)
α2=α0, (4-5)
(2)对应所述坐标Ψ1、Ψ2的坐标函数Ψ1(t)、Ψ2(t)定义域等分为相同的nC个分段,或者说,坐标函数Ψ1(t)、Ψ2(t)定义域各分段起点对应相同的参数t的增量ΔτC或等效增量ΔTC,
n1=n2=nC, (4-6)
Δτ1=Δτ2=ΔτC, (4-7)
ΔT1=ΔT2=ΔTC。 (4-8)
由所述特点可知:
①在按第1、2或3点所述的插补方法确定坐标函数值或其增量时,对应于坐标函数Ψ2(t)的虚拟坐标函数Φ2(t)就是坐标函数Ψ1(t),
Φ2(t)=R0cos(ωt+α0)=Ψ1(t), (4-9)
Φδ2(t)=Ψδ1(t)。 (4-10)
因此,在插补计算过程中,无需为Ψ1(t)、Ψ2(t)另设虚拟坐标函数。
②如果所需路径或轮廓线只包括了二个个坐标Ψ1和Ψ2,且坐标轴Ψ1和Ψ2构成了直角坐标系Ψ1OΨ2;则所需路径或轮廓线即为Ψ1OΨ2平面上圆心在坐标轴原点O、半径为R0的圆弧段ZC。圆弧段ZC上对应参数t的点与圆心O的连线相对轴Ψ1的夹角即为(ωt+α0)。每个等分圆弧段所对应的圆心角为
ΔTC=ωΔτC。 (4-11)
曲线在直角坐标系Ψ1OΨ2下的方程为
Ψ1 2+Ψ2 2=R0 2。 (4-12)
所述图形可参见图5,所述的Ψ1、Ψ2、R0、α0、t、ZC分别对应图中的ΦA、ΨA、HA、αA、t、CA。图中CA是第一象限的圆弧段。
5、如上述第2或3点所述的插补方法,其特点为:对应所述坐标其坐标函数定义域等分分段起点所对应的参数t的等效增量的取值满足下述公式,
与公式(5-1)相应,其坐标函数定义域等分分段段数的取值满足下述公式,
式中,①ΨA表示所述坐标中的某一个坐标,A是序号k(k=1、2、3、……、mΨ)中的某个序号,对应坐标ΨA的坐标函数为
ΨA(t)=HAsin(ωt+αA), (5-3)
②ΔTA为坐标函数ΨA(t)定义域等分分段起点所对应的参数t的等效增量,其数值为所述参数t的增量ΔτA的ω倍,
ΔTA=ωΔτA, (5-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), (5-5)
对应坐标函数ΨA(t)第i(i=1、2、3、……、n)个分段定义域,所述的分段线性函数ΨLA(t)表达式为
(b)ti(i=1、2、3、……、n、n+1)为坐标函数ΨA(t)定义域序号为i(i=1、2、3、……、n、n+1)的点所对应的参数t的值,
ti+1为与序号为i(i=1、2、3、……、n)的点相邻的后一个点所对应的参数t的值,
t1为坐标函数ΨA(t)定义域起点所对应的参数t的值,
tn+1为坐标函数ΨA(t)定义域终点所对应的参数t的值,
(d)ΔΨ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),(5-8)
其中,Ψ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)的点所对应的坐标函数值。
|ΔTA|或n的取值满足公式(5-1)或5-2),将使得所述的拟合误差|δΨ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的二个端点及二个端点间的中间点在内的点的序号。
根据公式(5-1)、(5-2)确定|ΔTA|、n的取值的依据是:
(A)以ΨLA(t)拟合ΨA(t)的误差
①以ΨLA(t)拟合ΨA(t),其拟合误差记以δΨL=A(t),
δΨL=A(t)=ΨLA(t)-ΨA(t), (5-9)
②参见图2至图6。在tOΨA平面上,将ΨA(t)所对应的正弦曲线段ZA分成序号为i(i=1、2、3、……、n)的n个等分分段;在虚拟ΦAOΨA平面上,将Ψ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处,且
其在坐标轴ΨA上的投影为
|δHA,Ψ(tM)|=|δHA|×|sin(ωtM+αA)|。(5-11)
④相应地认为,一个分段内,在中点tM处以正弦曲线段ZA的内接弦拟合正弦曲线段ZA的误差绝对值也是最大,为|δΨL-A(tM.)|;且|δΨL-A(tM.)|的值等于对应tM处|δHA|在坐标轴ΨA上的投影,
|δΨL-A(tM.)|=|δHA,Ψ(tM)|=|δHA|×|sin(ωtM+αA)|。 (5-12)
⑤在坐标函数定义域范围内,|δΨL-A(tM.)|的最大值|δΨL-A(tM.)|MAX为
|δΨL-A(tM.)|MAX=|δΨA|×|sin(ωtM+αA)|MAX, (5-13)式中,|sin(ωtM+αA)|MAX为在坐标函数ΨA(t)定义域范围内|sin(ωtM+αA)|的最大值。由于|ΔTA|或说|ΔτA|很小,可以认为
|sin(ωtM+αA)|MAX=|sin(ωt+αA)|MAX, (5-14)
式中,|sin(ωt+αA)|MAX为在坐标函数ΨA(t)定义域范围内|sin(ωt+αA)|的最大值。因此,式(5-13)可以改写为
|δΨL-A(tM.)|MAX=|δHA|×|sin(ωt+αA)|MAX。 (5-15)(B)ΔTA、n的取值
ΔTA、n的取值应使得ΨLA(t)拟合ΨA(t)的误差绝对值|δΨL-A(t)|的最大值|δΨL-A(tM.)|MAX不超过允许值εA,
|δΨL-A(tM.)|MAX≤εA。 (5-16)
①由公式(5-10)、(5-15)、(5-16),坐标函数ΨA(t)定义域等分分段对应的参数t的等效增量|ΔTA|的取值应满足下述公式,
或
②坐标函数ΨA(t)定义域等分分段段数n应满足下述公式,
③如果上述公式中的|sin(ωt+αA)|MAX都以1替换,
则
或
满足式(5-22)或(5-23)的|ΔTA|或|ΔτA|的取值,对任何可能的定义域,都可做到ΨLA(t)拟合ΨA(t)的误差的绝对值|δΨL-A(t)|不超过允许值εA。|ΔTA|或|ΔτA|的最大允许取值|ΔTA|MAX或|ΔτA|MAX为
或
6、如第5点所述的一种插补方法,其特点为:所述|sin(ωt+αA)|MAX以1替换。相应地,所述ΔTA或n的取值满足下述公式,
或
满足公式(6-1)或(6-2)的|ΔTA|或n的取值,可以使得对任何可能的定义域,都可做到以分段线性函数ΨLA(t)拟合坐标函数ΨA(t)的误差绝对值|δΨL-A(t)|不超过允许值εA。
|ΔTA|的最大允许取值|ΔTA|MAX为
7、如第4点所述的插补方法,其特点为:对应所述坐标Ψ1、Ψ2其坐标函数Ψ1(t)、Ψ2(t)定义域等分分段起点所对应的参数t的等效增量ΔTC的取值满足下述公式,
与公式(7-1)相应,其替代坐标函数定义域等分分段段数nC的取值满足下述公式,
式中,①t1为坐标函数Ψ1(t)、Ψ2(t)定义域起点对应的参数t的值,
t(nC+1)为坐标函数Ψ1(t)、Ψ2(t)定义域终点对应的参数t的值,
②εC为以圆弧段ZC等分分段的内接弦拟合圆弧段ZC的径向误差的绝对值的允许值,圆弧段ZC为坐标函数Ψ1(t)、Ψ2(t)在坐标轴Ψ1和Ψ2构成的直角坐标系Ψ1OΨ2的坐标平面上的图形。所述圆弧段ZC可参见图5,所述的Ψ1、Ψ2、R0、t、ZC分别对应图中的ΦA、ΨA、HA、t、CA。
满足公式(7-1)或(7-2)的|ΔTC|或nC取值,将使得以圆弧段ZC的等分圆弧分段内接弦拟合圆弧段ZC的径向误差的绝对值不超过允许值εC。
|ΔTC|的最大允许取值|ΔTC|MAX为
8、如第1、2、3、6或7点中任何一点所述的插补方法,其特点为:所述ω取值为1,
ω=1。 (8-1)
也就是说,所述坐标对应的正弦坐标函数的周期为2π。此时,所述坐标对应的坐标函数定义域各等分分段起点所对应的参数t的等效增量,等于所述参数t的增量。
9、如第4点所述的插补方法,其特点为:所述ω取值为1,
ω=1。 (9-1)
也就是说,所述坐标对应的正弦坐标函数的周期为2π。此时,所述坐标对应的坐标函数定义域各等分分段起点所对应的参数t的等效增量,等于所述参数t的增量。
10、如第5点所述的插补方法,其特点为:所述ω取值为1,
ω=1。 (10-1)
也就是说,所述坐标对应的正弦坐标函数的周期为2π。此时,所述坐标对应的坐标函数定义域各等分分段起点所对应的参数t的等效增量,等于所述参数t的增量。
值得注意的是,如果一个坐标函数是由若干个函数之和构成,则该坐标函数的插补结果等于构成该坐标函数的各个函数各自的插补结果之和。特别是构成该坐标函数的某个函数如果是常量,则该常量不会影响该函数的增量值。此外,所需路径或轮廓线其所在的直角坐标系坐标轴平移时,也不影响其位置坐标值增量的数值。
本发明的有益效果为:本发明针对正弦函数类所需路径或轮廓线,包括正弦曲线、椭圆曲线、圆弧曲线,提出一种新插补方法,通过只包含加、减、乘算术运算的递推公式就可以确定曲线中间点位置坐标值或其增量。由于运算简单,对于同样的分段段数,完成运算所需时间少,相当于提高了插补运算速度;或者,在同等的运算时间内,允许增加曲线分段段数,从而提高折线拟合曲线的精度。由于运算简单,这种方法可在单片计算机上实现,从而降低了插补器的成本。因此,这种插补方法速度快,精度高,装置成本低,具有极其广阔的市场前景。
【附图说明】
图1是本发明的坐标函数ΨA(t)插补的程序流程图,
图2是本发明的正弦曲线示意图,
图3是本发明的分段线性函数示意图,
图4是本发明的正弦曲线段局部示意图,
图5是本发明的圆弧曲线示意图,
图6是本发明的圆弧曲线局部示意图,
图7是本发明的椭圆曲线示意图。
【具体实施方式】
一、参见图1,这是针对坐标函数ΨA(t)插补的程序流程图。所述的坐标函数为
ΨA(t)=HA sin(ωt+αA)。 (J1-1)
程序由步骤(1)至步骤(8)组成:
(1)将坐标函数ΨA(t)定义域等分,以等分分段的交点作为定义域的中间点,确定坐标函数ΨA(t)定义域起点及中间点所对应的参数t的等效增量ΔTA,其数值为所述参数t的增量ΔτA的ω倍,是常数,
ΔTA=ωΔτA=常数; (J1-2)
(2)确定坐标函数ΨA(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的中间点所对应的坐标函数值增量ΔΨA(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)=HA sin(ωt+αk)。 (J2-1)
对应于所需路径或轮廓线,坐标函数ΨA(t)定义域为[t1,tn+1]。该定义域对应的正弦曲线段记以ZA。
三、参见图3,这是等分分段线性函数示意图。在直角坐标系tOΨA下的正弦曲线段ZA,其坐标函数为
ΨA(t)=HA sin(ωt+αk), (J3-1)n是坐标函数ΨA(t)定义域的等分分段数。正弦曲线段ZA的n个等分分段的内接弦构成折线ZLA。相应的分段线性函数ΨLA(t)为
(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(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)的点所对应的坐标函数值。
图中,n=4。 (J3-5)
四、参见图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,这是圆弧曲线示意图。在直角坐标系ΦAOΨA下的一个圆心在坐标轴原点O、半径为HA的圆弧曲线QC,其曲线方程为
曲线的坐标函数为
ΨA(t)=HAsin(ωt+αA),(J5-2)
ΦA(t)=HAcos(ωt+αA)。(J5-3)
圆弧QC上对应参数t的点与圆心O的连线相对轴ΦA的夹角即为(ωt+αA)。坐标函数ΨA(t)、ΦA(t)定义域为[t1,tn+1]。该定义域对应的圆弧曲线段记以CA,圆弧段CA上的一个分段所对应的参数t的等效增量记以ΔTA。图中CA是一个第一象限的圆弧段。
六、参见图6,这是圆弧曲线局部示意图。
①示意图表示圆弧段CA在第一象限的一个分段与其内接弦之间的关系。
②以tM,u表示一个分段中点处的参数t的值;对应tM,u,所述CA内接弦拟合CA的径向误差绝对值在坐标轴上的投影值即为|δHA,Ψ(tM,u)|。
③圆弧段CA的等分分段对应的圆心角为ΔTA。以λA表示圆弧段CA一个分段的内接弦的长度。对应于tu有
式中,ΔTA=ωΔτA。 (J6-3)
七、参见图7,这是椭圆曲线示意图。在直角坐标系Ψ1OΨ2下的中心在坐标轴原点O的椭圆曲线QE,其曲线方程为
式中,H1和H2为椭圆的半轴。
曲线的坐标函数为
Ψ2(t)=H2sin(ωt+α2)=H2sin(ωt+α0),
(J7-3)
式中,
α2=α0。 (J7-5)椭圆曲线QE上对应参数t的点与坐标轴原点O的连线相对ΨX轴的夹角即为(ωt+α0)。坐标函数Ψ1(t)、Ψ2(t)定义域所对应的椭圆曲线段记以ZE。图中ZE是一个第一象限椭圆弧段。
八、实施例
所需路径或轮廓线是在直角坐标平面ΨXOΨY上的圆心在坐标轴原点O、半径为R0的第一象限圆弧段ZC,其曲线方程为
曲线的坐标函数为
ΨX(t)=R0cost,(L-2)
ΨY(t)=R0sint,(L-3)
R0=50000。 (L-4)
圆弧段ZC上对应参数t的点与圆心O的连线相对轴ΨX的夹角即为参数t。
要求以折线拟合圆弧段ZC的最大径向误差绝对值不超过εC,
εC=0.5。 (L-5)
参见图5,所述的ΨX、ΨY、R0、t、ZC分别是图中的ΦA、ΨA、HA、t、CA。对于本例,图中αA等于0。
以圆弧段ZC等分分段的内接弦拟合圆弧段ZC。其插补过程如下:
1、确定内接弦对应的圆心角ΔTC与圆弧段ZC的分段
(1)确定ΔTC
将圆弧段ZC等分。以ΔTC表示圆弧段ZC各等分分段起点所对应的参数t的等效增量,ΔTC也就是圆弧段ZC内接弦对应的圆心角。对于本例,ΔTC等于所述参数t的增量ΔτC,
ΔTC=ΔτC。 (L-6)
如果要求ZC内接弦拟合ZC的径向误差绝对值的最大值|δR0|不超过0.5,则根据式(5-10),
相应地,
取ΔTC=0.00894。 (L-9)
(2)确定圆弧段ZC分段
依据式(L-9)确定的ΔTC值对圆弧段ZC进行分段,其分段段数理论值应为
分段段数只能是整数,取分段段数的实际值为
nC=176。 (L-11)
相应的ΔTC取值为
此时,拟合的径向误差误差绝对值的最大值
2、确定坐标函数定义域中间点的位置坐标值
以iC(iC=1、2、3、……、176、177)表示构成拟合圆弧ZC的折线的176个内接弦的起点及最后一个内接弦的终点在内的各点的序号,也就是坐标函数ΨX(t)、ΨY(t)定义域的二个端点及二个端点间的中间点在内的点的序号。二个端点分别对应着序号1及177,二个端点间的中间点分别对应着序号
iC=2、3、……、176。 (L-14)
(1)当iC=1,即圆弧段ZC起点,其位置坐标值为已知
ΨX,1=R0=50000, (L-15)
ΨY,1=0。 (L-16)
(2)当iC=2~175,以u+1表示iC(iC=2、3、……、125)中的某个中间点的序号,u代表与之相邻的前一个点的序号,
①根据第4点的说明可知,ΨX(t)可视为ΨY(t)的虚拟坐标函数,可根据展开式(3-1)、(3-2)确定圆弧段各中间点的坐标函数值增量。根据第3点对于展开式项数的分析,展开式的项数取为4。因此,
对应圆弧段起点的位置坐标值增量ΔΨX(t1)、ΔΨY(t1),可由其它计算机确定并将之作为后续插补运算的已知条件。
②相应的各中间点的位置坐标值ΨX(tu+1)、ΨY(tu+1)由下式确定,
ΨX(tu+1)=ΨX(tu)+ΔΨX(tu), (L-19)
ΨY(tu+1)=ΨY(tu)+ΔΨY(tu)。 (L-20)
(3)当iC=176,即对应最后一个中间点。其相应的位置坐标值增量ΔΨX,176、ΔΨY,176无需计算,因为最后一个内接弦的终点即所需圆弧段ZC的终点,其位置坐标值已给定,
ΨX,177=0, (L-21)
ΨY,177=50000。 (L-22)
由于第一象限的1/4圆弧相对角ΨXOΨY的平分线是对称的;因此,插补可以只针对圆心角为0~π/4部分的圆弧进行。圆心角为π/4~π/2部分的圆弧的位置坐标值或其增量可利用所述的对称性获得,计算量可以节省约50%。
Claims (10)
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二个已知点对应着相同的t值,
针对所需路径或轮廓线的插补就是针对其坐标函数的插补,
针对坐标函数Ψk(t)(k=1、2、3、……、mΨ)的插补步骤包括,
(1)确定坐标函数Ψk(t)(k=1、2、3、……、mΨ)定义域二个端点间的中间点,包括,
①确定所述中间点所对应的参数t的值或其增量的值,
②确定所述中间点的个数,
插补中确定的中间点将所述定义域分成分段,每个分段定义域将对应一个线性函数,所述各个分段定义域的端点所对应的线性函数值与所对应的坐标函数值相等,整个定义域将对应一个由各个分段定义域对应的线性函数组成的分段线性函数ΨLk(t)(k=1、2、3、……、mΨ),而坐标函数Ψk(t)(k=1、2、3、……、mΨ)将以分段线性函数ΨLk(t)(k=1、2、3、……、mΨ)拟合,
(2)确定所述中间点的坐标函数值或其增量值,
(3)存储/输出运算结果,
其特征在于:将对应所述坐标Ψk(k=1、2、3、……、mΨ)的各坐标函数Ψk(t)(k=1、2、3、……、mΨ)定义域分段,以分段的交点作为定义域的中间点,所述定义域中间点所对应的坐标函数值Ψk(t)(k=1、2、3、……、mΨ),基于泰勒公式按下述展开式确定,
式中,①ΨA表示所述坐标Ψk(k=1、2、3、……、mΨ)中的某个坐标,A为序号k(k=1、2、3、……、mΨ)中的某个序号,对应坐标ΨA的坐标函数为
ΨA(t)=HAsin(ωt+αA), (1-4)
②u+1为坐标函数ΨA(t)定义域二个端点间的某个中间点的序号,u是与之相邻的前一个中间点或定义域起点的序号,
以,n表示坐标函数ΨA(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相邻的前一个中间点或定义域起点的序号,
所述定义域起点指的是与所述曲线Q起点对应的定义域的端点,
所述定义域终点指的是与所述曲线Q终点对应的定义域的端点,
③tu+1为坐标函数ΨA(t)定义域二个端点间序号为u+1的中间点所对应的参数t的值,
tu为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的参数t的值,
t1为坐标函数ΨA(t)定义域起点所对应的参数t的值,
tn+1为坐标函数ΨA(t)定义域终点所对应的参数t的值,
④ΔTu为坐标函数ΨA(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的参数t的等效增量,其数值为相应的所述参数t的增量Δtu的ω倍,
ΔTu=ωΔtu, (1-5)
Δtu=tu+1-tu, (1-6)
⑤ΨA(tu+1)为坐标函数ΨA(t)定义域中序号为u+1的中间点所对应的坐标函数值,
⑥ΨA(tu)为坐标函数ΨA(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的坐标函数值,
⑦ΦA(tu+1)为坐标函数ΨA(t)定义域中序号为u+1的中间点所对应的虚拟坐标函数值,
⑧ΦA(tu)为坐标函数ΨA(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的虚拟坐标函数值,
⑨v′+1为正整数,是展开式(1-2)的项数,
v′≥0, (1-7)
⑩v″+1为正整数,是展开式(1-3)的项数,
v″≥0, (1-8)
上述⑦、⑧中所述的虚拟坐标函数ΦA(t)是一个与坐标函数ΨA(t)对应的函数,或说是一个与ΨA(t)具有相同幅值HA、相同周期(2π/ω)、相同初始相位αA及相同定义域的余弦函数,其表达式为
ΦA(t)=HAcos(ωt+αA)。 (1-9)
2.如权利要求1所述的插补方法,其特征为:将对应所述坐标Ψk(k=1、2、3、……、mΨ)的各坐标函数ΨA(t)(k=1、2、3、……、mΨ)定义域等分,以等分分段的交点作为定义域的中间点。
3.如权利要求2所述的插补方法,其特征为:所述定义域中间点所对应的坐标函数值增量ΔΨk(t)(k=1、2、3、……、mΨ),基于泰勒公式按下述展开式确定,
式中,①ΨA表示所述坐标Ψk(k=1、2、3、……、mΨ)中的某个坐标,A为序号k(k=1、2、3、……、mΨ)中的某个序号,对应坐标ΨA的坐标函数为
ΨA(t)=HAsin(ωt+αA), (3-3)
②u+1为坐标函数ΨA(t)定义域二个端点间的某个中间点的序号,u就是与之相邻的前一个中间点或定义域起点的序号,
以,n表示坐标函数ΨA(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为坐标函数ΨA(t)定义域二个端点间序号为u+1的中间点所对应的参数t的值,
tu为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的参数t的值,
tu+2为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的参数t的值,
t1为坐标函数ΨA(t)定义域起点所对应的参数t的值,
tn+1为坐标函数ΨA(t)定义域终点所对应的参数t的值,
④ΔTA为坐标函数ΨA(t)定义域等分分段起点所对应的参数t的等效增量,其数值为所述参数t的增量ΔτA的ω倍,
ΔTA=ωΔτA, (3-4)
⑤ΔΨA(tu+1)为坐标函数ΨA(t)定义域中序号为u+1的中间点所对应的坐标函数值增量,
ΔΨA(tu+1)=ΨA(tu+2)-ΨA(tu+1), (3-5)
其中,ΨA(tu+2)为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的坐标函数值,
ΨA(tu+1)为序号为u+1的中间点所对应的坐标函数值,
⑥ΔΨA(tu)为坐标函数ΨA(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的坐标函数值增量,
ΔΨA(tu)=ΨA(tu+1)-ΨA(tu), (3-6)
其中,ΨA(tu+1)为序号为u+1的中间点所对应的坐标函数值,
ΨA(tu)为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的坐标函数值,
⑦ΔΦA(tu+1)为坐标函数ΨA(t)定义域中序号为u+1的中间点所对应的虚拟坐标函数值增量,
ΔΦA(tu+1)=ΦA(tu+2)-ΦA(tu+1), (3-7)
其中,ΦA(tu+2)为与序号为u+1的中间点相邻的后一个中间点或定义域终点所对应的虚拟坐标函数值,
ΦA(tu+1)为序号为u+1的中间点所对应的虚拟坐标函数值,
⑧ΔΦA(tu)为坐标函数ΨA(t)定义域中与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的虚拟坐标函数值增量,
ΔΦA(tu)=ΦA(tu+1)-ΦA(tu), (3-8)
其中,ΦA(tu+1)为序号为u+1的中间点所对应的虚拟坐标函数值,
ΦA(tu)为与序号为u+1的中间点相邻的前一个中间点或定义域起点所对应的虚拟坐标函数值,
⑨κ′+1为正整数,是展开式(3-1)的项数,
κ′≥0, (3-9)
⑩κ″+1为正整数,是展开式(3-2)的项数,
κ″≥0, (3-10)
上述⑦、⑧中所述的虚拟坐标函数ΦA(t)是一个与坐标函数ΨA(t)对应的函数,或说是一个与ΨA(t)具有相同幅值HδA、相同周期(2π/ω)、相同初始相位αA及相同定义域的余弦函数,其表达式为
ΦA(t)=HAcos(ωt+αA)。 (3-11)
4.如权利要求1、2或3所述的插补方法,其特征为:
(1)所述坐标Ψk(k=1、……、mΨ)共有二个坐标Ψk(k=1、2)或说Ψ1、Ψ2,对应Ψ1、Ψ2的坐标函数Ψ1(t)、Ψ2(t)可以表示为一组幅值相同为R0、周期相同为(2π/ω)、初始相位相同为α0的余弦函数与正弦函数,其表达式为
Ψ2(t)=H2sin(ωt+α2)=R0sin(ωt+α0), (4-2)
式中,H1=H2=R0, (4-3)
α2=α0, (4-5)
(2)对应所述坐标Ψ1、Ψ2的坐标函数Ψ1(t)、Ψ2(t)定义域等分为相同的nC个分段,或者说,坐标函数Ψ1(t)、Ψ2(t)定义域各分段起点对应相同的参数t的增量ΔτC或等效增量ΔTC,
n1=n2=nC, (4-6)
Δτ1=Δτ2=ΔτC, (4-7)
ΔT1=ΔT2=ΔTC。 (4-8)
5.如权利要求2或3所述的插补方法,其特征为:对应所述坐标其坐标函数定义域等分分段起点所对应的参数t的等效增量的取值满足下述公式,
式中,①ΨA表示所述坐标中的某一个坐标,A是序号k(k=1、2、3、……、mΨ)中的某个序号,对应坐标ΨA的坐标函数为
ΨA(t)=HAsin(ωt+αA), (5-3)
②ΔTA为坐标函数ΨA(t)定义域等分分段起点所对应的参数t的等效增量,其数值为所述参数t的增量ΔτA的ω倍,
ΔTA=ωΔτA, (5-4)
③|sin(ωt+αA)|MAX为在坐标函数ΨA(t)定义域范围内|sin(ωt+αA)|的最大值,
④εA为以分段线性函数ΨLA(t)拟合坐标函数ΨA(t)的误差绝对值|δΨL-A(t)|的允许值,
δΨL=A(t)=ΨLA(t)-ΨA(t), (5-5)
对应坐标函数ΨA(t)第i个分段定义域,所述的分段线性函数ΨLA(t)表达式为
式中,(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的值,
ti+1为与序号为i(i=1、2、3、……、n)的点相邻的后一个点所对应的参数t的值,
t1为坐标函数ΨA(t)定义域起点所对应的参数t的值,
tn+1为坐标函数ΨA(t)定义域终点所对应的参数t的值,
(c)ΔτA是坐标函数ΨA(t)定义域各等分分段起点所对应的参数t的增量值,是常数,
(d)ΔΨ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), (5-8)
其中,Ψ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)的点所对应的坐标函数值。
6.如权利要求5所述的插补方法,其特征为::所述|sin(ωt+αA)|MAX以1替换。
7.如权利要求4所述的插补方法,其特征为:对应所述坐标Ψ1、Ψ2其坐标函数Ψ1(t)、Ψ2(t)定义域等分分段起点所对应的参数t的等效增量|ΔTC|的取值满足下述公式,
式中,εC为以圆弧段ZC等分分段的内接弦拟合圆弧段ZC的径向误差的绝对值的允许值,圆弧段ZC为坐标函数Ψ1(t)、Ψ2(t)在坐标轴Ψ1和Ψ2构成的直角坐标系Ψ1OΨ2的坐标平面上的图形。
8.如权利要求1、2、3、6或7中任何一项权利要求所述的插补方法,其特征为:所述ω取值为1,
ω=1。 (8-1)
9.如权利要求4所述的插补方法,其特征为:所述ω取值为1,
ω=1。 (9-1)
10.如权利要求5所述的插补方法,其特征为:所述ω取值为1,
ω=1。 (10-1)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201010169960 CN101881953B (zh) | 2009-05-06 | 2010-04-27 | 一种控制物体运动轨迹的插补方法 |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200910111659 | 2009-05-06 | ||
CN200910111659.3 | 2009-05-06 | ||
CN 201010169960 CN101881953B (zh) | 2009-05-06 | 2010-04-27 | 一种控制物体运动轨迹的插补方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101881953A true CN101881953A (zh) | 2010-11-10 |
CN101881953B CN101881953B (zh) | 2013-04-03 |
Family
ID=43053987
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201010169960 Expired - Fee Related CN101881953B (zh) | 2009-05-06 | 2010-04-27 | 一种控制物体运动轨迹的插补方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101881953B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104133423B (zh) * | 2014-07-16 | 2016-11-09 | 北京航空航天大学 | 一种空间椭圆弧插补方法 |
CN117226193A (zh) * | 2023-11-10 | 2023-12-15 | 华潞科技(山西)有限公司 | 一种电火花线切割硬件插补方法、装置及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1255681A (zh) * | 1998-12-03 | 2000-06-07 | 财团法人工业技术研究院 | 电脑数控曲线路径速率控制方法及装置 |
US20030033050A1 (en) * | 1999-12-16 | 2003-02-13 | Yutkowitz Stephen J. | Motion control system and method utilizing spline interpolation |
JP2006072695A (ja) * | 2004-09-02 | 2006-03-16 | Matsushita Electric Ind Co Ltd | 数値制御装置 |
JP2007058748A (ja) * | 2005-08-26 | 2007-03-08 | Mazda Motor Corp | 曲面nc加工における補間パス生成方法 |
CN101178594A (zh) * | 2007-11-30 | 2008-05-14 | 上海奈凯电子科技有限公司 | 数控机床系统中实现对刀路进行插补控制的方法 |
-
2010
- 2010-04-27 CN CN 201010169960 patent/CN101881953B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1255681A (zh) * | 1998-12-03 | 2000-06-07 | 财团法人工业技术研究院 | 电脑数控曲线路径速率控制方法及装置 |
US20030033050A1 (en) * | 1999-12-16 | 2003-02-13 | Yutkowitz Stephen J. | Motion control system and method utilizing spline interpolation |
JP2006072695A (ja) * | 2004-09-02 | 2006-03-16 | Matsushita Electric Ind Co Ltd | 数値制御装置 |
JP2007058748A (ja) * | 2005-08-26 | 2007-03-08 | Mazda Motor Corp | 曲面nc加工における補間パス生成方法 |
CN101178594A (zh) * | 2007-11-30 | 2008-05-14 | 上海奈凯电子科技有限公司 | 数控机床系统中实现对刀路进行插补控制的方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104133423B (zh) * | 2014-07-16 | 2016-11-09 | 北京航空航天大学 | 一种空间椭圆弧插补方法 |
CN117226193A (zh) * | 2023-11-10 | 2023-12-15 | 华潞科技(山西)有限公司 | 一种电火花线切割硬件插补方法、装置及存储介质 |
CN117226193B (zh) * | 2023-11-10 | 2024-02-02 | 华潞科技(山西)有限公司 | 一种电火花线切割硬件插补方法、装置及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN101881953B (zh) | 2013-04-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101881954B (zh) | 一种设定替代曲线的新数控插补方法 | |
CN111061213B (zh) | 一种基于Bezier曲线转角平滑过渡算法的加工方法 | |
CN105710881B (zh) | 一种机器人末端连续轨迹规划过渡方法 | |
CN101751008B (zh) | 一种数控插补方法 | |
CN106054817B (zh) | 局部最优小线段路径解析光顺的实时前瞻插补方法及系统 | |
CN110716493B (zh) | 一种五轴微线段加工路径光顺方法 | |
CN106078359B (zh) | 一种龙门式多主轴制孔组合机床的零点定义与标定方法 | |
CN104483897B (zh) | 一种直驱龙门式运动平台轮廓控制装置及方法 | |
CN102269984A (zh) | 五轴联动数控加工的后置处理方法 | |
CN101539769A (zh) | 基于二次b样条曲线对g01代码的拟合及插补方法 | |
CN109664303A (zh) | 一种误差可控的四轴工业机器人b样条过渡式平顺轨迹生成方法 | |
CN103425131B (zh) | 基于非光滑控制和扰动观测的农用拖拉机导航控制方法 | |
CN106959664B (zh) | 基于五轴双转台在线非线性误差补偿方法 | |
CN108227630A (zh) | 一种采用时间参数多项式插补的自由曲面数控加工方法 | |
CN106647623A (zh) | 一种几何精度及衔接速度最优化的五轴联动平滑插补方法 | |
CN101881953B (zh) | 一种控制物体运动轨迹的插补方法 | |
CN105549535A (zh) | 五轴摇篮式数控机床未变形切屑的三维几何建模方法 | |
CN109676613A (zh) | 一种误差可控的四轴工业机器人圆弧过渡式平顺轨迹生成方法 | |
CN106958643A (zh) | 齿轮轮齿接触性能分析方法 | |
CN106094737A (zh) | 一种指定加工误差条件下的数控加工速度优化控制方法 | |
CN104020719A (zh) | 速度敏感点分段nurbs曲线的s型加减速控制插补算法 | |
CN106814700A (zh) | 一种数控装置单轴加速度约束的小线段连接速度计算方法 | |
CN102653013B (zh) | 一种基于偏心距优化的正交车铣宽行加工方法 | |
CN100468254C (zh) | 采用回旋曲线的工业制品设计方法、数值控制方法及装置 | |
CN102393680B (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: 20101110 Assignee: Fuzhou Lizhiyuan Electronic Technology Development Co.,Ltd. Assignor: Chen Xuegong Contract record no.: 2015350000063 Denomination of invention: Interpolation method for controlling motion locus of object Granted publication date: 20130403 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: 20130403 |
|
CF01 | Termination of patent right due to non-payment of annual fee |