CN106933261B - 基于步进驱动的位置随动控制系统及控制方法 - Google Patents
基于步进驱动的位置随动控制系统及控制方法 Download PDFInfo
- Publication number
- CN106933261B CN106933261B CN201710300009.8A CN201710300009A CN106933261B CN 106933261 B CN106933261 B CN 106933261B CN 201710300009 A CN201710300009 A CN 201710300009A CN 106933261 B CN106933261 B CN 106933261B
- Authority
- CN
- China
- Prior art keywords
- control
- output signal
- frequency
- stepping motor
- timer
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
- G05D3/20—Control of position or direction using feedback using a digital comparing device
- G05D3/203—Control of position or direction using feedback using a digital comparing device using fine or coarse devices
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Stepping Motors (AREA)
Abstract
本发明公开了一种基于步进驱动的位置随动控制系统及控制方法,其控制系统,包括控制器、步进电机驱动器、步进电机、减速机和随动转台,控制器接收上位机位置给定,完成转台的位置控制,并将速度指令通过与步进电机驱动器之间的连接电缆传输给步进电机驱动器,完成步进电机的速度控制。所述的控制器通过上位机接口接收位置给定,在处理器中完成位置控制运算,通过脉冲输出信号、方向输出信号输出到步进电机驱动器,控制步进电机运行。所述的处理器以上位机位置给定与虚拟位置反馈组成闭环位置控制,并通过最大频率限制、频率变化率的控制实现位置随动系统的控制功能。
Description
技术领域
本发明涉及基于步进驱动的位置随动控制系统及控制方法,属于随动控制系统技术领域。
背景技术
位置随动系统是在给定的位置输入信号预先未知且随时间变化的控制系统,且系统位置输出量随位置输入量的变化而变化,通常驱动系统采用伺服电机驱动系统。步进电动机与步进电机驱动器组成的开环驱动系统,没有位置反馈元件,相比较采用伺服电机驱动,结构简单、价格低廉,在经济型设备中得到了广泛应用。
步进电机位置控制目前主要采用两种方法,方法1:在预先知道位置输入的情况下,采用运动轨迹加减速规划方法,实现步进电机的位置控制,如中国专利申请号:CN201210422712.3,申请日:2012年10月30日,专利名称为:一种步进电机的控制系统及控制方法,该发明涉及一种步进电机的控制系统及控制方法,由数字信号处理模块依据位置指令产生指数型加减速曲线,控制步进电机定位,这是目前步进电机控制普遍采用的方法。方法2:在负载末端安装位置传感器,检测负载的实际位置作为位置反馈信号,实现位置闭环控制,如文献“步进电机闭环伺服系统的高精度控制”(制导与引信,2013年第3期)中的基于步进驱动的位置闭环控制系统。
方法1是常用的步进驱动系统的位置控制方法,对应位置随动系统,其位置输入往往是未知的,因此难以采用轨迹规划的方式完成位置控制;方法2在位置控制系统增加位置传感器,作为位置反馈信号,可防止步进驱动失步或过冲,不足在于增加了硬件,系统复杂化,提高了位置控制系统的成本。
发明内容
为了解决上述不足,本发明提供了一种基于步进驱动的位置随动控制系统及控制方法。
本发明所采取的技术方案是:
一种基于步进驱动的位置随动控制系统,包括控制器、步进电机驱动器、步进电机、减速机和随动转台;控制器接收上位机位置给定,完成转台的位置控制,并将速度指令即脉冲输出信号和方向输出信号通过与步进电机驱动器之间的连接电缆传输给步进电机驱动器,完成步进电机的速度控制;步进电机输出轴与减速机输入转轴相连,带动减速机转动;减速机输出轴与随动转台转轴相连,带动随动转台转动。
所述的控制器包括处理器、上位机接口、脉冲输出信号和方向输出信号,所述的控制器通过上位机接口接收位置给定,在处理器中完成位置控制运算,通过脉冲输出信号、方向输出信号输出到步进电机驱动器,控制步进电机运行。
所述的处理器具备至少两个ARM定时器,所述处理器的位置控制运算包括位置给定、匹配系数、位置调节器、频率限制、频率变化率控制、频率输出和虚拟位置反馈,所述的处理器以上位机的位置给定与虚拟位置反馈组成闭环位置控制,并通过最大频率限制、频率变化率的控制实现位置随动系统的控制功能。
所述的位置调节器的计算如式(3):
所述的频率变化率控制是防止步进电机驱动系统失步或过冲,对频率变化率限制实际作用是限制步进驱动系统的最大角加速度和最大角减速度,频率变化率控制的计算式如式(5):
所述的频率输出是经过频率限制和频率变化率限制后的输出值利用ARM定时器1产生对应频率的脉冲输出信号,同时依据的正负极性产生对应的方向信号,当时,方向输出信号为高电平,当,方向输出信号为低电平,脉冲输出信号和方向输出信号通过与步进电机驱动器之间的连接电缆传输给步进电机驱动器对应控制端。
一种基于步进驱动的位置随动控制系统的控制方法,包括如下步骤:
(8)本采样周期控制结束,下一采样周期从步骤 (2)开始执行。
本发明所达到的有益效果:
(1)、本发明的系统通过利用对输出频率的双向计数,虚拟位置反馈,形成闭环位置随动系统的控制,可以充分利用闭环调节器的控制性能,实现基本步进驱动的随动控制;
(2)、本发明的系统通过对频率变化率的控制,有效解决未知输入无法规划步进电机运动轨迹,可能造成的步进电机驱动时的失步或过冲。
附图说明
图1是本发明的组成示意图;
图2是本发明的控制器组成示意图;
图3是本发明的位置控制算法示意图;
图4是本发明的控制流程图。
具体实施方式
下面结合附图对本发明作进一步描述。
如图1所示,一种基于步进驱动的位置随动控制系统,包括控制器、步进电机驱动器、步进电机、减速机和随动转台;所述的控制器接收上位机位置给定,完成转台的位置控制,并将频率指令(脉冲输出信号和方向输出信号)通过与步进电机驱动器之间的连接电缆传输给步进电机驱动器,完成步进电机的控制;步进电机输出轴与减速机输入转轴相连,带动减速机转动;减速机输出轴与随动转台转轴相连,带动随动转台转动。
如图2所示,所述的控制器,包括处理器(处理器具备至少具有两个定时器,本实例选择ARM芯片)、上位机接口、脉冲输出信号和方向输出信号,所述的控制器通过上位机接口接收位置给定,在处理器中完成位置控制运算,通过脉冲输出信号、方向输出信号输出到步进电机驱动器,控制步进电机运行。
如图3所示,所述处理器的位置控制算包括位置给定、匹配系数、位置调节器、频率限制、频率变化率控制、频率输出和虚拟位置反馈,所述的处理器中以上位机的位置给定与虚拟位置反馈组成闭环位置控制,利用位置调节器的控制性能对步进电机加减速控制,实现位置随动系统的控制功能;所示的匹配系数是将位置给定(单位:度)转换为位置给定脉冲数量(单位:个),计算式如式(1):
所述的位置调节器计算如式(3):
所述的频率变化率控制是防止步进电机驱动系统失步或过冲,对频率变化率限制实际作用是限制步进驱动系统的最大角加速度和最大角减速度,频率变化率控制计算式如式(5):
通过控制本次采样周期的期望输出频率与上次采样周期实际输出频率之间的差值实现输出频率的增量控制,即两次之间频率差值限定在之内,为步进驱动系统允许的最大角加速度(最大角减速度由于摩擦转矩的存在,系统允许的最大角减速度通常大于最大角加速度,因此可通过实验获得最大角加速度值,并留有一定的余量,确保不出现失步和过冲)对应的脉冲频率变化率。
所述的频率输出是经过频率限制和频率变化率限制后的输出值利用ARM定时器1产生对应频率的脉冲输出信号(ARM定时器1设置为PWM输出模式,占空比恒定为50%),同时依据的正负极性产生对应的方向信号,当时,方向输出信号为高电平,当,方向输出信号为低电平,脉冲输出信号和方向输出信号通过与步进电机驱动器之间的连接电缆传输给步进电机驱动器对应控制端。
本实例中速比,,;将ARM定时器1产生对应频率的脉冲输出信号连接到ARM定时器2的脉冲输入端,将ARM定时器1产生方向输出信号连接到ARM定时器2的计算方向输入端,ARM定时器2的计数器值即为虚拟位置反馈。
(8)本采样周期控制结束,下一采样周期从步骤 (2)开始执行。
以上显示和描述了本发明的基本原理、主要特征及优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。
Claims (2)
1.一种基于步进驱动的位置随动控制系统,其特征在于:包括控制器、步进电机驱动器、步进电机、减速机和随动转台;所述的控制器接收上位机位置给定,完成转台的位置控制,并将频率指令即脉冲输出信号和方向输出信号通过与步进电机驱动器之间的连接电缆传输给步进电机驱动器,完成步进电机的控制;步进电机输出轴与减速机输入转轴相连,带动减速机转动;减速机输出轴与随动转台转轴相连,带动随动转台转动;所述的控制器包括处理器、上位机接口、脉冲输出信号和方向输出信号,所述的控制器通过上位机接口接收位置给定,在处理器中完成位置控制运算,通过脉冲输出信号、方向输出信号输出到步进电机驱动器,控制步进电机运行;
所述的处理器具备至少两个ARM定时器,所述处理器的位置控制运算包括位置给定、匹配系数、位置调节器、频率限制、频率变化率控制、频率输出和虚拟位置反馈,所述的处理器中以上位机的位置给定与虚拟位置反馈组成闭环位置控制,利用位置调节器的控制性能对步进电机加减速控制,实现位置随动系统的控制功能;
所述的位置调节器的计算如式(3):
所述的频率变化率控制是防止步进电机驱动系统失步或过冲,对频率变化率限制实际作用是限制步进驱动系统的最大角加速度和最大角减速度,频率变化率控制的计算式如式(5):
所述的频率输出是经过频率限制和频率变化率限制后的输出值利用ARM定时器1产生对应频率的脉冲输出信号,同时依据的正负极性产生对应的方向信号,当时,方向输出信号为高电平,当,方向输出信号为低电平,脉冲输出信号和方向输出信号通过与步进电机驱动器之间的连接电缆传输给步进电机驱动器对应控制端;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710300009.8A CN106933261B (zh) | 2017-05-02 | 2017-05-02 | 基于步进驱动的位置随动控制系统及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710300009.8A CN106933261B (zh) | 2017-05-02 | 2017-05-02 | 基于步进驱动的位置随动控制系统及控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106933261A CN106933261A (zh) | 2017-07-07 |
CN106933261B true CN106933261B (zh) | 2020-05-26 |
Family
ID=59429416
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710300009.8A Active CN106933261B (zh) | 2017-05-02 | 2017-05-02 | 基于步进驱动的位置随动控制系统及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106933261B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107809193A (zh) * | 2017-11-03 | 2018-03-16 | 上海辛格林纳新时达电机有限公司 | 一种电机的运行控制方法、装置及电机驱动器 |
CN108227756B (zh) * | 2018-01-23 | 2020-12-11 | 南京科远智慧科技集团股份有限公司 | 一种高精度阀门控制方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2931003B1 (fr) * | 2008-05-07 | 2010-06-04 | Wuilfert Soc Nouv | Procede et dispositif de rejet robuste de perturbations periodiques dans une boucle de controle de position d'un axe |
CN101587327B (zh) * | 2008-05-21 | 2010-12-15 | 深圳市先阳软件技术有限公司 | 工业控制平台上的通用运动控制系统和控制方法 |
CN102904512B (zh) * | 2012-10-30 | 2015-03-11 | 北京信息科技大学 | 一种步进电机的控制系统及控制方法 |
CN204086988U (zh) * | 2014-09-05 | 2015-01-07 | 西安建筑科技大学 | 一种用于迷宫解算的迷宫机器鼠系统 |
CN106060380B (zh) * | 2016-05-11 | 2019-05-10 | 北京格灵深瞳信息技术有限公司 | 一种联动相机控制系统及控制方法 |
CN106026761B (zh) * | 2016-05-18 | 2018-03-02 | 南京航空航天大学 | 一种嵌入式超声电机驱动控制器 |
-
2017
- 2017-05-02 CN CN201710300009.8A patent/CN106933261B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN106933261A (zh) | 2017-07-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102904512B (zh) | 一种步进电机的控制系统及控制方法 | |
CN106933261B (zh) | 基于步进驱动的位置随动控制系统及控制方法 | |
EP1443372A3 (en) | Servomotor driving controller | |
EP0899863A2 (en) | Systems and methods for braking of actuator and brushless DC motor therein | |
JP2013037385A (ja) | 同期制御装置 | |
DE502006002742D1 (de) | Reglerstruktur mit einem Torsionsmodell | |
CN104333282A (zh) | 直流电机式电动推杆的精确定位控制方法 | |
JPS63148314A (ja) | セミクロ−ズドル−プサ−ボ制御系の制御装置 | |
CN105508696A (zh) | 一种旋转式精密调节阀及其控制方法 | |
CN102279605A (zh) | 考虑波动齿轮传动机构摩擦特性随温度改变的变化在执行机构中作适应摩擦补偿的方法 | |
Kumar | Position control of a Stepper Motor using LabView | |
CN114326842B (zh) | 驱动装置的控制方法及装置、无人设备的控制方法 | |
JP2006174607A (ja) | ステッピングモータ制御装置及びそれを用いたペンレコーダ | |
CN101951209B (zh) | 一种直流电机的高精度正反转控制系统及控制方法 | |
CN104779894A (zh) | 一种伺服驱动器的扭矩控制方法 | |
CN109542122B (zh) | 一种定日镜转动的控制方法及系统 | |
CN206601628U (zh) | 基于步进驱动的指挥镜两维转台随动控制系统 | |
CN111796606A (zh) | 基于电枢直流电机的二维转台随动控制系统及方法 | |
CN205383319U (zh) | 一种旋转式精密调节阀 | |
CN110778767A (zh) | 一种具有转速闭环控制的电动阀门及控制方法 | |
JP2000088131A (ja) | バルブの流量制御装置 | |
CN214506922U (zh) | 一种双闭环pid调节控制步进电机装置 | |
US20030227274A1 (en) | Energy balanced system, controller and method for moving a load to a setpoint | |
CN117674653A (zh) | 一种基于反正切函数的速度规划模糊控制方法 | |
JP2970166B2 (ja) | ステッパモータ駆動装置 |
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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20211027 Address after: 210000 Block E, 101 Caochangmen street, Gulou District, Nanjing, Jiangsu Patentee after: Nanjing hangbai Electronic Technology Co.,Ltd. Address before: 1 No. 211167 Jiangsu city of Nanjing province Jiangning Science Park Hongjing Road Patentee before: NANJING INSTITUTE OF TECHNOLOGY |