CN108287527A - 一种基于三角函数的改进s曲线加减速控制方法 - Google Patents
一种基于三角函数的改进s曲线加减速控制方法 Download PDFInfo
- Publication number
- CN108287527A CN108287527A CN201710587160.4A CN201710587160A CN108287527A CN 108287527 A CN108287527 A CN 108287527A CN 201710587160 A CN201710587160 A CN 201710587160A CN 108287527 A CN108287527 A CN 108287527A
- Authority
- CN
- China
- Prior art keywords
- time
- accelerating sections
- max
- acceleration
- section
- 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
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/35—Nc in input of data, input till input file format
- G05B2219/35221—Generate cutter path as function of speed, acceleration condition selected by operator
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曲线加减速控制方法,属于运动控制领域,本方法将曲线按照不同的运动特点分阶段,规划过程中通过参数限制和实际情况讨论各阶段是否存在,以获得各阶段的运行时间,进而得到规划后的位移曲线。在传统S曲线加减速的基础上,引入基于三角函数的加加速度控制方法,能够有效的保证加加速度的连续性,最大限度的减小对数控设备造成的冲击。
Description
技术领域:
本发明涉及一种基于三角函数的改进S曲线加减速控制方法,属于运动控制领域。
背景技术:
加减速控制是数控系统中的关键技术,良好的加减速控制方法可以有效的避免数控设备运动过程中出现的冲击、失步或振动等现象,提高加工精度和表明质量,同时实现数控机床的快速反应,短时间内达到指定速度,缩短加减速时间,提高生产效率。
目前数控系统中常用的加减速控制方法有:直线型加减速、指数型加减速、三角函数加减速和S形加减速。直线型加减速算法简单、耗时短,但是加速度曲线不连续,存在速度突变,易出现各种振动和噪声,对数控设运动造成柔性冲击,适用于对运动精度要求不高的低速、低成本的数控系统。指数型加减速算法平滑性比直线型加减速要好,运动精度高,但其加减速起点和终点加速度突变,同样存在柔性冲击。三角函数加减速,主要是利用0-π之间的正弦曲线构建速度曲线,进而实现加速度与加加速度的连续可导,从而达到速度平稳光滑过度的目的,但是由于当前的三角函数加减速为保证速度线型,无法充分发挥数控设备加加速度、加速度最大允许值的性能,造成速度无法在较短时间、距离内达到期望值。也有学者使用三角函数构建加速度和加加速度曲线,通过积分获得速度与位移曲线,同样也存在为保证三角函数线型而无法充分发挥数控设备的性能的问题。S形曲线加减速具有加速度曲线连续、速度曲线光滑等优点,适合高速高精加工场的应用,但目前的S曲线仍存在加加速度的阶跃变化,在阶跃变化的上升沿和下降沿,对数控设备进给系统造成振动和冲击,影响运行平稳性。
中国专利文件(申请号201310095677.3)公开了一种用于数控机床的三角函数二阶连续可导加减速算法,结合通用S型加减速曲线算法的优势,提出了改进型的三角函数算法,但该方案在对加加速度处理时,加加速度直接从最大加加速度以三角函数形式降低至0,从开始便有较大冲击,并且加加速度到达最大值时并未维持,加速效率较低,耗时长。
从以上分析可知,S曲线加减速与三角函数加减速是采用不同的曲线实现来完成速度的平稳光滑过度。在曲线的连续性上三角函数具有较优的能力,但无法充分发挥数控设备最大加速度、加加速度的性能,执行效率低。而S曲线具有良好的速度光滑性,但加加速度不连续,对数控设备进给系统有振动和冲击。
发明内容:
针对现有数控系统使用的加减速控制方法存在的问题,本发明的目的是提供一种基于三角函数的改进 S曲线加减速控制方法,实现加加速度的连续控制,保证运动过程平稳、无冲击;根据加加速度、加速度、速度和位移之间的积分关系,推导出计算公式,并给出该加减速控制方法的速度规划方法。
为实现以上目的,本发明的技术方案如下:
定义:t为时间,j(t)、a(t)、v(t)、s(t)分别为加加速度、加速度、速度和位移随时间的变化关系, Jcom、acom、vcom分别为数控设备允许最大加加速度、最大加速度和最大速度,vmax为实际能够达到的最大速度,vs为起点速度,ve为终点速度,S为待插补的位移。
一种基于三角函数的改进S曲线加减速控制方法,将曲线按照不同的运动特点分阶段,规划过程中通过参数限制和实际情况讨论各阶段是否存在,可以获得各阶段的运行时间,进而可以得到规划后的位移曲线。
一种基于三角函数的改进S曲线加减速控制方法,具有与传统S曲线相同的7段式结构,其曲线按时间顺序包括七个阶段,分别是:加加速段L1、匀加速段L2、减加速段L3、匀速段L4、加减速段L5、匀减速段L6和减减速段L7;对应这7个运动阶段,总运动时间T也被分成了7部分,每个阶段对应的时间为:加加速段时间Δt1,Δt1=t1;匀加速段时间Δt2,Δt2=t2-t1;减加速段时间Δt3,Δt3=t3-t2;匀速段时间Δt4,Δt4=t4-t3;加减速段时间Δt5,Δt5=t5-t4;匀减速段时间Δt6,Δt6=t6-t5;减减速段时间Δt7,Δt7=t7-t6;其中ti为各阶段过渡点的时刻,i=1,2...,7,Δti为各阶段时间,i=1,2...,7;
(1.1)将L1、L3、L5、L7段的时间分别分割为三部分,tij为分割后过渡点的时刻,i=1,3,5,7;j=1,2,3;
通过改进传统S曲线在L1、L3、L5、L7段的加加速度变化规律,引入三角函数形式的曲线形式,能够保证加加速度在整个运动过程中的连续性,同时保留匀加加速度段,能够充分发挥数控设备的加减速性能。但引入三角函数之后,L1、L3、L5、L7段的时间将会继续分割,以L1段为例,在进行修改之后,原加加速段时间t1被分割成加加加速段t11、匀加加速段t12-t11和减加加速段t13-t12三部分(t13=t1,t13所对应的时刻即为分割前t1所指的时刻)。因此致使总时间T被分成15段,大大增加了计算的难度。
为简化计算,优选的,步骤(1.1)中,将L1、L3、L5、L7段的时间分别进行三等分分割,设T1为L1、 L3段内时间三等分分割之后的分段时间长度,设T2为L5、L7段内时间三等分分割之后的分段时间长度,由于加速度的对称关系,存在如下关系
t11=t12-t11=t13-t12=t31-t2=t32-t31=t33-t32=T1,t51=t52-t51=t53-t52=t71-t6=t72-t71=t73-t72=T2 (1)。
以L1段为例,t11=t12-t11=t13-t12=T1,既能降低计算难度,又能保证存在匀加加速段,充分发挥数控设备的性能。同时有如下关系
t13=t1,t33=t3,t53=t5,t73=t7 (2),
t13所对应的时刻即为分割前t1所指的时刻,t33所对应的时刻即为分割前t3所指的时刻,t53所对应的时刻即为分割前t5所指的时刻,t73所对应的时刻即为分割前t7所指的时刻;
分割时间段后,其加加速度表达式如下:
τij(i=1,2,..,7;j=1,2,3)为以各个区间段的起点作为时间零点的时间表示。存在如下关系:
τij=t-tij(i=1,3,5,7;j=1,2,3)或τi=t-ti(i=2,4,6) (4)
上述加加速度与加速度、速度、位移的积分关系如下:
根据加加速度与加速度之间的积分关系,可得加速度表达式如下:
其中a12=a11+JcomT1,a32=a31-JcomT,a52=a51-JcomT2,a72=a71+JcomT2。
a2为加速段所能达到的最大加速度,后续规划计算中,在不同假设情况下使用aacci(i=1,2,3,4)表示 a2,即aacci=a2。同理-a6为减速段能达到的最大加速度,后续规划计算中使用adeci(i=1,2,3,4)表示-a6,即adeci=(-a2)。
根据速度与加速度之间的积分关系,可得速度表达式为:
其中v2=v13+a2(t2-t13); v6=v53+a6(t6-t53);
根据速度与位移之间的积分关系,可得位移表达式为:
其中 s4=s33+v4(t4-t33);
具体规划包括步骤如下:
(2.1)假设能够达到的最大速度为vmax1,且vmax1=vcom,
(2.1.1)加速段时间计算,所述加速段包括加加速段L1、匀加速段L2、减加速段L3;
首先分析匀加速段L2的存在性,假设加速段实际能够达到的最大加速度aacc1为数控设备允许的最大加速度acom,即aacc1=acom (11)
根据加加速度与加速度的积分关系,以及加加速段、减加速段的时间等分关系,可获得下式:
3T1=Δt1 (13);
联立(12)-(13),可获得加加速段时间
且存在关系Δt1=Δt3 (15);
假设匀加速段L2不存在时,仅通过加加速段和减加速段,根据速度关系,速度增量为Δv=aacc1Δt1 (16)
通过比较速度增量Δv与(vmax1-vs)的关系,可知匀加速段L2的存在性,判断如下
(2.1.1.a)Δv<(vmax-vs)
此时说明存在匀加速段L2,匀加速段的时间为:
(2.1.1.b)Δv=(vmax-vs)
此时说明恰好不需要匀加速段,无匀加速段L2;
(2.1.1.c)Δv>(vmax-vs)
此时说明不存在匀加速段L2,且需要重新计算加加速段L1和减加速段L3的时间,由速度关系可得自此,已求出三种不同情况a)、b)、c)的Δt1,Δt2,Δt3;此时加速段实际能够达到的最大加速度为
加速段运动位移为
(2.1.2)减速段时间计算,所述减速段包括加减速段L5、匀减速段L6和减减速段L7;
减速段的处理方式与加速段相同,即减速段可以看成反向的加速段,通过上述算法也可获得减速段各段时间Δt5、Δt6、Δt7,计算过程不再赘述,先分析匀减速段L6的存在性,假设减速段实际能够达到的最大加速度adec1为数控设备允许的最大加速度acom,根据加加速度与加速度的积分关系,以及加减速段、减减速段的时间等分关系,可求得Δt5,Δt7=Δt5;假设匀减速段L6不存在,仅通过加减速段和减减速段,根据速度关系,速度增量为Δv=aacc1Δt1,通过比较速度增量Δv与vmax-ve的关系,可知匀减速段L6的存在性,进而求出三种不同情况的Δt5、Δt6、Δt7。减速段位移为
(2.1.3)匀速段时间计算
根据速度与位移的积分关系,可推导出加速段与减速段的运动总位移为:S1=Sacc1+Sdec1 (22)
通过比较S1与给定的待插补位移S的关系可知匀速段的存在性,如下:
(2.1.3.a)S1<S
此时存在匀速段,匀速段时间为
至此,所有的7段的时间规划已经完成,实际能够达到的最大速度为vmax1=vcom,结束计算;
(2.1.3.b)S1=S
此时存在匀速段不存在,匀速段时间Δt4=0 (24)
至此,所有的7段的时间规划已经完成,实际能够达到的最大速度为vmax1=vcom,结束计算;
(2.1.3.c)S1>S
此时说明假设的最大速度vmax1大于实际所能达到的最大速度vmax,需要继续减小vmax1,进入(2.2);
(2.2)假设能够达到的最大速度为vmax2,且vmax2为vs与ve中的较大者进行不包含匀加速段的加速过程所能达到的速度;此时不存在匀速段,即Δt4=0;设定vs≥ve;(下面的算法有几个需要选择的部分,设定一个较大值只是为了表述具体直观)
(2.2.1)加速段时间计算
对于加速段,根据(2.2)假设条件,不存在匀加速段,即Δt2=0;能够到达的加速度aacc2为数控设备允许的最大加速度acom,aacc2=acom (25);
根据加速度关系,加加速段与减加速段时间相等,即Δt1=Δt3,有
求得加加速段和减加速段时间为
根据速度关系,可得最大速度为vmax2=aacc2×Δt1+vs (28)
比较vmax2与vcom的关系,如下:
(2.2.1.a)vmax2>vcom
此时说明假设的最大速度大于实际所能达到的最大速度,若vs>ve,进入(2.3);若vs=ve,进入(2.4);
(2.2.1.b)vmax2≤vcom
此时说明假设最大速度可能是满足条件的,继续进行计算;
由位移条件,加速段位移为进入(2.2.2);
(2.2.2)减速段时间计算
ve≤vs,因此减速段实际能够达到的最大加速度adec2为数控设备允许的最大加速度acom,adec2=acom (30)
减减速段与加减速段时间为
如果ve<vs,则存在匀减速段,有adec(Δt5+Δt6)=vmax2-ve (32)
则匀减速段时间为
如果ve=vs,则不存在匀减速段,匀减速段时间Δt6=0;
由位移关系,减速段位移为
判断Sacc2+Sdec2与给定的待插补距离S的关系,如下:
(2.2.2.a)Sacc2+Sdec2=S
此时说明假设的最大速度vmax2恰好为实际能够达到的最大速度vmax,所有7段时间都已经计算完成,结束计算;
(2.2.2.b)Sacc2+Sdec2>S
此时说明假设的最大速度vmax2仍然大于实际能够达到的最大速度vmax,进入(2.3);
(2.2.2.c)Sacc2+Sdec2<S
此时说明假设的最大速度vmax2小于实际能达到的最大速度vmax,其取值区间为vmax∈(vmax2,vcom),同时存在匀加速段和匀减速段,但不包含匀速段;具体计算如下:
加速段与减速段实际能够达到的最大加速度为aacc2=adec2=acom (35)
加加速段、减加速段、减减速段、加减速段的时间为
由速度关系,有vmax-vs=acom(Δt1+Δt2) (37)
可得匀加速段时间为
同理可得匀减速段时间
vmax-ve=acom(Δt5+Δt6) (39);
由位移关系,有
联立(35)-(41),由总插补位移关系构造方程
其中B=t1,
f(vmax)是vmax二次函数,由于B>0,所以根据求根公式得
通过将vmax带入前述各段时间的计算式,即可计算出各段时间,(各段时间指的是Δt1,Δt2,Δt3、Δt4、Δt5、Δt6、Δt7),完成计算;
(2.3)假设能够达到的最大速度为vmax3,且vmax3为vs与ve中的较小者进行不包含匀加速段(此处是设定一个最大速度,两端速度都看成向最大速度加速的过程)的加速过程所能达到的速度;此时不存在匀速段,Δt4=0;设定vs<ve,
(2.3.1)减速段时间计算
对于减速段,根据(2.3)假设条件,不存在匀减速段,即Δt6=0;能够到达的加速度adec3为数控设备允许的最大加速度acom,即adec3=acom (44)
根据加速度关系,减减速段与加减速段时间相等,即Δt5=Δt7有
可求得减减速段与加减速段时间为
根据速度关系,可得最大速度为vmax3=adec2×Δt5+ve (47)
比较vmax3与vcom的关系,如下:
(2.3.1.a)vmax3>vcom
此时说明假设的最大速度大于实际所能达到的最大速度,进入(2.4);
(2.3.1.b)vmax3≤vcom
此时说明假设最大速度可能是满足条件的,继续进行计算,由位移条件,减速段位移为
(2.3.2)加速段时间计算
由于ve<vs,因此没有匀加速段,即Δt2=0,设加速段所能达到的最大加速度设为aacc3,由加速度关系,加加速段与减加速段时间为
由位移关系,加速速段位移为
判断Sacc3+Sdec3与给定的待插补距离S的关系,如下:
(2.3.2.a)Sacc3+Sdec3=S
此时说明假设的最大速度vmax3恰好为实际能够达到的最大速度vmax,所有7段时间都已经计算完成,结束计算;
(2.3.2.b)Sacc3+Sdec3>S
此时说明假设的最大速度vmax3仍然大于实际能够达到的最大速度vmax,进入(2.4);
(2.3.2.c)Sacc3+Sdec3<S
此时说明假设的最大速度vmax3小于实际能达到的最大速度vmax,其取值区间为vmax∈(vmax3,vmax2),包含匀减速段,但不包含匀加速段和匀速段,具体计算如下:
由速度关系,加加速段与减加速段时间为
加速段所能达到的最大加速度为
加速段位移为
对于减速段,所能达到的最大加速度为acom,减减速段和减加速段时间为
由速度关系,有vmax-ve=acom(Δt5+Δt6) (55)
可得匀减速段时间为
减速段位移为
由位移关系,可得S3(vmax)=Sacc3+Sdec3 (58)
联立(51)-(58),由总位移关系,构造方程
因为S3(vmax)是vmax的单调递增函数,所以方程f3(vmax)在(vmax3,vmax2)内有且有唯一解,可使用二分法或牛顿迭代法进行求解,根据求解出的vmax可计算出Δt6,至此,已求解出各段时间,完成计算;
(2.4)最大速度vmax的取值范围为[max(vs,ve),vmax3)
此时匀速段、匀加速段和匀减速段都不存在,设定vs≥ve,进行推导计算:首先假设最大速度为起点速度,即vmax4=vs,此时加加速段与减加速段都不存在,加速段位移Sacc4为0,仅存在减减速段和加减速段,由加速度关系,减速段实际能达到的最大加速度为
由速度关系,减减速段与加减速段时间相等,即Δt5=Δt7,有
vmax4-ve=adec4Δt5 (61)
联立(60)-(61)可得减减速段与加减速段时间为
由位移关系,减速段位移为
比较Sdec4与待插补位移S的关系,如下:
(2.4.a)Sdec4>S
此时说明假设的最大速度vmax4要小于起点速度vs,因此在给定条件下不存在最大速度,无解,结束计算;
(2.4.b)Sdec4=S
此时说明假设的最大速度vmax4恰好等于实际能够达到的最大速度vmax,即vmax=vmax4,结束计算;
(2.4.c)Sdec4<S
此时说明实际能够达到的最大速度vmax应大于vmax4,其取值范围为vmax∈(vmax4,vmax3),由加速度关系,加加速段与减加速段时间相等,即Δt1=Δt3,加速段实际能够达到的加速度为
由速度关系,有vmax-vs=aacc4Δt1 (65)
由位移关系,可得加速段位移为
同理,有减速段相关关系
vmax-ve=adec4Δt5 (68);
由位移关系得S4(vmax)=Sacc4+Sdec4 (70)
由总位移关系,联立(63)-(70),构建方程
S(vmax)为vmax的单调递增函数,因此在(vmax4,vmax3)内有且有唯一解,可使用二分法或牛顿迭代法求解,获得vmax后,根据求解出的vmax可计算出Δt6,至此,已求解出各段时间,完成计算。
基于三角函数的改进S曲线规划原理
实际使用基于三角函数的改进S曲线加减速方法进行任务规划时,可能并不完全包含上述给出的全部 7段,会根据给定的最大加加速度Jcom、最大加速度acom、最大速度vcom、起点速度vs、终点速度ve、待规划位移S的不同,存在以下表1所示几种情况:
表1情况列表
包含 | 不包含 |
L1、L2、L3、L4、L5、L6、L7 | |
L1、L2、L3、L5、L6、L7 | L4 |
L1、L3、L4、L5、L6、L7 | L2 |
L1、L2、L3、L4、L5、L7 | L6 |
L1、L3、L4、L5、L7 | L2、L6 |
L1、L3、L5、L6、L7 | L2、L4 |
L1、L2、L3、L5、L7 | L6、L4 |
L1、L3、L5、L7 | L2、L4、L6 |
L5、L7 | L1、L2、L3、L4、L6 |
L1、L3 | L2、L4、L5、L6、L7 |
但利用本申请的规划方法可适应上述所有的情况。
本发明的优点在于:
1)本发明在传统S曲线加减速的基础上,引入基于三角函数的加加速度控制方法,能够有效的保证加加速度的连续性,最大限度的减小对数控设备造成的冲击。
2)基于三角函数的加加速度的控制中,保留了匀加加速度段和匀减减速度段,能够充分发挥数控设备最大允许加加速度和加速度的性能,保证较高的生产效率。
3)基于三角函数的加加速度的控制中,提出对加加加速度段、匀加加速度段和减加加速度段三部分运动时间进行等分控制的方法,能够有效简化计算,保证算法的实时性能。
4)本申请是加加速度是从0以三角函数形式增大至最大加加速度,因此无冲击,且本方案可将加加速度维持在最大值,直到合适时再下降,速度变化效率高。
附图说明
图1为根据本发明基于三角函数的改进S曲线加减速控制方法改进后的标准曲线示意图
图2为不包含匀速段的基于三角函数的改进S曲线加减速加速度曲线
图3为不包含匀加速段的基于三角函数的改进S曲线加减速加速度曲线
图4为不包含匀减速段的基于三角函数的改进S曲线加减速加速度曲线
图5为不包含匀加速段和匀减速段的基于三角函数的改进S曲线加减速加速度曲线
图6为不包含匀加速段和匀速段的基于三角函数的改进S曲线加减速加速度曲线
图7为不包含匀减速段和匀速段的基于三角函数的改进S曲线加减速加速度曲线
图8为不包含匀加速段、匀速段和匀减速段的基于三角函数的改进S曲线加减速加速度曲线
图9为仅包含减减速段和加减速段的基于三角函数的改进S曲线加减速加速度曲线
图10为仅包含加加速段和减加速段的基于三角函数的改进S曲线加减速加速度曲线
具体实施方式
下面通过实施例并结合附图对本发明做进一步的说明,但不仅于此。
实施例1:
如图1所示,基于三角函数的改进S曲线加减速控制方法具有7段式结构,分别是:加加速段L1、匀加速度段L2、减加速段L3、匀速段L4、加减速段L5、匀减速段L6和减减速度段L7。对应这7个运动阶段,总运动时间T也被分成了7部分,分别是加加速段时间t1(设为Δt1)、匀加速段时间t2-t1(设为Δt2)、减加速段时间t3-t2(设为Δt3)、匀速段时间t4-t3(设为Δt4)、加减速段时间t5-t4(设为Δt5)、匀减速段时间t6-t5(设为Δt6)和减减速段时间t7-t6(设为Δt7),其中ti(i=1,2...,7)为各阶段过渡点的时刻,Δti(i=1,2...,7)为各阶段时间。
为简化计算,对L1、L3、L5、L7段时间进行三等分,由于加速度的对称关系,存在如下关系
t11=t12-t11=t13-t12=t31-t2=t32-t31=t33-t32=T1,t51=t52-t51=t53-t52=t71-t6=t72-t71=t73-t72=T2 (1)
设T1为L1、L3段内时间三等分分割之后的分段时间长度,设T2为L5、L7段内时间三等分分割之后的分段时间长度,其中tij(i=1,3,5,7;j=1,2,3)为通过三等分方法新获得的过度时刻,同时有如下关系
t13=t1,t33=t3,t53=t5,t73=t7 (2)
分割时间段后,其加加速度表达式如前述公式(3):
τij(i=1,2,..,7;j=1,2,3)为以各个区间段的起点作为时间零点的时间表示。存在如下关系:
τij=t-tij(i=1,3,5,7;j=1,2,3)或τi=t-ti(i=2,4,6) (4)
上述加加速度与加速度、速度、位移的积分关系如前述公式(5)、(6)、(7)。
根据加加速度与加速度之间的积分关系,可得加速度表达式如前述公式(8)。
a2为加速段所能达到的最大加速度,后续规划计算中,在不同假设情况下使用aacci(i=1,2,3,4)表示 a2,即aacci=a2。同理-a6为减速段能达到的最大加速度,后续规划计算中使用adeci(i=1,2,3,4)表示-a6,即adeci=(-a2)。
根据速度与加速度之间的积分关系,可得速度表达式如前述公式(9)。
根据速度与位移之间的积分关系,可得位移表达式如前述公式(10)。
如图1-图10所示,实际使用基于三角函数的改进S曲线加减速方法进行任务规划时,可能并不完全所有的7段,会根据给定的最大加加速度Jcom、最大加速度acom、最大速度vcom、起点速度vs、终点速度 ve、待规划位移S的不同而存在多种情况。规划过程中,通过求解能够真实到达的最大加速度vmax,就可以获得各段的运行时间及每个时刻的速度特性。具体规划如下:
(2.1)假设能够达到的最大速度为vmax1,且vmax1=vcom。
(2.1.1)加速段时间计算,所述加速段包括加加速段L1、匀加速段L2、减加速段L3;
首先分析匀加速段的存在性,假设加速段实际能够达到的最大加速度aacc1为设备允许的最大加速度 acom,即aacc1=acom (11)
根据加加速度与加速度的积分关系,以及加加速段、减加速段的时间等分关系,可获得下式:
3T1=Δt1 (13)
联立(12)-(13),可获得加加速段时间
且存在关系Δt1=Δt3 (15);
假设匀加速段不存在时,仅通过加加速段和减加速段,根据速度关系,速度增量为
Δv=aacc1Δt1 (16)
通过比较速度增量Δv与(vmax1-vs)的关系,可知匀加速段的存在性,如下
(2.1.1.a)Δv<(vmax-vs)
此时说明存在匀加速段,匀加速时间为:
(2.1.1.b)v=(vmax-vs)
此时说明恰好不需要匀加速段。
(2.1.1.c)v>(vmax-vs)
此时说明不存在匀速段,且需要重新计算加加速段和减加速段时间,由速度关系可得
此时加速段实际能够达到的最大加速度为
加速段运动位移为
(2.1.2)减速段时间计算,所述减速段包括加减速段L5、匀减速段L6和减减速段L7;
减速段的处理方式与加速段相同,可获得减速段各段时间Δt5、Δt6、Δt7,计算过程不再赘述。减速段位移为
(2.1.3)匀速段时间计算
根据速度与位移的积分关系,可推导出加速段与减速段的运动总位移为:S1=Sacc1+Sdec1 (22)
通过比较S1与给定的待插补位移S的关系可知匀速段的存在性,如下:
(2.1.3.a)S1<S
此时存在匀速段,匀速段时间为
至此,所有的7段的时间规划已经完成,实际能够达到的最大速度为vmax1=vcom,结束计算。此时规划得到的各段加速度会出现如图1、图3、图4或图5所示的形式。
(2.1.3.b)S1=S
此时存在匀速段不存在,匀速段时间Δt4=0 (24)
至此,所有的7段的时间规划已经完成,实际能够达到的最大速度为vmax1=vcom,结束计算。此时规划得到的各段加速度会出现如图2、图6、图7或图8所示的形式。
(2.1.3.c)S1>S
此时说明假设的最大速度vmax1大于实际所能达到的最大速度vmax,需要继续减小vmax1,进入(2.2)。
(2.2)假设能够达到的最大速度为vmax2,且vmax2为vs与ve中的较大者进行不包含匀加速段的加速过程所能达到的速度。
此时不存在匀速段,即Δt4=0。下面以vs≥ve为例进行推导计算。
(2.2.1)加速段时间计算
对于加速段,根据(2.2)假设条件,不存在匀加速段,即Δt2=0。能够到达的加速度aacc2为数控设备允许的最大加速度acom,即aacc2=acom (25)
根据加速度关系,加加速段与减加速段时间相等,即Δt1=Δt3。有
可求得加加速段和减加速段时间为
由此速度关节,可得最大速度为vmax2=aacc2×Δt1+vs (28)
比较vmax2与vcom的关系,如下:
(2.2.1.a)vmax2>vcom
此时说明假设的最大速度大于实际所能达到的最大速度,若vs>ve,进入(2.3);若vs=ve,进入(2.4)。
(2.2.1.b)vmax2≤vcom
此时说明假设最大速度可能是满足条件的,继续进行计算;
由位移条件,加速段位移为进入(2.2.2)。
(2.2.2)减速段时间计算
由于ve≤vs,因此减速段实际能够达到的最大加速度adec2为设备允许的最大加速度acom,
即adec2=acom (30)
减减速段与加减速段时间为
如果ve<vs,则存在匀减速段,有adec(Δt5+Δt6)=vmax2-ve (32)
则匀减速段时间为
如果ve=vs,则不存在匀减速段,匀减速段时间Δt6=0。
由位移关系,减速段位移为
判断Sacc2+Sdec2与给定的待插补距离S的关系,如下:
(2.2.2.a)Sacc2+Sdec2=S
此时说明假设的最大速度vmax2恰好为实际能够达到的最大速度vmax,所有7段时间都已经计算完成,结束计算。此时规划得到的各段加速度会出现如图6或图8所示的形式。如果vs≤ve,各段加速度可能会出现如图7或图8所示的形式。
(2.2.2.b)Sacc2+Sdec2>S
此时说明假设的最大速度vmax2仍然大于实际能够达到的最大速度vmax,进入(2.3)。
(2.2.2.c)Sacc2+Sdec2<S
此时说明假设的最大速度vmax2小于于实际能达到的最大速度vmax,其取值区间为vmax∈(vmax2,vcom),同时存在匀加速段和匀减速段,但不包含匀速段。具体计算如下:
加速段与减速段实际能够达到的最大加速度为aacc2=adec2=acom (35)
加加速段、减加速段、减减速段、加减速段的时间为
由速度关系,有vmax-vs=acom(Δt1+Δt2) (37)
可得匀加速段时间为
同理可得匀减速段时间vmax-ve=acom(Δt5+Δt6) (39);
由位移关系,有
联立(35)-(41),由总插补位移关系构造方程
其中B=t1,
f(vmax)是vmax二次函数,由于B>0,所以根据求根公式得
通过将vmax带入前述各段时间的计算式,即可计算出各段时间,(各段时间指的是Δt1,Δt2,Δt3、Δt4、Δt5、Δt6、Δt7),完成计算。此时规划得到的各段加速度可能出现如图2所示的形式。
(2.3)假设能够达到的最大速度为vmax3,且vmax3为vs与ve中的较小者进行不包含匀加速段的加速过程所能达到的速度。
此时不存在匀速段,即Δt4=0。下面以vs<ve为例进行推导计算。
(2.3.1)减速段时间计算
对于减速段,根据(2.3)假设条件,不存在匀减速段,即Δt6=0。能够到达的加速度adec3为数控设备允许的最大加速度acom,即adec3=acom (44)
根据加速度关系,减减速段与加减速段时间相等,即Δt5=Δt7有
可求得减减速段与加减速段时间为
由此速度关节,可得最大速度为vmax3=adec2×Δt5+ve (47)
比较vmax3与vcom的关系,如下:
(2.3.1.a)vmax3>vcom
此时说明假设的最大速度大于实际所能达到的最大速度,进入(2.4)。
(2.3.1.b)vmax3≤vcom
此时说明假设最大速度可能是满足条件的,继续进行计算。由位移条件,减速段位移为
(2.3.2)加速段时间计算
由于ve<vs,因此没有匀加速段,即Δt2=0。设加速段所能达到的最大加速度为aacc3。由加速度关系,加加速段与减加速段时间为
由位移关系,加速速段位移为
判断Sacc3+Sdec3与给定的待插补距离S的关系,如下:
(2.3.2.a)Sacc3+Sdec3=S
此时说明假设的最大速度vmax3恰好为实际能够达到的最大速度vmax,所有7段时间都已经计算完成,结束计算。此时规划得到的各段加速度可能出现如图8所示的形式。
(2.3.2.b)Sacc3+Sdec3>S
此时说明假设的最大速度vmax3仍然大于实际能够达到的最大速度vmax,进入(2.4)。
(2.3.2.c)Sacc3+Sdec3<S
此时说明假设的最大速度vmax3小于实际能达到的最大速度vmax,其取值区间为vmax∈(vmax3,vmax2),包含匀减速段,但不包含匀加速段和匀速段。具体计算如下:
由速度关系,加加速段与减加速段时间为
加速段所能达到的最大加速度为
加速段位移为
对于减速段,所能达到的最大加速度为acom,减减速段和减加速段时间为
由速度关系,有vmax-ve=acom(Δt5+Δt6) (55)
可得匀减速段时间为
减速段位移为
由位移关系,可得S3(vmax)=Sacc3+Sdec3 (58)
联立(51)-(58),由总位移关系,构造方程
因为S3(vmax)是vmax的单调递增函数,所以方程f3(vmax)在(vmax3,vmax2)内有且有唯一解,可使用二分法或牛顿迭代法进行求解。根据求解出的vmax可计算出Δt6,至此,已求解出各段时间,完成计算。此时规划得到的各段加速度可能出现如图6所示的形式。如果vs<ve,各段加速度可能出现如图7所示的形式。
(2.4)最大速度vmax的取值范围为[max(vs,ve),vmax3)
此时匀速段、匀加速段和匀减速段都不存在,下面以vs≥ve为例进行推导计算。首先假设最大速度为起点速度,即vmax4=vs,此时加加速段与减加速段都不存在,加速段位移Sacc4为0,仅存在减减速段和加减速段。由加速度关系,减速段实际能达到的最大加速度为
由速度关系,减减速段与加减速段时间相等,即Δt5=Δt7,有
vmax4-ve=adec4Δt5 (61)
联立(60)-(61)可得减减速段与加减速段时间为
由位移关系,减速段位移为
比较Sdec4与待插补位移S的关系,如下:
(2.4.a)Sdec4>S
此时说明假设的最大速度vmax4要小于起点速度vs,因此在给定条件下不存在最大速度无解,结束计算。
(2.4.b)Sdec4=S
此时说明假设的最大速度vmax4恰好等于实际能够达到的最大速度vmax,即vmax=vmax4,结束计算。此时规划得到的各段加速度可能出现如图9所示的形式。如果vs≤ve,各段加速度可能出现如图10所示的形式。
(2.4.c)Sdec4<S
此时说明实际能够达到的最大速度vmax应大于vmax4,其取值范围为vmax∈(vmax4,vmax3)。由加速度关系,加加速段与减加速段时间相等,即Δt1=Δt3。加速段实际能够达到的加速度为
由速度关系,有vmax-vs=aacc4Δt1 (65)
由位移关系,可得加速段位移为
同理,有减速段相关关系
vmax-ve=adec4Δt5 (68);
由位移关系得S4(vmax)=Sacc4+Sdec4 (70)
由总位移关系,联立(63)-(70),构建方程
S(vmax)为vmax的单调递增函数,因此在(vmax4,vmax3)内有且有唯一解,可使用二分法或牛顿迭代法求解。获得vmax后,即可计算出各段时间,完成计算。此时规划得到的各段加速度可能出现如图8所示的形式。
实验例1
利用实施例1所述的控制方法,用c++编程,放入MATLAB优化算法求得对应图像。
本实验例为不包含匀速段的情况,设定表2数据如下。
表2
初始参数 | jmax | amax | vcom | vs | ve | s | |
参数值 | 5×104mm/s3 | 1500mm/s2 | 100mm/s | 10mm/s | 20mm/s | 10mm | |
时间(ms) | T1=39.59 | T2=18.62 | T3=39.59 | T4=0 | T5=39.59 | T6=11.95 | T7=39.59 |
位移(mm) | 0.74 | 1.72 | 5.02 | 5.02 | 8.45 | 9.14 | 10 |
在MATLAB中运行后,得出对应图2的曲线图,由表中可知,运行完成后,位移完成设定,由图2可知,整个过程速度平滑。
实验例2
利用实施例1所述的控制方法,用C++编程,放入MATLAB优化算法求得对应图像。
本实验例为不包含匀加速段的情况,设定表3数据如下。
表3
初始参数 | jmax | amax | vcom | vs | ve | s | |
参数值 | 5×104mm/s3 | 1500mm/s2 | 100mm/s | 60mm/s | 20mm/s | 15mm | |
时间(ms) | T1=32.49 | T2=0 | T3=32.49 | T4=42.26 | T5=39.59 | T6=13.74 | T7=39.59 |
位移(mm) | 2.11 | 2.11 | 5.03 | 9.22 | 12.76 | 13.57 | 15 |
在MATLAB中运行后,得出对应图3的曲线图,由表中可知,运行完成后,位移完成设定,由图3可知,整个过程速度平滑。
实验例3
利用实施例1所述的控制方法,用C++编程,放入MATLAB优化算法求得对应图像。
本实验例为不包含匀减速段的情况,设定表4数据如下。
表4
初始参数 | jmax | amax | vcom | vs | ve | s | |
参数值 | 5×104mm/s3 | 1500mm/s2 | 100mm/s | 10mm/s | 50mm/s | 20mm | |
时间(ms) | T1=39.59 | T2=20.41 | T3=39.59 | T4=90.73 | T5=36.33 | T6=0 | T7=36.33 |
位移(mm) | 0.74 | 1.84 | 5.24 | 14.2 | 17.49 | 17.49 | 20 |
在MATLAB中运行后,得出对应图4的曲线图,由表中可知,运行完成后,位移完成设定,由图4可知,整个过程速度平滑。
实验例4
利用实施例1所述的控制方法,用C++编程,放入MATLAB优化算法求得对应图像。
本实验例为不包含匀加速段和匀减速段的情况,设定表5数据如下。
表5
初始参数 | jmax | amax | vcom | vs | ve | s | |
参数值 | 5×104mm/s3 | 1500mm/s2 | 100mm/s | 50mm/s | 55mm/s | 15mm | |
时间(ms) | T1=36.33 | T2=0 | T3=36.33 | T4=42.09 | T5=34.46 | T6=0 | T7=34.46 |
位移(mm) | 2.07 | 2.07 | 5.27 | 9.43 | 12.59 | 12.59 | 15 |
在MATLAB中运行后,得出对应图5的曲线图,由表中可知,运行完成后,位移完成设定,由图5可知,整个过程速度平滑。
实验例5
利用实施例1所述的控制方法,用C++编程,放入MATLAB优化算法求得对应图像。
本实验例为不包含匀加速段和匀速段的情况,设定表6数据如下。
表6
初始参数 | jmax | amax | vcom | vs | ve | s | |
参数值 | 5×104mm/s3 | 1500mm/s2 | 100mm/s | 70mm/s | 25mm/s | 10mm | |
时间(ms) | T1=30.13 | T2=0 | T3=30.13 | T4=0 | T5=39.59 | T6=16.67 | T7=39.59 |
位移(mm) | 2.26 | 2.26 | 5.17 | 5.17 | 8.91 | 9.95 | 10 |
在MATLAB中运行后,得出对应图6的曲线图,由表中可知,运行完成后,位移完成设定,由图6可知,整个过程速度平滑。
实验例6
利用实施例1所述的控制方法,用C++编程,放入MATLAB优化算法求得对应图像。
本实验例为不包含匀减速段和匀速段的情况,设定表7数据如下。
表7
初始参数 | jmax | amax | vcom | vs | ve | s | |
参数值 | 5×104mm/s3 | 1500mm/s2 | 100mm/s | 20mm/s | 60mm/s | 10mm | |
时间(ms) | T1=39.59 | T2=13.33 | T3=39.59 | T4=0 | T5=32.24 | T6=0 | T7=32.24 |
位移(mm) | 1.12 | 1.89 | 5.22 | 5.22 | 8.12 | 8.12 | 10 |
在MATLAB中运行后,得出对应图7的曲线图,由表中可知,运行完成后,位移完成设定,由图7可知,整个过程速度平滑。
实验例7
利用实施例1所述的控制方法,用C++编程,放入MATLAB优化算法求得对应图像。
本实验例为不包含匀加速段、匀速段和匀减速段的情况,设定表8数据如下。
表8
初始参数 | jmax | amax | vcom | vs | ve | s | |
参数值 | 5×104mm/s3 | 1500mm/s2 | 100mm/s | 20mm/s | 30mm/s | 7mm | |
时间(ms) | T1=37.53 | T2=0 | T3=37.53 | T4=0 | T5=33.83 | T6=0 | T7=33.83 |
位移(mm) | 1.04 | 1.04 | 3.33 | 3.33 | 5.55 | 5.55 | 7 |
在MATLAB中运行后,得出对应图8的曲线图,由表中可知,运行完成后,位移完成设定,由图8可知,整个过程速度平滑。
实验例8
利用实施例1所述的控制方法,用C++编程,放入MATLAB优化算法求得对应图像。
本实验例为仅包含减减速段和加减速段的情况,设定表9数据如下。
表9
初始参数 | jmax | amax | vcom | vs | ve | s | |
参数值 | 5×104mm/s3 | 1500mm/s2 | 50mm/s | 60mm/s | 20mm/s | 8mm | |
时间(ms) | T1=0 | T2=0 | T3=0 | T4=90.01 | T5=32.49 | T6=0 | T7=32.49 |
位移(mm) | 0 | 0 | 0 | 5.4 | 7.14 | 7.14 | 8 |
在MATLAB中运行后,得出对应图9的曲线图,由表中可知,运行完成后,位移完成设定,由图9可知,整个过程速度平滑。
实验例9
利用实施例1所述的控制方法,用C++编程,放入MATLAB优化算法求得对应图像。
本实验例为仅包含加加速段和减加速段的情况,设定表10数据如下。
表10
初始参数 | jmax | amax | vcom | vs | ve | s | |
参数值 | 5×104mm/s3 | 1500mm/s2 | 60mm/s | 30mm/s | 60mm/s | 7mm | |
时间(ms) | T1=28.13 | T2=0 | T3=28.13 | T4=74.46 | T5=0 | T6=0 | T7=0 |
位移(mm) | 0.96 | 0.96 | 2.45 | 7 | 7 | 7 | 7 |
在MATLAB中运行后,得出对应图10的曲线图,由表中可知,运行完成后,位移完成设定,由图10 可知,整个过程速度平滑。
Claims (3)
1.一种基于三角函数的改进S曲线加减速控制方法,其特征在于,将曲线按照不同的运动特点分阶段,规划过程中通过参数限制和实际情况讨论各阶段是否存在,以获得各阶段的运行时间,进而得到规划后的位移曲线。
2.根据权利要求1所述的基于三角函数的改进S曲线加减速控制方法,其特征在于,其曲线按时间顺序包括七个阶段,分别是:加加速段L1、匀加速段L2、减加速段L3、匀速段L4、加减速段L5、匀减速段L6和减减速段L7;每个阶段对应的时间为:加加速段时间Δt1,Δt1=t1;匀加速段时间Δt2,Δt2=t2-t1;减加速段时间Δt3,Δt3=t3-t2;匀速段时间Δt4,Δt4=t4-t3;加减速段时间Δt5,Δt5=t5-t4;匀减速段时间Δt6,Δt6=t6-t5;减减速段时间Δt7,Δt7=t7-t6;其中ti为各阶段过渡点的时刻,i=1,2...,7,Δti为各阶段时间,i=1,2...,7;
(1.1)将L1、L3、L5、L7段的时间分别分割为三部分,tij为分割后过渡点的时刻,i=1,3,5,7;j=1,2,3;
(2.1)假设能够达到的最大速度为vmax1,且vmax1=vcom,
(2.1.1)加速段时间计算,所述加速段包括加加速段L1、匀加速段L2、减加速段L3;
首先分析匀加速段L2的存在性,假设加速段实际能够达到的最大加速度aacc1为数控设备允许的最大加速度acom,
aacc1=acom (11)
根据加加速度与加速度的积分关系,以及加加速段、减加速段的时间等分关系,可获得下式:
3T1=Δt1 (13);
联立(12)-(13),可获得加加速段时间
且存在关系Δt1=Δt3 (15);
假设匀加速段L2不存在时,仅通过加加速段和减加速段,根据速度关系,速度增量为
Δv=aacc1Δt1 (16)
通过比较速度增量Δv与(vmax1-vs)的关系,可知匀加速段L2的存在性,判断如下:
(2.1.1.a)Δv<(vmax-vs)
此时说明存在匀加速段L2,匀加速段的时间为:
(2.1.1.b)Δv=(vmax-vs)
此时说明无匀加速段L2;
(2.1.1.c)Δv>(vmax-vs)
此时说明不存在匀加速段L2,且需要重新计算加加速段L1和减加速段L3的时间,由速度关系可得
此时加速段实际能够达到的最大加速度为
加速段运动位移为
(2.1.2)减速段时间计算,所述减速段包括加减速段L5、匀减速段L6和减减速段L7;
减速段的处理方式与加速段相同,通过上述算法获得减速段各段时间Δt5、Δt6、Δt7:先分析匀减速段L6的存在性,假设减速段实际能够达到的最大加速度adec1为数控设备允许的最大加速度acom,根据加加速度与加速度的积分关系,以及加减速段、减减速段的时间等分关系,可求得Δt5,Δt7=Δt5;假设匀减速段L6不存在,仅通过加减速段和减减速段,根据速度关系,速度增量为Δv=aacc1Δt1,通过比较速度增量Δv与vmax-ve的关系,可知匀减速段L6的存在性,进而求出三种不同情况的Δt5、Δt6、Δt7);
减速段位移为
(2.1.3)匀速段时间计算
根据速度与位移的积分关系,可推导出加速段与减速段的运动总位移为:
S1=Sacc1+Sdec1 (22),
通过比较S1与给定的待插补位移S的关系可知匀速段的存在性,如下:
(2.1.3.a)S1<S
此时存在匀速段,匀速段时间为
至此,所有的7段的时间规划已经完成,实际能够达到的最大速度为vmax1=vcom,结束计算;
(2.1.3.b)S1=S
此时存在匀速段不存在,匀速段时间Δt4=0(24)
至此,所有的7段的时间规划已经完成,实际能够达到的最大速度为vmax1=vcom,结束计算;
(2.1.3.c)S1>S
此时说明假设的最大速度vmax1大于实际所能达到的最大速度vmax,需要继续减小vmax1,进入(2.2);
(2.2)假设能够达到的最大速度为vmax2,且vmax2为vs与ve中的较大者进行不包含匀加速段的加速过程所能达到的速度;此时不存在匀速段,即Δt4=0;设定vs≥ve;
(2.2.1)加速段时间计算
对于加速段,根据(2.2)假设条件,不存在匀加速段,即Δt2=0;能够到达的加速度aacc2为数控设备允许的最大加速度acom,aacc2=acom (25);
根据加速度关系,加加速段与减加速段时间相等,即Δt1=Δt3,有
求得加加速段和减加速段时间为
根据速度关系,得最大速度为vmax2=aacc2×Δt1+vs (28)
比较vmax2与vcom的关系,如下:
(2.2.1.a)vmax2>vcom
此时说明假设的最大速度大于实际所能达到的最大速度,若vs>ve,进入(2.3);若vs=ve,进入(2.4);
(2.2.1.b)vmax2≤vcom
此时说明假设最大速度可能是满足条件的,继续进行计算;
由位移条件,加速段位移为进入(2.2.2);
(2.2.2)减速段时间计算
ve≤vs,因此减速段实际能够达到的最大加速度adec2为数控设备允许的最大加速度
acom,adec2=acom(30)
减减速段与加减速段时间为
如果ve<vs,则存在匀减速段,有adec(Δt5+Δt6)=vmax2-ve(32)
则匀减速段时间为
如果ve=vs,则不存在匀减速段,匀减速段时间Δt6=0;
由位移关系,减速段位移为
判断Sacc2+Sdec2与给定的待插补距离S的关系,如下:
(2.2.2.a)Sacc2+Sdec2=S
此时说明假设的最大速度vmax2恰好为实际能够达到的最大速度vmax,所有7段时间都已经计算完成,结束计算;
(2.2.2.b)Sacc2+Sdec2>S
此时说明假设的最大速度vmax2仍然大于实际能够达到的最大速度vmax,进入(2.3);
(2.2.2.c)Sacc2+Sdec2<S
此时说明假设的最大速度vmax2小于实际能达到的最大速度vmax,其取值区间为vmax∈(vmax2,vcom),同时存在匀加速段和匀减速段,但不包含匀速段;具体计算如下:
加速段与减速段实际能够达到的最大加速度为aacc2=adec2=acom (35)
加加速段、减加速段、减减速段、加减速段的时间为
由速度关系,有vmax-vs=acom(Δt1+Δt2) (37)
可得匀加速段时间为
同理可得匀减速段时间vmax-ve=acom(Δt5+Δt6) (39);
由位移关系,有
联立(35)-(41),由总插补位移关系构造方程
其中B=t1,
f(vmax)是vmax二次函数,由于B>0,所以根据求根公式得
通过将vmax带入前述各段时间的计算式,即计算出各段时间,完成计算;
(2.3)假设能够达到的最大速度为vmax3,且vmax3为vs与ve中的较小者进行不包含匀加速段的加速过程所能达到的速度;此时不存在匀速段,Δt4=0;设定vs<ve,
(2.3.1)减速段时间计算
对于减速段,根据(2.3)假设条件,不存在匀减速段,Δt6=0;能够到达的加速度adec3为数控设备允许的最大加速度acom,即adec3=acom (44)
根据加速度关系,减减速段与加减速段时间相等,Δt5=Δt7,有
求得减减速段与加减速段时间为
根据速度关系,得最大速度为vmax3=adec2×Δt5+ve (47)
比较vmax3与vcom的关系,如下:
(2.3.1.a)vmax3>vcom
此时说明假设的最大速度大于实际所能达到的最大速度,进入(2.4);
(2.3.1.b)vmax3≤vcom
此时说明假设最大速度是满足条件的,继续进行计算,由位移条件,减速段位移为
(2.3.2)加速段时间计算
由于ve<vs,因此没有匀加速段,即Δt2=0,设加速段所能达到的最大加速度设为aacc3,由加速度关系,加加速段与减加速段时间为
由位移关系,加速速段位移为
判断Sacc3+Sdec3与给定的待插补距离S的关系,如下:
(2.3.2.a)Sacc3+Sdec3=S
此时说明假设的最大速度vmax3恰好为实际能够达到的最大速度vmax,所有7段时间都已经计算完成,结束计算;
(2.3.2.b)Sacc3+Sdec3>S
此时说明假设的最大速度vmax3仍然大于实际能够达到的最大速度vmax,进入(2.4);
(2.3.2.c)Sacc3+Sdec3<S
此时说明假设的最大速度vmax3小于实际能达到的最大速度vmax,其取值区间为vmax∈(vmax3,vmax2),包含匀减速段,但不包含匀加速段和匀速段,计算如下:
由速度关系,加加速段与减加速段时间为
加速段所能达到的最大加速度为
加速段位移为
对于减速段,所能达到的最大加速度为acom,减减速段和减加速段时间为
由速度关系,有vmax-ve=acom(Δt5+Δt6) (55)
可得匀减速段时间为
减速段位移为
由位移关系,可得S3(vmax)=Sacc3+Sdec3 (58)
联立(51)-(58),由总位移关系,构造方程
因为S3(vmax)是vmax的单调递增函数,所以方程f3(vmax)在(vmax3,vmax2)内有且有唯一解,可使用二分法或牛顿迭代法进行求解,根据求解出的vmax可计算出Δt6,至此,已求解出各段时间,完成计算;
(2.4)最大速度vmax的取值范围为[max(vs,ve),vmax3)
此时匀速段、匀加速段和匀减速段都不存在,设定vs≥ve,进行推导计算:首先假设最大速度为起点速度,即vmax4=vs,此时加加速段与减加速段都不存在,加速段位移Sacc4为0,仅存在减减速段和加减速段,由加速度关系,减速段实际能达到的最大加速度为
由速度关系,减减速段与加减速段时间相等,即Δt5=Δt7,有
vmax4-ve=adec4Δt5 (61)
联立(60)-(61)可得减减速段与加减速段时间为
由位移关系,减速段位移为
比较Sdec4与待插补位移S的关系,如下:
(2.4.a)Sdec4>S
此时说明假设的最大速度vmax4要小于起点速度vs,因此在给定条件下不存在最大速度,无解,结束计算;
(2.4.b)Sdec4=S
此时说明假设的最大速度vmax4恰好等于实际能够达到的最大速度vmax,即vmax=vmax4,结束计算;
(2.4.c)Sdec4<S
此时说明实际能够达到的最大速度vmax应大于vmax4,其取值范围为vmax∈(vmax4,vmax3),由加速度关系,加加速段与减加速段时间相等,即Δt1=Δt3,加速段实际能够达到的加速度为
由速度关系,有vmax-vs=aacc4Δt1 (65)
由位移关系,可得加速段位移为
同理,有减速段相关关系
vmax-ve=adec4Δt5 (68);
由位移关系得S4(vmax)=Sacc4+Sdec4 (70)
由总位移关系,联立(63)-(70),构建方程
S(vmax)为vmax的单调递增函数,因此在(vmax4,vmax3)内有且有唯一解,可使用二分法或牛顿迭代法求解,获得vmax后,根据求解出的vmax可计算出Δt6,至此,已求解出各段时间,完成计算。
3.根据权利要求2所述的基于三角函数的改进S曲线加减速控制方法,其特征在于,优选的,步骤(1.1)中,将L1、L3、L5、L7段的时间分别进行三等分分割,设T1为L1、L3段内时间三等分分割之后的分段时间长度,设T2为L5、L7段内时间三等分分割之后的分段时间长度,由于加速度的对称关系,存在如下关系
t11=t12-t11=t13-t12=t31-t2=t32-t31=t33-t32=T1,t51=t52-t51=t53-t52=t71-t6=t72-t71=t73-t72=T2 (1)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710587160.4A CN108287527B (zh) | 2017-07-18 | 2017-07-18 | 一种基于三角函数的改进s曲线加减速控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710587160.4A CN108287527B (zh) | 2017-07-18 | 2017-07-18 | 一种基于三角函数的改进s曲线加减速控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108287527A true CN108287527A (zh) | 2018-07-17 |
CN108287527B CN108287527B (zh) | 2019-02-01 |
Family
ID=62831482
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710587160.4A Active CN108287527B (zh) | 2017-07-18 | 2017-07-18 | 一种基于三角函数的改进s曲线加减速控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108287527B (zh) |
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107825424A (zh) * | 2017-10-31 | 2018-03-23 | 河北工业大学 | 一种高速机械手减少残余振动的非对称s型轨迹规划方法 |
CN109240215A (zh) * | 2018-11-22 | 2019-01-18 | 山东易码智能科技股份有限公司 | 一种基于改进型s曲线加减速的pvt控制方法 |
CN109332910A (zh) * | 2018-09-18 | 2019-02-15 | 大族激光科技产业集团股份有限公司 | 一种激光切割的速度调节方法以及系统 |
CN110109491A (zh) * | 2019-05-30 | 2019-08-09 | 深圳市众为创造科技有限公司 | 连续s曲线加减速运动控制方法、系统及电子设备 |
CN110109490A (zh) * | 2019-04-16 | 2019-08-09 | 浙江工业大学 | 一种步进电机驱动机头的自适应速度控制方法 |
CN110175339A (zh) * | 2018-09-20 | 2019-08-27 | 北京神工科技有限公司 | 一种s型加减速的最优时间分配方法及装置 |
CN110209173A (zh) * | 2019-06-28 | 2019-09-06 | 中科新松有限公司 | 基于s型速度规划的时间最优在线轨迹规划方法 |
CN110601617A (zh) * | 2019-09-02 | 2019-12-20 | 歌尔股份有限公司 | 步进电机控制方法、装置、系统及存储介质 |
CN111273708A (zh) * | 2020-03-13 | 2020-06-12 | 湖南网大科技有限公司 | 一种作业机械加速运动控制装置和方法 |
CN111352342A (zh) * | 2018-12-20 | 2020-06-30 | 沈阳高精数控智能技术股份有限公司 | 一种基于转台控制的伺服驱动器的优化控制方法 |
CN111381565A (zh) * | 2018-12-27 | 2020-07-07 | 沈阳高精数控智能技术股份有限公司 | 三次多项式s曲线加减速的加加速度递归计算限制方法 |
CN111487930A (zh) * | 2020-04-24 | 2020-08-04 | 东莞市精驰软件有限公司 | 基于对称图形替换技术的运动控制系统、方法、装置、机床和存储介质 |
CN111562766A (zh) * | 2020-05-08 | 2020-08-21 | 重庆科技学院 | 十字滑台性能仿真控制方法、系统、存储介质、计算机 |
CN111711387A (zh) * | 2020-07-01 | 2020-09-25 | 浙江工业大学 | 一种智能手套机电机的柔性速度控制方法 |
CN111966047A (zh) * | 2020-08-04 | 2020-11-20 | 天津大学 | 基于三角函数加减速控制的三轴微线段直接速度过渡方法 |
CN112327954A (zh) * | 2020-11-14 | 2021-02-05 | 大连理工大学 | 非对称s型速度曲线控制的直线电机高精定位方法 |
CN112706166A (zh) * | 2020-12-22 | 2021-04-27 | 江苏集萃智能制造技术研究所有限公司 | 一种基于s型与三角函数的多关节同步轨迹规划方法 |
CN113359620A (zh) * | 2021-06-15 | 2021-09-07 | 深圳市旗众智能科技有限公司 | 一种用于轴运动的软限位控制方法及基于rtx64的开放式运动控制器 |
CN113467466A (zh) * | 2021-07-22 | 2021-10-01 | 珠海格力电器股份有限公司 | 一种工业机器人控制方法、装置及工业机器人 |
CN113534789A (zh) * | 2021-05-18 | 2021-10-22 | 杭州壹悟科技有限公司 | 移动机器人三次多项式速度曲线实时规划方法及装置 |
CN113852306A (zh) * | 2021-09-30 | 2021-12-28 | 浙江众邦机电科技有限公司 | 缝纫机的送布电机控制方法、系统、缝纫机及存储介质 |
CN114035504A (zh) * | 2021-11-05 | 2022-02-11 | 天津大学 | 基于时间最优的加减速控制方法、数控系统、介质、机床 |
CN114227655A (zh) * | 2021-12-30 | 2022-03-25 | 深圳市英威腾电气股份有限公司 | 确定规划路径的方法、装置、scara机器人及介质 |
WO2023134746A1 (zh) * | 2022-01-13 | 2023-07-20 | 达闼机器人股份有限公司 | 可移动设备的速度控制方法、装置、可移动设备、存储介质及计算机程序 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103279069A (zh) * | 2013-03-25 | 2013-09-04 | 昆山天大精益数控科技发展有限公司 | 用于数控机床的三角函数二阶连续可导加减速算法 |
CN104150301A (zh) * | 2014-07-25 | 2014-11-19 | 永大电梯设备(中国)有限公司 | 电梯运行曲线修正方法 |
CN105629882A (zh) * | 2014-11-07 | 2016-06-01 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于样条插补的三角函数速度规划方法 |
CN106201996A (zh) * | 2016-07-19 | 2016-12-07 | 宝鸡文理学院 | 一种改进的三角函数切换算法 |
CN106647637A (zh) * | 2015-11-03 | 2017-05-10 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于高质量加工的三角函数加减速控制方法 |
-
2017
- 2017-07-18 CN CN201710587160.4A patent/CN108287527B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103279069A (zh) * | 2013-03-25 | 2013-09-04 | 昆山天大精益数控科技发展有限公司 | 用于数控机床的三角函数二阶连续可导加减速算法 |
CN104150301A (zh) * | 2014-07-25 | 2014-11-19 | 永大电梯设备(中国)有限公司 | 电梯运行曲线修正方法 |
CN105629882A (zh) * | 2014-11-07 | 2016-06-01 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于样条插补的三角函数速度规划方法 |
CN106647637A (zh) * | 2015-11-03 | 2017-05-10 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于高质量加工的三角函数加减速控制方法 |
CN106201996A (zh) * | 2016-07-19 | 2016-12-07 | 宝鸡文理学院 | 一种改进的三角函数切换算法 |
Non-Patent Citations (1)
Title |
---|
崔洁等: "步进电机加减速曲线的算法研究", 《电子工业专用设备》 * |
Cited By (35)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107825424B (zh) * | 2017-10-31 | 2020-05-26 | 河北工业大学 | 一种高速机械手减少残余振动的非对称s型轨迹规划方法 |
CN107825424A (zh) * | 2017-10-31 | 2018-03-23 | 河北工业大学 | 一种高速机械手减少残余振动的非对称s型轨迹规划方法 |
CN109332910A (zh) * | 2018-09-18 | 2019-02-15 | 大族激光科技产业集团股份有限公司 | 一种激光切割的速度调节方法以及系统 |
CN110175339B (zh) * | 2018-09-20 | 2023-01-10 | 北京神工科技有限公司 | 一种s型加减速的最优时间分配方法及装置 |
CN110175339A (zh) * | 2018-09-20 | 2019-08-27 | 北京神工科技有限公司 | 一种s型加减速的最优时间分配方法及装置 |
CN109240215A (zh) * | 2018-11-22 | 2019-01-18 | 山东易码智能科技股份有限公司 | 一种基于改进型s曲线加减速的pvt控制方法 |
CN111352342A (zh) * | 2018-12-20 | 2020-06-30 | 沈阳高精数控智能技术股份有限公司 | 一种基于转台控制的伺服驱动器的优化控制方法 |
CN111352342B (zh) * | 2018-12-20 | 2022-03-29 | 沈阳中科数控技术股份有限公司 | 一种基于转台控制的伺服驱动器的优化控制方法 |
CN111381565B (zh) * | 2018-12-27 | 2023-02-21 | 沈阳中科数控技术股份有限公司 | 三次多项式s曲线加减速的加加速度递归计算限制方法 |
CN111381565A (zh) * | 2018-12-27 | 2020-07-07 | 沈阳高精数控智能技术股份有限公司 | 三次多项式s曲线加减速的加加速度递归计算限制方法 |
CN110109490A (zh) * | 2019-04-16 | 2019-08-09 | 浙江工业大学 | 一种步进电机驱动机头的自适应速度控制方法 |
CN110109491A (zh) * | 2019-05-30 | 2019-08-09 | 深圳市众为创造科技有限公司 | 连续s曲线加减速运动控制方法、系统及电子设备 |
CN110209173A (zh) * | 2019-06-28 | 2019-09-06 | 中科新松有限公司 | 基于s型速度规划的时间最优在线轨迹规划方法 |
CN110601617A (zh) * | 2019-09-02 | 2019-12-20 | 歌尔股份有限公司 | 步进电机控制方法、装置、系统及存储介质 |
CN111273708A (zh) * | 2020-03-13 | 2020-06-12 | 湖南网大科技有限公司 | 一种作业机械加速运动控制装置和方法 |
CN111487930A (zh) * | 2020-04-24 | 2020-08-04 | 东莞市精驰软件有限公司 | 基于对称图形替换技术的运动控制系统、方法、装置、机床和存储介质 |
CN111487930B (zh) * | 2020-04-24 | 2022-08-05 | 东莞市精驰软件有限公司 | 基于对称图形替换技术的运动控制系统、方法、装置、机床和存储介质 |
CN111562766A (zh) * | 2020-05-08 | 2020-08-21 | 重庆科技学院 | 十字滑台性能仿真控制方法、系统、存储介质、计算机 |
CN111711387A (zh) * | 2020-07-01 | 2020-09-25 | 浙江工业大学 | 一种智能手套机电机的柔性速度控制方法 |
CN111966047A (zh) * | 2020-08-04 | 2020-11-20 | 天津大学 | 基于三角函数加减速控制的三轴微线段直接速度过渡方法 |
CN111966047B (zh) * | 2020-08-04 | 2022-01-28 | 天津大学 | 基于三角函数加减速控制的三轴微线段直接速度过渡方法 |
CN112327954A (zh) * | 2020-11-14 | 2021-02-05 | 大连理工大学 | 非对称s型速度曲线控制的直线电机高精定位方法 |
CN112706166A (zh) * | 2020-12-22 | 2021-04-27 | 江苏集萃智能制造技术研究所有限公司 | 一种基于s型与三角函数的多关节同步轨迹规划方法 |
CN113534789B (zh) * | 2021-05-18 | 2024-04-05 | 杭州壹悟科技有限公司 | 移动机器人三次多项式速度曲线实时规划方法及装置 |
CN113534789A (zh) * | 2021-05-18 | 2021-10-22 | 杭州壹悟科技有限公司 | 移动机器人三次多项式速度曲线实时规划方法及装置 |
CN113359620A (zh) * | 2021-06-15 | 2021-09-07 | 深圳市旗众智能科技有限公司 | 一种用于轴运动的软限位控制方法及基于rtx64的开放式运动控制器 |
CN113359620B (zh) * | 2021-06-15 | 2022-03-15 | 深圳市旗众智能科技有限公司 | 一种用于轴运动的软限位控制方法及基于rtx64的开放式运动控制器 |
CN113467466A (zh) * | 2021-07-22 | 2021-10-01 | 珠海格力电器股份有限公司 | 一种工业机器人控制方法、装置及工业机器人 |
CN113852306B (zh) * | 2021-09-30 | 2024-02-13 | 浙江众邦机电科技有限公司 | 缝纫机的送布电机控制方法、系统、缝纫机及存储介质 |
CN113852306A (zh) * | 2021-09-30 | 2021-12-28 | 浙江众邦机电科技有限公司 | 缝纫机的送布电机控制方法、系统、缝纫机及存储介质 |
CN114035504B (zh) * | 2021-11-05 | 2024-03-19 | 天津大学 | 基于时间最优的加减速控制方法、数控系统、介质、机床 |
CN114035504A (zh) * | 2021-11-05 | 2022-02-11 | 天津大学 | 基于时间最优的加减速控制方法、数控系统、介质、机床 |
CN114227655A (zh) * | 2021-12-30 | 2022-03-25 | 深圳市英威腾电气股份有限公司 | 确定规划路径的方法、装置、scara机器人及介质 |
CN114227655B (zh) * | 2021-12-30 | 2024-06-04 | 深圳市英威腾电气股份有限公司 | 确定规划路径的方法、装置、scara机器人及介质 |
WO2023134746A1 (zh) * | 2022-01-13 | 2023-07-20 | 达闼机器人股份有限公司 | 可移动设备的速度控制方法、装置、可移动设备、存储介质及计算机程序 |
Also Published As
Publication number | Publication date |
---|---|
CN108287527B (zh) | 2019-02-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108287527B (zh) | 一种基于三角函数的改进s曲线加减速控制方法 | |
CN101833306B (zh) | 一种基于前瞻-滤波技术的多程序段连续加减速控制方法 | |
CN104678899A (zh) | 曲线速度规划方法、装置及其数控加工路径数据处理方法 | |
CN109359888B (zh) | 一种多设备工序间存在紧密衔接约束的综合调度方法 | |
CN108319228A (zh) | 一种数控系统轨迹规划中加减速控制方法 | |
CN102419570A (zh) | 数控机床高速加工的加减速前瞻控制方法 | |
CN102945020A (zh) | 速度前瞻的方法及其数控装置、数控系统 | |
CN106020122B (zh) | 基于牛顿迭代的数控轨迹控制方法 | |
CN104732355A (zh) | 设备空闲时间段调整的设备驱动综合调度方法 | |
CN108829045B (zh) | 连续微直线段的衔接速度的优化方法及系统 | |
CN104181860A (zh) | 数控机床s型加减速控制方法 | |
CN109556610B (zh) | 一种路径规划方法、控制器及系统 | |
CN103324141B (zh) | 一种高精度变插补周期的多轴联动运动控制方法 | |
CN106773668A (zh) | 一种用于变时延双边遥操作系统的稳定控制方法 | |
CN107765648A (zh) | 一种cnc加工的进给速度规划方法及装置 | |
CN107272598A (zh) | 一种加工路径长度已知的nurbs曲线插补方法 | |
CN103279069A (zh) | 用于数控机床的三角函数二阶连续可导加减速算法 | |
CN103941647A (zh) | 用于嵌入式数控设备的柔性加减速控制插补方法 | |
CN108958173A (zh) | 基于梯形求解的任意位移速度下的s曲线加减速规划方法 | |
CN104375468B (zh) | 数控设备cnc系统前瞻滚动处理方法 | |
CN104597845A (zh) | 一种用于高质量加工的样条曲线插补算法 | |
CN103163838A (zh) | 一种用于数控机床加减速的控制方法 | |
CN111319255A (zh) | 一种3d打印尖锐轨迹的处理方法 | |
CN103838520A (zh) | 一种输入/输出流量控制方法及设备 | |
CN103246236B (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 |