CN113224983A - 一种可提高增量式光电编码器速度控制精度的测速*** - Google Patents
一种可提高增量式光电编码器速度控制精度的测速*** Download PDFInfo
- Publication number
- CN113224983A CN113224983A CN202110383288.5A CN202110383288A CN113224983A CN 113224983 A CN113224983 A CN 113224983A CN 202110383288 A CN202110383288 A CN 202110383288A CN 113224983 A CN113224983 A CN 113224983A
- Authority
- CN
- China
- Prior art keywords
- speed
- control
- photoelectric encoder
- input end
- module
- 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
- 238000005259 measurement Methods 0.000 claims abstract description 19
- 230000010354 integration Effects 0.000 claims abstract description 14
- 238000000034 method Methods 0.000 claims description 16
- 238000000691 measurement method Methods 0.000 claims description 3
- 230000004069 differentiation Effects 0.000 abstract description 8
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
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
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/08—Arrangements for controlling the speed or torque of a single motor
-
- 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
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/0003—Control strategies in general, e.g. linear type, e.g. P, PI, PID, using robust control
-
- 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
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/12—Stator flux based control involving the use of rotor position or rotor speed sensors
-
- 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
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/14—Estimation or adaptation of machine parameters, e.g. flux, current or voltage
- H02P21/18—Estimation of position or speed
-
- 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
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/22—Current control, e.g. using a current control loop
-
- 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
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/28—Arrangements for controlling current
-
- 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
- H02P2205/00—Indexing scheme relating to controlling arrangements characterised by the control loops
- H02P2205/01—Current loop, i.e. comparison of the motor current with a current reference
-
- 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
- H02P2205/00—Indexing scheme relating to controlling arrangements characterised by the control loops
- H02P2205/07—Speed loop, i.e. comparison of the motor speed with a speed reference
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明公开一种可提高增量式光电编码器速度控制精度的测速***,包括增量式光电编码器、微分测速模块、速度指令输入端、速度P控制模块、电流环、电机、积分模块及速度I控制模块;增量式光电编码器的一路依次通过微分测速模块、速度P控制模块、电流环与电机的输入端连接,速度指令输入端的一路依次通过速度P控制模块、电流环与电机的输入端连接;速度指令输入端的另一路依次通过积分模块、速度I控制模块、电流环与电机的输入端连接,增量式光电编码器的另一路依次通过速度I控制模块、电流环与电机的输入端连接。本发明可有效减少位置微分带来的速度反馈计算误差,从而提升速度控制绝对精度,提升机械设备的加工精度和其它控制性能。
Description
技术领域
本发明涉及一种提高增量式光电编码器速度控制精度的技术,具体涉及一种可提高增量式光电编码器速度控制精度的测速***。
背景技术
如图1所示,为已有的变频器或者伺服驱动器带编码器(PG)的速度控制方式,采用位置微分得到反馈速度,然后通过速度PID闭环计算转矩指令。转矩指令通过系数转换得到转矩电流指令和励磁电流指令。两个电流指令送给电流环完成电流环控制。电流环作为速度环的内环使用。
其中,增量式光电编码器,采用M法、T法或者MT法的方法获得微分测速的结果。速度PID所采用的计算公式为,Iq_Ki_Ref=Ki*∫(V_Ref-V_Fdb)dt,Iq_Ki_Ref为转矩指令,Ki为速度控制I增益,V_Ref为速度指令,V_Fdb为增量式光电编码器测量的速度反馈。由于以上测速方法的测速精度存在固有的测速误差,导致速度PID闭环后的速度控制精度不高。例如,存在电机指令转速为2000rpm,用仪器实测的电机转速为1997rpm或者1998rpm。
发明内容
本发明的目的在于克服现有技术的不足,提供一种可提高增量式光电编码器速度控制精度的测速***。
本发明的技术方案如下:
一种可提高增量式光电编码器速度控制精度的测速***,包括增量式光电编码器、微分测速模块、速度指令输入端、速度P控制模块、电流环、电机、积分模块及速度I控制模块;
所述增量式光电编码器的一路依次通过所述微分测速模块、速度P控制模块、电流环与所述电机的输入端连接,所述速度指令输入端的一路依次通过所述速度P控制模块、电流环与所述电机的输入端连接,所述速度P控制模块采用微分测速模块得到的速度反馈和速度指令输入端输入的速度指令计算得出第一转矩指令;
所述速度指令输入端的另一路依次通过所述积分模块、速度I控制模块、电流环与所述电机的输入端连接,所述增量式光电编码器的另一路依次通过所述速度I控制模块、电流环与所述电机的输入端连接,所述速度I控制模块采用积分模块得到的速度指令积分和增量式光电编码器的位置反馈做变形的I控制并计算得出第二转矩指令;
所述电流环最终根据所述第一转矩指令和第二转矩指令结合完成控制。
其中,所述速度P控制模块所采用的计算公式为,Iq_Kp_Ref=Kp*(V_Ref-V_Fdb),其中,Iq_Kp_Ref为第一转矩指令,Kp为速度控制P增益,V_Ref为速度指令,V_Fdb为增量式光电编码器测量的速度反馈。
其中,所述速度I控制模块所采用的计算公式为,Iq_Ki_Ref=Ki*(θ_Ref-θ_Fdb),其中,Iq_Ki_Ref为第二转矩指令,Ki为速度控制I增益,θ_Ref为速度控制计算的虚拟位置指令,θ_Fdb为速度控制的实际反馈位置。
其中,所述增量式光电编码器的反馈速度测速方法为M法、T法或者MT法。
相对于现有技术,本发明的有益效果在于:本发明通过将速度PI控制划分成速度P控制和速度I控制,速度P控制采用位置微分得到的速度反馈和速度指令做计算,速度I控制不采用已有方案的速度微分得到的速度反馈和速度指令做计算,而是采用速度指令积分和位置反馈做变形的I控制。通过该方式有效减少了位置微分带来的速度反馈计算误差,误差可做到少于1rpm的转速。本发明可应用于速控机床等对速度控制绝对精度要求较高的工业应用现场,可以显著提升速度控制的绝对精度,从而提升机械设备的加工精度和其它控制性能。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为现有技术的***框图;
图2为本发明的***框图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
为了说明本发明所述的技术方案,下面通过具体实施例来进行说明。
实施例
请参阅图2,本发明实施例提供一种可提高增量式光电编码器速度控制精度的测速***,包括增量式光电编码器、微分测速模块、速度指令输入端、速度P控制模块、电流环、电机、积分模块及速度I控制模块。其中,所述增量式光电编码器的一路依次通过所述微分测速模块、速度P控制模块、电流环与所述电机的输入端连接,所述速度指令输入端的一路依次通过所述速度P控制模块、电流环与所述电机的输入端连接,所述速度P控制模块采用微分测速模块得到的速度反馈和速度指令输入端输入的速度指令计算得出第一转矩指令;所述速度指令输入端的另一路依次通过所述积分模块、速度I控制模块、电流环与所述电机的输入端连接,所述增量式光电编码器的另一路依次通过所述速度I控制模块、电流环与所述电机的输入端连接,所述速度I控制模块采用积分模块得到的速度指令积分和增量式光电编码器的位置反馈做变形的I控制并计算得出第二转矩指令;所述电流环最终根据所述第一转矩指令和第二转矩指令结合完成控制。
该***通过将公式Iq_Ki_Ref=Ki*∫(V_Ref-V_Fdb)dt做以下改进变形:
Iq_Ki_Ref
=Ki*∫(V_Ref-V_Fdb)dt
=Ki*(∫V_Ref dt-∫V_Fdb dt)
=Ki*(θ_Ref-θ_Fdb);
其中,速度控制的虚拟位置指令计算,速度指令积分:
θ_Ref=∫V_Ref dt;
θ_Fdb为光电编码器实测得到的反馈位置。
经以上变形后,新的速度控制为:
速度P控制:Iq_Kp_Ref=Kp*(V_Ref-V_Fdb);
速度I控制:Iq_Ki_Ref=Ki*(θ_Ref-θ_Fdb);
速度PI控制的最终结果:
Iq_Ref=Iq_Kp_Ref+Iq_Ki_Ref;
反馈速度的计算原理为光电编码器位置微分得到反馈速度:
V_Fdb=dθ/dt;
备注:所述增量式光电编码器的反馈速度测速方法为M法、T法或者MT法。
其中,Kp为速度控制P增益,Ki为速度控制I增益,θ_Ref为速度控制计算的虚拟位置指令,θ_Fdb为速度控制的实际反馈位置,V_Ref为速度指令,V_Fdb为增量式光电编码器测量的速度反馈,Iq_Kp_Ref为第一转矩指令,Iq_Ki_Ref为第二转矩指令。
综上所述,本发明通过将速度PI控制划分成速度P控制和速度I控制,速度P控制采用位置微分得到的速度反馈和速度指令做计算,速度I控制不采用已有方案的速度微分得到的速度反馈和速度指令做计算,而是采用速度指令积分和位置反馈做变形的I控制。通过该方式有效减少了位置微分带来的速度反馈计算误差,误差可做到少于1rpm的转速。
本发明可应用于速控机床等对速度控制绝对精度要求较高的工业应用现场,可以显著提升速度控制的绝对精度,从而提升机械设备的加工精度和其它控制性能。
以上仅为本发明的较佳实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (4)
1.一种可提高增量式光电编码器速度控制精度的测速***,其特征在于:包括增量式光电编码器、微分测速模块、速度指令输入端、速度P控制模块、电流环、电机、积分模块及速度I控制模块;
所述增量式光电编码器的一路依次通过所述微分测速模块、速度P控制模块、电流环与所述电机的输入端连接,所述速度指令输入端的一路依次通过所述速度P控制模块、电流环与所述电机的输入端连接,所述速度P控制模块采用微分测速模块得到的速度反馈和速度指令输入端输入的速度指令计算得出第一转矩指令;
所述速度指令输入端的另一路依次通过所述积分模块、速度I控制模块、电流环与所述电机的输入端连接,所述增量式光电编码器的另一路依次通过所述速度I控制模块、电流环与所述电机的输入端连接,所述速度I控制模块采用积分模块得到的速度指令积分和增量式光电编码器的位置反馈做变形的I控制并计算得出第二转矩指令;
所述电流环最终根据所述第一转矩指令和第二转矩指令结合完成控制。
2.根据权利要求1所述的一种可提高增量式光电编码器速度控制精度的测速***,其特征在于:所述速度P控制模块所采用的计算公式为,Iq_Kp_Ref=Kp*(V_Ref-V_Fdb),其中,Iq_Kp_Ref为第一转矩指令,Kp为速度控制P增益,V_Ref为速度指令,V_Fdb为增量式光电编码器测量的速度反馈。
3.根据权利要求1所述的一种可提高增量式光电编码器速度控制精度的测速***,其特征在于:所述速度I控制模块所采用的计算公式为,Iq_Ki_Ref=Ki*(θ_Ref-θ_Fdb),其中,Iq_Ki_Ref为第二转矩指令,Ki为速度控制I增益,θ_Ref为速度控制计算的虚拟位置指令,θ_Fdb为速度控制的实际反馈位置。
4.根据权利要求1所述的一种可提高增量式光电编码器速度控制精度的测速***,其特征在于:所述增量式光电编码器的反馈速度测速方法为M法、T法或者MT法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110383288.5A CN113224983A (zh) | 2021-04-09 | 2021-04-09 | 一种可提高增量式光电编码器速度控制精度的测速*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110383288.5A CN113224983A (zh) | 2021-04-09 | 2021-04-09 | 一种可提高增量式光电编码器速度控制精度的测速*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113224983A true CN113224983A (zh) | 2021-08-06 |
Family
ID=77086915
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110383288.5A Pending CN113224983A (zh) | 2021-04-09 | 2021-04-09 | 一种可提高增量式光电编码器速度控制精度的测速*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113224983A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115528974A (zh) * | 2022-11-30 | 2022-12-27 | 上海艾利特机器人有限公司 | 一种伺服电机测速反馈控制***及方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6744233B1 (en) * | 2000-11-01 | 2004-06-01 | Mitsubishi Denki Kabushiki Kaisha | Servo controller and method |
CN200972605Y (zh) * | 2006-09-20 | 2007-11-07 | 哈尔滨工程大学 | 基于dsp的电机位置伺服装置 |
CN104702158A (zh) * | 2013-12-09 | 2015-06-10 | 山洋电气株式会社 | 电机控制装置 |
CN105024616A (zh) * | 2015-08-05 | 2015-11-04 | 合肥工业大学 | 电网电压对称骤升下的双馈风力发电机组的轴系振荡抑制控制***及其方法 |
CN105511399A (zh) * | 2015-12-02 | 2016-04-20 | 山东科技大学 | 一种结构优化的伺服电机速度闭环控制方法 |
CN108880358A (zh) * | 2018-07-02 | 2018-11-23 | 哈尔滨理工大学 | 基于角位移无时滞观测器的永磁同步电机控制方法及装置 |
CN109546913A (zh) * | 2018-12-24 | 2019-03-29 | 哈尔滨工业大学 | 一种电容小型化电机驱动装置 |
CN111347422A (zh) * | 2019-12-27 | 2020-06-30 | 北京卫星制造厂有限公司 | 一种提高机器人关节精度的控制方法 |
-
2021
- 2021-04-09 CN CN202110383288.5A patent/CN113224983A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6744233B1 (en) * | 2000-11-01 | 2004-06-01 | Mitsubishi Denki Kabushiki Kaisha | Servo controller and method |
CN200972605Y (zh) * | 2006-09-20 | 2007-11-07 | 哈尔滨工程大学 | 基于dsp的电机位置伺服装置 |
CN104702158A (zh) * | 2013-12-09 | 2015-06-10 | 山洋电气株式会社 | 电机控制装置 |
CN105024616A (zh) * | 2015-08-05 | 2015-11-04 | 合肥工业大学 | 电网电压对称骤升下的双馈风力发电机组的轴系振荡抑制控制***及其方法 |
CN105511399A (zh) * | 2015-12-02 | 2016-04-20 | 山东科技大学 | 一种结构优化的伺服电机速度闭环控制方法 |
CN108880358A (zh) * | 2018-07-02 | 2018-11-23 | 哈尔滨理工大学 | 基于角位移无时滞观测器的永磁同步电机控制方法及装置 |
CN109546913A (zh) * | 2018-12-24 | 2019-03-29 | 哈尔滨工业大学 | 一种电容小型化电机驱动装置 |
CN111347422A (zh) * | 2019-12-27 | 2020-06-30 | 北京卫星制造厂有限公司 | 一种提高机器人关节精度的控制方法 |
Non-Patent Citations (1)
Title |
---|
周新良 等: "一种快速扫描伺服***的设计与实现", 《雷达科学与技术》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115528974A (zh) * | 2022-11-30 | 2022-12-27 | 上海艾利特机器人有限公司 | 一种伺服电机测速反馈控制***及方法 |
CN115528974B (zh) * | 2022-11-30 | 2023-03-10 | 上海艾利特机器人有限公司 | 一种伺服电机测速反馈控制***及方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Hoseinnezhad et al. | Calibration of resolver sensors in electromechanical braking systems: A modified recursive weighted least-squares approach | |
CN103701386B (zh) | 基于观测磁链误差的异步电机无速度传感器的全阶磁链观测器的获取方法 | |
CN110752806B (zh) | 改进趋近律的内置式永磁同步电机的滑模转速控制方法 | |
CN112701968B (zh) | 一种永磁同步电机模型预测控制鲁棒性能提升方法 | |
CN101394146A (zh) | 直流电机速度控制对象参数识别***及识别方法 | |
CN104333285A (zh) | 永磁同步电机准无传感器位置伺服控制装置及方法 | |
CN114389497B (zh) | 一种异步电机电压电流混合磁链观测器定向误差补偿方法 | |
CN110077458A (zh) | 一种基于自抗扰控制的智能车转角控制方法 | |
CN111464097A (zh) | 一种永磁同步电机转动惯量离线辨识方法 | |
Hwang et al. | Practical synchronous steering angle control of a dual-motor driving steer-by-wire system | |
CN111756286A (zh) | 一种高性能鲁棒永磁同步轮毂电机复合控制器 | |
CN113224983A (zh) | 一种可提高增量式光电编码器速度控制精度的测速*** | |
CN105929791B (zh) | 平面直角坐标运动***的直接轮廓控制方法 | |
CN108512467B (zh) | 直流无刷电机控制装置及控制方法 | |
CN104270046A (zh) | 一种基于转速-电流二维模糊模型自学习的电机控制方法 | |
CN116638544A (zh) | 一种基于超局部模型的关节模组协同控制方法 | |
CN114714364B (zh) | 机器人关节摩擦力补偿调节方法、机器人摩擦力补偿方法 | |
CN116339177A (zh) | 一种基于动态摩擦补偿的机器人控制方法 | |
CN113890424B (zh) | 基于参数辨识的永磁同步电机速度环pi控制器调谐方法 | |
CN112304336B (zh) | 一种高频角振动转台控制方法 | |
CN111880483B (zh) | 一种雷达天线四电机驱动伺服***预定性能控制方法 | |
CN104022707A (zh) | 基于新型转子磁链观测器的异步电机速度控制装置及*** | |
CN113890446A (zh) | 基于LuGre模型的伺服控制***的参数辨识方法 | |
CN206743139U (zh) | 一种双电机协同控制*** | |
CN114785208B (zh) | 永磁同步电机无位置传感器控制转子位置误差观测方法 |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20210806 |