CN111158318B - 一种非对称性四次曲线柔性加减速规划方法 - Google Patents
一种非对称性四次曲线柔性加减速规划方法 Download PDFInfo
- Publication number
- CN111158318B CN111158318B CN202010047726.6A CN202010047726A CN111158318B CN 111158318 B CN111158318 B CN 111158318B CN 202010047726 A CN202010047726 A CN 202010047726A CN 111158318 B CN111158318 B CN 111158318B
- Authority
- CN
- China
- Prior art keywords
- acceleration
- max
- maximum
- deceleration
- speed
- 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/416—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 of velocity, acceleration or deceleration
- G05B19/4163—Adaptive control of feed or cutting velocity
-
- 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/36—Nc in input of data, input key till input tape
- G05B2219/36521—Select by combination of detected force, acceleration, speed, work rate
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
一种非对称性四次曲线柔性加减速规划方法,属于数控加工运动控制领域。首先构建了新的加减速控制模型,然后给出了详细的算法实现方案,采用分类讨论和循环迭代相结合的方法进行算法实现,同时采用匀速补偿法克服不同精度要求下算法耗时不稳定的问题,在无复杂函数运算、参数控制灵活、计算稳定可靠的基础上,解决了传统S型曲线加加速度存在阶跃的问题,提高了数控加工的运动平稳性,为数控系统提供了一种可行实用的加减速规划方案。
Description
技术领域
本发明属于数控加工运动控制领域,涉及一种非对称性四次曲线柔性加减速规划方法。
背景技术
随着工业现代化水平的不断发展,制造业对数控加工提出了更高的要求,数控系统正朝着高速高精、高可靠性方向发展,而加减速规划是影响数控系统性能的一项关键技术。
目前,工程上使用较多的是直线加减速和S型加减速。直线加减速实现简单、计算效率高,但是规划出的速度曲线平滑性差,一般只适用于低端数控系统。S型加减速控制可规划出速度和加速度均连续变化的轨迹曲线,满足一般的数控加工要求,然而S型加减速控制的加加速度在起点和终点以及正负值的转接点位置均存在突变,在高速加工中,会导致机床系统产生振动和冲击,因此很难满足高速高精度加工的要求。而当前存在的改进方案,仍存在一定的缺陷:(1)采用三角函数或指数函数类曲线进行改进,虽避免了加加速度阶跃,但影响了嵌入式系统的实时性和计算精度,在实际数控系统中很少使用;(2)加速阶段和减速阶段的非对称性只是起始速度和终点速度是不相等的,但是加速阶段与减速阶段的参数值是相等的,意味着加速过程和减速过程快慢不能分开控制,降低加减速控制方法的灵活性;(3)没有考虑系统精度的影响,一旦系统精度要求提高,计算量可能会倍增,从而造成系统不稳定。
发明内容
针对上述现有技术中存在的问题,本发明提出了一种非对称性四次曲线柔性加减速规划方法。构建了新的加减速控制模型,并给出了详细的算法实现方案,在无复杂函数运算、参数控制灵活、计算稳定可靠的基础上,解决了传统S型曲线加加速度存在阶跃的问题。
本发明技术方案为:
一种非对称性四次曲线柔性加减速规划方法,步骤如下:
1、非对称性四次曲线柔性加减速规划模型构建
构建的加减速规划模型包含加速运动阶段、匀速运动阶段和减速运动阶段;加加速度的变化规律为三角形状连续变化,向上逐次积分得到加速度、速度和位移变化规律,规划出的加加速度、加速度、速度和位移分别是连续变化的一次、二次、三次和四次曲线;加速阶段和减速阶段的参数值均可不同,完整的加减速过程被划分为11个运动阶段,每个运动阶段都有相对应的参数函数表达式。
2、非对称性四次曲线柔性加减速规划实现方案
总体实现流程包括以下处理步骤:
S1,输入系统给定参数,包括:待加工路径长度L、起始速度Vs和终点速度Ve、机床运行最大速度Vmax、加速运动阶段的最大加速度Aa和最大加加速度Ja、减速运动阶段的最大加速度Ad和最大加加速度Jd。
S2,取可达到的最大速度Vmax_act=Vmax,校验此时加速阶段和减速阶段的最大加速度可达性,并分别求出加速阶段的位移长度Sa和减速阶段的位移长度Sd。
S3,判断待加工路径长度L与Sa+Sd的大小关系,从而校验机床运行最大速度Vmax可达性,若机床运行最大速度可达,则实际可达到的最大速度取机床运行最大速度,并跳转至步骤S6;若机床运行最大速度不可达,至步骤S4。
S4,设置精度误差δ和最大可迭代次数Count;确定迭代区间[Vmax_low,Vmax_up];并通过循环迭代法求解实际可达到的最大速度,若在最大可迭代次数内达到系统精度要求,则实际可达到的最大速度取当前求解出来的最大速度值,并跳转至步骤S6;若算法迭代次数达到最大可迭代次数仍不满足系统精度要求,至步骤S5。
S5,采用匀速补偿法,实际可达到的最大速度取当前区间下边界值,并在匀速阶段对位置进行补偿。
S6,解析求解时间参数Ti(i=1,2,...,11)值,并结束流程。
本发明的有益效果:本发明提出的非对称性四次曲线柔性加减速规划方法是有效的、可行的,在无复杂函数运算、参数控制灵活、计算稳定可靠的基础上,解决了传统S型曲线加加速度存在阶跃的问题,规划出的轨迹曲线与传统S型曲线加减速规划方法相比,具有更好的平滑性;在满足高端数控系统实时性要求的前提下,提高了数控加工的运动平稳性,为数控系统提供了一种可行实用的加减速规划方案。
附图说明
图1是非对称性四次曲线柔性加减速规划模型图。图中,ti(i=1,2,...,11)为各个运动阶段的转接点时刻;τi(i=1,2,...,11)为局部时间坐标,是以各个运动阶段的转接点时刻作为零点的时间,即τi=t-ti-1;Ti(i=1,2,...,11)为各个运动阶段的持续运行时间;(a)为位移规划模型图;(b)为速度规划模型图;(c)为加速度规划模型图;(d)为加加速度规划模型图。
图2是方案实现流程图。
图3是加工型面仿真图。
图4是非对称性四次曲线柔性加减速规划轨迹图,其中,(a)为速度规划轨迹图;(b)为加速度规划轨迹图;(c)为加加速度规划轨迹图。
图5是传统S型曲线加减速规划轨迹图,其中,(a)为速度规划轨迹图;(b)为加速度规划轨迹图;(c)为加加速度规划轨迹图。
图6是规划轨迹曲线放大对比图,其中,(a)为四次曲线加减速中速度轨迹曲线放大图;(b)为四次曲线加减速中加速度轨迹曲线放大图;(c)为四次曲线加减速中加加速度轨迹曲线放大图;(d)为传统S型曲线加减速中速度轨迹曲线放大图;(e)为传统S型曲线加减速中加速度轨迹曲线放大图;(f)为传统S型曲线加减速中加加速度轨迹曲线放大图。
图7实际加工效果图。
具体实施方式:
下面结合附图对本发明的具体实施方式做进一步说明。
1、非对称性四次曲线柔性加减速规划模型构建
构建的加减速规划模型包含加速运动阶段、匀速运动阶段和减速运动阶段;加加速度的变化规律为三角形状连续变化,向上逐次积分得到加速度、速度和位移变化规律,规划出的加加速度、加速度、速度和位移分别是连续变化的一次、二次、三次和四次曲线;加速阶段和减速阶段的参数值均可不同。
加减速规划的轨迹(轨迹是指加工过程中刀具的位移、速度、加速度或加加速度)是由系统给定参数确定的,系统给定参数分为机械参数和路径参数。机械参数包括机床运行的最大速度Vmax、加速运动阶段的最大加速度Aa和最大加加速度Ja、减速运动阶段的最大加速度Ad和最大加加速度Jd。路径参数包括给定路径长度L、起始速度Vs和终点速度Ve。定义所研究加减速规划的加加速度、加速度、速度和位移与时间参数t的函数表达式分别为j(t)、a(t)、v(t)和s(t),则构建的非对称性四次曲线柔性加减速规划模型如图1所示。完整的加减速过程被划分为11个运动阶段,每个运动阶段都有相对应的参数函数表达式。
(1)当t∈[0,t1)时,各参数函数表达式如式(1)所示。
(2)当t∈[t1,t2)时,各参数函数表达式如式(2)所示。
(3)当t∈[t2,t3)时,各参数函数表达式如式(3)所示。
(4)当t∈[t3,t4)时,各参数函数表达式如式(4)所示。
(5)当t∈[t4,t5)时,各参数函数表达式如式(5)所示。
(6)当t∈[t5,t6)时,各参数函数表达式如式(6)所示。
(7)当t∈[t6,t7)时,各参数函数表达式如式(7)所示。
(8)当t∈[t7,t8)时,各参数函数表达式如式(8)所示。
(9)当t∈[t8,t9)时,各参数函数表达式如式(9)所示。
(10)当t∈[t9,t10)时,各参数函数表达式如式(10)所示。
(11)当t∈[t10,t11)时,各参数函数表达式如式(11)所示。
当加减速规划模型确定后,轨迹曲线由系统给定参数唯一确定。根据系统给定参数求解出Ti(i=1,2,...,11)值,分别代入各运动段的位移函数s(t)、速度函数v(t)、加速度函数a(t)和加加速度函数j(t)表达式,便可确定t时刻轨迹状态,进行后续插补处理。
2、非对称性四次曲线柔性加减速规划实现方案
如图2所示,总体实现流程包括以下处理步骤:
S1,输入系统给定参数,包括:待加工路径长度L、起始速度Vs和终点速度Ve、机床运行最大速度Vmax、加速运动阶段的最大加速度Aa和最大加加速度Ja、减速运动阶段的最大加速度Ad和最大加加速度Jd。
S2,取可达到的最大速度Vmax_act=Vmax,校验此时加速阶段和减速阶段的最大加速度可达性,并分别求出加速阶段的位移长度Sa和减速阶段的位移长度Sd。
S3,判断待加工路径长度L与Sa+Sd的大小关系,从而校验机床运行最大速度Vmax可达性,若机床运行最大速度可达,则实际可达到的最大速度取机床运行最大速度,并跳转至步骤S6;若机床运行最大速度不可达,至步骤S4。
S4,设置精度误差δ和最大可迭代次数Count;确定迭代区间[Vmax_low,Vmax_up];并通过循环迭代法求解实际可达到的最大速度,若在最大可迭代次数内达到系统精度要求,则实际可达到的最大速度取当前求解出来的最大速度值,并跳转至步骤S6;若算法迭代次数达到最大可迭代次数仍不满足系统精度要求,至步骤S5。
S5,采用匀速补偿法,实际可达到的最大速度取当前区间下边界值,并在匀速阶段对位置进行补偿。
S6,解析求解时间参数Ti(i=1,2,...,11)值,并结束流程。
上述步骤S2中的计算过程具体方式为:
S2.1,取可达到的最大速度Vmax_act为机床运行最大速度Vmax,即令Vmax_act=Vmax。
S2.2,校验此时加速阶段最大加速度Aa可达性,并计算加速阶段的位移长度Sa。
①若(Vmax_act-Vs)≥2Aa 2/Ja,则说明加速阶段能达到最大加速度Aa,计算加速阶段各运动时间长度为:
②若(Vmax_act-Vs)<2Aa 2/Ja,则说明加速阶段不能达到最大加速度Aa,计算加速阶段各运动时间长度为:
此时加速阶段实际可达到的最大加速度为:
③基于步骤①、②所得加速阶段各运动时间长度,加速阶段的位移长度Sa为:
Sa=(Vs+Vmax_act)(4T1+T3)/2 (15)
S2.3,校验此时减速阶段最大加速度Ad可达性,并计算减速阶段的位移长度Sd。
①若(Vmax_act-Ve)≥2Ad 2/Jd,则说明减速阶段能达到最大加速度Ad,计算减速阶段各运动时间长度为:
②若(Vmax_act-Ve)<2Ad 2/Jd,则说明减速阶段不能达到最大加速度Ad,计算减速阶段各运动时间长度为:
此时减速阶段实际可达到的最大加速度为:
③基于步骤①、②所得减速阶段各运动时间长度,减速阶段的位移长度Sd为:
Sd=(Ve+Vmax_act)(4T7+T9)/2 (19)
上述步骤S3中的计算过程具体方式为:
S3.1,判断待加工路径长度L与Sa+Sd的大小关系
若待加工路径长度L≥Sa+Sd,则说明系统存在匀速运动段,此时实际可达到的最大速度Vmax_act即为机床运行最大速度Vmax,计算此时匀速段运动时间长度为:
并跳转至步骤S6。
若给定待加工路径长度L<Sa+Sd,则说明系统不存在匀速运动速段,此时实际可达到的最大速度Vmax_act小于机床运行最大速度Vmax,需重新计算实际可达到的最大速度Vmax_act,至步骤S4。
上述步骤S4中的计算过程具体方式为:
S4.1,根据系统加工精度要求,设置最大允许误差δ(δ>0);根据系统实时性要求,设置最大可迭代次数Count;设置累计迭代次数i=0。
S4.2,确定循环迭代区间,取区间上边界Vmax_up=Vmax,区间下边界Vmax_low=max(Vs,Ve),则实际可达到的最大速度Vmax_act∈[Vmax_low,Vmax_up]。
S4.3,取Vmax_act=(Vmax_up+Vmax_low)/2;由步骤S2.2和步骤S2.3分别计算出此时加速阶段的位移长度Sa和减速阶段的位移长度Sd;且累计迭代次数i自动加1。
S4.4,判断|L-Sa-Sd|与δ的关系。
若|L-Sa-Sd|≤δ,表示当前Vmax_act取值已满足系统精度要求,令T4=0,并跳转至步骤S6。
若|L-Sa-Sd|>δ,表示当前Vmax_act取值不满足系统精度要求。
S4.5,判断i与Count的关系。
若i≥Count,表示当前累计迭代次数已达到最大可迭代次数,为了保证算法可靠,耗时稳定,不能继续迭代,跳转至步骤S5。
若i<Count,表示当前累计迭代次数小于最大可迭代次数,可继续进行循环迭代,跳转至步骤S4.6。
S4.6,判断L与Sa+Sd的关系。
若L≥Sa+Sd,表示当前Vmax_act取值小于实际可达到的最大速度,此时令Vmax_low=Vmax_act,并跳转到步骤S4.3。
若L<Sa+Sd,表示当前Vmax_act取值大于实际可达到的最大速度,此时令Vmax_up=Vmax_act,并跳转到步骤S4.3。
上述步骤S5中的计算过程具体方式为:
S5.1,采用匀速补偿法,取此时实际可达到的最大速度Vmax_act=Vmax_low。
S5.2,由步骤S2.2和步骤S2.3分别计算出此时加速阶段的位移长度Sa和减速阶段的位移长度Sd,并在匀速阶段对位置进行补偿:
并跳转至步骤S6。
上述步骤S6中的计算过程具体方式为:
S6.1,根据确定的Vmax_act,其它时间参数Ti(i=1,2,...,11)值通过式(12)~式(19)计算得出,结束流程。
经过以上步骤,算法实现方案可根据系统给定参数,自动验证加速阶段和减速阶段最大加速度可达性,并判断匀速阶段是否存在;通过分类讨论和循环迭代相结合的方法,能够简化不同给定参数情况的讨论过程;采用匀速补偿法能够克服不同精度要求下算法耗时不稳定的问题;并且整个计算过程不包含三角函数等复杂运算;根据系统给定参数求解出Ti(i=1,2,...,1值,分别代入各运动段的位移函数s(t)、速度函数v(t)、加速度函数a(t)和加加速度函数j(t)表达式,便可确定t时刻轨迹状态,进行后续插补处理。
仿真验证:
加减速规划方法的有效性主要体现在其准确性和对所有可能情况的正确处理上。为了充分验证方法的有效性,选择某样条曲线型面作为实验对象,型面仿真如图3所示。该样条曲线由100多个小线段拟合而成,存在各种不同的路径信息,适用于对算法的有效性进行验证。设置最大速度为100mm/s2,加速运动阶段允许的最大加速度为1200mm/s2、最大加加速度为10000mm/s3,减速阶段允许的最大加速度为1000mm/s2、最大加加速度为10000mm/s3。
首先根据各拐点约束条件,确定各拐点速度,然后分别采用本发明提出的非对称性四次曲线柔性加减速规划方法和传统S型曲线加减速规划方法进行编程设计,生成的速度、加速度、加加速度轨迹曲线分别如图4和图5所示。
由图4可以看出,所提出的非对称性四次曲线柔性加减速规划方法能够对各种路径情况进行正确的处理,并且满足最大速度、最大加速度和最大加加速度的约束条件,保证不超过系统设置值,说明方法是有效的。
对图4和图5中某一段轨迹曲线放大进行对比,如图6所示。由图6可知,所提出的非对称性四次曲线柔性加减速规划方法相对于传统S型曲线加减速规划方法,规划出的速度曲线更加平滑,加速度曲线无拐点,加加速度曲线呈三角形线性连续变化,而传统S型加减速算法规划出的加加速度是突变的,容易导致机床系统产生振动和冲击。因此采用本文所提出的方法解决了传统S型加减速规划方法加加速度突变的问题,能够提高数控加工的运动平稳性,更好的满足机床动态性能。
实例加工:
为验证所提出算法的工程可行性,实验采用三轴数控雕刻平台进行实例加工验证,其中驱动器选用信捷DS5C-20P7-PTA伺服驱动器,实验过程选择位置控制模式,电机选用信捷MS5G-130STE伺服专用电机。实验平台使用的控制器为自主研发的数控系统,主处理器采用的是ARM Cortex-A8,所提出的加减速规划方法在此控制器中进行实现。
利用本发明提出的非对称性四次曲线柔性加减速规划方法进行实际编程设计,在三轴数控雕刻实验平台对某三维型面进行加工操作,实际加工效果如图7所示。算法可满足数控系统实际加工要求,具有实用性。
综上所述,本发明提出的非对称性四次曲线柔性加减速规划方法是有效的、可行的,在无复杂函数运算、参数控制灵活、计算稳定可靠的基础上,解决了传统S型曲线加加速度存在阶跃的问题,规划出的轨迹曲线与传统S型曲线加减速规划方法相比,具有更好的平滑性;在满足高端数控系统实时性要求的前提下,提高了数控加工的运动平稳性,为数控系统提供了一种可行实用的加减速规划方案。
Claims (3)
1.一种非对称性四次曲线柔性加减速规划方法,其特征在于,步骤如下:
步骤一、非对称性四次曲线柔性加减速规划模型构建
构建的加减速规划模型包含加速运动阶段、匀速运动阶段和减速运动阶段;加加速度的变化规律为三角形状连续变化,向上逐次积分得到加速度、速度和位移变化规律,规划出的加加速度、加速度、速度和位移分别是连续变化的一次、二次、三次和四次曲线;加速阶段和减速阶段的参数值均可不同,完整的加减速过程被划分为11个运动阶段,每个运动阶段都有相对应的参数函数表达式;
步骤二、非对称性四次曲线柔性加减速规划实现方案
总体实现流程包括以下处理步骤:
S1,输入系统给定参数,包括:待加工路径长度L、起始速度Vs和终点速度Ve、机床运行最大速度Vmax、加速运动阶段的最大加速度Aa和最大加加速度Ja、减速运动阶段的最大加速度Ad和最大加加速度Jd;定义所研究加减速规划的加加速度、加速度、速度和位移与时间参数t的函数表达式分别为j(t)、a(t)、v(t)和s(t);
所述11个运动阶段各自相对应的参数函数表达式为:
(1)当t∈[0,t1)时,各参数函数表达式如式(1)所示;
(2)当t∈[t1,t2)时,各参数函数表达式如式(2)所示;
(3)当t∈[t2,t3)时,各参数函数表达式如式(3)所示;
(4)当t∈[t3,t4)时,各参数函数表达式如式(4)所示;
(5)当t∈[t4,t5)时,各参数函数表达式如式(5)所示;
(6)当t∈[t5,t6)时,各参数函数表达式如式(6)所示;
(7)当t∈[t6,t7)时,各参数函数表达式如式(7)所示;
(8)当t∈[t7,t8)时,各参数函数表达式如式(8)所示;
(9)当t∈[t8,t9)时,各参数函数表达式如式(9)所示;
(10)当t∈[t9,t10)时,各参数函数表达式如式(10)所示;
(11)当t∈[t10,t11)时,各参数函数表达式如式(11)所示;
其中,t1~t11分别表示为各个运动阶段的转接点时刻;τ1~τ11分别表示局部时间坐标,即τi=t-ti-1;T1~T11分别表示各个运动阶段的持续运行时间;
当加减速规划模型确定后,轨迹曲线由系统给定参数唯一确定;根据系统给定参数求解出Ti值,i=1,2,...,11,分别代入各运动段的位移函数s(t)、速度函数v(t)、加速度函数a(t)和加加速度函数j(t)表达式,便可确定t时刻轨迹状态,进行后续插补处理;
S2,取可达到的最大速度Vmax_act=Vmax,校验此时加速阶段和减速阶段的最大加速度可达性,并分别求出加速阶段的位移长度Sa和减速阶段的位移长度Sd;
S2.1,取可达到的最大速度Vmax_act为机床运行最大速度Vmax,即令Vmax_act=Vmax;
S2.2,校验此时加速阶段最大加速度Aa可达性,并计算加速阶段的位移长度Sa;
①当(Vmax_act-Vs)≥2Aa 2/Ja时,则说明加速阶段能达到最大加速度Aa,计算加速阶段各运动时间长度为:
②当(Vmax_act-Vs)<2Aa 2/Ja时,则说明加速阶段不能达到最大加速度Aa,计算加速阶段各运动时间长度为:
此时加速阶段实际可达到的最大加速度为:
③基于步骤①、②所得加速阶段各运动时间长度,加速阶段的位移长度Sa为:
Sa=(Vs+Vmax_act)(4T1+T3)/2 (15)
S2.3,校验此时减速阶段最大加速度Ad可达性,并计算减速阶段的位移长度Sd;
④当(Vmax_act-Ve)≥2Ad 2/Jd时,则说明减速阶段能达到最大加速度Ad,计算减速阶段各运动时间长度为:
⑤当(Vmax_act-Ve)<2Ad 2/Jd时,则说明减速阶段不能达到最大加速度Ad,计算减速阶段各运动时间长度为:
此时减速阶段实际可达到的最大加速度为:
⑥基于步骤④、⑤所得减速阶段各运动时间长度,减速阶段的位移长度Sd为:
Sd=(Ve+Vmax_act)(4T7+T9)/2 (19);
S3,判断待加工路径长度L与Sa+Sd的大小关系,从而校验机床运行最大速度Vmax可达性,当机床运行最大速度可达时,则实际可达到的最大速度取机床运行最大速度,并跳转至步骤S6;当机床运行最大速度不可达时,至步骤S4;
S3.1,判断待加工路径长度L与Sa+Sd的大小关系
当待加工路径长度L≥Sa+Sd时,则说明系统存在匀速运动段,此时实际可达到的最大速度Vmax_act即为机床运行最大速度Vmax,计算此时匀速段运动时间长度为:
并跳转至步骤S6;
当给定待加工路径长度L<Sa+Sd时,则说明系统不存在匀速运动速段,此时实际可达到的最大速度Vmax_act小于机床运行最大速度Vmax,需重新计算实际可达到的最大速度Vmax_act,至步骤S4;
S4,设置精度误差δ和最大可迭代次数Count;确定迭代区间[Vmax_low,Vmax_up],其中Vmax_up为取区间上边界,Vmax_low为区间下边界;并通过循环迭代法求解实际可达到的最大速度,当在最大可迭代次数内达到系统精度要求时,则实际可达到的最大速度取当前求解出来的最大速度值,并跳转至步骤S6;当算法迭代次数达到最大可迭代次数仍不满足系统精度要求时,至步骤S5;
S5,采用匀速补偿法,实际可达到的最大速度取当前区间下边界值,并在匀速阶段对位置进行补偿;
S5.1,采用匀速补偿法,取此时实际可达到的最大速度Vmax_act=Vmax_low;
S5.2,由步骤S2.2和步骤S2.3分别计算出此时加速阶段的位移长度Sa和减速阶段的位移长度Sd,并在匀速阶段对位置进行补偿:
并跳转至步骤S6;
S6,解析求解时间参数Ti值,i=1,2,...,11,并结束流程。
2.根据权利要求1所述的一种非对称性四次曲线柔性加减速规划方法,其特征在于,
步骤S4中的计算过程具体方式为:
S4.1,根据系统加工精度要求,设置最大允许误差δ,δ>0;根据系统实时性要求,设置最大可迭代次数Count;设置累计迭代次数i=0;
S4.2,确定循环迭代区间,取区间上边界Vmax_up=Vmax,区间下边界Vmax_low=max(Vs,Ve),则实际可达到的最大速度Vmax_act∈[Vmax_low,Vmax_up];
S4.3,取Vmax_act=(Vmax_up+Vmax_low)/2;由步骤S2.2和步骤S2.3分别计算出此时加速阶段的位移长度Sa和减速阶段的位移长度Sd;且累计迭代次数i自动加1;
S4.4,判断|L-Sa-Sd|与δ的关系;
当|L-Sa-Sd|≤δ时,表示当前Vmax_act取值已满足系统精度要求,令T6=0,并跳转至步骤S6;
当|L-Sa-Sd|>δ时,表示当前Vmax_act取值不满足系统精度要求;
S4.5,判断i与Count的关系;
当i≥Count时,表示当前累计迭代次数已达到最大可迭代次数,为了保证算法可靠,耗时稳定,不能继续迭代,跳转至步骤S5;
当i<Count时,表示当前累计迭代次数小于最大可迭代次数,可继续进行循环迭代,跳转至步骤S4.6;
S4.6,判断L与Sa+Sd的关系;
当L≥Sa+Sd时,表示当前Vmax_act取值小于实际可达到的最大速度,此时令Vmax_low=Vmax_act,并跳转到步骤S4.3;
当L<Sa+Sd时,表示当前Vmax_act取值大于实际可达到的最大速度,此时令Vmax_up=Vmax_act,并跳转到步骤S4.3。
3.根据权利要求1所述的一种非对称性四次曲线柔性加减速规划方法,其特征在于,
步骤S6中的计算过程具体方式为:根据确定的Vmax_act,其它时间参数Ti值,i=1,2,...,11,通过式(12)~式(19)计算得出,结束流程。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010047726.6A CN111158318B (zh) | 2020-01-16 | 2020-01-16 | 一种非对称性四次曲线柔性加减速规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010047726.6A CN111158318B (zh) | 2020-01-16 | 2020-01-16 | 一种非对称性四次曲线柔性加减速规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111158318A CN111158318A (zh) | 2020-05-15 |
CN111158318B true CN111158318B (zh) | 2022-10-18 |
Family
ID=70563326
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010047726.6A Active CN111158318B (zh) | 2020-01-16 | 2020-01-16 | 一种非对称性四次曲线柔性加减速规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111158318B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112327954B (zh) * | 2020-11-14 | 2021-11-26 | 大连理工大学 | 非对称s型速度曲线控制的直线电机高精定位方法 |
CN112255913B (zh) * | 2020-11-14 | 2021-08-10 | 大连理工大学 | 一种用于飞行拍摄效率最优的柔性速度规划方法 |
CN113721555B (zh) * | 2021-08-27 | 2023-11-28 | 深圳数马电子技术有限公司 | 一种s型速度规划的目标速度的确定方法及装置 |
CN115657608B (zh) * | 2022-10-26 | 2023-09-08 | 英孚康(浙江)工业技术有限公司 | 基于Brent迭代法的全局非对称式S型柔性速度曲线规划方法 |
CN116700150B (zh) * | 2023-07-13 | 2024-01-30 | 哈尔滨工业大学 | 精密运动平台点位运动鲁棒轨迹规划系统及其规划方法 |
CN118170030B (zh) * | 2024-04-19 | 2024-08-16 | 英孚康(浙江)工业技术有限公司 | 变换系数自适应的运控系统退绕式旋转轴超柔性控制方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1465034A1 (de) * | 2003-04-04 | 2004-10-06 | Siemens Aktiengesellschaft | Steuerverfahren zur rückbegrenzten Geschwindigkeitsführung eines bewegbaren Maschinenelementes einer numerisch gesteuerten industriellen Bearbeitungsmaschine |
CN1971457A (zh) * | 2005-11-25 | 2007-05-30 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于数控机床的加减速控制方法 |
CN103728923A (zh) * | 2013-12-24 | 2014-04-16 | 嘉兴学院 | 一种高效高平稳的数控系统柔性加减速控制方法 |
CN106168790A (zh) * | 2016-02-29 | 2016-11-30 | 华南理工大学 | 一种在线改变目标速度和位置的s形加减速控制方法 |
CN106647637A (zh) * | 2015-11-03 | 2017-05-10 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于高质量加工的三角函数加减速控制方法 |
CN108306567A (zh) * | 2018-01-20 | 2018-07-20 | 江南大学 | 一种基于igso优化ekf的无传感器永磁同步电机速度估计方法 |
CN108319228A (zh) * | 2018-02-09 | 2018-07-24 | 苏州科技大学 | 一种数控系统轨迹规划中加减速控制方法 |
CN109240215A (zh) * | 2018-11-22 | 2019-01-18 | 山东易码智能科技股份有限公司 | 一种基于改进型s曲线加减速的pvt控制方法 |
CN109910013A (zh) * | 2019-04-04 | 2019-06-21 | 江南大学 | 一种scara机器人加加速度连续有界的ptp轨迹规划方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7437201B2 (en) * | 2003-01-14 | 2008-10-14 | Cullen Christopher P | Electric motor controller |
US7919940B2 (en) * | 2007-10-21 | 2011-04-05 | Ge Intelligent Platforms, Inc. | System and method for jerk limited trajectory planning for a path planner |
CN104008250B (zh) * | 2014-06-10 | 2016-01-20 | 广东工业大学 | 基于主频能量时域最优分布的非对称变加速度规划方法 |
-
2020
- 2020-01-16 CN CN202010047726.6A patent/CN111158318B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1465034A1 (de) * | 2003-04-04 | 2004-10-06 | Siemens Aktiengesellschaft | Steuerverfahren zur rückbegrenzten Geschwindigkeitsführung eines bewegbaren Maschinenelementes einer numerisch gesteuerten industriellen Bearbeitungsmaschine |
CN1971457A (zh) * | 2005-11-25 | 2007-05-30 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于数控机床的加减速控制方法 |
CN103728923A (zh) * | 2013-12-24 | 2014-04-16 | 嘉兴学院 | 一种高效高平稳的数控系统柔性加减速控制方法 |
CN106647637A (zh) * | 2015-11-03 | 2017-05-10 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于高质量加工的三角函数加减速控制方法 |
CN106168790A (zh) * | 2016-02-29 | 2016-11-30 | 华南理工大学 | 一种在线改变目标速度和位置的s形加减速控制方法 |
CN108306567A (zh) * | 2018-01-20 | 2018-07-20 | 江南大学 | 一种基于igso优化ekf的无传感器永磁同步电机速度估计方法 |
CN108319228A (zh) * | 2018-02-09 | 2018-07-24 | 苏州科技大学 | 一种数控系统轨迹规划中加减速控制方法 |
CN109240215A (zh) * | 2018-11-22 | 2019-01-18 | 山东易码智能科技股份有限公司 | 一种基于改进型s曲线加减速的pvt控制方法 |
CN109910013A (zh) * | 2019-04-04 | 2019-06-21 | 江南大学 | 一种scara机器人加加速度连续有界的ptp轨迹规划方法 |
Non-Patent Citations (3)
Title |
---|
全类型非对称七段式S型曲线加减速控制算法研究;潘海鸿等;《机械科学与技术》;20180524(第12期);全文 * |
多项式加减速控制方法研究;徐川等;《组合机床与自动化加工技术》;20090920(第09期);全文 * |
多项式加减速的NURBS插补控制方法;李英祺等;《组合机床与自动化加工技术》;20180520(第05期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN111158318A (zh) | 2020-05-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111158318B (zh) | 一种非对称性四次曲线柔性加减速规划方法 | |
CN106168790B (zh) | 一种在线改变目标速度和位置的s形加减速控制方法 | |
CN110865610B (zh) | 一种基于机床振动抑制的刀具轨迹插值和速度规划方法 | |
CN103064344B (zh) | 一种基于nurbs曲线插补的速度平滑控制方法 | |
CN104678899A (zh) | 曲线速度规划方法、装置及其数控加工路径数据处理方法 | |
CN108319228B (zh) | 一种数控系统轨迹规划中加减速控制方法 | |
CN101477354B (zh) | 位置s型指令产生方法 | |
CN112965443B (zh) | 一种裁床拐角轨迹跟踪高精度插值控制方法 | |
CN109683615B (zh) | 机器人连续运动的路径的速度前瞻方法及机器人控制器 | |
CN113635301B (zh) | 一种六轴机械臂运动速度控制改进方法 | |
CN109048091A (zh) | 激光切割速度规划方法、装置、存储介质及计算机设备 | |
Yuan et al. | Time-optimal interpolation for CNC machining along curved tool pathes with confined chord error | |
Lu et al. | An offline predictive feedrate scheduling method for parametric interpolation considering the constraints in trajectory and drive systems | |
JP2016179812A (ja) | 列車の移動を制御する方法およびシステム | |
CN113031621B (zh) | 一种桥式起重机安全避障路径规划方法及系统 | |
CN111722591B (zh) | 一种商标模切机高精度联动插补的方法 | |
CN113189938A (zh) | 一种连续加工路径的速度曲线规划方法 | |
CN118192435A (zh) | 采用圆弧映射和加减速算法的nurbs插补方法及系统 | |
Fang et al. | A high-precision non-uniform rational B-spline interpolator based on S-shaped feedrate scheduling | |
CN108829032B (zh) | 一种高精度控制的插补方法 | |
CN113495565A (zh) | 一种机器人及其轨迹规划和平滑过渡方法、系统及介质 | |
CN113741336A (zh) | 基于实时运动的笛卡尔空间轨迹规划方法和系统 | |
CN115480481A (zh) | 一种单轴高阶约束加减速控制方法 | |
CN103901815A (zh) | 数值控制装置和数值控制方法 | |
CN114019911B (zh) | 一种基于速度规划的曲线拟合方法 |
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 |