CN106444635A - 一种运动控制系统的非对称s曲线加减速控制方法和装置 - Google Patents

一种运动控制系统的非对称s曲线加减速控制方法和装置 Download PDF

Info

Publication number
CN106444635A
CN106444635A CN201510472799.9A CN201510472799A CN106444635A CN 106444635 A CN106444635 A CN 106444635A CN 201510472799 A CN201510472799 A CN 201510472799A CN 106444635 A CN106444635 A CN 106444635A
Authority
CN
China
Prior art keywords
time
max
accelerating sections
subtract
accelerating
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
Application number
CN201510472799.9A
Other languages
English (en)
Other versions
CN106444635B (zh
Inventor
谭华卿
王立松
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Leadshine Technology Co Ltd
Original Assignee
Leadshine Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Leadshine Technology Co Ltd filed Critical Leadshine Technology Co Ltd
Priority to CN201510472799.9A priority Critical patent/CN106444635B/zh
Publication of CN106444635A publication Critical patent/CN106444635A/zh
Application granted granted Critical
Publication of CN106444635B publication Critical patent/CN106444635B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/41Numerical 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

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)
  • Regulating Braking Force (AREA)

Abstract

本发明公开一种运动控制系统的非对称S曲线加减速控制方法和装置,通过对加速度和减速度为非对称的S曲线中,分开控制加速过程和减速过程,增强S曲线加减速控制方法的灵活性;并根据已知参数,判断加速度曲线类型再计算,从而避开迭代法等复杂的S曲线加减速计算,降低计算机消耗,提高运算效率;以及引入基于动力学限制的圆整方法,补偿S曲线加减速控制离散化处理过程中的精度损失。

Description

一种运动控制系统的非对称S曲线加减速控制方法和装置
技术领域
本发明涉及运动控制系统的加减速控制技术,特别是适用于通用运动控制器、数控系统和机器人控制系统非对称S曲线加减速控制技术。
背景技术
加减速控制技术是运动控制系统插补技术中的一项极其重要的技术,是运动控制系统实现高速度高精度加工的关键技术。在运动控制系统中,为保证电动机在启动和停止时不产生冲击、失步和振荡,输入到驱动器的脉冲或者电压必须进行加减速控制。在电动机启动时,输入到电动机驱动器的脉冲频率或者电压必须逐渐增大,而当电动机减速停止时,输入到电动机驱动器的脉冲频率或者电压必须逐渐减小。
目前,经常被使用的加减速控制方法是梯形加减速控制方法和S形加减速控制方法。梯形加减速控制方法实现简单,但是由于梯形加减速控制方法加速度不连续,在电机启动和加减速结束时加速度均存在突变,因此会产生很大的冲击,影响零件加工质量和机械设备的使用寿命。为使得加速度连续,常用的加减速控制方法是S形加减速控制方法。
但是目前的非对称S形加减速控制方法存在以下三方面缺陷:(1)非对称只是起始速度和停止速度不相等,但是加速度和减速度仍然是相等的。加速度和减速度相等意味着加速过程和减速过程快慢不能分开控制,降低S形加减速控制方法灵活性;(2)加减速计算需要使用迭代法或二分法等数值分析方法,计算过程复杂,加大计算机消耗和降低计算效率;(3)由于计算机实现加减速必须把连续的数学公式离散化处理,因此必须把公式最后计算得到的时间量转化为插补周期的整数倍。但是对于起始速度和停止速度非对称、加速度和减速度也是非对称的S曲线,把时间量转化为插补周期的整数倍,目前的文献和技术资料还没有公开的转化方法。
发明内容
本发明提供一种运动控制系统的非对称S曲线加减速控制方法和装置,解决了加速度和减速度也是非对称时分别控制加速和减速的过程,并补偿S曲线加减速控制离散化处理过程中的精度损失的技术问题。
为解决上述技术问题,本发明提供了一种运动控制系统的非对称S曲线加减速控制方法,包括以下处理过程:接收非对称S曲线的输入参数,所述输入参数至少包括:起始速度Vs、末速度Ve、最大理论速度Vm、S段时间Ts、加速时间Tacc、减速时间Tdec和路径长度S;
根据所述输入参数计算所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax
根据所述输入参数以及所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax计算所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va
将所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7分别进行圆整处理,并根据圆整后的参数进行运动参数调整控制。
优选的,所述根据所述输入参数计算所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax具体包括:
所述的计算加速段最大加速度Amax为:
所述的计算减速段最大减速度Dmax为:
本发明还提供了微小线段动态前瞻控制装置,包括:
运动参数接收模块,用于接收非对称S曲线的输入参数,所述输入参数至少包括:起始速度Vs、末速度Ve、最大理论速度Vm、S段时间Ts、加速时间Tacc、减速时间Tdec和路径长度S;
第一计算模块,用于根据所述运动参数接收模块接收的输入参数计算所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax
第二计算模块,用于根据所述输入参数以及所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax计算所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va
圆整处理和调整模块,用于将所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7分别进行圆整处理,并根据圆整后的参数进行运动参数调整控制。
本发明的有益效果:
(1)增强了S曲线加减速控制方法的灵活性
由于本发明非对称S曲线不但起始速度和停止速度是非对称的,加速度和减速度也是非对称的,从而使得加速过程和减速过程可以分开控制,增强非对称S曲线加减速控制方法的灵活性。
(2)降低计算机消耗,提高运算效率
本发明根据已知参数,判断加速度曲线类型,再以最高次为3次的方程就可以计算非对称S曲线,从而避开迭代法等复杂的S曲线加减速计算,降低计算机消耗,提高运算效率。
(3)提高了加减速规划末速度精度和位移精度
由于本发明引入基于动力学限制的圆整方法,补偿S曲线加减速控制离散化处理过程中的精度损失,从而可以提高加减速规划末速度精度和位移精度。
附图说明
图1是本发明非对称S曲线加减速控制方法总体流程图。
具体实施方式
以下结合实施例详细先介绍本发明非对称S曲线加减速控制的具体实现过程。
本发明的主要发明构思是使得:(1)S曲线不但起始速度和停止速度是非对称的,加速度和减速度也是非对称的,从而使得加速过程和减速过程可以分开控制,增强S曲线加减速控制方法的灵活性;(2)根据已知参数,判断加速度曲线类型再计算,从而避开迭代法等复杂的S曲线加减速计算,降低计算机消耗,提高运算效率;(3)引入基于动力学限制的圆整方法,补偿S曲线加减速控制离散化处理过程中的精度损失。
如图1所示,本发明的总体实现流程包括以下处理步骤:
S1,运动控制系统接收到输入参数,包括:起始速度Vs、末速度Ve、最大理论速度Vm、S段时间Ts、加速时间Tacc、减速时间Tdec和路径长度S;
S2,计算加速段最大加速度Amax、减速段最大减速度Dmax;进一步还可以通过Amax和Dmax计算出加速段加加速度Ja和减速段加加速度Jd
S3,根据S1、S2中的参数值计算加加速段时间、匀加速段时间、加减速段时间、匀速段时间、减加速段时间、匀减速段时间、减减速段时间和最大实际速度;
S4,圆整;将S3中计算得出的加加速段时间、匀加速段时间、加减速段时间、匀速段时间、减加速段时间、匀减速段时间、减减速段时间分别圆整为插补周期T的整数倍,并根据圆整后的参数进行运动参数调整控制。
其中步骤S2中的计算过程具体方式为:
加速段最大加速度Amax为:
减速段段最大减速度Dmax为:
加速段加加速度Ja为:
减速段加加速度Jd为:
上述步骤S3中计算加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va包括以下过程:
S21,计算在最大实际速度Va等于最大理论速度Vm,且t1=t3=t5=t7=Ts条件下加速段长度SA和减速度长度SD
所述SA为:
所述SD为:
S22,计算满足以下条件
时的加速段和减速段之和S1;所述的S1为:
S23,计算满足以下条件
时的加速段和减速段之和S2;所述的S2为:
S2=2VsTs+AmaxTs 2+Ve2Ts+DmaxTs 2
S24,计算满足以下条件
时的加速段和减速段之和S3;所述的S3为:
S25,计算满足以下条件
时的加速段和减速段之和S4;所述的S4为:
S26,根据S1、S2、S3、S4、S、Amax、Dmax、Vm、Ve、Vs和Ts计算加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va
上述步骤S26中根据S1、S2、S3、S4、S、Amax、Dmax、Vm、Ve、Vs和Ts计算加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va具体包括以下处理过程:
S261,当满足以下条件
时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
S262,当满足以下条件
时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
S263,当满足以下条件
时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
S264,当满足以下条件
时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
S265,当仅满足以下两个条件
中的一个时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
S266,当仅满足以下两个条件
中的一个时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
S267,当仅满足以下两个条件
中的一个时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
S268,当仅满足以下五个条件
中的一个时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
上述步骤S4具体包括以下处理过程:
S31,将t1、t2、t3、t5、t6、t7按以下方式向上圆整为为插补周期T的整数倍:
S32,根据T1、T2、T3、T5、T6、T7,并按照以下方式将加速段长度SA调整为SA1,将减速段长度SD调整为SD1
SA1=Vs(2T1+T2)+Amax(T1 2+1.5T1T2+0.5T2 2)
SD1=Ve(2T5+T6)+Dmax(T5 2+1.5T5T6+0.5T6 2)
S33,根据SA1、SD1、VA、S,并按照以下方式计算圆整后的匀速段时间T4和调整后实际能够达到的最大速度VA1
S34,按照以下方式将加速段最大加速度Amax调整为Amax1,并作为最终的最大加速度,并计算最终加速段的加加速度JA1
S35,按照以下方式将减速段最大减速度Dmax调整为Dmax1,并作为最终的减速段最大减速度,并计算最终减速段的加加速度JD1
本发明还公开了一种运动控制系统的非对称S曲线加减速控制装置,其特征在于,包括:运动参数接收模块、第一计算模块、第二计算模块和圆整处理和调整模块。
其中运动参数接收模块,用于接收非对称S曲线的输入参数,所述输入参数至少包括:起始速度Vs、末速度Ve、最大理论速度Vm、S段时间Ts、加速时间Tacc、减速时间Tdec和路径长度S;
第一计算模块,用于根据所述运动参数接收模块接收的输入参数计算所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax
第二计算模块,用于根据所述输入参数以及所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax计算所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va
圆整处理和调整模块,用于将所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7分别进行圆整处理,并根据圆整后的参数进行运动参数调整控制。
以上内容是结合具体的实施方式对本发明所作的进一步详细说明,不能认定本发明的具体实施只局限于这些说明。对于本发明所属技术领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干简单推演或替换,都应当视为属于本发明的保护范围。

Claims (6)

1.一种运动控制系统的非对称S曲线加减速控制方法,其特征在于,包括以下处理过程:
接收非对称S曲线的输入参数,所述输入参数至少包括:起始速度Vs、末速度Ve、最大理论速度Vm、S段时间Ts、加速时间Tacc、减速时间Tdec和路径长度S;
根据所述输入参数计算所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax
根据所述输入参数以及所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax计算所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va
将所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7分别进行圆整处理,并根据圆整后的参数进行运动参数调整控制。
2.根据权利要求1所述的运动控制系统的非对称S曲线加减速控制方法,其特征在于,所述根据所述输入参数计算所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax具体包括:
所述的计算加速段最大加速度Amax为:
A max = V m - V s T a c c - T s
所述的计算减速段最大减速度Dmax为:
D m a x = V m - V e T d e c - T s
3.根据权利要求2所述的运动控制系统的非对称S曲线加减速控制方法,其特征在于,所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va的计算过程为:
S21,计算在最大实际速度Va等于最大理论速度Vm,且t1=t3=t5=t7=Ts条件下加速段长度SA和减速度长度SD
所述SA为:
所述SD为:
S22,计算满足以下条件
t 6 = V m a x - V e D m a x - T s t 1 = t 5 = T s t 2 = t 4 = 0
时的加速段和减速段之和S1;所述的S1为:
S 1 = 2 V s T s + A max T s 2 + V e [ T s + V m - V e D max ] + D max [ T s 2 + 1.5 [ V m - V e D max - T s ] T s + 0.5 [ V m - V e D max - T s ] 2 ]
S23,计算满足以下条件
t 5 = T s t 2 = t 4 = t 6 = 0 t 1 = V m - V s A m a x
时的加速段和减速段之和S2;所述的S2为:
S2=2VsTs+AmaxTs 2+Ve2Ts+DmaxTs 2
S24,计算满足以下条件
t 1 = t 5 = T s t 4 = t 6 = 0 t 2 = V m - V s A m a x - t 1
时的加速段和减速段之和S3;所述的S3为:
S 3 = 2 V S V m - V s A m a x + A m a x [ T s 2 + 1.5 T s - [ V m - V s A m a x - T s ] + 0.5 [ V m - V s A m a x - T s ] 2 + 2 T e T s + D m a x T s 2 ]
S25,计算满足以下条件
t 1 = T s t 4 = t 6 = 0 t 5 = V m - V e D max
时的加速段和减速段之和S4;所述的S4为:
S 4 = 2 V s T s + A max T s 2 + 2 V e V m - V e D m a x + D m a x ( V m - V e D m a x ) 2
S26,根据S1、S2、S3、S4、S、Amax、Dmax、Vm、Ve、Vs和Ts计算加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va
4.根据权利要求3所述的运动控制系统的非对称S曲线加减速控制方法,其特征在于,所述根据S1、S2、S3、S4、S、Amax、Dmax、Vm、Ve、Vs和Ts计算加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va具体包括以下处理过程:
S261,当满足以下条件
S A + S D < S V m - V s > A max T s V m - V e > D m a x T s 时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
t 1 = t 3 = t 5 = t 7 = T s t 2 = V m - V s A m a x - T s t 6 = V m - V e D m a x - T s t 4 = S - S A - S D V m V a = V m
S262,当满足以下条件
S A + S D < S V m - V s > A max T s V m - V e &le; D max T s 时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
t 1 = t 3 = T s t 5 = t 7 = V m - V e D m a x t 2 = V m - V s A max - T s t 6 = 0 t 4 = S - S A - S D V m V a = V m
S263,当满足以下条件
S A + S D < S V m - V s &le; A max T s V m - V e > D max T s 时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
t 5 = t 7 = T s t 1 = t 3 = V m - V s A m a x t 2 = 0 t 6 = V m - V e D max - T s t 4 = S - S A - S D V m V a = V m
S264,当满足以下条件
S A + S D < S V m - V s &le; A max T s V m - V e &le; D max T s 时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
t 1 = t 3 = V m - V s A m a x t 5 = t 7 = V m - V e D m a x t 2 = 0 t 6 = 0 t 4 = S - S A - S D V m V a = V m
S265,当仅满足以下两个条件
S 1 < S V m - V s &GreaterEqual; A max T s V m - V e &GreaterEqual; D max T s V s + A max T s > V e + D max T s S 3 < S V m - V s &GreaterEqual; A max T s V m - V e &GreaterEqual; D max T s V s + A max T s &le; V e + D m a x T s 中的一个时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
t 5 = t 7 = t 1 = t 3 = T s V A = T s 2 - 2 ( 1 A max + 1 D max ) &lsqb; V s 2 ( T s - V s A max ) + V e 2 ( T s - V e D max ) &rsqb; - S - T s ( 1 A max + 1 D max ) t 2 = V A - V s A max - T s t 6 = V A - V e D max - T s t 4 = 0
S266,当仅满足以下两个条件
S 2 < S V m - V s &GreaterEqual; A max T s V m - V e &GreaterEqual; D m a x T s V s + A max T s > V e + D max T s S 1 &GreaterEqual; S S 2 < S V m - V s < A m a x T s V m - V e &GreaterEqual; D max T s 中的一个时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
t 5 = t 7 = T s V A = 1 4 T s 2 4 ( 1 A max + 1 2 D max ) &lsqb; V e 2 ( T s - V e D max ) - V s 2 D max &rsqb; - S - 1 2 T s 2 ( 1 A max + 1 2 D max ) t 1 = t 3 = V A - V s A max t 6 = V A - V e D max - T s t 4 = t 2 = 0
S267,当仅满足以下两个条件
S 3 &GreaterEqual; S V m - V s &GreaterEqual; A max T s V m - V e &GreaterEqual; D m a x T s V s + A max T s &le; V e + D max T s S 4 &le; S S 4 < S V m - V s &GreaterEqual; A m a x T s V m - V e < D max T s 中的一个时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
t 1 = t 3 = T s V A = 1 4 T s 2 - 4 ( 1 2 A max + 1 D max ) &lsqb; V s 2 ( T s - V s D max ) - V e 2 D max &rsqb; - S - 1 2 T s 2 ( 1 2 A max + 1 D max ) t 5 = t 7 = V A - V e A max t 6 = V A - V s A max - T s t 4 = t 6 = 0
S268,当仅满足以下五个条件
S 1 &GreaterEqual; S V m - V s &GreaterEqual; A max T s V m - V e &GreaterEqual; D m a x T s V s + A max T s > V e + D max T s S 1 &GreaterEqual; S , S 3 &GreaterEqual; S V m - V s &GreaterEqual; A max T s V m - V e &GreaterEqual; D m a x T s V s + A max T s > V e + D max T s S 4 &GreaterEqual; S , S 1 &GreaterEqual; S V m - V s &GreaterEqual; A m a x T s V m - V e < D max T s , S 2 &GreaterEqual; S V m - V s < A m a x T s V m - V e > D max T s V m - V s &le; A max T S V m - V e &le; D max T s 中的一个时,
所述加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va分别为:
t 4 = t 6 = t 2 = 0 V A = D m a x V s 2 + A m a x V e 2 + SD m a x A m a x ( A m a x + D m a x ) t 5 = t 7 = V A - V e D m a x t 1 = t 3 = V A - V s A m a x .
5.根据权利要求2-4任一项所述的运动控制系统的非对称S曲线加减速控制方法,其特征在于,将所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7分别进行圆整处理,并根据圆整后的参数进行运动调整控制具体包括以下处理过程:
S31,将t1、t2、t3、t5、t6、t7按以下方式向上圆整为为插补周期T的整数倍:
T 1 = t 1 + 1 T 2 = t 2 + 1 T 3 = t 4 + 1 T 5 = t 5 + 1 T 6 = t 6 + 1 T 7 = t 7 + 1
S32,根据T1、T2、T3、T5、T6、T7,并按照以下方式将加速段长度SA调整为SA1,将减速段长度SD调整为SD1
SA1=Vs(2T1+T2)+Amax(T1 2+1.5T1T2+0.5T2 2)
SD1=Ve(2T5+T6)+Dmax(T5 2+1.5T5T6+0.5T6 2)
S33,根据SA1、SD1、VA、S,并按照以下方式计算圆整后的匀速段时间T4和调整后实际能够达到的最大速度VA1
S34,按照以下方式将加速段最大加速度Amax调整为Amax1,并作为最终的最大加速度,并计算最终加速段的加加速度JA1
J A 1 = A m a x 1 T 1
S35,按照以下方式将减速段最大减速度Dmax调整为Dmax1,并作为最终的减速段最大减速度,并计算最终减速段的加加速度JD1
J D 1 = D m a x 1 T 5 .
6.一种运动控制系统的非对称S曲线加减速控制装置,其特征在于,包括:
运动参数接收模块,用于接收非对称S曲线的输入参数,所述输入参数至少包括:起始速度Vs、末速度Ve、最大理论速度Vm、S段时间Ts、加速时间Tacc、减速时间Tdec和路径长度S;
第一计算模块,用于根据所述运动参数接收模块接收的输入参数计算所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax
第二计算模块,用于根据所述输入参数以及所述非对称S曲线的加速段最大加速度Amax、减速段最大减速度Dmax计算所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7和最大实际速度Va
圆整处理和调整模块,用于将所述非对称S曲线的加加速段时间t1、匀加速段时间t2、加减速段时间t3、匀速段时间t4、减加速段时间t5、匀减速段时间t6、减减速段时间t7分别进行圆整处理,并根据圆整后的参数进行运动参数调整控制。
CN201510472799.9A 2015-08-04 2015-08-04 一种运动控制系统的非对称s曲线加减速控制方法和装置 Active CN106444635B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510472799.9A CN106444635B (zh) 2015-08-04 2015-08-04 一种运动控制系统的非对称s曲线加减速控制方法和装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510472799.9A CN106444635B (zh) 2015-08-04 2015-08-04 一种运动控制系统的非对称s曲线加减速控制方法和装置

Publications (2)

Publication Number Publication Date
CN106444635A true CN106444635A (zh) 2017-02-22
CN106444635B CN106444635B (zh) 2019-09-13

Family

ID=59216439

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510472799.9A Active CN106444635B (zh) 2015-08-04 2015-08-04 一种运动控制系统的非对称s曲线加减速控制方法和装置

Country Status (1)

Country Link
CN (1) CN106444635B (zh)

Cited By (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106950923A (zh) * 2017-03-13 2017-07-14 浙江工业大学 一种定插补周期的速度规划方法
CN107544247A (zh) * 2017-09-11 2018-01-05 北京航空航天大学 一种抑制机械运动结构振动的方法及系统
CN107765648A (zh) * 2017-10-13 2018-03-06 山东大学 一种cnc加工的进给速度规划方法及装置
CN107765639A (zh) * 2017-09-30 2018-03-06 山东大学 一种s曲线加减速的圆整误差补偿方法
CN107825424A (zh) * 2017-10-31 2018-03-23 河北工业大学 一种高速机械手减少残余振动的非对称s型轨迹规划方法
CN108646674A (zh) * 2018-07-20 2018-10-12 深圳市众为创造科技有限公司 位置s型平滑指令产生方法、系统和电子设备
CN109074049A (zh) * 2017-11-04 2018-12-21 卢俊 一种数控插补尾巴平摊处理的方法
CN109240215A (zh) * 2018-11-22 2019-01-18 山东易码智能科技股份有限公司 一种基于改进型s曲线加减速的pvt控制方法
WO2019019707A1 (zh) * 2017-07-28 2019-01-31 珞石(山东)智能科技有限公司 非零初始状态s型停止曲线速度规则及其在线求解方法
CN109861621A (zh) * 2019-03-08 2019-06-07 杭州中冠瀚明科技有限公司 胶装机小车的高精度定位悬停方法及控制系统
CN109991932A (zh) * 2017-12-29 2019-07-09 沈阳新松机器人自动化股份有限公司 一种物流搬运设备s曲线加减速速度规划与控制方法
CN109991934A (zh) * 2019-03-10 2019-07-09 天津大学 一种时间最优的在线s型加减速规划方法
CN110209173A (zh) * 2019-06-28 2019-09-06 中科新松有限公司 基于s型速度规划的时间最优在线轨迹规划方法
CN110286653A (zh) * 2019-06-14 2019-09-27 杭州爱科科技股份有限公司 用于任意曲线运动s加减速控制的速度计算方法
CN110398993A (zh) * 2018-04-24 2019-11-01 北京京东尚科信息技术有限公司 速度控制方法、装置及计算机可读存储介质
CN112327954A (zh) * 2020-11-14 2021-02-05 大连理工大学 非对称s型速度曲线控制的直线电机高精定位方法
CN115657608A (zh) * 2022-10-26 2023-01-31 英孚康(浙江)工业技术有限公司 基于Brent迭代法的全局非对称式S型柔性速度曲线规划方法
CN116577994A (zh) * 2023-06-25 2023-08-11 英孚康(浙江)工业技术有限公司 冗余容错式非对称s型柔性速度曲线自适应规划方法
CN116700151A (zh) * 2023-07-13 2023-09-05 哈尔滨工业大学 一种精密运动平台运动轨迹规划系统及其参数整定方法
CN117891210A (zh) * 2024-03-14 2024-04-16 济南邦德激光股份有限公司 基于s曲线加减速最大可达速度的运动控制方法及设备
CN116700151B (zh) * 2023-07-13 2024-05-31 哈尔滨工业大学 一种精密运动平台的运动轨迹规划系统的参数整定方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1997008596A1 (fr) * 1995-08-31 1997-03-06 Fanuc Ltd Procede d'interpolation de courbes pour la regulation de vitesse a l'occasion d'une jonction robotisee
CN103076759A (zh) * 2012-12-31 2013-05-01 北京配天大富精密机械有限公司 一种获取数控系统的s型曲线的方法及其装置
CN103970073A (zh) * 2013-01-24 2014-08-06 北京配天大富精密机械有限公司 一种用于数控系统的加减速规划方法、装置及数控机床
CN104076742A (zh) * 2014-06-20 2014-10-01 北京航空航天大学 一种连续多类型曲线段混合插补三次多项式进给速度前瞻规划方法
CN104483906A (zh) * 2015-01-07 2015-04-01 浙江师范大学 一种离散采样的s曲线加减速控制方法及装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1997008596A1 (fr) * 1995-08-31 1997-03-06 Fanuc Ltd Procede d'interpolation de courbes pour la regulation de vitesse a l'occasion d'une jonction robotisee
CN103076759A (zh) * 2012-12-31 2013-05-01 北京配天大富精密机械有限公司 一种获取数控系统的s型曲线的方法及其装置
CN103970073A (zh) * 2013-01-24 2014-08-06 北京配天大富精密机械有限公司 一种用于数控系统的加减速规划方法、装置及数控机床
CN104076742A (zh) * 2014-06-20 2014-10-01 北京航空航天大学 一种连续多类型曲线段混合插补三次多项式进给速度前瞻规划方法
CN104483906A (zh) * 2015-01-07 2015-04-01 浙江师范大学 一种离散采样的s曲线加减速控制方法及装置

Cited By (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106950923B (zh) * 2017-03-13 2019-01-22 浙江工业大学 一种定插补周期的速度规划方法
CN106950923A (zh) * 2017-03-13 2017-07-14 浙江工业大学 一种定插补周期的速度规划方法
WO2019019707A1 (zh) * 2017-07-28 2019-01-31 珞石(山东)智能科技有限公司 非零初始状态s型停止曲线速度规则及其在线求解方法
CN107544247A (zh) * 2017-09-11 2018-01-05 北京航空航天大学 一种抑制机械运动结构振动的方法及系统
CN107765639A (zh) * 2017-09-30 2018-03-06 山东大学 一种s曲线加减速的圆整误差补偿方法
CN107765648A (zh) * 2017-10-13 2018-03-06 山东大学 一种cnc加工的进给速度规划方法及装置
CN107825424A (zh) * 2017-10-31 2018-03-23 河北工业大学 一种高速机械手减少残余振动的非对称s型轨迹规划方法
CN107825424B (zh) * 2017-10-31 2020-05-26 河北工业大学 一种高速机械手减少残余振动的非对称s型轨迹规划方法
CN109074049A (zh) * 2017-11-04 2018-12-21 卢俊 一种数控插补尾巴平摊处理的方法
WO2019084938A1 (zh) * 2017-11-04 2019-05-09 卢俊 一种数控插补尾巴平摊处理的方法
CN109074049B (zh) * 2017-11-04 2021-05-11 广州芯越数字控制系统有限公司 一种数控插补尾巴平摊处理的方法
CN109991932A (zh) * 2017-12-29 2019-07-09 沈阳新松机器人自动化股份有限公司 一种物流搬运设备s曲线加减速速度规划与控制方法
CN110398993A (zh) * 2018-04-24 2019-11-01 北京京东尚科信息技术有限公司 速度控制方法、装置及计算机可读存储介质
CN110398993B (zh) * 2018-04-24 2022-09-06 北京京东尚科信息技术有限公司 速度控制方法、装置及计算机可读存储介质
CN108646674A (zh) * 2018-07-20 2018-10-12 深圳市众为创造科技有限公司 位置s型平滑指令产生方法、系统和电子设备
CN109240215A (zh) * 2018-11-22 2019-01-18 山东易码智能科技股份有限公司 一种基于改进型s曲线加减速的pvt控制方法
CN109861621A (zh) * 2019-03-08 2019-06-07 杭州中冠瀚明科技有限公司 胶装机小车的高精度定位悬停方法及控制系统
CN109991934A (zh) * 2019-03-10 2019-07-09 天津大学 一种时间最优的在线s型加减速规划方法
CN110286653A (zh) * 2019-06-14 2019-09-27 杭州爱科科技股份有限公司 用于任意曲线运动s加减速控制的速度计算方法
CN110209173A (zh) * 2019-06-28 2019-09-06 中科新松有限公司 基于s型速度规划的时间最优在线轨迹规划方法
CN112327954A (zh) * 2020-11-14 2021-02-05 大连理工大学 非对称s型速度曲线控制的直线电机高精定位方法
CN115657608A (zh) * 2022-10-26 2023-01-31 英孚康(浙江)工业技术有限公司 基于Brent迭代法的全局非对称式S型柔性速度曲线规划方法
CN115657608B (zh) * 2022-10-26 2023-09-08 英孚康(浙江)工业技术有限公司 基于Brent迭代法的全局非对称式S型柔性速度曲线规划方法
CN116577994A (zh) * 2023-06-25 2023-08-11 英孚康(浙江)工业技术有限公司 冗余容错式非对称s型柔性速度曲线自适应规划方法
CN116577994B (zh) * 2023-06-25 2024-02-27 英孚康(浙江)工业技术有限公司 冗余容错式非对称s型柔性速度曲线自适应规划方法
CN116700151A (zh) * 2023-07-13 2023-09-05 哈尔滨工业大学 一种精密运动平台运动轨迹规划系统及其参数整定方法
CN116700151B (zh) * 2023-07-13 2024-05-31 哈尔滨工业大学 一种精密运动平台的运动轨迹规划系统的参数整定方法
CN117891210A (zh) * 2024-03-14 2024-04-16 济南邦德激光股份有限公司 基于s曲线加减速最大可达速度的运动控制方法及设备

Also Published As

Publication number Publication date
CN106444635B (zh) 2019-09-13

Similar Documents

Publication Publication Date Title
CN106444635A (zh) 一种运动控制系统的非对称s曲线加减速控制方法和装置
ShangGuan et al. Multiobjective optimization for train speed trajectory in CTCS high-speed railway with hybrid evolutionary algorithm
CN101833306B (zh) 一种基于前瞻-滤波技术的多程序段连续加减速控制方法
Dai et al. Disturbance-observer based prescribed-performance fuzzy sliding mode control for PMSM in electric vehicles
CN102324877B (zh) 一种车用永磁同步电机控制系统及方法
CN101499755B (zh) 一种直流电机速度pid控制方法
CN102651626A (zh) 一种永磁同步电机的弱磁控制方法
Min et al. A trust region interior point algorithm for optimal power flow problems
CN104281099A (zh) 一种考虑加工特性的nurbs直接插补方法及装置
CN103208958A (zh) 一种直流伺服驱动控制系统
CN106842960A (zh) 一种用于电机控制的抗积分饱和控制方法
CN105116720A (zh) 火电机组压控阀控方式一次调频主汽压力自适应优化方法
CN105034853A (zh) 一种减小电动汽车定速巡航速度波动的控制系统及方法
CN105974983A (zh) 一种数字电压环与电流环互相跟随的控制方法
CN101723096A (zh) 迭代制导下减少大姿态扰动的控制方法
Shafighy et al. Modelling and simulation of regeneration in AC traction propulsion system of electrified railway
CN106230333A (zh) 直流电机输出能力控制方法及系统
CN106685228B (zh) 一种直流转换方法及直流转换器
Pérez et al. Determination of the adjoint state evolution for the efficient operation of a hybrid electric vehicle
CN107357323A (zh) 一种座舱压力自适应控制系统
Licheng et al. Optimization of train speed curve based on ATO tracking control strategy
CN104653503B (zh) 用于轨道交通变流器的基于变频变极的风机控制方法及控制装置
CN113258556A (zh) 一种自同步电压源并网装置的输出电压控制方法及系统
Ren et al. Linearizing control of induction motor based on networked control systems
CN105599705B (zh) 电动汽车的不对等式变周期动态调节网络化控制装置

Legal Events

Date Code Title Description
C06 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