CN104811106B - 直流电机闭环控制的方法和系统 - Google Patents
直流电机闭环控制的方法和系统 Download PDFInfo
- Publication number
- CN104811106B CN104811106B CN201510194898.5A CN201510194898A CN104811106B CN 104811106 B CN104811106 B CN 104811106B CN 201510194898 A CN201510194898 A CN 201510194898A CN 104811106 B CN104811106 B CN 104811106B
- Authority
- CN
- China
- Prior art keywords
- data
- unit
- sampled
- direct current
- velocity amplitude
- 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.)
- Expired - Fee Related
Links
Landscapes
- Control Of Eletrric Generators (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明涉及现金处理机技术领域,尤其涉及一种直流电机闭环控制的方法和系统,所述方法包括:通过滤波单元对采样数据进行过滤,剔除其中异常数据,得到滤波数据;所述滤波数据转换成速度值,通过周期波动处理单元对所述速度值进行处理,再经均衡处理单元提取到一个速度平均值;通过PID运算模块将所述速度平均值转换成PWM值;将所述PWM值反馈给驱动模块,以调节直流电机的速度,本发明剔除了采样数据中的异常值,并对采样数据进行周期离散和均衡,降低了采样数据的波动,使最后输出的PWM值更符合实际运行效果,使直流电机的驱动更加稳定,挖钞速度更均匀。
Description
技术领域
本发明涉及现金处理机技术领域,具体涉及一种直流电机闭环控制的方法和系统。
背景技术
在ATM取款机等现金处理机上挖钞时,一般是通过直流电机对挖钞的速度进行控制,主要是通过采样直流电机当前的挖钞速度,经过一系列数据的转换反馈给驱动回路,驱动回路再根据这一数据调节直流电机的速度,使挖钞速度趋向平稳,具体操作是:在电源连接下,驱动回路驱动直流电机运转,平均挖一次钞,直流电机的3个霍尔元件输出24个速度的正弦波,正弦波经过驱动回路的编码单元转换成24个方波;MCU通过ADC采样电路对方波进行采样,根据采样的结果计算出当前电机的运行速度;将采样速度同理论速度进行PID计算,获取到输出给驱动回路的PWM数值,由驱动回路驱动直流电机速度的改变,其控制结构图如图1所示。
在现有技术中,方波数据在CPU内的处理主要是包括采样模块和PID模块,采样模块对挖钞的速度进行采样,再通过PID模块进行调节,最后反馈给驱动回路以调节电机运行速度。但这种方法由于ADC的采样精度、直流电机的速度波动、负载的变化等因素导致采样的数据存在一定的波动,或者存在不符合标准的采样数据,如果直接将采样数据通过比例、积分、微分控制模块(PID模块)进行计算,换算出PWM,对电机进行驱动的话,会降低电机运行的稳定性和响应性。
发明内容
本发明的目的在于提出一种直流电机闭环控制的方法和系统,能够提高直流电机的稳定性和响应性。
为达此目的,本发明采用以下技术方案:
一种直流电机闭环控制的方法,包括:
通过滤波单元对采样数据进行过滤,剔除其中异常数据,得到滤波数据;
将所述滤波数据转换成速度值,通过周期波动处理单元对所述速度值进行处理,再经均衡处理单元提取到一个速度平均值;
所述速度平均值经过PID(Proportion Integration Differentiation,比例积分微分)运算模块转换成PWM(Pulse Width Modulation,脉冲宽度调制)值;
将所述PWM值反馈给驱动模块,以调节直流电机的速度。
其中,所述通过滤波单元对采样数据进行过滤,剔除其中异常数据,得到滤波数据之前还包括:
MCU(Micro Control Unit,微控制单元)通过ADC(Analog-to-DigitalConverter,模数变换器)采样电路对编码单元输出的方波进行采样。
其中,所述异常数据是指采样数据中超过预设的阈值的数据。
其中,所述周期波动处理单元用于对所述速度值进行周期离散;所述均衡处理单元用于将离散后的速度值进行周期均衡。
其中,所述速度值的计算公式为:
V = T * F / (PulsePer * PulseWidth)
其中,V为速度值;T为分钟与秒的进率,为常值60;F为当前采样频率;
PulsePer为脉冲周期个数,为常值24;PulseWidth为采样脉冲宽度。
其中,所述PID运算模块包括PID运算单元和定点处理运算单元,所述PID运算单元采用位置式PID算法将所述速度平均值转换为PWM值;所述定点处理运算单元采用定点乘除法的控制模式。
一种直流电机闭环控制的系统,包括:采样数据处理模块、
数据二次处理模块、PID运算模块和驱动模块,所述采样数据处理模块包括滤波单元,所述数据二次处理模块包括滤波数据处理单元、周期波动处理单元和均衡处理单元;
所述滤波单元,用于对采样数据进行过滤,剔除其中异常数据,得到滤波数据;
所述滤波数据处理单元,用于将所述滤波数据转换成速度值;
所述周期波动处理单元,用于对所述速度值进行处理;
所述均衡处理单元,用于根据所述速度值提取到一个速度平均值;
所述PID运算模块,用于将所述速度平均值转换成PWM值;
所述驱动模块,用于接收所述PWM值,并根据所述PWM值调节直流电机的速度。
其中,所述采样数据处理模块还包括采样单元,所述采样单元内设置有ADC采样电路,所述ADC采样电路用于对编码单元输出的方波进行采样。
其中,所述滤波数据处理单元内设置有速度值计算器,所述速度值的计算公式为:
V = T * F / (PulsePer * PulseWidth)
其中,V为速度值;T为分钟与秒的进率,为常值60;F为当前采样频率;
PulsePer为脉冲周期个数,为常值24;PulseWidth为采样脉冲宽度。
其中,所述PID运算模块包括PID运算单元和定点处理运算单元,所述PID运算单元采用位置式PID算法将所述速度平均值转换为PWM值;所述定点处理运算单元采用定点乘除法的控制模式。
本发明的有益效果为:一种直流电机闭环控制的方法和系统,所述方法包括:通过滤波单元对采样数据进行过滤,剔除其中异常数据,得到滤波数据;所述滤波数据转换成速度值,通过周期波动处理单元对所述速度值进行处理,再经均衡处理单元提取到一个速度平均值;通过PID运算模块将所述速度平均值转换成PWM值;将所述PWM值反馈给驱动模块,以调节直流电机的速度,本发明在处理采样数据时,按照顺序执行的方式将整个处理过程分为采样数据处理、数据二次处理和PID运算控制三个步骤来进行,剔除了采样数据中的异常值,并对采样数据进行周期离散和均衡,降低了采样数据的波动,使最后输出的PWM值更符合实际运行效果,使直流电机的驱动更加稳定,挖钞速度更均匀。
附图说明
图1是现有技术提供的直流电机闭环控制的系统控制结构图。
图2是本发明实施例一提供的一种直流电机闭环控制的方法流程图。
图3是本发明实施例二提供的一种直流电机闭环控制的系统结构图。
具体实施方式
下面结合图2及图3并通过具体实施方式来进一步说明本发明的技术方案。
实施例一
图2是本发明实施例一提供的一种直流电机闭环控制的方法流程图。
一种直流电机闭环控制的方法,包括:
步骤110、通过滤波单元对采样数据进行过滤,剔除其中异常数据,得到滤波数据;
步骤120、将所述滤波数据转换成速度值,通过周期波动处理单元对所述速度值进行处理,再经均衡处理单元提取到一个速度平均值;
步骤130、通过PID运算模块将所述速度平均值转换成PWM值;
步骤140、将所述PWM值反馈给驱动模块,以调节直流电机的速度。
在本实施例中,在处理现金处理机的采样数据时,按照顺序执行的方式将整个处理过程分为采样数据处理、数据二次处理和PID运算控制三个步骤来进行,具体是在原本的采样单元和PID运算模块的基础上,增加了滤波单元、周期波动处理单元、周期均衡处理单元和定点处理运算单元,剔除了采样数据中的异常值,并对采样数据进行周期离散和均衡,降低了采样数据的波动,使最后输出的PWM值更符合实际运行效果,使直流电机的驱动更加稳定,挖钞速度更均匀。
在本实施例中,所述滤波单元的作用是对采样数据进行分析,将采样数据中的异常值剔除,得到滤波数据,所述异常数据是指采样数据中超过预设的阈值的数据,在本实施例中,所述预设的阈值为采样数据平均值的0.9倍至1.1倍,也即若有数据小于采样数据平均值的0.9倍或大于采样数据平均值的1.1倍,即为异常数据,例如对一组连续的霍尔反馈信号进行数据采样,采样得到的数据为:5600、5640、5700、5590、5580、6800、5630……,那么滤波单元就会将6800这个数据进行滤除,并将该数据修改为采样的均衡值。
在本实施例中,所述通过滤波单元对采样数据进行过滤,剔除其中异常数据,得到滤波数据之前还包括:
步骤100、MCU通过ADC采样电路对编码单元输出的方波进行采样,所述编码单元用于将直流电机输出的正弦波转换为方波信号。
在本实施例中,所述周期波动处理单元用于对所述速度值进行周期离散,在现金处理机挖钞的过程中,每次的挖钞都可以看成一个往复的过程,在这个过程中采样的数据是有周期性的;所述均衡处理单元用于将离散后的速度值进行周期均衡,降低速度值的波动,是对采样数据的修正过程。
在本实施例中,所述速度值的计算公式为:
V = T * F / (PulsePer * PulseWidth)
其中,V为速度值;T为分钟与秒的进率,为常值60;F为当前采样频率;
PulsePer为脉冲周期个数,为常值24;PulseWidth为采样脉冲宽度。
在本实施例中,所述PID运算模块包括PID运算单元和定点处理运算单元,所述PID运算单元采用位置式PID算法将所述速度平均值转换为PWM值;所述定点处理运算单元采用定点乘除法的控制模式。
在本实施例中,在运算过程中由于MCU控制精度的问题,如果直接计算会导致计算结果的误差较大,所以引入了定点处理运算单元,定点运算的作用是将MCU的运算精度提高,设计中采用了定点乘除法的控制模式,将控制精度提高10位。
在本实施例中,所述位置式PID算法的计算公式如下:
pstBSMPIDPrm->dCurrError = SetSpeed - ulCcpSpeed;
pstBSMPIDPrm->dSumError += pstBSMPIDPrm->dCurrError;
pstBSMPIDPrm->dLastError =
pstBSMPIDPrm->dCurrError - pstBSMPIDPrm->dPrevError;
//计算脉冲宽度
dPWMPulseWidth =
pstBSMPIDPrm->dCurrError * pstBSMCntPrm->dProportion
+ pstBSMPIDPrm->dSumError * pstBSMCntPrm->dIntegral
+ pstBSMPIDPrm->dLastError * pstBSMCntPrm->dDerivative; pstBSMPIDPrm->dPrevError = pstBSMPIDPrm->dCurrError;
其中:SetSpeed为设置速度,ulCcpSpeed为计算后得到的速度,pstBSMPIDPrm->dCurrError为当前速度误差,pstBSMPIDPrm->dSumError为速度误差累积和,pstBSMPIDPrm->dLastError为本次误差与上次误差的差值,pstBSMPIDPrm->dPrevError为上次误差,dPWMPulseWidth为脉冲计算的宽度信息,pstBSMCntPrm->dProportion为参数P,pstBSMCntPrm->dIntegral为参数I,pstBSMCntPrm->dDerivative为参数D。
实施例二
如图3所示,一种直流电机闭环控制的系统,包括:采样数据处理模块、
数据二次处理模块、PID运算模块和驱动模块,所述采样数据处理模块包括滤波单元,所述数据二次处理模块包括滤波数据处理单元、周期波动处理单元和均衡处理单元;
所述滤波单元,用于对采样数据进行过滤,剔除其中异常数据,得到滤波数据;
所述滤波数据处理单元,用于将所述滤波数据转换成速度值;
所述周期波动处理单元,用于对所述速度值进行处理;
所述均衡处理单元,用于根据所述速度值提取到一个速度平均值;
所述PID运算模块,用于将所述速度平均值转换成PWM值;
所述驱动模块,用于接收所述PWM值,并根据所述PWM值调节直流电机的速度。
在本实施例中,所述采样数据处理模块还包括采样单元,所述采样单元内设置有ADC采样电路,所述ADC采样电路用于对编码单元输出的方波进行采样。
在本实施例中,所述系统还包括编码单元,所述编码单元用于将直流电机输出的正弦波转换为方波信号。
在本实施例中,所述滤波数据处理单元内设置有速度值计算器,所述速度值的计算公式为:
V = T * F / (PulsePer * PulseWidth)
其中,V为速度值;T为分钟与秒的进率,为常值60;F为当前采样频率;
PulsePer为脉冲周期个数,为常值24;PulseWidth为采样脉冲宽度。
在本实施例中,所述PID运算模块包括PID运算单元和定点处理运算单元,所述PID运算单元采用位置式PID算法将所述速度平均值转换为PWM值;所述定点处理运算单元采用定点乘除法的控制模式。
以上所述仅为本发明的具体实施方式,这些描述只是为了解释本发明的原理,而不能以任何方式解释为对本发明保护范围的限制。基于此处的解释,本领域的技术人员不需要付出创造性的劳动即可联想到本发明的其它具体实施方法,这些方式都将落入本发明的保护范围之内。
Claims (6)
1.一种直流电机闭环控制的方法,其特征在于,包括:
通过滤波单元对采样数据进行过滤,剔除其中异常数据,得到滤波数据;所述异常数据是指采样数据中超过预设的阈值的数据,所述预设的阈值为采样数据平均值的0.9倍和1.1倍,即数据小于采样数据平均值的0.9倍或大于采样数据平均值的1.1倍则为异常数据;
将所述滤波数据转换成速度值,通过周期波动处理单元对所述速度值进行处理,再经均衡处理单元提取到一个速度平均值;所述周期波动处理单元用于对所述速度值进行周期离散;所述均衡处理单元用于将离散后的速度值进行周期均衡;
通过PID运算模块将所述速度平均值转换成PWM值;所述PID运算模块包括PID运算单元和定点处理运算单元,所述PID运算单元采用位置式PID算法将所述速度平均值转换为PWM值;所述定点处理运算单元采用定点乘除法的控制模式;
将所述PWM值反馈给驱动模块,以调节直流电机的速度。
2.根据权利要求1所述的一种直流电机闭环控制的方法,其特征在于,所述通过滤波单元对采样数据进行过滤,剔除其中异常数据,得到滤波数据之前还包括:
MCU通过ADC采样电路对编码单元输出的方波进行采样。
3.根据权利要求1所述的一种直流电机闭环控制的方法,其特征在于,所述速度值的计算公式为:
V=T*F/(PulsePer*PulseWidth)
其中,V为速度值;T为分钟与秒的进率,为常值60;F为当前采样频率;PulsePer为脉冲周期个数,为常值24;PulseWidth为采样脉冲宽度。
4.一种直流电机闭环控制的系统,其特征在于,包括:采样数据处理模块、数据二次处理模块、PID运算模块和驱动模块,所述采样数据处理模块包括滤波单元,所述数据二次处理模块包括滤波数据处理单元、周期波动处理单元和均衡处理单元;
所述滤波单元,用于对采样数据进行过滤,剔除其中异常数据,得到滤波数据;所述异常数据是指采样数据中超过预设的阈值的数据,所述预设的阈值为采样数据平均值的0.9倍和1.1倍,即数据小于采样数据平均值的0.9倍或大于采样数据平均值的1.1倍则为异常数据;
所述滤波数据处理单元,用于将所述滤波数据转换成速度值;
所述周期波动处理单元,用于对所述速度值进行周期离散;
所述均衡处理单元,用于将离散后的速度值进行周期均衡得到一个速度平均值;
所述PID运算模块,用于将所述速度平均值转换成PWM值;所述PID运算模块包括PID运算单元和定点处理运算单元,所述PID运算单元采用位置式PID算法将所述速度平均值转换为PWM值;所述定点处理运算单元采用定点乘除法的控制模式;
所述驱动模块,用于接收所述PWM值,并根据所述PWM值调节直流电机的速度。
5.根据权利要求4所述的一种直流电机闭环控制的系统,其特征在于,所述采样数据处理模块还包括采样单元,所述采样单元内设置有ADC采样电路,所述ADC采样电路用于对编码单元输出的方波进行采样。
6.根据权利要求4所述的一种直流电机闭环控制的系统,其特征在于,所述滤波数据处理单元内设置有速度值计算器,所述速度值的计算公式为:
V=T*F/(PulsePer*PulseWidth)
其中,V为速度值;T为分钟与秒的进率,为常值60;F为当前采样频率;PulsePer为脉冲周期个数,为常值24;PulseWidth为采样脉冲宽度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510194898.5A CN104811106B (zh) | 2015-04-23 | 2015-04-23 | 直流电机闭环控制的方法和系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510194898.5A CN104811106B (zh) | 2015-04-23 | 2015-04-23 | 直流电机闭环控制的方法和系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104811106A CN104811106A (zh) | 2015-07-29 |
CN104811106B true CN104811106B (zh) | 2018-11-09 |
Family
ID=53695673
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510194898.5A Expired - Fee Related CN104811106B (zh) | 2015-04-23 | 2015-04-23 | 直流电机闭环控制的方法和系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104811106B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106352980A (zh) * | 2016-08-17 | 2017-01-25 | 中国电子科技集团公司第四十研究所 | 一种有限转角电机直驱的高精度光栅定位装置及方法 |
CN106953561B (zh) * | 2017-04-24 | 2019-06-07 | 福州大学 | 一种基于最小二乘分类测速的有刷直流电机调速方法 |
CN107544574B (zh) * | 2017-09-07 | 2020-12-22 | 上海电力学院 | 基于嵌入式arm和组合滤波的巡检机器人轮速控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5392378A (en) * | 1990-11-09 | 1995-02-21 | Matsushita Electric Industrial Co., Ltd. | Speed controlling system and a predictor |
CN101480347A (zh) * | 2009-01-20 | 2009-07-15 | 深圳市蓝韵实业有限公司 | 一种四维超声探头电机控制系统 |
CN101997463A (zh) * | 2010-10-20 | 2011-03-30 | 夷中机科技(北京)有限公司 | 一种点钞仪双直流无刷电机控制器及其控制方法 |
CN202906819U (zh) * | 2012-10-12 | 2013-04-24 | 中国海洋石油总公司 | 井下无刷直流电机控制器 |
-
2015
- 2015-04-23 CN CN201510194898.5A patent/CN104811106B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5392378A (en) * | 1990-11-09 | 1995-02-21 | Matsushita Electric Industrial Co., Ltd. | Speed controlling system and a predictor |
CN101480347A (zh) * | 2009-01-20 | 2009-07-15 | 深圳市蓝韵实业有限公司 | 一种四维超声探头电机控制系统 |
CN101997463A (zh) * | 2010-10-20 | 2011-03-30 | 夷中机科技(北京)有限公司 | 一种点钞仪双直流无刷电机控制器及其控制方法 |
CN202906819U (zh) * | 2012-10-12 | 2013-04-24 | 中国海洋石油总公司 | 井下无刷直流电机控制器 |
Non-Patent Citations (1)
Title |
---|
基于单片机的数字测速系统设计;袁捷;《电子测试》;20130731;第12-13页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104811106A (zh) | 2015-07-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1784824B (zh) | 永久磁铁式同步电动机的控制装置 | |
CN104811106B (zh) | 直流电机闭环控制的方法和系统 | |
CN102354107B (zh) | 一种交流位置伺服系统模型参数在线辨识和控制方法 | |
CN106842918B (zh) | 一种刮板输送机实时煤量的计算方法 | |
CN103066866B (zh) | 基于模型预测控制的主动前端整流器滤波延迟补偿方法 | |
CN104113259B (zh) | 一种变频器追踪电机转速的方法及其装置 | |
CN103904922A (zh) | 一种基于虚拟磁链定向用于电压型整流器的控制方法 | |
CN107063311A (zh) | 一种单线圈振弦式传感器的动态测量系统方法 | |
CN102914693A (zh) | 最大功率点跟踪器 | |
CN102854912A (zh) | 一种双路mppt跟踪装置及方法 | |
CN103944481A (zh) | 一种交流异步电机矢量控制系统模型参数在线修正方法 | |
CN103186160B (zh) | 一种光伏发电最大功率点跟踪的自调节控制方法 | |
CN105633964A (zh) | 一种apf电流控制方法及系统 | |
CN103904883B (zh) | 并联直流开关电源的负荷分配控制方法及装置 | |
CN102346219B (zh) | 电压源逆变器接入点电压三相软件锁相环相位检测方法 | |
CN103926476B (zh) | 基于fft和对称分量法的三相不平衡检测方法及逆变器 | |
CN102946110B (zh) | 电压不平衡跌落时pwm整流器定频模型预测控制方法 | |
CN103885522A (zh) | 基于直流母线电压控制的最大功率跟踪方法 | |
CN106921308A (zh) | 一种新型三相逆变器及控制方法 | |
CN106546837B (zh) | 恒压供水无流量休眠检测方法 | |
CN106953582B (zh) | 一种交流变频电机拖动二维平面定位控制方法 | |
CN103774179A (zh) | 铜电解生产中自动控制添加剂的装置和方法 | |
CN107979317A (zh) | 永磁同步电主轴弱磁调速方法 | |
CN106877773A (zh) | 一种高效的速度反馈pid控制装置 | |
CN102810995B (zh) | 半桥三电平并网逆变器的正负输入电容的电压调节方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20181109 |
|
CF01 | Termination of patent right due to non-payment of annual fee |