CN113206628A - 一种精确控制交流伺服电机转速的装置及其控制方法 - Google Patents
一种精确控制交流伺服电机转速的装置及其控制方法 Download PDFInfo
- Publication number
- CN113206628A CN113206628A CN202110647648.8A CN202110647648A CN113206628A CN 113206628 A CN113206628 A CN 113206628A CN 202110647648 A CN202110647648 A CN 202110647648A CN 113206628 A CN113206628 A CN 113206628A
- Authority
- CN
- China
- Prior art keywords
- motor
- speed
- pls
- output
- calculating
- 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
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/20—Controlling the acceleration or deceleration
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/14—Estimation or adaptation of motor parameters, e.g. rotor time constant, flux, speed, current or voltage
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/22—Controlling the speed digitally using a reference oscillator, a speed proportional pulse rate feedback and a digital comparator
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
- Control Of Ac Motors In General (AREA)
- Control Of Motors That Do Not Use Commutators (AREA)
Abstract
本发明公开了一种精确控制交流伺服电机转速的装置及其控制方法。可以精确平稳的控制电机速度。电路结构简单,速度采集、电流采集、三相互补PWM的产生等都是通过主控单片机实现的,只需要连接少许的***电路模块。通过数字脉冲发生器产生的数字脉冲频率来控制电机转速,数字脉冲发生器装置简单。在计算电机反馈速度时,进行了数字信号滤波处理,从而使电机高速运转时转速可以保持平稳。计算反馈速度滤波和速度环积分时,除法运算过程中保留小数精度,从而避免累计误差。
Description
技术领域
本发明涉及化工机械领域,具体为一种精确控制交流伺服电机转速的装置及其控制方法。
背景技术
交流伺服电机由于稳定性好、适应性强、加减速动态响应及时、热消耗少和噪音低等优点,广泛应用于机床制造业、汽车制造业、铸件制造业等众多工业制造领域。工业中使用交流伺服电机经常需要调节电机的转速,控制电机转速的***一般都是由内环电流环PID、外环速度环PID构成。电流环为了控制电机转矩,是控制的根本,电流环为了控制速度调节的动态响应,让速度调节更加平稳。但是随着电机转速提高,反馈速度的测量误差通常会影响电机转动的稳定性,而且速度环PID中的积分增量由于长时间累计误差,也会引起速度控制上的偏差,致使电机的转速产生偏差,因此会导致不能精确平稳地控制电机转速。
发明内容
为了克服上述的不足,本发明提出一种精确控制交流伺服电机转速的装置及其控制方法。
本发明采取的技术方案如下:
一种精确控制交流伺服电机转速的装置,包括单片机、差分信号采集和光耦隔离模块、三相PWM驱动模块、电机编码器、霍尔传感器。数字脉冲发生器与差分信号采集和光耦隔离模块的输入相连接;差分信号采集和光耦隔离模块的输出与单片机16引脚连接,使用单片机计数器采集数字脉冲频率;单片机51~56引脚连接三相PWM驱动模块的输入,用于产生三相PWM波形,控制PWM驱动模块;三相PWM驱动模块的输出连接三相交流伺服电机A/B/C三相端子;三相交流伺服电机安装电机编码器;电机编码器的差分信号输出连接差分信号采集和光耦隔离模块的输入;差分信号采集和光耦隔离模块的输出与单片机58、59引脚连接,使用单片机相位计数器采集电机转速;霍尔传感器连接到三相PWM驱动模块的输出;霍尔传感器的输出连接到单片机80、81引脚,使用单片机AD转换模块,采集电机的电流。
一种精确控制交流伺服电机转速的装置的控制方法,包括以下步骤:
(1)读取当前时刻t的电机编码器脉冲数,计算反馈频率增量PLSd
PLSd=(PLSnew-PLSold)*PLSG,
公式中PLSnew是当前时刻t读取的电机编码器脉冲数,PLSold是上一时刻t-1读取的编码器脉冲数,PLSG是电机轴编码器补偿值,
(2)更新当前时刻t的测量频率HZ,
HZ=HZ+PLSd
(3)当前时刻t的测量频率HZ经过滤波处理,得到反馈频率HZF
HZF=HZF+(HZ-HZF)/HZT,
公式中HZT是电机轴编码器脉冲频率滤波时间常数,取除法的余数,下一时刻t+1运算时累加上该余数;
(4)计算当前时刻t设定速度和反馈速度的偏差HZd,并限幅
HZd=HZS-HZF,
公式中HZS是电机当前时刻t速度设定值,当HZd>HZSth时,HZd=HZSstep,公式中HZSstep是速度的调节步长设定值;
(5)计算当前时刻t速度积分量SEK,
SEK=SEK+HZd/ICR,
公式中ICR是积分系数,取除法的余数,下一时刻t+1运算时累加上该余数,
(6)计算速度环控制输出量HZi
HZi=HZd*PG+SEK+ZRS,
公式中PG是比例系数,ZRS是偏置系数;
(7)通过反馈频率增量PLSd,计算正弦波查找表的索引值TIM
TIM=TIM+PLSd*PHG,
公式中PHG是单位时间的相位比例系数,
(8)通过索引值TIM,查找表得到正弦值SIN和余弦值COS,
(9)计算三相PWM的控制量Ui,Vi
Ui=HZM*COS-HZi*SIN,
Vi=(HZM*SIN+HZi*COS)*√3-Ui)/2,
公式中HZM是虚部设定常数,
(10)读取霍尔传感器的电流值Uf,Vf,
(11)计算电流偏差Ud,Vd,
Ud=Ui-Uf,
Vd=Vi-Vf,
(12)计算输出控制量Uo,Vo,Wo,用于设定三相PWM的占空比
Uo=Ud*IG+ZR,
Vo=Vd*IG+ZR,
Wo=Ud*IG+Vd*IG+ZRI,
公式中IG是比例系数,ZRI是偏置系数。
有益效果:本发明提出了一种精确控制交流伺服电机转速的装置,可以精确平稳的控制电机速度。电路结构简单,速度采集、电流采集、三相互补PWM的产生等都是通过主控单片机实现的,只需要添加少许的***电路。通过数字脉冲发生器产生的数字脉冲频率来控制电机转速,数字脉冲发生器装置简单。在计算电机反馈速度时,进行了数字信号滤波处理,从而使电机高速运转时转速可以保持平稳。计算反馈速度滤波和速度环积分时,除法运算过程中保留小数精度,从而避免累计误差。
附图说明
图1是一种精确控制交流伺服电机转速的装置电路结构图。
图2是一种精确控制交流伺服电机转速的装置的控制方法流程图。
具体实施方式
如图1-2所示:单片机的型号R5F524U,差分信号采集和光耦隔离模块的型号TPL2745,三相PWM驱动模块的型号FP25R12KT3,电机编码器型号SJH101B5VL625004P,三相交流伺服电机的型号TSM3P7C25,霍尔传感器的型号L18P025D15。数字脉冲发生器与差分信号采集和光耦隔离模块的输入相连接;差分信号采集和光耦隔离模块的输出与单片机16引脚连接,使用单片机计数器采集数字脉冲频率;单片机51~56引脚连接三相PWM驱动模块的输入,用于产生三相PWM波形,控制PWM驱动模块;三相PWM驱动模块的输出连接三相交流伺服电机A/B/C三相端子;三相交流伺服电机安装电机编码器;电机编码器的差分信号输出连接差分信号采集和光耦隔离模块的输入;差分信号采集和光耦隔离模块的输出与单片机58、59引脚连接,使用单片机相位计数器采集电机转速;霍尔传感器连接到三相PWM驱动模块的输出;霍尔传感器的输出连接到单片机80、81引脚,使用单片机AD转换模块,采集电机的电流。
一种精确控制交流伺服电机转速的装置的控制方法,包括以下步骤:
(1)读取当前时刻t的电机编码器脉冲数,计算反馈频率增量PLSd
PLSd=(PLSnew-PLSold)*PLSG,
公式中PLSnew是当前时刻t读取的电机编码器脉冲数,PLSold是上一时刻t-1读取的编码器脉冲数,PLSG是电机轴编码器补偿值,1≤PLSG≤32
(2)更新当前时刻t的测量频率HZ,
HZ=HZ+PLSd
(3)当前时刻t的测量频率HZ经过滤波处理,得到反馈频率HZF
HZF=HZF+(HZ-HZF)/HZT,
公式中HZT是电机轴编码器脉冲频率滤波时间常数,1≤HZT≤100,取除法的余数,下一时刻t+1运算时累加上该余数;
(4)计算当前时刻t设定速度和反馈速度的偏差HZd,并限幅
HZd=HZS-HZF,
公式中HZS是电机当前时刻t速度设定值,当HZd>HZSth时,HZd=HZSstep,公式中HZSstep是速度的调节步长设定值,0≤HZSstep≤40;
(5)计算当前时刻t速度积分量SEK,
SEK=SEK+HZd/ICR,
公式中ICR是积分系数,1≤ICR≤100,取除法的余数,下一时刻t+1运算时累加上该余数,
(6)计算速度环控制输出量HZi
HZi=HZd*PG+SEK+ZRS,
公式中PG是比例系数,10≤PG≤80,ZRS是偏置系数,0≤ZRS≤60;
(7)通过反馈频率增量PLSd,计算正弦波查找表的索引值TIM,
TIM=TIM+PLSd*PHG,
公式中PHG是单位时间的相位比例系数,0.01≤PHG≤100
(8)通过索引值TIM,查找表得到正弦值SIN和余弦值COS,
(9)计算三相PWM的控制量Ui,Vi,
Ui=HZM*COS-HZi*SIN,
Vi=(HZM*SIN+HZi*COS)*√3-Ui)/2,
公式中HZM是虚部设定常数,20≤HZM≤80,
(10)读取霍尔传感器的电流值Uf,Vf,
(11)计算电流偏差Ud,Vd,
Ud=Ui-Uf,
Vd=Vi-Vf,
(12)计算输出控制量Uo,Vo,Wo,用于设定三相PWM的占空比
Uo=Ud*IG+ZR,
Vo=Vd*IG+ZR,
Wo=Ud*IG+Vd*IG+ZRI,
公式中IG是比例系数,1≤IG≤100,ZRI是偏置系数,200≤ZRI≤800。
Claims (2)
1.一种精确控制交流伺服电机转速的装置,包括单片机及***模块,其特征在于:数字脉冲发生器与差分信号采集和光耦隔离模块的输入相连接;差分信号采集和光耦隔离模块的输出与单片机16引脚连接,使用单片机计数器采集数字脉冲频率;单片机51~56引脚连接三相PWM驱动模块的输入,用于产生三相PWM波形,控制PWM驱动模块;三相PWM驱动模块的输出连接三相交流伺服电机A/B/C三相端子;三相交流伺服电机安装电机编码器;电机编码器的差分信号输出连接差分信号采集和光耦隔离模块的输入;差分信号采集和光耦隔离模块的输出与单片机58、59引脚连接,使用单片机相位计数器采集电机转速;霍尔传感器连接到三相PWM驱动模块的输出;霍尔传感器的输出连接到单片机80、81引脚,使用单片机AD转换模块,采集电机的电流。
2.一种精确控制交流伺服电机转速的装置的控制方法,其特征在于:包括以下步骤:
(1)读取当前时刻t的电机编码器脉冲数,计算反馈频率增量PLSd
PLSd=(PLSnew-PLSold)*PLSG,
公式中PLSnew是当前时刻t读取的电机编码器脉冲数,PLSold是上一时刻t-1读取的编码器脉冲数,PLSG是电机轴编码器补偿值,
(2)更新当前时刻t的测量频率HZ,
HZ=HZ+PLSd
(3)当前时刻t的测量频率HZ经过滤波处理,得到反馈频率HZF
HZF=HZF+(HZ-HZF)/HZT,
公式中HZT是电机轴编码器脉冲频率滤波时间常数,取除法的余数,下一时刻t+1运算时累加上该余数;
(4)计算当前时刻t设定速度和反馈速度的偏差HZd,并限幅
HZd=HZS-HZF,
公式中HZS是电机当前时刻t速度设定值,当HZd>HZSth时,HZd=HZSstep,
公式中HZSstep是速度的调节步长设定值,
(5)计算当前时刻t速度积分量SEK,
SEK=SEK+HZd/ICR,
公式中ICR是积分系数,取除法的余数,下一时刻t+1运算时累加上该余数,
(6)计算速度环控制输出量HZi
HZi=HZd*PG+SEK+ZRS,
公式中PG是比例系数,ZRS是偏置系数,
(7)通过反馈频率增量PLSd,计算正弦波查找表的索引值TIM
TIM=TIM+PLSd*PHG,
公式中PHG是单位时间的相位比例系数,
(8)通过索引值TIM,查找表得到正弦值SIN和余弦值COS,
(9)计算三相PWM的控制量Ui,Vi
Ui=HZM*COS-HZi*SIN,
公式中HZM是虚部设定常数,
(10)读取霍尔传感器的电流值Uf,Vf,
(11)计算电流偏差Ud,Vd,
Ud=Ui-Uf,
Vd=Vi-Vf,
(12)计算输出控制量Uo,Vo,Wo,用于设定三相PWM的占空比
Uo=Ud*IG+ZR,
Vo=Vd*IG+ZR,
Wo=Ud*IG+Vd*IG+ZRI,
公式中IG是比例系数,ZRI是偏置系数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110647648.8A CN113206628B (zh) | 2021-06-10 | 2021-06-10 | 一种精确控制交流伺服电机转速的装置及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110647648.8A CN113206628B (zh) | 2021-06-10 | 2021-06-10 | 一种精确控制交流伺服电机转速的装置及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113206628A true CN113206628A (zh) | 2021-08-03 |
CN113206628B CN113206628B (zh) | 2023-09-05 |
Family
ID=77024431
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110647648.8A Active CN113206628B (zh) | 2021-06-10 | 2021-06-10 | 一种精确控制交流伺服电机转速的装置及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113206628B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113848499A (zh) * | 2021-09-28 | 2021-12-28 | 珠海格力电器股份有限公司 | 驱动电源的参数监控方法、装置及驱动电源*** |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4680515A (en) * | 1985-05-21 | 1987-07-14 | Crook James C | Digital speed control of motors |
CN102510251A (zh) * | 2011-11-30 | 2012-06-20 | 沈阳工业大学 | 驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法 |
CN102636194A (zh) * | 2012-04-24 | 2012-08-15 | 浙江大学 | 正交正、余弦轴角编码器信号检测和转换电路 |
CN106208876A (zh) * | 2016-08-02 | 2016-12-07 | 李梁 | 多轴交流伺服电机控制装置 |
CN108306568A (zh) * | 2018-03-06 | 2018-07-20 | 南京理工大学 | 电梯用pmsm抗负载扰动的自适应积分反步控制方法 |
CN111637887A (zh) * | 2020-06-01 | 2020-09-08 | 太原理工大学 | 一种基于惯性模块的矿用单轨吊机车定位方法 |
-
2021
- 2021-06-10 CN CN202110647648.8A patent/CN113206628B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4680515A (en) * | 1985-05-21 | 1987-07-14 | Crook James C | Digital speed control of motors |
CN102510251A (zh) * | 2011-11-30 | 2012-06-20 | 沈阳工业大学 | 驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法 |
CN102636194A (zh) * | 2012-04-24 | 2012-08-15 | 浙江大学 | 正交正、余弦轴角编码器信号检测和转换电路 |
CN106208876A (zh) * | 2016-08-02 | 2016-12-07 | 李梁 | 多轴交流伺服电机控制装置 |
CN108306568A (zh) * | 2018-03-06 | 2018-07-20 | 南京理工大学 | 电梯用pmsm抗负载扰动的自适应积分反步控制方法 |
CN111637887A (zh) * | 2020-06-01 | 2020-09-08 | 太原理工大学 | 一种基于惯性模块的矿用单轨吊机车定位方法 |
Non-Patent Citations (1)
Title |
---|
杨殿龙;谢明红;: "基于速度模式的数控***高速高精度控制研究", 机床与液压 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113848499A (zh) * | 2021-09-28 | 2021-12-28 | 珠海格力电器股份有限公司 | 驱动电源的参数监控方法、装置及驱动电源*** |
CN113848499B (zh) * | 2021-09-28 | 2022-11-11 | 珠海格力电器股份有限公司 | 驱动电源的参数监控方法、装置及驱动电源*** |
Also Published As
Publication number | Publication date |
---|---|
CN113206628B (zh) | 2023-09-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Lorenz et al. | High-resolution velocity estimation for all-digital, ac servo drives | |
CN101499753B (zh) | 基于永磁无刷直流电机的无刷伺服控制***和驱动装置 | |
CN113206628B (zh) | 一种精确控制交流伺服电机转速的装置及其控制方法 | |
CN108448965B (zh) | 两相混合式步进电机的重载闭环驱动***及方法 | |
CN109873586A (zh) | 一种基于高阶滑模观测器的电机机械参数辨识方法及*** | |
CN201403064Y (zh) | 基于永磁无刷直流电机的无刷伺服控制***和驱动装置 | |
CN104779875A (zh) | 一种直流伺服电机闭环控制*** | |
CN102904496A (zh) | 双电机同步控制***及其同步控制的方法 | |
CN110398359A (zh) | 一种机械传动链综合误差的动态检测方法及装置 | |
CN110601611A (zh) | 补偿无刷直流电机反电动势常数的无位置控制*** | |
CN207994965U (zh) | 一种双pg控制的旋转定位装置 | |
CN203720602U (zh) | 基于进给***位置反馈信号的振动抑制控制器 | |
Boggarpu et al. | New learning algorithm for high-quality velocity measurement and control when using low-cost optical encoders | |
CN109120189B (zh) | 一种多电机交叉同步控制*** | |
CN116295118A (zh) | 一种增量式光编码器刻线与细分误差补偿方法 | |
CN102497149A (zh) | 永磁直线同步电机驱动悬浮平台的直接解耦控制方法 | |
CN113824376B (zh) | 一种永磁同步伺服电机齿槽转矩补偿方法 | |
CN113070735B (zh) | 一种高动态响应和高精度的交流伺服电机手轮控制方法 | |
Yokote et al. | A hybrid digital and analog controller for DC and brushless servomotors | |
CN113411030B (zh) | 一种高转矩快速响应的交流伺服电机控制方法 | |
Kim et al. | Accurate position control for AC servo motor using novel speed estimator | |
CN220354095U (zh) | 一种热泵直流风机测速和调速*** | |
Kang | Analysis of Servo Control System Under Photoelectric Zero-Point Calibration and Its Commutator Accuracy | |
CN116345982B (zh) | 音圈电机控制方法、***及设备 | |
SU1716479A1 (ru) | Трехканальна след ща система |
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 |