CN111258339B - 基于步进电机和光电开关的随动控制装置 - Google Patents
基于步进电机和光电开关的随动控制装置 Download PDFInfo
- Publication number
- CN111258339B CN111258339B CN201911165673.1A CN201911165673A CN111258339B CN 111258339 B CN111258339 B CN 111258339B CN 201911165673 A CN201911165673 A CN 201911165673A CN 111258339 B CN111258339 B CN 111258339B
- Authority
- CN
- China
- Prior art keywords
- stepping motor
- photoelectric switch
- motor
- step number
- control device
- 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
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Stepping Motors (AREA)
Abstract
本发明涉及一种基于步进电机和光电开关的随动控制装置,其中,包括:FPGA包括:步进电机控制模块,通过DSP发送的电机转速值,实时转化为可控制步进电机的脉冲信号,脉冲信号上升沿有效,通过每秒产生脉冲个数控制电机运行步数;光电开关信号滤波模块,对两个光电开关输入信号进行滤波,以消除干扰;角度计数及修正模块,对步进电机转动步数进行累计,正转时累加,反转时累减,并通过光电开关信号对当前累计步数值进行修正;DSP上电后执行整个运动范围转动,寻找零位,并记录零位位置;DSPb)根据FPGA反馈的当前角度值与目标位置,通过PID算法生成步进电机的速度值,并发送给FPGA。
Description
技术领域
本发明涉及一种随动控制装置,特别涉及基于步进电机和光电开关的随动控制装置。
背景技术
基于角位置的闭环控制技术已在现代设备中广泛应用,其技术方案大都采用有刷/无刷直流力矩电机和角位置传感器实现,其中常用的角位置传感器有旋转变压器、光栅码盘、电位器、霍尔传感器四大类,采购价格都在几百至数万元不等,这大大增加了控制系统的成本支出。因此,设计一款结构简单,低成本的随动控制装置显得十分必要。
步进电机具有转矩大、惯性小、响应频率高等优点,因此具有瞬间起动与急速停止的优越特性。其输出的转角或位移精度高,误差不会积累,是用作控制系统的理想器件。
基于角位置的闭环控制技术已在现代设备中广泛应用,其技术方案大都采用有刷/无刷直流力矩电机和角位置传感器实现,其中常用的角位置传感器有旋转变压器、光栅码盘、电位器、霍尔传感器四大类,采购价格都在几百至数万元不等,这大大增加了控制系统的成本支出。
发明内容
本发明的目的在于提供一种基于步进电机和光电开关的随动控制装置,用于解决上述现有技术的不足。
本发明一种基于步进电机和光电开关的随动控制装置,其中,包括控制电路板、步进电机以及光电开关;控制电路板的核心处理器采用DSP和FPGA共同完成;FPGA包括:步进电机控制模块,通过 DSP发送的电机转速值,实时转化为可控制步进电机的脉冲信号,脉冲信号上升沿有效,通过每秒产生脉冲个数控制电机运行步数;光电开关信号滤波模块,对两个光电开关输入信号进行滤波,以消除干扰;角度计数及修正模块,对步进电机转动步数进行累计,正转时累加,反转时累减,并通过光电开关信号对当前累计步数值进行修正;DSP上电后执行整个运动范围转动,寻找零位,并记录零位位置;DSPb) 根据FPGA反馈的当前角度值与目标位置,通过PID算法生成步进电机的速度值,并发送给FPGA。
根据本发明的基于步进电机和光电开关的随动控制装置的一实施例,其中,步进电机控制模块可设置步进电机工作状态为使能、运行方向和电流选择,同时通过DSP下发的速度指令控制步进电机转速。
根据本发明的基于步进电机和光电开关的随动控制装置的一实施例,其中,对于脉冲电平小于10us的信号认为是干扰信号,予以滤除。
根据本发明的基于步进电机和光电开关的随动控制装置的一实施例,其中,光电开关信号滤波模块当两个输入信号有高低电平变化时,分别进行10us的采样计数处理,若10us内出现相反电平,则计数器清零,直到计数器计满10us则认为信号稳定。
根据本发明的基于步进电机和光电开关的随动控制装置的一实施例,其中,角度计数及修正模块的角度计数由计数器实现,首先判定信号确定电机运行方向,累加或累减;通过检测信号上升沿对计数器加和减操作,角度修正通过检测信号实现,并对计数器修正。
根据本发明的基于步进电机和光电开关的随动控制装置的一实施例,其中,步进电机选用两相式步进电机。
根据本发明的基于步进电机和光电开关的随动控制装置的一实施例,其中,光电开关共2个,安装在电机侧,2个光电开关配合挡片使用,挡片与光电开关组合能够实现-4°、+4°、-22°以及+22°的位置切入切出响应。
本发明克服现有技术的不足,开发了一款基于步进电机和光电开关的随动控制装置,该装置能够实现传统的位置闭环控制系统,具有角度修正功能,误差不会累积。由控制电路、1个步进电机和2个光电开关组成,能够实现基于角位置的闭环控制,且成本低廉,在控制精度要求不高的场合具有广泛的应用前景。
附图说明
图1为本发明基于步进电机和光电开关的随动控制装置的示意图;
图2所示为步进电机控制模块输入输出接口关系图;
图3所示为光电开关信号滤波模块输入输出接口关系图;
图4所示为角度计数及修正模块输入输出接口关系图;
图5所示为光电开关功能示意图;
图6所示为光电开关功能原理示意图。
具体实施方式
为使本发明的目的、内容、和优点更加清楚,下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。
图1为本发明基于步进电机和光电开关的随动控制装置的示意图,如图1所示,本发明图1为本发明基于步进电机和光电开关的随动控制装置包括控制电路板、步进电机、光电开关。
如图1所示,控制电路板(1)的核心处理器采用DSP和FPGA共同完成,FPGA内软件程序由3个功能模块组成:
a)步进电机控制模块。通过DSP发送的电机转速值,实时转化为可控制步进电机的脉冲信号,脉冲信号上升沿有效,通过每秒产生脉冲个数控制电机运行步数,即转速。
步进电机控制模块可设置步进电机工作状态(使能、运行方向、电流选择),同时通过DSP下发的速度指令控制步进电机转速,模块输入输出接口关系如图2所示。
b)光电开关信号滤波模块。对两个光电开关输入信号进行滤波,以消除干扰,对于脉冲电平小于10us的信号认为是干扰信号,予以滤除。
模块输入输出接口关系如图3所示,当Collector1_in、Collector2_in 两个输入信号有高低电平变化时,分别进行10us的采样计数处理,若 10us内出现相反电平,则计数器清零,直到计数器计满10us则认为信号稳定,可以输出。
c)角度计数及修正模块。对步进电机转动步数进行累计,正转时累加,反转时累减,并通过光电开关信号对当前累计步数值进行修正。
模块输入输出接口关系如图4所示,角度计数由计数器实现,首先判定Dir信号确定电机运行方向,Dir高时累加,Dir低时累减,计数器CountStepNum为16位寄存器;通过检测Step信号上升沿对计数器加、减操作。角度修正通过检测COL1、COL2两个信号实现,当COL1 为高电平且COL2有上升沿时,将计数器CountStepNum修正为-4°对应值;当COL2为高电平且COL1有上升沿时,将计数器CountStepNum 修正为+4°对应值;当COL2为低电平且COL1有下降沿时,将计数器 CountStepNum修正为-20°对应值;当COL1为低电平且COL2有下降沿时,将计数器CountStepNum修正为+20°对应值;
DSP完成主要工作如下:
a)上电后执行整个运动范围转动,寻找零位,并记录零位位置;
b)根据FPGA反馈的当前角度值与目标位置,通过PID算法生成步进电机的速度值,并发送给FPGA。
本发明之所以选用FPGA驱动步进电机和接收光电开关信号,而没有直接由DSP执行,是因为DSP的控制频率在几KHz,速度慢,这样一来会导致光电开关信号接收有较大延时,从而引入误差,而FPGA 运行周期为几十ns,可以最大限度的减小延时误差。
(2)步进电机。步进电机选用常用的两相式步进电机。
(3)光电开关。光电开关共2个,安装在电机侧,光电开关选用霍尼韦尔公司的HOA1872,具有成本低、响应速度快、可靠性高的特点。2个光电开关需配合挡片使用,挡片长度覆盖范围26°,具体如图5所示,挡片与光电开关组合能够实现-4°、+4°、-22°、+22°的位置切入切出响应,原理如图6所示,其中“00”“10”“11”“01”“00”表示两个光电开关的开关状态,被挡片遮挡为“1”,未被遮挡为“0”;其中±4°两个位置用于角度修正,即步进电机每经过±4°光电开关位置时,FPGA就将累计角度值修正到±4°;±22°两个位置用于限位保护。以上描述实现的是-22°~+22°的位置范围,也可通过修改光电开关挡片长度实现任意角度范围。
本发明与现有技术相比的有益效果是:
(1)该随动控制系统不需要位置传感器作为反馈器件,大大降低了成本;
(2)由于省去了位置传感器,结构上更加简单紧凑;
(3)运动范围内每经过-4°、+4°位置时都进行角度修正,从而保证了长时间运行位置准确。
光电开关作为一种光电器件,具有体积小,定位精度高,成本低的优点,常用作限位或寻零。本发明是一款结构简单,低成本的随动控制装置。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。
Claims (6)
1.一种基于步进电机和光电开关的随动控制装置,其特征在于,包括控制电路板、步进电机以及光电开关;
控制电路板的核心处理器采用DSP和FPGA共同完成;
FPGA包括:步进电机控制模块,通过DSP发送的电机转速值,实时转化为可控制步进电机的脉冲信号,脉冲信号上升沿有效,通过每秒产生脉冲个数控制电机运行步数;光电开关信号滤波模块,对两个光电开关输入信号进行滤波,以消除干扰;角度计数及修正模块,对步进电机转动步数进行累计,正转时累加,反转时累减,并通过光电开关信号对当前累计步数值进行修正;
DSP上电后执行整个运动范围转动,寻找零位,并记录零位位置;DSP根据FPGA反馈的当前角度值与目标位置,通过PID算法生成步进电机的速度值,并发送给FPGA;
光电开关共2个,安装在电机侧,2个光电开关配合挡片使用,挡片与光电开关组合能够实现-4°、+4°、-22°以及+22°的位置切入切出响应。
2.如权利要求1所述的基于步进电机和光电开关的随动控制装置,其特征在于,步进电机控制模块可设置步进电机工作状态为使能、运行方向和电流选择,同时通过DSP下发的速度指令控制步进电机转速。
3.如权利要求1所述的基于步进电机和光电开关的随动控制装置,其特征在于,对于脉冲电平小于10us的信号认为是干扰信号,予以滤除。
4.如权利要求1所述的基于步进电机和光电开关的随动控制装置,其特征在于,光电开关信号滤波模块当两个输入信号有高低电平变化时,分别进行10us的采样计数处理,若10us内出现相反电平,则计数器清零,直到计数器计满10us则认为信号稳定。
5.如权利要求1所述的基于步进电机和光电开关的随动控制装置,其特征在于,角度计数及修正模块的角度计数由计数器实现,首先判定信号确定电机运行方向,累加或累减;通过检测信号上升沿对计数器加和减操作,角度修正通过检测信号实现,并对计数器修正。
6.如权利要求1所述的基于步进电机和光电开关的随动控制装置,其特征在于,步进电机选用两相式步进电机。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911165673.1A CN111258339B (zh) | 2019-11-25 | 2019-11-25 | 基于步进电机和光电开关的随动控制装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911165673.1A CN111258339B (zh) | 2019-11-25 | 2019-11-25 | 基于步进电机和光电开关的随动控制装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111258339A CN111258339A (zh) | 2020-06-09 |
CN111258339B true CN111258339B (zh) | 2022-12-09 |
Family
ID=70948506
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911165673.1A Active CN111258339B (zh) | 2019-11-25 | 2019-11-25 | 基于步进电机和光电开关的随动控制装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111258339B (zh) |
Family Cites Families (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0268490A3 (en) * | 1986-11-20 | 1988-08-24 | Unimation Inc. | Digital robot control having improved arm joint motor control and feedback torque current sensing systems |
CN101271348B (zh) * | 2008-02-25 | 2010-09-15 | 湖北汉丹机电有限公司 | 数字化舵机 |
CN101259468B (zh) * | 2008-04-22 | 2011-11-16 | 中国印钞造币总公司 | 有价证券清分机中主动轮和从动轮之间的同步跟踪方法 |
CN101876381B (zh) * | 2009-04-30 | 2013-01-30 | 浙江中科德润科技有限公司 | 伺服电动阀及其控制方法 |
EP2457328B1 (en) * | 2009-07-24 | 2014-03-26 | Technion Research and Development Foundation, Ltd. | Ultra-high-speed photonic-enabled adc based on multi-phase interferometry |
US8788099B2 (en) * | 2011-07-29 | 2014-07-22 | National Instruments Corporation | Position-based step control algorithm for a motion control system |
CN102332859B (zh) * | 2011-09-16 | 2015-06-03 | 天津市亚安科技股份有限公司 | 一种用于步进电动机的闭环控制方法及系统 |
US8723462B2 (en) * | 2012-06-15 | 2014-05-13 | GM Global Technology Operations LLC | Methods, systems and apparatus for estimating angular position and/or angular velocity of a rotor of an electric machine |
US9423786B2 (en) * | 2013-04-10 | 2016-08-23 | Panasonic Intellectual Property Management Co., Ltd. | Motor drive device |
CN105775275A (zh) * | 2014-12-22 | 2016-07-20 | 无锡兰桂联芳医疗科技有限公司 | 一种自动智能剥药机 |
CN105258717B (zh) * | 2015-11-13 | 2017-07-04 | 中国民用航空总局第二研究所 | 一种机场跑道异物探测系统限位转台的寻零装置 |
CN105278557B (zh) * | 2015-11-20 | 2018-03-09 | 南京杰迈视讯科技有限公司 | 一种实时主动自动校准的云台控制装置和方法 |
CN106125782B (zh) * | 2016-08-31 | 2018-12-04 | 合肥金星机电科技发展有限公司 | 电机定位修正方法 |
CN106849786A (zh) * | 2016-12-28 | 2017-06-13 | 江苏博权医疗科技有限公司 | 一种医用步进电机加减速行程控制装置 |
CN108800475A (zh) * | 2018-06-04 | 2018-11-13 | 珠海格力电器股份有限公司 | 风机转速控制方法、装置及送风设备 |
CN109672375A (zh) * | 2018-12-12 | 2019-04-23 | 天津津航技术物理研究所 | 一种通用型步进电机驱动装置 |
CN110187721A (zh) * | 2019-05-05 | 2019-08-30 | 湖北久之洋红外系统股份有限公司 | 一种千分度精密云台运动控制装置及方法 |
-
2019
- 2019-11-25 CN CN201911165673.1A patent/CN111258339B/zh active Active
Non-Patent Citations (3)
Title |
---|
《FPGA implementation of adaptive ANN controller for speed regulation of permanent magnet stepper motor drives》;Hany M. Hasanien;《Energy Conversion and Management》;20100919;第1252-1257页 * |
《FPGA Soft-Core Based Step Motor Driving》;Zhang Chengjun 等;《2010 International Conference on Electrical and Control Engineering》;20101231;第1035-1038页 * |
《Pipelining Design Controlled by Stepper Motor Based on SCM》;LingXi Pei 等;《IEEE》;20101231;第3703-3706页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111258339A (zh) | 2020-06-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104122531B (zh) | 自适应处理雷达天线位置振荡的方法 | |
CN100498625C (zh) | 一种卫星天线运动控制系统 | |
CN102893513B (zh) | 马达控制装置 | |
WO2021088235A1 (zh) | 零点定位方法、系统、伺服电机及存储介质 | |
WO2021004218A1 (zh) | 机床运动轨迹的控制方法及装置、存储介质、处理器 | |
CN109514040B (zh) | 焊枪跟踪方法和爬行焊接机器人 | |
CN106788014A (zh) | 步进电机极速驱动方法 | |
CN105223870A (zh) | 一种基于dsp与cpld的电动舵机控制系统 | |
CN109546917B (zh) | 针对交流永磁同步电机执行机构的多路调节系统及方法 | |
CN106712612A (zh) | 快速响应的步进电机极速驱动系统及方法 | |
CN111258339B (zh) | 基于步进电机和光电开关的随动控制装置 | |
CN104932540A (zh) | 一种伺服驱动器的位置控制方法 | |
US20100125430A1 (en) | Analog angle sensor accuracy correction program correction method recording medium and servo driver | |
CN107186710A (zh) | 一种机械手精确快速回原的方法 | |
JPH05188267A (ja) | 光学機器 | |
CN203872095U (zh) | 一种3d打印中的步进电机控制电路 | |
WO2012077767A1 (ja) | モータ制御回路 | |
CN116300623A (zh) | 飞拍控制方法、装置、系统及存储介质 | |
CN110737284A (zh) | 传动机构的位置调节方法、装置、终端设备及介质 | |
CN109542122B (zh) | 一种定日镜转动的控制方法及系统 | |
JPS61151713A (ja) | 零点補正付デイジタルサ−ボ装置 | |
Yu | A high performance microchip control system design for DC motor | |
SU818821A1 (ru) | Устройство дл координировани рабочихОРгАНОВ МЕТАллОРЕжущиХ CTAHKOB | |
KR820002167B1 (ko) | 스핀들 제어 방식 | |
JPS6234210A (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 |