基于梯形求解的任意位移速度下的S曲线加减速规划方法

摘要

本发明公开了一种基于梯形求解的任意位移速度下的S曲线加减速规划方法，它解决了现有技术中常规S曲线法只能通过分段规划速度和时间、影响加工效率的问题，能够保证数控系统可以在任意位移和速度下进行加减速规划且速度不受零值点的影响果；其技术方案为：首先获取运动位移、初速度和末速度，根据不同的运动形式选取规划方法：初速度、末速度和位移均为正，采用常规S曲线加减速法进行速度规划；初速度、末速度中至少一个为负，位移为正或负，采用梯形求解法，即利用S曲线的对称性，在速度时间曲线图形中构建直角梯形；位移为负、初速度和末速度同为负或正，采用常规S曲线加减速算法或梯形求解法进行速度规划，规划完成后的速度、位移取反。

权利要求

1.基于梯形求解的任意位移速度下的S曲线加减速规划方法，其特征在于，首先获取运动位移、初速度和末速度，其次根据不同的运动形式选取规划方法，具体如下：(1)初速度、末速度和位移均为正值，采用常规S曲线加减速法进行速度规划；

(2)初速度、末速度中至少一个为负值，位移为正值或负值，采用梯形求解法，即利用S曲线的对称性，在速度时间曲线图形中构建直角梯形，求解总位移S’以对各时间段速度进行规划；

(3)位移为负值、初速度和末速度同为负值或正值，采用常规S曲线加减速算法或梯形求解法进行速度规划，规划完成后的速度、位移取反；

其特征在于，以速度最大值点vmax至时间轴的垂线为界分为左侧的加速段和右侧的减速段，通过分别计算加速段位移S1、减速段位移S2得到总位移S’，并判断总位移S’与目标位置S的关系；

所述梯形求解法包括以下步骤：

1)获取S曲线加速段或减速段与时间轴的交点C关于其中点N的对称点B，从S曲线速度最大值点向时间轴作垂线lo，其垂点记为点D，从点B向lo作垂线，二者的交点记为点A，依次连接点A、B、C、D得到直角梯形；

2)分别计算直角梯形的三条边长度SAB、SCD、HAD，并计算直角梯形面积，即为加速度段或减速段的规划位移；

当末速度为负值且位移为正值时，减速段采用梯形求解法，其中，点C位于时间区间[t6，t7]内；其中，

当v7≥0时，SCD＝t5+t6+t7zero，t7zero表示C点在t7段的长度；

当v7＜0，v6≥0时，SCD＝t5+t6zero，t6zero表示C点在t6段的长度；

B点位于时间区间[t5，t6]内，当v6＝0时，SAB＝ttop；

当v6＞0时，SAB＝2*tmid‑(t5+t6+t7zero)，tmid表示中间点N的时间；

当C点在t6段，B点在t6段，SAB＝2*tmid‑(t5+t6zero)；

根据B点所在时间段的时间ttop及S曲线加减速计算公式得到vB，且HAD＝vB；

减速段位移表示为：S2＝0.5*(SCD+SAB)*HAD；

当初速度为正值且位移为正值时，加速段采用常规S曲线加减速法；当初速度为负值且位移为正值时，加速段采用梯形求解法。

2.根据权利要求1所述的基于梯形求解的任意位移速度下的S曲线加减速规划方法，其特征在于，所述常规S曲线加减速法，通过增大或减小最大速度vmax，计算得到位移S',并与目标位移S比较，最终确定各加减速段时间t1～t7。

说明书

基于梯形求解的任意位移速度下的S曲线加减速规划方法

技术领域

[0001] 本发明涉及数控系统运动控制领域，尤其涉及一种基于梯形求解的任意位移速度下的S曲线加减速规划方法。

背景技术

[0002] 加减速控制是数控系统运动控制领域的关键技术。目前较为常见的加减速方法有直线加减速、三角函数加减速、指数加减速、S曲线加减速等，前三种加减速方法在始末位置
处会出现加速度突变的情况，为避免加工中因加速度突变造成的振动和噪声，在数控运动
控制中，S曲线加减速使用最多。

[0003] 常规S曲线加减速算法是通过给定的位移、始末速度和运动参数限制，使用迭代和不等式求解，求解各段的时间、各时间节点的位移、速度、加速度。这种方法仅适用于始末速
度和位移均为正的情况，当数控系统加工中出现位移和始末速度为负值的情况时，只能通
过分段规划其速度和时间，且当速度接近零值时因为加速度连续约束导致速度变化缓慢，
影响加工效率，所以常规S曲线加减速不能完全保证在数控加工中的使用要求。

[0004] 综上所述，针对现有技术如何保证数控系统任意情况下的速度规划且快速通过零值点，尚缺乏有效的解决方案。

发明内容

[0005] 为了克服现有技术的不足，本发明提供了一种基于梯形求解的任意位移速度下的S曲线加减速规划方法，通过求解直角梯形的面积求出当前阶段的运行位移，从而计算出每
一加减速段的时间和各时间节点速度，具有能够保证数控系统可以在任意位移和速度下进
行加减速规划并且速度不受零值点的影响的效果。

[0006] 本发明采用下述技术方案：

[0007] 基于梯形求解的任意位移速度下的S曲线加减速规划方法，首先获取运动位移、初速度和末速度，其次根据不同的运动形式选取规划方法，具体如下：

[0008] (1)初速度、末速度和位移均为正值，采用常规S曲线加减速法进行速度规划；

[0009] (2)初速度、末速度中至少一个为负值，位移为正值或负值，采用梯形求解法，即利用S曲线的对称性，在速度时间曲线图形中构建直角梯形，求解总位移S’以对各时间段速度
进行规划；

[0010] (3)位移为负值、初速度和末速度同为负值或正值，采用常规S曲线加减速算法或梯形求解法进行速度规划，规划完成后的速度、位移取反。

[0011] 进一步的，以速度最大值点vmax至时间轴的垂线为界分为左侧的加速段和右侧的减速段，通过分别计算加速段位移S1、减速段位移S2得到总位移S’，并判断总位移S’与目标
位置S的关系。

[0012] 进一步的，所述梯形求解法包括以下步骤：

[0013] 1)获取S曲线加速段或减速段与时间轴的交点C关于其中点N的对称点B，从S曲线速度最大值点向时间轴作垂线lo，其垂点记为点D，从点B向lo作垂线，二者的交点记为点A，
依次连接点A、B、C、D得到直角梯形；

[0014] 2)分别计算直角梯形的三条边长度SAB、SCD、HAD，并计算直角梯形面积，即为加速度段或减速段的规划位移。

[0015] 进一步的，当末速度为负值且位移为正值时，减速段采用梯形求解法，其中，点C位于时间区间[t6，t7]内；其中，

[0016] 当v7≥0时，SCD＝t5+t6+t7zero，t7zero表示C点在t7段的长度；

[0017] 当v7＜0，v6≥0时，SCD＝t5+t6zero，t6zero表示C点在t6段的长度。

[0018] 进一步的，B点位于时间区间[t5，t6]内，

[0019] 当v6＝0时，SAB＝ttop；

[0020] 当v6>0时，SAB＝2*tmid‑(t5+t6+t7zero)，tmid表示中间点N的时间；

[0021] 当C点在t6段，B点在t6段，SAB＝2*tmid‑(t5+t6zero)。

[0022] 进一步的，根据B点所在时间段的时间ttop及S曲线加减速计算公式得到vB，且HAD＝vB。

[0023] 进一步的，减速段位移表示为：S2＝0.5*(SCD+SAB)*HAD。

[0024] 进一步的，当初速度为正值且位移为正值时，加速段采用常规S曲线加减速法；当初速度为负值且位移为正值时，加速段采用梯形求解法。

[0025] 进一步的，所述常规S曲线加减速法，通过增大或减小最大速度vmax，计算得到位移S',并与目标位移S比较，最终确定各加减速段时间t1～t7。

[0026] 与现有技术相比，本发明的有益效果是：

[0027] (1)本发明的梯形求解法不需要分段进行S曲线加减速规划，且跨过零点时不需要考虑加速度限制，运行时间短，可以很好的满足数控系统的速度规划要求；

[0028] (2)本发明可以在运动参数限制范围内的任意方向始末速度和位移进行速度规划，运动速度快且不受零值点的影响，提高了加工效率。

附图说明

[0029] 构成本申请的一部分的说明书附图用来提供对本申请的进一步理解，本申请的示意性实施例及其说明用于解释本申请，并不构成对本申请的不当限定。

[0030] 图1为本发明的任意位移、始末速度的加减速规划流程图；

[0031] 图2为S曲线加减速示意图；

[0032] 图3为本发明第③种情况常规S曲线速度规划示意图；

[0033] 图4为本发明第③种情况梯形求解S曲线速度规划示意图；

[0034] 图5为本发明的梯形求解S曲线位移流程图；

[0035] 图6为本发明第⑦种情况常规S曲线速度规划示意图；

[0036] 图7为本发明第⑦种情况梯形求解S曲线速度规划示意图；

[0037] 图8为本发明基于数控机床的第③种情况梯形求解S曲线规划位移曲线图；

[0038] 图9为本发明基于数控机床的第③种情况梯形求解S曲线规划速度曲线图；

[0039] 图10为本发明基于数控机床的第③种情况常规S曲线规划位移曲线图；

[0040] 图11为本发明基于数控机床的第③种情况常规S曲线规划速度曲线图；

[0041] 图12为本发明基于数控机床的第⑦种情况梯形求解S曲线规划位移曲线图；

[0042] 图13为本发明基于数控机床的第⑦种情况梯形求解S曲线规划速度曲线图；

[0043] 图14为本发明基于数控机床的第⑦种情况常规S曲线规划位移曲线图；

[0044] 图15为本发明基于数控机床的第⑦种情况常规S曲线规划速度曲线图。

具体实施方式

[0045] 应该指出，以下详细说明都是例示性的，旨在对本申请提供进一步的说明。除非另有指明，本文使用的所有技术和科学术语具有与本申请所属技术领域的普通技术人员通常
理解的相同含义。

[0046] 需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本申请的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式
也意图包括复数形式，此外，还应当理解的是，当在本说明书中使用术语“包含”和/或“包
括”时，其指明存在特征、步骤、操作、器件、组件和/或它们的组合。

[0047] 正如背景技术所介绍的，现有技术中存在常规S曲线法只能通过分段规划速度和时间、影响加工效率的不足，为了解决如上的技术问题，本申请提出了一种基于梯形求解的
任意位移速度下的S曲线加减速规划方法。

[0048] 本申请的一种典型的实施方式中，提供了一种基于梯形求解的任意位移速度下的S曲线加减速规划方法，总体分为以下三种情况：

[0049] 一、当初速度、末速度和位移均为正值时，采用常规S曲线加减速法进行速度规划；

[0050] 二、当初速度、末速度中出现负值，位移为正值或负值时，采用梯形求解法，即利用S曲线的对称性，在速度时间曲线图形中构建直角梯形，求解总位移S’以对各时间段速度进
行规划；

[0051] 三、当位移为负值、初速度和末速度同为负值或正值时，采用常规S曲线加减速算法或梯形求解法进行速度规划，规划完成后的速度、位移取反。

[0052] 具体分为八种情况，如表1所示：

[0053] 表1数控系统中的位移、速度

[0054]

[0055]

[0056] 1、当位移为正、初速度为正、末速度为正时：

[0057] (1)常规S曲线加减速法规划

[0058] 如图2所示，常规S曲线加减速整个过程分为三大段：加速段、匀速段和减速段。加速段分为加加速段、匀加速段和减加速段，减速段分为加减速段、匀减速段和减减速段。根
据位移的长短和始末速度的大小，在实际运用中S曲线加减速可能不包含匀速段、匀加速段
和匀减速段。

[0059] 常规S曲线加减速规划时，通过增大或减小最大速度vmax，计算得到位移S',与目标位移S比较最终确定各加减速段时间t1～t7，具体规划步骤如下：

[0060] ①、令匀速段时间t4＝0，以最大运动限制参数进行完整三角形加减速，求得当前位移S'，若S'S，转到步骤②。

[0061] ②、令vs＝max(vs,ve)，ve＝min(vs,ve)进行五段加减速规划，求得当前位移S'，若S'

[0062]

[0063] 其中，amax表示最大加速度，jmax表示最大加加速度；

[0064] 确定各加减速段时间t1～t7；若S'>S，转到步骤③。

[0065] ③、令vs＝min(vs,ve)，ve＝max(vs,ve)进行四段加减速规划，求得当前位移S'，若S'S，转到步骤④。

[0066] ④、由vs加速到ve求解位移S'，若S'S，减小Vmax迭代区间，进行四段加减速规划，求解Vmax，确定各加减速段时间t1～t7；

[0067] 由上述步骤知，只要求得当前步骤下规划的位移S就可以按照常规S曲线加减速规划出各段时间和各时间节点的速度值。

[0068] 使用常规S曲线加减速算法计算上述情况时，要分段进行规划。因为始末加速度限制，在速度越过零点的过程中速度进行缓慢变化，整个速度规划过程如图3所示，当t＝t7
时，速度减速至0，加速度为0，此时速度还没有达到指定速度，需要反向加速时间t*，从图中
可以看出，在t7速度零值点的附近要受加速度连续的限制，速度变化率降低，时间增长至
t*，不能很好地满足加工要求，作业效率低。

[0069] (2)梯形求解法S曲线加减速规划

[0070] 梯形求解法规划S曲线速度示意图如图4所示，0～t3段的位移按照常规S曲线加减速计算方法得到S1，由于C点到t7段的位移为负，所以t3～t7段的位移无法按照常规S曲线
计算公式计算。

[0071] 由S曲线的对称性得知，N点为整个减速段的中点，B点和C点关于中点N对称，所以，由A、B和Vmax围成的面积和C、t7和ve围成的面积相等，即ABCD梯形的面积就是右半边S曲线
的面积S2，梯形求解法的流程图如图5所示，计算步骤如下：

[0072] ①、计算CD段长度SCD：

[0073] C点的时间区间为[t6,t7]，当v7≥0时，C点在t7段，令

[0074] v6‑amax*t+0.5*jmax*t*t＝0

[0075] 求得C点在t7段的长度t7zero，CD段长度为：SCD＝t5+t6+t7zero；

[0076] 当v7<0,v6>＝0时，C点在t6段，令

[0077] v5‑amax*t＝0

[0078] 求得C点在t6段的长度t6zero，CD段长度为：SCD＝t5+t6zero。

[0079] ②、计算AB段长度SAB：

[0080] B、C点关于中点N对称，B点的时间区间为[t5,t6]。

[0081] 当v6＝0时，没有匀减速段，中点N的时间tmid＝t5，C点在t7段，B点在t5段，求得B点在t5段的长度ttop＝t5‑t7zero，AB段长度：SAB＝ttop；

[0082] 当v6>0时，中点N的时间 如果C在t7段，B点在t5段，求得AB段长度：SAB＝2*tmid‑(t5+t6+t7zero)；

[0083] 如果C点在t6段，B点在t6段，求得AB段长度：SAB＝2*tmid‑(t5+t6zero)。

[0084] ③、计算AD段长度，求得B点所在的时间段和所在时间段的时间ttop，代入S曲线加减速计算公式得到B点的速度值，就是AD的长度：HAD＝vB。

[0085] S曲线规划总的位移为S'＝S1+S2，并判断S'和目标位移S的关系，可以规划出各段时间t1～t7和各时间节点的速度值v1～v7。

[0086] 由图3和图4可以看出，使用梯形求解法不需要分段进行S曲线加减速规划，且跨过零点时不需要考虑加速度限制，运行时间短，可以很好的满足数控系统的速度规划要求。

[0087] 2、当位移为正，初速度为负，末速度为负时：

[0088] 常规S曲线加减速规划这种情况时，需要分成三段进行规划，首先vs反向减速至0，然后做正向加减速，加减速过程中末速度降至0时，再反向加速至ve，整个加减速规划示意
图如图6所示。

[0089] 从0至t0时刻，速度由vs反向减速至0；从t7至t*时刻，速度由0反向加速至ve；从图中可以看出，在t0和t7速度零值点的附近要受加速度连续的限制，速度变化率降低，作业效
率低，不能很好地满足加工要求。

[0090] 使用梯形求解法进行S曲线加减速规划，vs、ve均为负值，两边计算位移时均要构建直角梯形求解，规划示意图如图7所示。

[0091] 求得S曲线位移S＝SABCD+SEFCG，从而求解出各加减速段时间和各时间节点的速度值。

[0092] 由图6和图7可以看出，使用梯形求解位移进行S曲线加减速规划时，不需要进行分段规划，且跨过零点值不需要考虑加速度限制，大大减少了运动时间，提高加工效率。

[0093] 本申请的另一种实施方式中，以数控机床为例进行S曲线加减速规划验证，其运动2
参数限制为：最大速度限制为400mm/s，最大加速度限制为1000mm/s ，最大加加速度限制为
3
10000mm/s。

[0094] 情况③位移为正，初速度为正，末速度为负：给定位移为35mm，初速度为50mm/s，末速度为‑30mm/s。

[0095] 情况⑦位移为正，初速度为负，末速度为负：给定位移为50mm，初速度为‑20mm/s，末速度为‑10mm/s。

[0096] 图8、图9分别为情况③中基于梯形求解的S曲线加减速规划位移、速度曲线图，图10、图11分别为情况③中常规S曲线加减速规划位移、速度曲线图；图12、图13分别为情况⑦
中基于梯形求解的S曲线加减速规划位移、速度曲线图，图14、图15分别为情况⑦中常规S曲
线加减速规划位移、速度曲线图。

[0097] 通过对比可以看出，本申请的基于梯形求解的S曲线加减速规划方法运行时间短，在零值点处不受加速度影响，效率高，完整地证明了其可行性。

[0098] 以上所述仅为本申请的优选实施例而已，并不用于限制本申请，对于本领域的技术人员来说，本申请可以有各种更改和变化。凡在本申请的精神和原则之内，所作的任何修
改、等同替换、改进等，均应包含在本申请的保护范围之内。