三次多项式S曲线加减速的加加速度递归计算限制方法技术

本发明专利技术涉及三次多项式S曲线加减速的加加速度递归计算限制方法，包括以下步骤：给出最大jerk限制数值，递归计算的最大次数N、每次a减小的百分比、当前程序段信息；判断当前是否满足递归计算终止条件：一是使用当前的a计算得到的jerk数值小于或等于最大jerk限制数值，二是递归计算次数到达N次。满足条件时递归返回；不满足递归计算终止条件时按照每次a减小的百分比设定方式减小a，进入下一次递归计算。本发明专利技术递归计算过程简便。加加速度jerk的计算方法相同，使用递归调用传递不同的a等参数数值即可计算出新的jerk数值，调用过程简便。计算过程中加速度a的数值逐次减小，递归计算停止时可取得满足条件的极大数值，使加减速过程即满足jerk约束。

【技术实现步骤摘要】
三次多项式S曲线加减速的加加速度递归计算限制方法
本专利技术涉及三次多项式S曲线加减速的加加速度递归计算限制方法，属于数控

技术介绍
数控技术中使用S曲线加减速方式能够有效地减小振动。三次多项式S曲线加减速的速度曲线为三次，加速度为二次曲线，加加速度为直线形式，能够保证加加速度没有阶跃。但三次多项式S曲线加减速方式的特征中有其固有的局限，即加速度与加加速度数值从0增加，在加速或减速的中间达到最大值，在加速与减速的末尾再减小到0，如图1a～图1f所示。本文中加速度使用a表示，加加速度使用jerk表示。图1a～图1f中，加速或减速的整体时间越短，a变化率就越大，jerk的最大值也会越大。如果jerk的最大值太大，则加减速过程同样产生振动，与直线加减速没有区别。因此改变a的变化率太大的加减速过程，减小jerk的最大值可有效减小加减速过程的振动，使三次多项式S曲线加减速方式真正起到降低振动的作用。对于一个固定长度的程序段来说，三次多项式S曲线加减速减小jerk最大值的方法是减小a最大值的数值，使加速或减速的时间延长，但a减小的数值与jerk最大值减小的数值并不是线性关系，因此不能使用固定的公式一步计算得到。
技术实现思路
有鉴于此，本专利技术的目的是提供三次多项式S曲线加减速的加加速度递归计算限制方法，以给出一种使用配置的最大jerk来限制a最大值的方法，从而控制加加速度jerk，解决现有技术中存在的三次多项式S曲线加减速过程无法控制加加速度jerk的问题。为达到上述目的，本专利技术采用如下技术方案：三次多项式S曲线加减速的加加速度递归计算限制方法，包括以下步骤：(1)设定最大加加速度jerk限制数值，递归计算的最大次数N、每次加速度a减小的百分比、当前程序段信息；(2)确定速度曲线形式，在选择的速度曲线中加速度变化时间最短的阶段计算最大加加速度jerk；判断当前是否满足递归计算终止条件，满足则结束递归计算，否则执行下一步；(3)按照每次a减小的百分比设定方式减小a，返回步骤(2)。所述当前程序段信息包括程序段长度、加速度a的初始数值、起始速度vStart、末尾速度vEnd、最大速度vM。所述每次a减小的百分比根据需要进行设定。每次a减小的百分比可变：选择多个阶段，每个阶段包括多次递归并且各阶段分别设定a减小的百分比。所述当前程序段信息由程序段在加减速过程中实时信息设置：程序段长度为当前程序段剩余的未移动的长度，a的初始数值为当前程序段构造时设定的加速度的数值，起始速度vStart与末尾速度vEnd为当前程序段通过速度规划给出的速度，最大速度vM为编程进给率与进给率倍率的乘积。所述确定速度曲线形式具体为根据当前程序段信息判断满足下列哪种形式：第1种形式，只有加速阶段的判定条件是：vEnd2-vStart2＝4/3*a*L第2种形式，有匀速阶段的判定条件是：(3*(vEnd2+vStart2)-4*a*L)/6＞vM2第3种形式，有加速与减速阶段，但没有匀速阶段的判定条件是：vEnd2-vStart2＜4/3*a*L并且(3*(vEnd2+vStart2)-4*a*L)/6＜＝vM2判定条件中a为当前递归计算中当前递归次数按照a减小的百分比减小之后的数值，L为当前程序段长度；vStart为起始速度，vEnd为末尾速度，vM为最大速度。所述在选择的速度曲线中加速度变化时间最短的阶段计算最大加加速度jerk，包括以下步骤：当速度曲线为第一种形式时，选取vStart到vEnd的加速阶段进行jerk约束计算：jerk＝4/3*a2/(vEnd-vStart)；当速度曲线为第二种形式时，选取vM到vEnd的减速阶段进行jerk约束计算，jerk＝4/3*a2/(vM-vEnd)；当速度曲线为第三种形式时，选取vM’到vEnd的减速阶段进行jerk约束计算，jerk＝4/3*a2/(vM'-vEnd)，其中，vStart为起始速度，vEnd为末尾速度，vM为最大速度。所述判断当前是否满足递归计算终止条件：一是使用当前的a计算得到的jerk数值小于或等于最大jerk限制数值，二是递归计算次数到达N次；满足至少一个条件时结束递归计算。根据a的变化速度曲线改变，数控系统根据速度曲线进行加减速控制。本专利技术具有以下有益效果及优点：一是递归计算过程简便。加加速度jerk的计算方法相同，使用递归调用传递不同的a等参数数值即可计算出新的jerk数值，调用过程简便。二是能有效利用系统配置的加速度。计算过程中加速度a的数值逐次减小，递归计算停止时可取得满足条件的极大数值，使加减速过程即满足jerk约束，又不至于太慢。附图说明图1a是三次多项式S曲线加减速的加速过程的速度曲线；图1b是三次多项式S曲线加减速的减速过程的速度曲线；图1c是三次多项式S曲线加减速的加速过程的加速度曲线；图1d是三次多项式S曲线加减速的减速过程的加速度曲线；图1e是三次多项式S曲线加减速的加速过程的加加速度曲线；图1f是三次多项式S曲线加减速的减速过程的加加速度曲线；图2是本专利技术方法的整体流程图；图3a是三次多项式S曲线加减速的速度曲线形式一；图3b是三次多项式S曲线加减速的速度曲线形式二；图3c是三次多项式S曲线加减速的速度曲线形式三。图4a是三次多项式S曲线加减速的速度曲线形式四；图4b是三次多项式S曲线加减速的速度曲线形式五；图4c是三次多项式S曲线加减速的速度曲线形式六。图4d是三次多项式S曲线加减速的速度曲线形式七。具体实施方式下面结合附图对本专利技术方法作进一步详细说明。如图2所示，本专利技术方法包括以下步骤：(1)给出最大jerk限制数值，递归计算的最大次数N、每次a减小的百分比、当前程序段信息(包括程序段长度、a的初始数值、起始速度vStart、末尾速度vEnd、最大速度vM。)(2)判断当前是否满足递归计算终止条件：一是使用当前的a计算得到的jerk数值小于或等于最大jerk限制数值，二是递归计算次数到达N次。满足条件时递归返回(3)不满足递归计算终止条件时按照每次a减小的百分比设定方式减小a，进入下一次递归计算本专利技术方法中步骤(1)给出最大jerk限制数值，递归计算的最大次数N、每次a减小的百分比、当前程序段信息(包括程序段长度、a的初始数值、起始速度vStart、末尾速度vEnd、最大速度vM)具体过程如下：最大jerk限制数值使用配置的数值；递归计算的最大次数N根据需要进行设定，本专利技术中设定为15；每次a减小的百分比根据需要进行设定，本专利技术中前10次每次减小10％，后5次每次减小2％，到达第15次时还未满足最大jerk限制，将a设定为本文档来自技高网...

【技术保护点】
1.三次多项式S曲线加减速的加加速度递归计算限制方法，其特征在于包括以下步骤：/n(1)设定最大加加速度jerk限制数值，递归计算的最大次数N、每次加速度a减小的百分比、当前程序段信息；/n(2)确定速度曲线形式，在选择的速度曲线中加速度变化时间最短的阶段计算最大加加速度jerk；判断当前是否满足递归计算终止条件，满足则结束递归计算，否则执行下一步；/n(3)按照每次a减小的百分比设定方式减小a，返回步骤(2)。/n

【技术特征摘要】
1.三次多项式S曲线加减速的加加速度递归计算限制方法，其特征在于包括以下步骤：
(1)设定最大加加速度jerk限制数值，递归计算的最大次数N、每次加速度a减小的百分比、当前程序段信息；
(2)确定速度曲线形式，在选择的速度曲线中加速度变化时间最短的阶段计算最大加加速度jerk；判断当前是否满足递归计算终止条件，满足则结束递归计算，否则执行下一步；
(3)按照每次a减小的百分比设定方式减小a，返回步骤(2)。


2.根据权利要求1所述的三次多项式S曲线加减速的加加速度递归计算限制方法，其特征在于所述当前程序段信息包括程序段长度、加速度a的初始数值、起始速度vStart、末尾速度vEnd、最大速度vM。


3.根据权利要求1所述的三次多项式S曲线加减速的加加速度递归计算限制方法，其特征在于，所述每次a减小的百分比根据需要进行设定。


4.根据权利要求1或3所述的三次多项式S曲线加减速的加加速度递归计算限制方法，其特征在于，每次a减小的百分比可变：选择多个阶段，每个阶段包括多次递归并且各阶段分别设定a减小的百分比。


5.根据权利要求1所述的三次多项式S曲线加减速的加加速度递归计算限制方法，其特征在于，所述当前程序段信息由程序段在加减速过程中实时信息设置：程序段长度为当前程序段剩余的未移动的长度，a的初始数值为当前程序段构造时设定的加速度的数值，起始速度vStart与末尾速度vEnd为当前程序段通过速度规划给出的速度，最大速度vM为编程进给率与进给率倍率的乘积。


6.根据权利要求1所述的三次多项式S曲线加减速的加加速度递归计算限制方法，其特征在于，所述确定速度曲线形式具体为根据当前程序段信息判断满足下列哪种形式：
第1种形式，只有加速阶段的判定条件是：
vEnd2-v...

【专利技术属性】
技术研发人员：韩文业，田野，李博，秦悦，黄艳，
申请(专利权)人：沈阳高精数控智能技术股份有限公司，
类型：发明
国别省市：辽宁;21