CN110618659B - 一种面向五轴线性插补的平动轴旋转轴协调运动规划控制方法 - Google Patents
一种面向五轴线性插补的平动轴旋转轴协调运动规划控制方法 Download PDFInfo
- Publication number
- CN110618659B CN110618659B CN201910966496.0A CN201910966496A CN110618659B CN 110618659 B CN110618659 B CN 110618659B CN 201910966496 A CN201910966496 A CN 201910966496A CN 110618659 B CN110618659 B CN 110618659B
- Authority
- CN
- China
- Prior art keywords
- axis
- maximum
- acceleration
- shaft
- angular
- 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
Images
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/41—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 interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path
-
- 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/34—Director, elements to supervisory
- G05B2219/34083—Interpolation general
Landscapes
- Engineering & Computer Science (AREA)
- Computing Systems (AREA)
- Theoretical 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
本发明公开了一种面向五轴线性插补的平动轴旋转轴协调运动规划控制方法,用以解决五轴线性插补时平动轴旋转轴运动特性的统一协调方面存在的技术问题。结合五轴线性插补原理,首先建立了旋转轴角加速度与平动轴加速度间的关系模型,基于该模型获得旋转轴实际最大角加速度,再结合各旋转轴角加速度约束参数对平动轴的最大初始加速度进行了修调,重新进行平动轴的速度规划获得最大进给速度后,计算出了旋转轴实际最大角速度,利用旋转轴角速度约束参数对平动轴最大速度进行修调。最后根据平动轴速度和加速度的修调结果待插补线性路径各插补周期的平动轴进给速度/旋转轴角速度进行重新规划计算,完成对平动轴旋转轴进行运动协调的规划控制过程。
Description
技术领域
本发明涉及计算机数字控制(CNC)技术领域,特别涉及该领域中五轴加工线性插补时平动轴(旋转轴)的速度(角速度)及加速度(角加速度)的规划控制技术。
背景技术
轨迹插补及运动控制技术是CNC技术的基础和核心,基于该技术,机床CNC系统才能精密控制机床各个运动坐标轴实现刀具相对工件能沿既定轨迹行进切削加工的目标。但在行进过程中,以什么样的运动形态却是另一个值得思考的问题。任何运动机械都有自己的速度/加速度等运动动态特性约束参数,为保证加工效率提高运动速度/加速度时又必须要保证在运动机械所允许的动态特性约束范围之内,CNC机床也是如此。五轴加工CNC机床是包含平动轴和旋转轴的一种运动机械,由于平动和旋转量纲不统一,在进行运动控制时如何保证两者间的协调一致已逐渐成为一个关键的难点问题。
五轴CNC机床的平动轴与旋转轴在运动形态方面的差异,直接导致两种进给伺服轴在运动时所能承受的最大速度、最大加速度也有所不同。目前有关平动轴与旋转轴运动控制方面的差异性协调统一的方法主要有:1)一种最优的平动轴约束进给量规划算法,主要通过求解二阶微分方程推导得出脉冲达到极限时速度函数的表达式;2)一种三次S曲线加减速算法,给出了平动轴的加加速度、加速度、速度和位移的数学表达式,对数控加工中各种情况进行了速度规划,但是没有考虑旋转轴的角速度和角加速度的极限范围;3)通过对多轴联动的数控系统分析,建立了平动轴与旋转轴之间的量纲转化系数,可以根据平动轴的速度、加速度来计算旋转轴的速度、加速度,但是该方法在推导转化系数时存在转化误差。
以上方法仍然沿用平动轴最大速度、加速度极限去规划旋转轴的转动角速度和角加速度,这将可能导致旋转轴角速度、角加速度超出机床旋转轴的最大可承受角速度、角加速度极限范围,换句话说也就是转动跟不上平动,结果必然是平动轴与旋转轴之间的运动不协调,不协调运动又会产生机械冲击,加工工件时可能发生过切现象,影响加工表面质量和精度。因此,针对五轴CNC机床平动轴旋转轴的运动协调统一问题提出相应的运动控制方法,对于提高五轴CNC机床的运动控制性能将极具重要作用和实际应用价值。
发明内容
一般地,五轴CNC机床的控制系统广泛采用五轴线性插补功能,其相应的数控加工代码为G01。若某机床的G01格式为G01 Xx Yy Zz Aa Cc,则表明该机床的平动轴为X、Y和Z轴,旋转轴则为A轴和C轴。本发明将为解决五轴线性插补时平动轴旋转轴运动特性的统一协调方面存在的技术问题,提供一种面向五轴线性插补的平动轴旋转轴运动特性约束下的平动轴速度/加速度、旋转轴角速度/角加速度的规划控制方法,其主要内容包括对平动轴速度和加速度以及旋转轴角速度和角加速度的约束控制技术。
本发明为解决上述技术问题所采用的技术方案是:
1)由数控加工代码解析出待插补的线性轨迹,进行平动轴的速度/加速度规划处理,并提取最大平动加速度。
2)计算最大平动加速度所对应的各旋转轴角加速度,利用各旋转轴的最大极限角加速度约束判定是否超出约束控制范围,若超出则对最大平动加速度进行降低修调处理。
3)以此时的最大平动加速度对平动轴进行速度规划处理,重新计算出最大合成进给速度。
4)以新的最大合成进给速度计算对应的旋转轴角速度,利用旋转轴最大极限角速度约束判定是否超出约束控制范围,若超出则对最大合成进给速度进行再次更新处理,重新规划平动轴的运动参数,完成对平动轴旋转轴进行运动协调统一的运动规划控制。
附图说明
图1是五轴线性插补前平动轴旋转轴的运动规划流程图。
具体实施方式
假设机床的平动轴最大允许的极限加速度为Vmax,并假定在第m个插补周期时,平动轴具有最大合成进给速度Vm,显然有Vm≤Vmax。以A-C型双摆头五轴CNC机床为例,根据五轴线性插补原理可知,在第m个插补周期内有
成立。式(1)中:
Δlm-平动轴在第m个插补周期的合成位移ΔAm-A旋转轴在第m个插补周期的角位移
ΔCm-C旋转轴在第m个插补周期的角位移VAm-A旋转轴在第m个插补周期的角速度
VCm-C旋转轴在第m个插补周期的角速度
式(1)中的旋转轴角位移ΔAm和ΔCm可按照以下线性比例进行分配获得
其中:l-当前插补路径段的总长度
As-A旋转轴在当前插补路径段的起点坐标Ac-A旋转轴在当前插补路径段的终点坐标
Cs-C旋转轴在当前插补路径段的起点坐标
Ce-C旋转轴在当前插补路径段的终点坐标
式(2)中ΔAm和ΔCm分别与(Ae-As)和(Ce-Cs)取得相同的符号。
由式(1)和(2)可知,平动轴在第m个插补周期达到Vm的进给速度时,A、C旋转轴角速度的绝对值也将分别达到最大值,分别为|VAm|和|VCm|,只要控制|VAm|和|VCm|均在机床旋转轴可承受的角速度约束范围内即可。
根据式(1)和(2),可推导出第m个插补周期内平动轴的合成进给速度Vm与A、C旋转轴的角速度VAm、VCm的关系式
假设五轴CNC机床A、C旋转轴的最大极限角速度约束分别为VA max和VC max(机床旋转轴无论正转还是反转,角速度约束应恒为正值,即VA max和VC max均大于0)。对A、C旋转轴角速度约束控制计算过程为:
1)根据式(3)计算出VAm和VCm,将结果分别表示为如下形式
VAm=sgn(VAm)abs(VAm)
VCm=sgn(VCm)abs(VCm)
式中:sgn(x)-取x符号的函数
abs(x)-取x的绝对值函数
2)当abs(VAm)≤VA max且abs(VCm)≤VC max时,表示A、C旋转轴的角速度均未超出机床旋转轴最大极限角速度,同时也表明此时的平动轴与旋转轴均可在各自允许的极限速度范围内协调运动,说明此时对平动轴进给速度的规划结果可以满足旋转轴角速度约束控制要求。
3)反之,当abs(VAm)>VA max或abs(VCm)>VC max时,表明当前平动轴进给速度的规划结果中实际可达到的平动进给速度偏高,使得至少有一根旋转轴的角速度已超出该旋转轴最大可承受的极限角速度,此时超出角速度约束范围的旋转轴将出现与平动轴运动不协调一致的情况。为此,需降低实际可达到的平动进给速度,使得对应的旋转轴角速度被约束控制在机床旋转轴最大极限角速度以内。对此,本发明给出如下重新规划计算方法:
a.平动轴最大合成进给速度的修调
对一根旋转轴的角速度超出该轴角速度极限约束范围的情形(不妨设为A轴),可以sgn(VAm)VA max代替式(3)中的VAm,可求得新的平动轴最大合成进给速度
同理对两根旋转轴的角速度均超出各自角速度极限约束范围的情形,分别以sgn(VAm)VA max和sgn(VCm)VC max代替式(3)中的VAm和VCm,求得
此时应取(Vm′)A和(Vm′)C中较小者作为新的平动轴最大合成速度Vm′,即
Vm′=min((Vm′)A,(Vm′)C) (6)
式(6)中:min(x,y)函数-返回x和y中较小的数。
b.平动轴进给速度的重新规划计算
根据式(4)、(5)和(6)计算获得平动轴新的最大合成进给速度Vm′后,将Vmax重新赋值为Vm′,对平动轴的进给速度进行重新规划计算。
通过以上步骤完成基于旋转轴最大可承受极限角速度的对平动轴进给速度的约束控制和修调。根据修调后的平动轴进给速度和旋转轴最大极限角速度又可完成对平动轴加速度的约束控制和修调,其具体实施方式如下:
假设五轴CNC机床A、C旋转轴的最大极限角加速度约束分别为aA max和aC max(aA max和aC max均为正数),在整个加工过程中,实际最大角加速度应不大于aA max和aC max。在任意的第i个插补周期,旋转轴角加速度的计算公式为
式中:ai-平动轴在第i个插补周期的加速度
根据式(7)可知,旋转轴的角加速度与平动轴加速度之间具有线性相关性,即当平动轴具有加速度时,旋转轴同时也将具有角加速度,而且有
式(8)中:(aA)max-A旋转轴实际的最大角加速度
(aC)max-C旋转轴实际的最大角加速度
且(aA)max和(aC)max(都取为非负数值)。
对式(8)的运算结果作如下讨论:
1)当(aA)max≤aA max且(aC)max≤aC max时,表示A、C旋转轴的角加速度均未超出机床旋转轴最大极限角加速度,同时也表明如按照机床平动轴最大极限加速度amax进行速度规划,其计算结果可以满足旋转轴角加速度约束控制的要求。
2)当(aA)max>aA max或(aC)max>aC max时,表示至少有一根旋转轴的角加速度已超出该旋转轴最大可承受的极限角加速度,此时表明如果继续按照机床平动轴最大极限加速度amax进行速度规划,将导致旋转轴角加速度超出相应的最大极限角加速度约束范围。因此,需在进行平动轴速度规划前重新计算新的平动轴最大加速度amax,这时又需采用如下方法对平动轴最大加速度amax进行修调。
a.当一根旋转轴的角加速度超出该轴角加速度最大极限约束时(不妨设为A轴),可以(aA)max代替式(7)中的aAi,解得新的平动轴最大加速度
b.当两根旋转轴的角加速度均超出各自角加速度最大极限约束时,可分别以(aA)max和(aC)max代替式(7)中的aAi和aCi,求得
取式(10)中(amax)A和(amax)C的较小者作为新的平动轴最大加速度amax,即
amax=min((amax)A,(amax)C) (11)
将式(9)、(10)和(11)计算出的amax作为平动轴进给速度规划时的加速度约束参数使用。
Claims (1)
1.一种面向五轴线性插补的平动轴旋转轴协调运动规划控制方法,其特征在于五轴线性插补过程中,保证旋转轴实际最大角加速度和角速度分别处于机床旋转轴允许的极限角加速度和极限角速度的约束范围内,对平动轴旋转轴进行协调运动的规划控制,由数控加工代码解析出待插补线性轨迹后,首先进行平动轴速度/加速度规划,提取机床平动轴最大加速度amax,然后结合机床A、C旋转轴允许的最大极限角加速度aA max和aC max,对A、C旋转轴实际最大角加速度(其中,abs(x)为取x绝对值的函数,l为当前插补路径段的总长度,As为A旋转轴在当前插补路径段的起点坐标,Ae为A旋转轴在当前插补路径段的终点坐标,Cs为C旋转轴在当前插补路径段的起点坐标,Ce为C旋转轴在当前插补路径段的终点坐标)进行约束控制,实现对机床平动轴最大加速度amax的修调:a.当仅有A旋转轴的角加速度超出A轴角加速度最大极限约束时,得b.当A、C旋转轴的角加速度均超出各自角加速度最大极限约束时,得(其中min(x,y)为取x和y中较小数的函数),以修调获得的平动轴最大加速度amax作为平动轴进给速度规划时的加速度约束参数,计算出平动轴最大合成进给速度Vm,随后结合机床A、C旋转轴允许的最大极限角速度VA max和VC max,对A、C旋转轴实际最大角速度和进行约束控制:当仅有abs(VAm)>VA max成立时,得机床平动轴新的最大合成进给速度(其中sgn(x)为取x符号的函数),当A、C旋转轴的角速度均超出各自角速度极限约束时,得将Vm′赋值给机床平动轴最大进给速度Vmax,实现对机床平动轴最大进给速度的修调。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910966496.0A CN110618659B (zh) | 2019-10-11 | 2019-10-11 | 一种面向五轴线性插补的平动轴旋转轴协调运动规划控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910966496.0A CN110618659B (zh) | 2019-10-11 | 2019-10-11 | 一种面向五轴线性插补的平动轴旋转轴协调运动规划控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110618659A CN110618659A (zh) | 2019-12-27 |
CN110618659B true CN110618659B (zh) | 2022-09-16 |
Family
ID=68925662
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910966496.0A Active CN110618659B (zh) | 2019-10-11 | 2019-10-11 | 一种面向五轴线性插补的平动轴旋转轴协调运动规划控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110618659B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111708322B (zh) * | 2020-06-12 | 2021-09-17 | 广州数控设备有限公司 | 三坐标定位器调姿运控方法、系统、调姿控制器及存储介质 |
CN113359607B (zh) * | 2021-07-06 | 2022-08-09 | 深圳数马电子技术有限公司 | 一种应用于五轴数控机的拐角过渡的轨迹确定方法 |
CN113467384B (zh) * | 2021-07-30 | 2022-09-06 | 深圳数马电子技术有限公司 | 一种应用于五轴数控机床的拐角过渡方法 |
CN114020055B (zh) * | 2021-10-25 | 2024-06-07 | 深圳众为兴技术股份有限公司 | 速度控制方法、装置、自动化设备、电子设备及存储介质 |
CN114019913B (zh) * | 2021-10-26 | 2024-04-09 | 深圳众为兴技术股份有限公司 | 速度控制方法、装置、自动化设备、电子设备及存储介质 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105005265A (zh) * | 2015-07-26 | 2015-10-28 | 大连理工大学 | 一种基于曲线光滑变形的数控加工进给率规划方法 |
CN106547251A (zh) * | 2016-10-11 | 2017-03-29 | 浙江大学 | 一种基于低速敏感区域插补信息反馈的五轴刀路生成方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3297643B2 (ja) * | 1997-10-14 | 2002-07-02 | 東芝機械株式会社 | 送り駆動系のサーボ制御方法およびサーボ制御装置 |
CN104635619A (zh) * | 2013-11-12 | 2015-05-20 | 沈阳高精数控技术有限公司 | 基于刀具矢量插补的五轴数控加工方法 |
CN110221576B (zh) * | 2019-05-20 | 2020-08-14 | 大连理工大学 | 干涉和运动学约束的五轴加工刀轴线性优化方法 |
-
2019
- 2019-10-11 CN CN201910966496.0A patent/CN110618659B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105005265A (zh) * | 2015-07-26 | 2015-10-28 | 大连理工大学 | 一种基于曲线光滑变形的数控加工进给率规划方法 |
CN106547251A (zh) * | 2016-10-11 | 2017-03-29 | 浙江大学 | 一种基于低速敏感区域插补信息反馈的五轴刀路生成方法 |
Non-Patent Citations (1)
Title |
---|
五轴线性插补中非线性误差补偿方法;陈良骥;《机械科学与技术》;20190602;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN110618659A (zh) | 2019-12-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110618659B (zh) | 一种面向五轴线性插补的平动轴旋转轴协调运动规划控制方法 | |
CN112698625B (zh) | 一种面向联动轨迹误差预测的五轴机床数字孪生建模方法 | |
CN102147600B (zh) | 实时生成曲率连续路径的数控插补系统 | |
JP5255108B2 (ja) | 指令経路速度条件による速度制御を行う数値制御装置 | |
JP4975872B1 (ja) | 多軸加工機用速度制御機能を有する数値制御装置 | |
CN105900027A (zh) | 轨迹控制装置 | |
JP5323280B1 (ja) | 数値制御装置 | |
CN109901518B (zh) | 一种恒力约束条件下的数控机床加减速速度规划方法 | |
CN102091967A (zh) | 一种多轴数控加工的进给速度平滑方法 | |
CN111633668B (zh) | 一种用于机器人加工三维自由曲面的运动控制方法 | |
WO2008053601A1 (fr) | Dispositif de contrôle de travail et son programme | |
CN115122329B (zh) | 一种便捷的工业机器人关节空间轨迹规划方法 | |
Lin et al. | Local corner smoothing with kinematic and real-time constraints for five-axis linear tool path | |
CN113189939B (zh) | 一种用于摇篮式机床的全局最优进给速度规划方法 | |
Lin et al. | Real-time interpolators for multi-axis CNC machine tools | |
CN111722591B (zh) | 一种商标模切机高精度联动插补的方法 | |
CN114415598B (zh) | 加工路径的过渡方法、装置、存储介质及计算机设备 | |
CN102528553B (zh) | 五轴联动数控铣床伺服动态参数快速调整方法 | |
JP3004651B2 (ja) | 数値制御装置 | |
JP2003005811A (ja) | 6軸制御ncプログラム生成方法及び生成装置、並びに6軸制御ncプログラム生成プログラム及びこのプログラムを記憶したコンピュータ読み取り可能な記録媒体 | |
CN111414672B (zh) | 基于数控系统的曲轴磨削方法及装置 | |
Qiao et al. | A space cutter compensation method for multi-axis machining using triple NURBS trajectory | |
So et al. | 5-Axis machining speed enhancement by step length optimization | |
Liu et al. | Planning and implementation of motion trajectory based on C 2 PH spline | |
JPH0751989A (ja) | 自由曲面加工装置 |
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 |