CN110879569A - 一种前瞻控制方法 - Google Patents
一种前瞻控制方法 Download PDFInfo
- Publication number
- CN110879569A CN110879569A CN201911309556.8A CN201911309556A CN110879569A CN 110879569 A CN110879569 A CN 110879569A CN 201911309556 A CN201911309556 A CN 201911309556A CN 110879569 A CN110879569 A CN 110879569A
- Authority
- CN
- China
- Prior art keywords
- interpolation
- point
- curve
- speed
- acceleration
- 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
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/406—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 monitoring or safety
- G05B19/4065—Monitoring tool breakage, life or condition
-
- 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/37616—Use same monitoring tools to monitor tool and workpiece
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
本发明公开了一种前瞻控制方法,适用于包括微小线段在内的任意插补曲线,具体包括以下步骤:进行插补曲线终点的拐点处的最大速度v1进行计算,加上拐点处的夹角构成一个约束,在此约束下进行曲线插补;曲线插补的最后一点的目标插补点不是曲线的终点,而是真实轨迹圆弧的中点;曲线插补的加减速控制保证到达插补终点的上一点的速度正好为v1,本发明结构科学合理,使用安全方便,本发明科学合理,计算简单,易于计算机实现;这种前瞻控制方法,包括微小线段在内的任意插补曲线,极大的扩展。
Description
技术领域
本发明涉及数控***及机器人控制***技术领域,具体为一种前瞻控制方法。
背景技术
具有复杂型面工件的加工一般都是把曲面曲线解析成大量的直线或者圆弧,包含有微小线段,再通过运动控制***以直线插补或圆弧插补的方式实现轨迹加工,微小线段速度控制具有重大意义,它不仅直接影响工件的加工质量,加工效率,还影响加工设备的寿命,如果每一段微小线段的进给速度都从零开始加速然后再减速到零,将极大地降低平均进给速度,从而导致加工效率低下,另外,频繁的加减速也会降低加工工件的表面质量,加大机床以及电机振动与负荷,降低机床和电机寿命;
为解决上述问题,目前对微小线段的加工主要采用前瞻控制方法,使得每一段轨迹不用从零加速然后再减速到零,CN201510470826.9公开了一种前瞻控制方法,以解决以下四方面缺陷:
(1)为了使得最后一段终点速度为0,目前的控制***需要使用者指出某一段轨迹为最后一段,这在使用者也不知道哪一段是最后一段的情况下(比如微小线段轨迹是通过视觉***得到),无法使用,或者末段速度有跳动;
(2)需要确定前瞻段数,这不仅会导致运动控制***需要比较大的存储资源,而且当前的微小线段轨迹块前瞻插补完成后,需要等待下一个微小线段轨迹块完成前瞻计算才能重新插补,这个缺陷会降低整体效率;
(3)轨迹段段间衔接速度没有考虑插补周期只能是整数倍这个影响因素,这个缺陷会导致对一些插补周期小于2,或者起始速度等于运行速度且等于停止速度的轨迹段进行速度规划时,实际规划出的起始速度或停止速度有偏差,从而导致插补时速度产生突变,影响加工精度;
(4)相邻两段直线轨迹段夹角极小情况下,没有做拟合处理,导致前瞻计算时间增加,且会降低加工效率,但是此方法过于繁琐。
发明内容
本发明提供一种前瞻控制方法,可以有效解决上述背景技术中提出的问题。
为实现上述目的,本发明提供如下技术方案:一种前瞻控制方法,包括微小线段在内的任意插补曲线,具体包括以下步骤:
进行插补曲线终点的拐点处的最大速度v1进行计算,加上拐点处的夹角构成一个约束,在此约束下进行曲线插补;
根据上述技术方案,所述曲线插补的最后一点的目标插补点不是曲线的终点,而是真实轨迹圆弧的中点;
根据上述技术方案,所述曲线插补的加减速控制保证到达插补终点的上一点的速度正好为v1。
根据上述技术方案,所述步骤S1中拐点最大速度的有以下约束:
1)轨迹容许误差;
2)插补最大加速度;
3)插补最大速度。
根据上述技术方案,所述曲线插补线速度的加减速的原则为:按当前线速度一直以a大小匀减速未过超目标,则加速,直到最大速度,若按当前速度一直以a大小匀减速已超过目标则减速。
与现有技术相比,本发明的有益效果:本发明结构科学合理,使用安全方便,本发明科学合理,计算简单,易于计算机实现;这种前瞻控制方法,包括微小线段在内的任意插补曲线,极大的扩展了前瞻控制的适用范围,是插补更加平滑,从而提高加工质量。
附图说明
附图用来提供对本发明的进一步理解,并且构成说明书的一部分,与本发明的实施例一起用于解释本发明,并不构成对本发明的限制。
在附图中:
图1是插补拐点处的插补控制原理图;
图2是曲线插补实例图。
具体实施方式
以下结合附图对本发明的优选实施例进行说明,应当理解,此处所描述的优选实施例仅用于说明和解释本发明,并不用于限定本发明。
实施例:如图1所示,本发明提供技术方案,:一种前瞻控制方法,包括微小线段在内的任意插补曲线,具体包括以下步骤:
S1、进行插补曲线终点的拐点处的最大速度v1进行计算,加上拐点处的夹角构成一个约束,在此约束下进行曲线插补;
根据上述技术方案,步骤S1中拐点最大速度的有以下约束:
1)轨迹容许误差,设为Δd_max;;
2)插补最大加速度a;
3)插补最大速度v_max。
根据上述技术方案,曲线插补线速度的加减速的原则为:按当前线速度一直以a大小匀减速未过超目标,则加速,直到最大速度,若按当前速度一直以a大小匀减速已超过目标则减速。
假设拐点速度为v,0点到1点,1点到2点的时间为ΔT,0点为插补曲线到达终点的前一点,1点为预期到达的拐点,2点为下一插补曲线的第一个插补点,有关系式:
tan(α/2)=v*ΔT/R; (1)
sin(α/2)=v*ΔT/(R+Δd); (2)
由(1)(2)式可得:
Δd=v*ΔT*tan(α/4); (3)
由(3)可得对速度的约束为:
v≤Δd_max/(ΔT*tan(α/4)); (4)
由于插补最大加速度为a,而:
a=v*v/R; (5)
由(5)可以得到约束:
v≤a*ΔT/tan(α/2); (6)
加上最大速度约束:
v≤v_max; (7)
根据(4)(6)(7)可以计算出任意曲线拐点的最大速度v1,而此速度v1与夹角α作为前瞻控制的依据,可以有效产生平滑控制的效果;
如图2所示,进行一个闭合曲线的插补,假设a=5000mm/s^2,Δdmax=0.03mm,ΔT=50ms,vmax=1000mm/s;
若是粗加工,对轨迹偏差无要求,则计算出拐点最大速度v1=250mm/s;v2=1000mm/s;v3=1000mm/s;v4=250mm/s;
很明显此算法在4个拐点平滑效果明显;
若是精加工对轨迹偏差有要求,则计算出拐点最大速度v1=1.45mm/s;v2=1000mm/s;v3=1000mm/s;v4=1.45mm/s;
此算法对于v2,v3效果很明显,达到了平滑控制的目的,也实现了前瞻控制的目的。
这种曲线插补的特殊性在于:首如在如图1所示的插补曲线的0点,其目标插补点不是1点,而是真实轨迹圆弧的中点,此中点可以由最大速度v1与夹角α计算得出;
其次,曲线插补线速度的加减速的原则为:按当前线速度一直以a大小匀减速未过超目标,则加速,直到最大速度,若按当前速度一直以a大小匀减速已超过目标则减速,其中a为最大加速度。
以终点限速v1的一段长度为s12直线的插补为例进一步进行说明;
假设起始速度为v0,最大速度为vm,当前速度为v,当前位置为s,插补周期为ΔT,最大加速度为a,插补速度的算法为:
起点初始速度v=v0,若Δs≥s12-s则减速v=v-a*ΔT;
若Δs<s12-s且v<vm,则加速v=v+a*ΔT,此算法可让到达终点时速度控制在目标速度。
由于任意曲线都能以s为参数表达,
x=u(s);y=v(s);z=w(s);
因此可以控制任意曲线的加减速都能归结为控制参数s的加减速,直线段的加减速控制插补算法也适用。
与现有技术相比,本发明的有益效果:本发明结构科学合理,使用安全方便,本发明科学合理,计算简单,易于计算机实现;这种前瞻控制方法,包括微小线段在内的任意插补曲线,极大的扩展了前瞻控制的适用范围,是插补更加平滑,从而提高加工质量。
最后应说明的是:以上所述仅为本发明的优选实例而已,并不用于限制本发明,尽管参照前述实施例对本发明进行了详细的说明,对于本领域的技术人员来说,其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (2)
1.一种前瞻控制方法,其特征在于:适用包括微小线段在内的任意插补曲线,具体包括以下步骤:
S1、进行插补曲线终点的拐点处的最大速度v1进行计算;S2、加上拐点处的夹角构成一个约束,在此约束下进行曲线插补;
所述曲线插补的最后一点的目标插补点不是曲线的终点,而是真实轨迹圆弧的中点;
所述曲线插补的加减速控制保证到达插补终点的上一点的速度正好为v1。
所述插补曲线终点的拐点处的最大速度v1有以下约束:
1)轨迹容许误差;
2)插补最大加速度;
3)插补最大速度。
2.根据权利要求1所述的一种前瞻控制方法,其特征在于,所述曲线插补线速度的加减速的原则为:按当前线速度一直以a大小匀减速未过超目标,则加速,直到最大速度,按当前速度一直以a大小匀减速已超过目标则减速。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911309556.8A CN110879569B (zh) | 2019-12-18 | 2019-12-18 | 一种前瞻控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911309556.8A CN110879569B (zh) | 2019-12-18 | 2019-12-18 | 一种前瞻控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110879569A true CN110879569A (zh) | 2020-03-13 |
CN110879569B CN110879569B (zh) | 2021-09-07 |
Family
ID=69731594
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911309556.8A Active CN110879569B (zh) | 2019-12-18 | 2019-12-18 | 一种前瞻控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110879569B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112783084A (zh) * | 2021-01-04 | 2021-05-11 | 大族激光科技产业集团股份有限公司 | 一种曲线加工方法及数控*** |
CN113504764A (zh) * | 2021-06-30 | 2021-10-15 | 浙江大学 | 基于位置矢量加权积分的连续线段数控加工路径平滑方法 |
CN113791585A (zh) * | 2021-08-16 | 2021-12-14 | 金华凯晖智能科技有限公司 | 一种圆弧轨迹速度自适应控制方法 |
CN114296400A (zh) * | 2021-11-16 | 2022-04-08 | 中南大学 | 一种用于激光切割高速插补的自适应前瞻处理方法 |
CN117555291A (zh) * | 2024-01-11 | 2024-02-13 | 佛山德玛特智能装备科技有限公司 | 一种插补方法、装置、插补器和介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101470434A (zh) * | 2007-12-28 | 2009-07-01 | 中国科学院沈阳计算技术研究所有限公司 | 基于滤波技术的速度前瞻控制方法 |
CN101976060A (zh) * | 2010-11-17 | 2011-02-16 | 西南交通大学 | 基于机床动力学和曲线特性的nurbs插补方法 |
CN106802627A (zh) * | 2017-03-08 | 2017-06-06 | 苏州达尔普工业控制有限公司 | 连续微小线段前瞻控制插补算法 |
EP3480671A1 (de) * | 2017-11-02 | 2019-05-08 | Siemens Aktiengesellschaft | Verfahren zum betrieb einer numerisch gesteuerten produktionsanlage sowie produktionsanlage dazu |
CN110471368A (zh) * | 2019-08-30 | 2019-11-19 | 长安大学 | 一种高速数控机床加工速度自适应的前瞻插补方法 |
-
2019
- 2019-12-18 CN CN201911309556.8A patent/CN110879569B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101470434A (zh) * | 2007-12-28 | 2009-07-01 | 中国科学院沈阳计算技术研究所有限公司 | 基于滤波技术的速度前瞻控制方法 |
CN101976060A (zh) * | 2010-11-17 | 2011-02-16 | 西南交通大学 | 基于机床动力学和曲线特性的nurbs插补方法 |
CN106802627A (zh) * | 2017-03-08 | 2017-06-06 | 苏州达尔普工业控制有限公司 | 连续微小线段前瞻控制插补算法 |
EP3480671A1 (de) * | 2017-11-02 | 2019-05-08 | Siemens Aktiengesellschaft | Verfahren zum betrieb einer numerisch gesteuerten produktionsanlage sowie produktionsanlage dazu |
CN110471368A (zh) * | 2019-08-30 | 2019-11-19 | 长安大学 | 一种高速数控机床加工速度自适应的前瞻插补方法 |
Non-Patent Citations (3)
Title |
---|
张君等: "面向连续短线段高速加工的圆弧连接前瞻控制算法", 《中国机械工程》 * |
陈日东等: "连续轨迹动态前瞻插补算法研究", 《电子设计工程》 * |
韩业宸: "网络化运动控制***的轨迹描述与插补", 《中国优秀硕士学位论文全文数据库信息科技辑(月刊)》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112783084A (zh) * | 2021-01-04 | 2021-05-11 | 大族激光科技产业集团股份有限公司 | 一种曲线加工方法及数控*** |
CN113504764A (zh) * | 2021-06-30 | 2021-10-15 | 浙江大学 | 基于位置矢量加权积分的连续线段数控加工路径平滑方法 |
CN113791585A (zh) * | 2021-08-16 | 2021-12-14 | 金华凯晖智能科技有限公司 | 一种圆弧轨迹速度自适应控制方法 |
CN113791585B (zh) * | 2021-08-16 | 2023-09-22 | 上海瑞盛联信息科技有限公司 | 一种圆弧轨迹速度自适应控制方法 |
CN114296400A (zh) * | 2021-11-16 | 2022-04-08 | 中南大学 | 一种用于激光切割高速插补的自适应前瞻处理方法 |
CN114296400B (zh) * | 2021-11-16 | 2024-03-12 | 中南大学 | 一种用于激光切割高速插补的自适应前瞻处理方法 |
CN117555291A (zh) * | 2024-01-11 | 2024-02-13 | 佛山德玛特智能装备科技有限公司 | 一种插补方法、装置、插补器和介质 |
CN117555291B (zh) * | 2024-01-11 | 2024-03-22 | 佛山德玛特智能装备科技有限公司 | 一种插补方法、装置、插补器和介质 |
Also Published As
Publication number | Publication date |
---|---|
CN110879569B (zh) | 2021-09-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110879569B (zh) | 一种前瞻控制方法 | |
CN107608313B (zh) | 一种五轴双样条曲线插补速度规划方法 | |
Dong et al. | Smooth feedrate planning for continuous short line tool path with contour error constraint | |
CN106168790B (zh) | 一种在线改变目标速度和位置的s形加减速控制方法 | |
EP1869531B1 (en) | Method of tolerance-based trajectory planning | |
Lai et al. | On the development of a parametric interpolator with confined chord error, feedrate, acceleration and jerk | |
Wang et al. | A look-ahead and adaptive speed control algorithm for high-speed CNC equipment | |
WO2013129294A1 (ja) | モータ制御装置 | |
CN107765648A (zh) | 一种cnc加工的进给速度规划方法及装置 | |
CN113156893B (zh) | 一种基于s形加减速的五轴机床速度规划方法 | |
CN108958173B (zh) | 基于梯形求解的任意位移速度下的s曲线加减速规划方法 | |
CN107291047B (zh) | 一种基于多约束条件的正反双向nurbs曲线插补方法 | |
CN112486101B (zh) | Nurbs曲线自适应前瞻插补方法 | |
CN104281099A (zh) | 一种考虑加工特性的nurbs直接插补方法及装置 | |
CN105629882A (zh) | 一种用于样条插补的三角函数速度规划方法 | |
CN111633668B (zh) | 一种用于机器人加工三维自由曲面的运动控制方法 | |
CN113190021A (zh) | 一种工业机器人小线段轨迹规划算法 | |
CN109901518A (zh) | 一种恒力约束条件下的数控机床加减速速度规划方法 | |
CN114740803A (zh) | 一种nurbs曲线插补速度控制方法、装置及设备 | |
Qiao et al. | Nanoscale trajectory planning with flexible Acc/Dec and look-ahead method | |
KR102180545B1 (ko) | 가상 공작 기계를 활용하여 가공 오차를 제한하는 수치 제어 장치 | |
CN111487928A (zh) | 一种基于刀位点增删改指令的数控加工轨迹平滑方法 | |
Lee | Generation of velocity profiles with speed limit of each axis for high-speed machining using look-ahead buffer | |
CN115963782A (zh) | 一种基于初始加速度不为零的s型速度规划方法 | |
Chen et al. | A universal velocity limit curve generator considering abnormal tool path geometry for CNC machine tools |
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 |