CN104483906A - 一种离散采样的s曲线加减速控制方法及装置 - Google Patents
一种离散采样的s曲线加减速控制方法及装置 Download PDFInfo
- Publication number
- CN104483906A CN104483906A CN201510011320.1A CN201510011320A CN104483906A CN 104483906 A CN104483906 A CN 104483906A CN 201510011320 A CN201510011320 A CN 201510011320A CN 104483906 A CN104483906 A CN 104483906A
- Authority
- CN
- China
- Prior art keywords
- acceleration
- pulse
- frequency
- speed
- curve
- 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.)
- Pending
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/4166—Controlling feed or in-feed
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Stepping Motors (AREA)
Abstract
本发明属于数控加工技术领域,具体是一种离散采样的S曲线加减速控制方法及装置。根据单个采样周期内位移增量是对速度增量积分,也是对加速度增量二重积分的关系,本发明通过纯硬件实现了高频采样的S曲线加减速控制方法。基于现场可编程门阵列运动控制器硬件平台,利用硬件描述语言设计了包括采样周期、速度控制、计数比较和脉冲发生等功能的运动控制模块;分析了S曲线各变速点的判断方法;通过对电机位置、速度及加速度的实时反馈比较,改变加加速的状态,进而改变加速度累加器和速度累加器的值,实现了对驱动脉冲频率的S曲线控制。本发明采样频率高,可重构复用;驱动脉冲频率变化连续、平滑,提高了电机运行效率和数控系统的可靠性。
Description
技术领域
本发明涉及数控机床的数字控制加工技术领域,具体是一种离散采样的S曲线加减速控制方法及其装置。
背景技术
在计算机数字控制系统(CNC,Computer Numerical Control)中,为避免各轴产生冲击、失步、超程和振荡,以保证运动部件的平稳和准确定位,必须进行加减速控制,以使进给速度平滑过渡。常用的加减速控制有直线加减速、指数加减速、S曲线加减速等方法。直线加减速和指数加减速,虽然计算量小,编程简单,但是在加减速阶段存在加速度突变的现象,导致机床产生剧烈振动,不适合用于数控机床的高速加工。S曲线加减速方法可实现加减速过程中加速度的连续变化,能够有效减小冲击和振荡。而S曲线加减速控制要实现多阶段和自动加减速控制,参数调整不易,算法实现较为复杂,因而S曲线加减速控制多用软件来实现。
目前数控系统大都基于数据采样控制系统,其数据采样周期均为一固定时间周期常数,从2-8ms不等。在数据采样控制系统中,所有不同处理步骤的时间理论上必须为该周期的整数倍,但实际上会有误差,因此会带来相应的量化误差问题,即圆整误差。采样周期越大,误差也越大。该误差会对速度进给的平滑性、加工表面的光洁度带来相应的影响。
发明内容
本发明针对现有技术的不足,提供一种在定长脉冲驱动模式下基于现场可编程门阵列硬件平台的高频离散采样S曲线加减速控制方法及装置,是一种高速可靠、圆整误差小、进给速度平滑,适用于一般CNC系统的加减速控制方法及装置。
本发明的技术方案如下:
一种离散采样的S曲线加减速控制方法及装置,其特征在于:通过人机交互界面将运动参数写入该基于现场可编程门阵列的加减速控制装置,该装置完成加减速运算配置脉冲频率后,产生相应脉冲用以驱动电机,当输出脉冲数等于预设脉冲数时,控制器停止输出,电机完成走位。同时装置还接收编码器的反馈信号,以反映当前电机的速度和实际的位移。(如图1所示)
本发明利用可调分频器来产生预设频率的脉冲。在已知的高频系统时钟下,根据给定的离散算法来修改脉冲的频率值,就能产生一连串预期频率的脉冲,这些脉冲即可通过差分芯片直接控制伺服电机驱动器。
本发明基于离散采样,可设系统设置的采样周期、最高驱动速度和初始速度分别为Ts、Vs和V0。限定加加速段、减加速段、加减速段和减减速段所用的时间相等,设为tc(如图2),则有tc=Nc·Ts(Nc表示tc时间内的采样周期数),匀速段所用时间为tu,匀加速段和匀减速段所用的时间相等且设为td,则有td=Nd·Ts(Nd表示td时间内的采样周期数)。最大加速度和加速度导数分别为Amax和ja,则由线性变化的加速度规律可得tc=Amax/ja。
本发明根据运动控制模块所需实现的功能,采用硬件描述语言将现场可编程门阵列片内逻辑设计分为四个子功能模块:采样周期模块、速度控制模块、计数比较模块、脉冲发生模块(如图3所示)。
本发明的采样周期模块主要是通过对系统时钟分频计数得到采样周期和触发脉冲的,由一个分频器和一个计数器组成。其具体步骤为:
Step1设置一个可更改的分频系数DT,用于对系统时钟Fclk的分频。采样频率fT和采样周期Ts的表达式为:fT=Fclk/DT,Ts=DT/Fclk,采样频率越高,速度越平滑。
Step2计数器对分频后的采样频率脉冲计数,产生两个频率相同(均为fT)但不同步的触发脉冲TA,TB,分别用于触发ja乘法器和At乘法器的运作,以实现对速度控制模块中的两个累加器进行同频异步控制。
本发明的速度控制主要体现在一个采样时间内的电机位移增量,是对速度增量的积分,也是对加速度增量的二重积分。因此在速度控制模块中,设计了ja选择器、At累加器、ft累加器以及2个乘法器。其具体步骤为:
Step1系统设置一个可调加速度导数ja,则ja选择器将对外部控制信号EN1,EN2进行译码进而选择使用ja,0及-ja三个参数进入ja乘法器与采样周期值Ts相乘。
Step2ja乘法器输出加速度增量J进入At累加器。
Step3At累加器输出当前加速度值A(t)进入At乘法器。
Step4At乘法器将当前加速度值A(t)、采样周期Ts和脉冲当量σ的倒数进行相乘,输出脉冲频率增量Δf进入ft累加器。
Step5ft累加器输出预期脉冲的频率值f(t)。
本发明本质上是改变预期脉冲的频率值来控制速度。而S曲线加减速相应的时间节点控制是由计数比较模块完成。根据已知预期脉冲的频率值f(t),采用可调分频器对高频系统时钟进行分频的方法获得该脉冲。
本发明的脉冲发生模块设计有锁相环PLL、除法器、寄存器和分频器。其具体步骤为:
Step1系统时钟Fclk进入PLL倍频,设倍频系数为k。则倍频后的高频时钟Fclkpll=k·Fclk。
Step2在寄存器中设置32位的整型数G(其值为高频时钟Fclkpll的频率值),作为除法器的被除数。
Step3将当前预期脉冲频率值f(t)作为除法器的除数,由此可得:Q为除法器运算后的商向下取整的结果,其值也是一个32位的整型。
Step4将Q作为可调分频器的分频系数。可得驱动脉冲的频率为:该驱动脉冲的频率fa(t)与当前预期脉冲频率值f(t)极为接近。
Step5驱动脉冲经过鉴相、滤波即可发送给伺服驱动器驱动电机。
本发明的计数比较模块主要用于控制S曲线的各个变加速度点的判断(如图2、4),采用多个计数器及比较器实现对信号EN1,EN2的编码输出,进而对ja选择器进行参数输出控制。
在定长脉冲驱动输出模式下,如果设置的定长脉冲数P不足以使S曲线加速到所设定的最高驱动速度Vs,将形成一个三角形的加速度曲线(如图4)。S曲线分为5段,需实现4个变速点位置判断功能,分别为:减加速起点α,加减速起点β和减减速起点γ。具体判断步骤为:
Step1经推导可知加加速段所需脉冲P(tc)与总的输出脉冲P之间的关系为:P(tc)/P≈1/12。使用Pt计数器对驱动脉冲计数,通过比较器当P(t)=P/12且加速度A(t)<Amax时,为减加速起点α,ja选择器改变加速度导数ja的符号,开始降低加速度的值。
Step2通过Pt比较器当P(t)=P/2时,为加减速起点β,改变ja的符号进入加减速。
Step3直至当P(t)=11P/12时,为减减速起点γ,再次改变ja的符号至速度为零。整段速度曲线为完全S曲线。
如果设置的定长脉冲数P能使速度到达最高驱动速度Vs,则S曲线分为7段,需实现6个变速点位置判断功能,(如图2),分别为:匀加速起点a,减加速起点b,匀速起点c,加减速起点d,匀减速起点e和减减速起点f。具体判断步骤为:
Step1通过At比较器判断当加速度A(t)=Amax时,为匀加速起点a,此时Pt计数器的值记为Pa,速度进入匀加速段。
Step2经推导可知加加速段和匀加速段所需采样周期数(Nc+Nd)=(Vs-V0)/AmaxTs,使用Nt计数器对触发脉冲TA或TB计数,计得值通过Nt比较器,当N=Nc+Nd时,为减加速起点b,此时Pt计数器的值记为Pb,速度进入减加速段。
Step3通过ft比较器判断当速度V(t)=Vs即f(t)=fs时,为匀速起点c,此时Pt计数器的值记为Pc,速度进入匀速段。
Step4由Pt比较器判断当P(t)=P-Pc时,为加减速起点d,速度进入加减速段。
Step5由Pt比较器判断当P(t)=P-Pb时,为匀减速起点e,速度进入匀减速段。
Step6由Pt比较器判断当P(t)=P-Pa时,为减减速起点f,速度进入减减速段。
本发明实施例选用4台Panasonic公司Minas A4系列MCDDT3520伺服驱动器和4台适配MHMD082P1U伺服电机,其额定功率为750W,额定转速为3000rpm;人机界面选用Kinco公司MD304L文本显示器。
本发明实施例采用的现场可编程门阵列(FPGA)是ALTERA公司Cyclone IV系列EP4CE30F23C6芯片,该芯片共有28848个LE(逻辑单元),328个可用引脚和4个锁相环IP核,资源丰富,足以满足实验要求。
本发明实施例在Quartus II 12.1设计环境下采用VHDL硬件描述语言编写程序及原理模块。
本发明实现了对电机完全S曲线和部分S曲线的加减速控制,验证了设计的正确性。本发明的主要优势在于高速采样频率S曲线加减速的模块化设计和纯硬件实现,减少了外部元器件,提高了电机运行效率和系统的可靠性,方便系统维护及功能重构复用。
附图说明
图1为运动控制硬件平台流程示意图。
图2为部分S曲线加减速的加速度、进给速度的变化规律示意图。
图3为基于现场可编程门阵列的S曲线加减速控制原理示意图。
图4为完全S曲线加减速的加速度、进给速度的变化规律示意图。
图5为定长脉冲数P为25时的驱动脉冲及反馈波形示意图。
图6为定长脉冲数P为25时的反馈与拟合的频率曲线对比示意图。
图7为定长脉冲数P为25时的反馈脉冲的位置曲线示意图。
图8为定长脉冲数P为100时的反馈脉冲频率曲线示意图。
图9为定长脉冲数P为100时的反馈脉冲的位置曲线示意图。
具体实施方式
下面结合附图与具体实施方式对本技术及装置进一步说明如下:
一种高频采样的S曲线加减速控制装置,其具体实施过程:图1所示,通过人机交互界面将运动参数写入该基于现场可编程门阵列的加减速控制装置,该装置完成加减速运算配置脉冲频率后,产生相应脉冲用以驱动电机,当输出脉冲数等于预设脉冲数时,控制器停止输出,电机完成走位。同时装置还接收编码器的反馈信号,以反映当前电机的速度和实际的位移。
本发明利用可调分频器来产生预设频率的脉冲。在已知的高频系统时钟下,根据给定的离散算法来修改脉冲的频率值,就能产生一连串预期频率的脉冲,这些脉冲即可通过差分芯片直接控制伺服电机驱动器。
本发明基于离散采样,可设系统设置的采样周期、最高驱动速度和初始速度分别为Ts、Vs和V0。限定加加速段、减加速段、加减速段和减减速段所用的时间相等,设为tc(如图2所示),则有tc=Nc·Ts(Nc表示tc时间内的采样周期数),匀速段所用时间为tu,匀加速段和匀减速段所用的时间相等且设为td,则有td=Nd·Ts(Nd表示td时间内的采样周期数)。最大加速度和加速度导数分别为Amax和ja,则由线性变化的加速度规律可得tc=Amax/ja。
本发明利用加速度和速度对加速度导数的积分关系,可依次推导出S曲线加减速的加速度A(t)、速度V(t)的数学表达式如下:
本发明根据运动控制模块所需实现的功能,采用硬件描述语言将现场可编程门阵列片内逻辑设计分为四个子功能模块:采样周期模块、速度控制模块、计数比较模块、脉冲发生模块(如图3所示)。
本发明的采样周期模块主要是通过对系统时钟分频计数得到采样周期和触发脉冲的,由一个分频器和一个计数器组成。其具体步骤为:
Step1设置一个可更改的分频系数DT,用于对系统时钟Fclk的分频。采样频率fT和采样周期Ts的表达式为:
fT=Fclk/DT (3)
Ts=DT/Fclk (4)
更改分频系数DT,可得到预期的高速采样频率fT,一个采样周期内,整个装置完成一次速度配比运算,采样频率越高,速度越平滑。
Step2计数器对分频后的采样频率脉冲计数,产生两个频率相同(均为fT)但不同步的触发脉冲TA,TB,分别用于触发ja乘法器和At乘法器的运作,以实现对速度控制模块中的两个累加器进行同频异步控制。
本发明的速度控制主要体现在一个采样时间内的电机位移增量,是对速度增量的积分,也是对加速度增量的二重积分。因此在速度控制模块中,设计了ja选择器、At累加器、ft累加器以及2个乘法器。其具体步骤为:
Step1系统设置一个可调加速度导数ja,则ja选择器将对外部控制信号EN1,EN2进行译码进而选择使用ja,0及-ja三个参数进入ja乘法器与采样周期值Ts相乘。
Step2ja乘法器输出加速度增量J进入At累加器。以加加速段为例,则有:
J=Ja·Ts (5)
对于伺服电机,一个脉冲驱动电机走的转角是一定的,每个脉冲代表一定的位移量,即脉冲当量,用σ表示。由此可得电机当前速度的计算公式:
V(t)=σ·f(t) (6)
其中f(t)为当前预期脉冲频率值。由式(1)、(2)、(5)可得:
由式(6)、(7)、(8)可得:
Δf=A(t)·Ts/σ (10)
Step3由式(7)可知:At累加器输出当前加速度值A(t)进入At乘法器。
Step4由式(10)可知:At乘法器将当前加速度值A(t)、采样周期Ts和脉冲当量σ的倒数进行相乘,输出脉冲频率增量Δf进入ft累加器。
Step5ft累加器输出预期脉冲的频率值f(t)。
本发明本质上是改变预期脉冲的频率值来控制速度。而S曲线加减速相应的时间节点控制是由计数比较模块完成。根据已知预期脉冲的频率值f(t),采用可调分频器对高频系统时钟进行分频的方法获得该脉冲。
本发明的脉冲发生模块设计有锁相环PLL、除法器、寄存器和分频器。其具体步骤为:
Step1系统时钟Fclk进入PLL倍频,设倍频系数为k(1≤k≤8)。则倍频后的高频时钟Fclkpll=k·Fclk。
Step2在寄存器中设置32位的整型数G(其值为高频时钟Fclkpll的频率值),作为除法器的被除数。
Step3将当前预期脉冲频率值f(t)作为除法器的除数,由此可得:
其中Q为除法器运算后的商向下取整的结果,其值也是一个32位的整型。
Step4将Q作为可调分频器的分频系数。由式(11)可得驱动脉冲的频率为:
该驱动脉冲的频率fa(t)与当前预期脉冲频率值f(t)极为接近。
Step5驱动脉冲经过鉴相、滤波即可发送给伺服驱动器驱动电机。
本发明的计数比较模块主要用于控制S曲线的各个变加速度点的判断(如图2、4),采用多个计数器及比较器实现对信号EN1,EN2的编码输出,进而对ja选择器进行参数输出控制。
在定长脉冲驱动输出模式下,如果设置的定长脉冲数P不足以使S曲线加速到所设定的最高驱动速度Vs,则S曲线的加速度A将在加加速段结束前开始减小。而这样将形成一个三角形的加速度曲线(如图4)。S曲线分为5段,需实现4个变速点位置判断功能,分别为:减加速起点α,加减速起点β和减减速起点γ。具体判断步骤为:
Step1设初始速度V0=0,由公式(2)可知在加加速段和减加速度段的速度可表示为:
所以,从0时刻到t时刻的输出脉冲P(t)就是对速度的V(t)积分:
由式(14)计算可知:P(tc)/P(t2c)≈1/6。因此可推出加加速段所需脉冲P(tc)与总的输出脉冲P之间的关系为:P(tc)/P≈1/12。
使用Pt计数器对输出脉冲计数,当P(t)=P/12且加速度A(t)<Amax时,为减加速起点α,ja选择器将改变加速度导数ja的符号,开始降低加速度的值。
Step2通过Pt比较器当P(t)=P/2时,为加减速起点β,改变ja的符号进入加减速。
Step3直至当P(t)=11P/12时,为减减速起点γ,再次改变ja的符号至速度为零。整段速度曲线为完全S曲线。
如果设置的定长脉冲数P能使速度到达最高驱动速度Vs,则S曲线分为7段,需实现6个变速点位置判断功能,(如图2),分别为:匀加速起点a,减加速起点b,匀速起点c,加减速起点d,匀减速起点e和减减速起点f。具体判断步骤为:
Step1通过At比较器判断当加速度A(t)=Amax时,为匀加速起点a,此时Pt计数器的值记为Pa,速度进入匀加速段。
Step2由公式(2)可知加加速段和匀加速段所需采样周期数(Nc+Nd)=(Vs-V0)/AmaxTs,使用Nt计数器对采样周期模块中的触发脉冲TA或TB进行计数,计得值通过Nt比较器,当N=Nc+Nd时,为减加速起点b,此时Pt计数器的值记为Pb,速度进入减加速段。
Step3通过ft比较器判断当速度V(t)=Vs即f(t)=fs时,为匀速起点c,此时Pt计数器的值记为Pc,速度进入匀速段。
Step4由Pt比较器判断当P(t)=P-Pc时,为加减速起点d,速度进入加减速段。
Step5由Pt比较器判断当P(t)=P-Pb时,为匀减速起点e,速度进入匀减速段。
Step6由Pt比较器判断当P(t)=P-Pa时,为减减速起点f,速度进入减减速段。
本发明整个自动加减速控制功能是通过对信号EN1,EN1进行编码,并由ja选择器进行译码从而对加速度导数ja的状态控制得以实现的,其编码译码的情况如表1所示。
表1编码译码真值表
本发明实施例选用4台Panasonic公司Minas A4系列MCDDT3520伺服驱动器和4台适配MHMD082P1U伺服电机,其额定功率为750W,额定转速为3000rpm;人机界面选用Kinco公司MD304L文本显示器。
本发明实施例采用的现场可编程门阵列(FPGA)是ALTERA公司Cyclone IV系列EP4CE30F23C6芯片,该芯片共有28848个LE(逻辑单元),328个可用引脚和4个锁相环IP核,资源丰富,足以满足实验要求。
本发明实施例在Quartus II 12.1设计环境下采用VHDL硬件描述语言编写程序及原理模块。
本发明实施例基于图1的硬件平台进行实验检测。实验过程中,系统时钟Fclk为50MHz,设置PLL倍频系数k为8。通过人机界面设置分频系数DT为5000可得采样周期Ts为0.1ms,设置加速度增量J为10,最大加速度Amax为1000(其单位等同于脉冲频率增量Δf的单位Hz),初始速度V0即初始频率为1kHz,最高驱动速度Vs即最高频率为20kHz。
实验一:设置定长脉冲数P为25。
如图5可以看出编码器反馈波形与驱动脉冲频率一致,脉冲总数相同,反馈波形延时一个采样周期。
对反馈脉冲频率进行分析,同时对比相同条件下对频率曲线进行拟合(如图6)。可以看出反馈脉冲频率曲线为完全S曲线,加、减速所用时间分别为2.63ms和2.84ms,加速到最大频率为8.34kHz。图7为编码器反馈脉冲的位置曲线,电机的走位与输入的定长脉冲数P一致。
由此可知当设置的定长脉冲数不足以使速度达到最高驱动速度,则运动控制器按完全S曲线的变化规律进行自动加减速控制;反之,则按部分S曲线的变化规律进行加减速控制。
实验二:通过人机界面设置其他参数不变,将定长脉冲数P改为100。
此时编码器反馈波形的速度曲线如图8,图中反馈脉冲频率曲线为7段部分S曲线,加、减速所用时间分别为4.12ms和4.18ms,匀速时间为1.2ms,加速到设定的最高频率20kHz。图9为定长脉冲数P设成100时反馈脉冲的位置曲线,可知电机的走位与输入的定长脉冲数P一致。
由此,该运动控制器频率曲线连续、平滑,加减速时间短,可使CNC系统更具柔性,提高机床的运行效率和平稳性。
总结:本发明实现了对电机完全S曲线和部分S曲线的加减速控制,验证了设计的正确性。本发明的主要优势在于高速采样频率S曲线加减速的模块化设计和纯硬件实现,减少了外部元器件,提高了电机运行效率和系统的可靠性,方便系统维护及功能重构复用。
以上所述为本发明的较佳实施例,并非对本发明的技术范围作任何限制,故凡依据本发明的技术实质对以上实施例所作的任何细微修改、等同变化与修饰,均仍属于本发明技术方案的范围内。
Claims (9)
1.一种离散采样的S曲线加减速控制方法及装置,其特征在于:通过人机交互界面将运动参数写入该基于现场可编程门阵列的加减速控制装置;该装置完成加减速运算配置脉冲频率后,产生相应脉冲用以驱动电机;当输出脉冲数等于预设脉冲数时,控制器停止输出,电机完成走位;同时装置还接收编码器的反馈信号,以反映当前电机的速度和实际的位移;本装置利用可调分频器来产生预设频率的脉冲,在已知的高频系统时钟下,根据给定的离散算法来修改脉冲的频率值,从而产生一连串预期频率的脉冲,这些脉冲即可通过差分芯片直接控制伺服电机驱动器。
2.如权利要求1中所述的运动控制装置是基于现场可编程门阵列为核心控制器,根据运动规划所需实现的功能,采用硬件描述语言将现场可编程门阵列片内逻辑设计分为四个子功能模块:采样周期模块、速度控制模块、计数比较模块、脉冲发生模块。
3.如权利要求1中所述的预期频率脉冲,是通过对电机位置的实时反馈和加速度、速度的实时比较,实现对S曲线各变速点的判断以改变加加速的状态,从而通过加速度累加器和速度累加器实现对输出脉冲的S曲线控制。
4.如权利要求1中所述的离散算法的基于离散采样,系统设置采样周期Ts、最高驱动速度Vs和初始速度V0;限定加加速段、减加速段、加减速段和减减速段所用的时间相等,设为tc,则有tc=Nc·Ts(Nc表示tc时间内的采样周期数);匀速段所用时间为tu,匀加速段和匀减速段所用的时间相等且设为td,则有td=Nd·Ts(Nd表示td时间内的采样周期数);最大加速度和加速度导数分别为Amax和ja,则由线性变化的加速度规律可得tc=Amax/ja。
5.如权利要求2中所述的采样周期模块主要由一个分频器和一个计数器组成;对该分频器系统设置一个可更改的分频系数DT,用于对系统时钟Fclk的分频;计数器可产生两个频率相同(均为采样频率fT)但不同步的触发脉冲TA,TB,分别用于触发ja乘法器和At乘法器的运作,可实现对速度控制模块中的两个累加器进行同频异步控制。
6.如权利要求2中所述的速度控制模块设计了ja选择器、At累加器、ft累加器以及2个乘法器;系统设置一个可调加速度导数ja,则ja选择器将对外部控制信号EN1,EN2进行译码进而选择使用ja,0及-ja三个参数进入ja乘法器,与采样周期值Ts相乘后,ja乘法器输出加速度增量J进入At累加器;At累加器输出的是当前加速度值A(t);At乘法器是将当前加速度值A(t)、采样周期Ts和脉冲当量σ的倒数进行相乘,输出脉冲频率增量Δf进入ft累加器;最后ft累加器输出预期脉冲的频率值f(t);速度控制模块本质上是改变预期脉冲的频率值来控制速度。
7.如权利要求2中所述的脉冲发生模块设计有锁相环PLL、除法器、寄存器和分频器;系统时钟Fclk首先进入PLL倍频;在寄存器中设置32位的整型数G(其值为系统时钟Fclk倍频后的频率值),作为除法器的被除数;由速度控制模块产生的当前预期脉冲频率值f(t)作为除法器的除数,其值用作可调分频器的分频系数;分频器输出实际驱动脉冲的频率fa(t);经鉴相、滤波即可发送给伺服驱动器驱动电机。
8.如权利要求2中所述的计数比较模块,采用了多个计数器及比较器实现对信号EN1,EN2的编码输出,并由ja选择器进行译码从而对加速度导数ja的状态控制得以实现的。
9.如权利要求2中所述的计数比较模块是用于对S曲线的各个变加速度点的判断,分为完全S曲线和部分S曲线:
在定长脉冲驱动输出模式下,若设置的定长脉冲数P不足以使S曲线加速到所设定的最高驱动速度Vs,将形成一个三角形的加速度曲线;经推导可知加加速段所需脉冲P(tc)与总的输出脉冲P之间的关系为P(tc)/P≈1/12;使用Pt计数器对输出脉冲计数,当P(t)=P/12且加速度A(t)<Amax时,ja选择器将改变加速度导数ja的符号,开始降低加速度的值;当P(t)=P/2时,改变ja的符号进入加减速,直至当P(t)=11P/12时,再次改变ja的符号至速度为零,整段速度曲线为完全S曲线;
若设置的定长脉冲数P能使速度到达最高驱动速度Vs,则S曲线分为7段,需实现6个变速点位置判断功能,分别为:匀加速起点a,减加速起点b,匀速起点c,加减速起点d,匀减速起点e和减减速起点f;通过At比较器判断当加速度A(t)=Amax时,为匀加速起点a,此时Pt计数器的值记为Pa,速度进入匀加速段;使用Nt计数器对采样周期模块中的触发脉冲TA或TB进行计数,计得值通过Nt比较器,当N=Nc+Nd时,为减加速起点b,此时Pt计数器的值记为Pb,速度进入减加速段;通过ft比较器判断当速度V(t)=Vs即f(t)=fs时,为匀速起点c,此时Pt计数器的值记为Pc,速度进入匀速段;同样由Pt比较器判断当P(t)=P-Pc,P(t)=P-Pb及P(t)=P-Pa时,可分别判断出加减速起点d,匀减速起点e和减减速起点f。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510011320.1A CN104483906A (zh) | 2015-01-07 | 2015-01-07 | 一种离散采样的s曲线加减速控制方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510011320.1A CN104483906A (zh) | 2015-01-07 | 2015-01-07 | 一种离散采样的s曲线加减速控制方法及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104483906A true CN104483906A (zh) | 2015-04-01 |
Family
ID=52758464
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510011320.1A Pending CN104483906A (zh) | 2015-01-07 | 2015-01-07 | 一种离散采样的s曲线加减速控制方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104483906A (zh) |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444635A (zh) * | 2015-08-04 | 2017-02-22 | 深圳市雷赛智能控制股份有限公司 | 一种运动控制系统的非对称s曲线加减速控制方法和装置 |
CN106647749A (zh) * | 2016-11-30 | 2017-05-10 | 上海精星仓储设备工程有限公司 | 一种基于密集存储库内穿梭车行走精确定位的方法 |
CN106909077A (zh) * | 2017-03-16 | 2017-06-30 | 深圳市正弦电气股份有限公司 | 一种变频器s曲线加减速突变的控制方法 |
CN107092238A (zh) * | 2016-12-22 | 2017-08-25 | 深圳学泰科技有限公司 | 基于脉冲驱动型电机的平滑加速控制方法和系统 |
CN107844058A (zh) * | 2017-11-24 | 2018-03-27 | 北京特种机械研究所 | 一种运动曲线离散动态规划方法 |
CN108663994A (zh) * | 2018-06-04 | 2018-10-16 | 绵阳逢研科技有限公司 | 一种伺服电机s曲线加减速控制方法 |
CN109470194A (zh) * | 2017-09-08 | 2019-03-15 | 株式会社三丰 | 形状测定装置的控制方法 |
CN109470193A (zh) * | 2017-09-08 | 2019-03-15 | 株式会社三丰 | 形状测定装置的控制方法 |
CN109713956A (zh) * | 2019-01-17 | 2019-05-03 | 深圳市强瑞电子有限公司 | 电机加减速控制方法及系统 |
CN110286653A (zh) * | 2019-06-14 | 2019-09-27 | 杭州爱科科技股份有限公司 | 用于任意曲线运动s加减速控制的速度计算方法 |
CN111273708A (zh) * | 2020-03-13 | 2020-06-12 | 湖南网大科技有限公司 | 一种作业机械加速运动控制装置和方法 |
CN111469568A (zh) * | 2020-06-12 | 2020-07-31 | 深圳市汉森软件有限公司 | 打印小车的驱动脉冲产生方法、装置、设备及存储介质 |
CN111595846A (zh) * | 2020-05-29 | 2020-08-28 | 北京大恒图像视觉有限公司 | 一种低噪音酒类异物检验机的电气控制系统 |
CN112713883A (zh) * | 2020-12-29 | 2021-04-27 | 深圳市泰力格打印技术有限公司 | 基于电路控制的执行机构运动速度信息采集方法及系统 |
CN113186665A (zh) * | 2021-04-02 | 2021-07-30 | 浙江工业大学 | 一种缝纫伺服电机的平滑速度规划控制方法 |
CN113359620A (zh) * | 2021-06-15 | 2021-09-07 | 深圳市旗众智能科技有限公司 | 一种用于轴运动的软限位控制方法及基于rtx64的开放式运动控制器 |
CN114035513A (zh) * | 2021-09-28 | 2022-02-11 | 苏州谋迅智能科技有限公司 | S形速度曲线前瞻规划方法和装置、存储介质和计算设备 |
CN116330299A (zh) * | 2023-05-26 | 2023-06-27 | 浙江工业大学 | 一种基于加速度平滑的工业机器人柔顺运动控制方法 |
CN117439460A (zh) * | 2023-12-14 | 2024-01-23 | 黑龙江惠达科技股份有限公司 | 平面步进双轴系统插补方法、系统、控制装置和控制方法 |
CN118282262A (zh) * | 2024-06-03 | 2024-07-02 | 道简(深圳)医疗科技有限公司 | 一种步进电机的控制方法、控制系统、电子设备及存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030184255A1 (en) * | 2002-03-27 | 2003-10-02 | Canon Kabushiki Kaisha | Circuit and method for controlling stepping motor |
CN101710814A (zh) * | 2009-12-25 | 2010-05-19 | 青岛朗讯科技通讯设备有限公司 | 产生任意频率脉冲的方法以及步进电机的升降速控制方法 |
CN202634356U (zh) * | 2012-04-13 | 2012-12-26 | 深圳众为兴技术股份有限公司 | 一种电机加减速精确控制装置 |
CN104135212A (zh) * | 2014-07-21 | 2014-11-05 | 华南理工大学 | 一种柔性化运动控制ip核及实现方法 |
-
2015
- 2015-01-07 CN CN201510011320.1A patent/CN104483906A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030184255A1 (en) * | 2002-03-27 | 2003-10-02 | Canon Kabushiki Kaisha | Circuit and method for controlling stepping motor |
CN101710814A (zh) * | 2009-12-25 | 2010-05-19 | 青岛朗讯科技通讯设备有限公司 | 产生任意频率脉冲的方法以及步进电机的升降速控制方法 |
CN202634356U (zh) * | 2012-04-13 | 2012-12-26 | 深圳众为兴技术股份有限公司 | 一种电机加减速精确控制装置 |
CN104135212A (zh) * | 2014-07-21 | 2014-11-05 | 华南理工大学 | 一种柔性化运动控制ip核及实现方法 |
Cited By (32)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444635B (zh) * | 2015-08-04 | 2019-09-13 | 深圳市雷赛智能控制股份有限公司 | 一种运动控制系统的非对称s曲线加减速控制方法和装置 |
CN106444635A (zh) * | 2015-08-04 | 2017-02-22 | 深圳市雷赛智能控制股份有限公司 | 一种运动控制系统的非对称s曲线加减速控制方法和装置 |
CN106647749A (zh) * | 2016-11-30 | 2017-05-10 | 上海精星仓储设备工程有限公司 | 一种基于密集存储库内穿梭车行走精确定位的方法 |
CN107092238A (zh) * | 2016-12-22 | 2017-08-25 | 深圳学泰科技有限公司 | 基于脉冲驱动型电机的平滑加速控制方法和系统 |
CN106909077A (zh) * | 2017-03-16 | 2017-06-30 | 深圳市正弦电气股份有限公司 | 一种变频器s曲线加减速突变的控制方法 |
CN106909077B (zh) * | 2017-03-16 | 2020-05-05 | 深圳市正弦电气股份有限公司 | 一种变频器s曲线加减速突变的控制方法 |
CN109470194A (zh) * | 2017-09-08 | 2019-03-15 | 株式会社三丰 | 形状测定装置的控制方法 |
CN109470193A (zh) * | 2017-09-08 | 2019-03-15 | 株式会社三丰 | 形状测定装置的控制方法 |
CN109470193B (zh) * | 2017-09-08 | 2021-10-26 | 株式会社三丰 | 形状测定装置的控制方法 |
CN109470194B (zh) * | 2017-09-08 | 2022-02-11 | 株式会社三丰 | 形状测定装置的控制方法 |
CN107844058A (zh) * | 2017-11-24 | 2018-03-27 | 北京特种机械研究所 | 一种运动曲线离散动态规划方法 |
CN107844058B (zh) * | 2017-11-24 | 2020-08-25 | 北京特种机械研究所 | 一种运动曲线离散动态规划方法 |
CN108663994A (zh) * | 2018-06-04 | 2018-10-16 | 绵阳逢研科技有限公司 | 一种伺服电机s曲线加减速控制方法 |
CN108663994B (zh) * | 2018-06-04 | 2020-08-25 | 绵阳逢研科技有限公司 | 一种伺服电机s曲线加减速控制方法 |
CN109713956A (zh) * | 2019-01-17 | 2019-05-03 | 深圳市强瑞电子有限公司 | 电机加减速控制方法及系统 |
CN110286653A (zh) * | 2019-06-14 | 2019-09-27 | 杭州爱科科技股份有限公司 | 用于任意曲线运动s加减速控制的速度计算方法 |
CN111273708A (zh) * | 2020-03-13 | 2020-06-12 | 湖南网大科技有限公司 | 一种作业机械加速运动控制装置和方法 |
CN111595846A (zh) * | 2020-05-29 | 2020-08-28 | 北京大恒图像视觉有限公司 | 一种低噪音酒类异物检验机的电气控制系统 |
CN111469568A (zh) * | 2020-06-12 | 2020-07-31 | 深圳市汉森软件有限公司 | 打印小车的驱动脉冲产生方法、装置、设备及存储介质 |
CN111469568B (zh) * | 2020-06-12 | 2021-08-31 | 深圳市汉森软件有限公司 | 打印小车的驱动脉冲产生方法、装置、设备及存储介质 |
CN112713883A (zh) * | 2020-12-29 | 2021-04-27 | 深圳市泰力格打印技术有限公司 | 基于电路控制的执行机构运动速度信息采集方法及系统 |
CN113186665B (zh) * | 2021-04-02 | 2022-09-06 | 浙江工业大学 | 一种缝纫伺服电机的平滑速度规划控制方法 |
CN113186665A (zh) * | 2021-04-02 | 2021-07-30 | 浙江工业大学 | 一种缝纫伺服电机的平滑速度规划控制方法 |
CN113359620B (zh) * | 2021-06-15 | 2022-03-15 | 深圳市旗众智能科技有限公司 | 一种用于轴运动的软限位控制方法及基于rtx64的开放式运动控制器 |
CN113359620A (zh) * | 2021-06-15 | 2021-09-07 | 深圳市旗众智能科技有限公司 | 一种用于轴运动的软限位控制方法及基于rtx64的开放式运动控制器 |
CN114035513A (zh) * | 2021-09-28 | 2022-02-11 | 苏州谋迅智能科技有限公司 | S形速度曲线前瞻规划方法和装置、存储介质和计算设备 |
CN116330299A (zh) * | 2023-05-26 | 2023-06-27 | 浙江工业大学 | 一种基于加速度平滑的工业机器人柔顺运动控制方法 |
CN116330299B (zh) * | 2023-05-26 | 2023-09-01 | 浙江工业大学 | 一种基于加速度平滑的工业机器人柔顺运动控制方法 |
CN117439460A (zh) * | 2023-12-14 | 2024-01-23 | 黑龙江惠达科技股份有限公司 | 平面步进双轴系统插补方法、系统、控制装置和控制方法 |
CN117439460B (zh) * | 2023-12-14 | 2024-03-15 | 黑龙江惠达科技股份有限公司 | 平面步进双轴系统插补方法、系统、控制装置和控制方法 |
CN118282262A (zh) * | 2024-06-03 | 2024-07-02 | 道简(深圳)医疗科技有限公司 | 一种步进电机的控制方法、控制系统、电子设备及存储介质 |
CN118282262B (zh) * | 2024-06-03 | 2024-08-09 | 道简(深圳)医疗科技有限公司 | 一种步进电机的控制方法、控制系统、电子设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104483906A (zh) | 一种离散采样的s曲线加减速控制方法及装置 | |
CN204595567U (zh) | 一种离散采样的s曲线加减速控制装置 | |
CN101853013B (zh) | 一种用于数控机床高速加工的加减速控制方法 | |
CN106341063B (zh) | 步进电机加减速控制方法 | |
CN102722141B (zh) | 一种基于pc-fpga的nurbs曲线实时插补方法 | |
CN102799146B (zh) | 用于数控设备控制系统的s形加减速控制的速度规划方法 | |
CN103064343B (zh) | 一种面向复杂曲面加工的轨迹生成方法及其轨迹生成系统 | |
CN104135212A (zh) | 一种柔性化运动控制ip核及实现方法 | |
CN102298359B (zh) | 一种数控系统中加减速过渡平滑控制方法 | |
US3258667A (en) | Phase shift decoder for a servo control | |
CN107276469B (zh) | 步进电机的驱动方法和驱动装置 | |
CN103941647A (zh) | 用于嵌入式数控设备的柔性加减速控制插补方法 | |
CN101299589B (zh) | 基于dds技术的步进电机运动控制器 | |
Anuchin et al. | Optimized method for speed estimation using incremental encoder | |
CN103312248B (zh) | 一种基于dsp的直线加减速拐点误差补偿方法 | |
EP3387497B1 (en) | Stepper trajectory driver | |
CN103163838A (zh) | 一种用于数控机床加减速的控制方法 | |
CN204576209U (zh) | 一种基于可编程逻辑器件的直线加减速控制装置 | |
Bangji et al. | Velocity profile algorithm realization on FPGA for stepper motor controller | |
CN105141203A (zh) | 电机的脉冲滤波系统、脉冲滤波方法及其控制系统 | |
CN103354448A (zh) | 基于fpga的高分辨率时间间隔产生系统 | |
CN103368484B (zh) | 电机运动控制电路及其控制方法 | |
US3557350A (en) | Digital feedrate generator | |
CN104133409A (zh) | 一种对称性可调的三角波合成装置 | |
CN107046382B (zh) | 一种基于三角函数的迭代速度控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20150401 |