CN113794401A - 一种伺服电机鲁棒扰动补偿方法 - Google Patents
一种伺服电机鲁棒扰动补偿方法 Download PDFInfo
- Publication number
- CN113794401A CN113794401A CN202111053889.6A CN202111053889A CN113794401A CN 113794401 A CN113794401 A CN 113794401A CN 202111053889 A CN202111053889 A CN 202111053889A CN 113794401 A CN113794401 A CN 113794401A
- Authority
- CN
- China
- Prior art keywords
- motor
- formula
- model
- compensation method
- expressed
- 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
- 238000000034 method Methods 0.000 title claims abstract description 25
- 230000008878 coupling Effects 0.000 claims abstract description 5
- 238000010168 coupling process Methods 0.000 claims abstract description 5
- 238000005859 coupling reaction Methods 0.000 claims abstract description 5
- 230000000694 effects Effects 0.000 claims description 6
- 125000004432 carbon atom Chemical group C* 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000013016 damping Methods 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 238000004088 simulation Methods 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02N—ELECTRIC MACHINES NOT OTHERWISE PROVIDED FOR
- H02N2/00—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction
- H02N2/10—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction producing rotary motion, e.g. rotary motors
- H02N2/14—Drive circuits; Control arrangements or methods
- H02N2/145—Large signal circuits, e.g. final stages
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02N—ELECTRIC MACHINES NOT OTHERWISE PROVIDED FOR
- H02N2/00—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction
- H02N2/10—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction producing rotary motion, e.g. rotary motors
- H02N2/12—Constructional details
Landscapes
- Control Of Electric Motors In General (AREA)
Abstract
本发明提出一种伺服电机鲁棒扰动补偿方法,所述补偿方法中,电机的控制***包括电机控制器;电机动力***中,电机一侧的输出轴测量端(3)与光电编码器(1)相连接,另一侧的输出轴动力端(6)与用于模拟电机扰动负载的飞轮惯性负载相连;所述飞轮惯性负载的输出轴经弹性联轴器(9)与力矩传感器(10)相连;所述电机控制器经光电编码器采集电机输出轴的角速度,经力矩传感器采集飞轮惯性负载的摩擦力矩,以根据采集数据调整电机工况来进行鲁棒扰动补偿;本发明能有效的增进***的控制效能,并进一步减少电机控制***对于不确定性的影响程度。
Description
技术领域
本发明涉及电机控制技术领域,尤其是一种伺服电机鲁棒扰动补偿方法。
背景技术
现有的超声波电机伺服控制***,根据预摩擦模型的性质,可以发现该模型是高度非线性的,并且获得包括反转点状态在内的所有状态信息是物理上不可能实现的。
此外,由于无法完全消除该类***内的未知摩擦和建模,若该控制方案可与传统控制器相结合,则有助于抑制残余摩擦力和方程不完全补偿引起的模型不确定性。
发明内容
本发明提出一种伺服电机鲁棒扰动补偿方法,能有效的增进***的控制效能,并进一步减少电机控制***对于不确定性的影响程度。
本发明采用以下技术方案。
一种伺服电机鲁棒扰动补偿方法,所述补偿方法中,电机的控制***包括电机控制器;电机动力***中,电机一侧的输出轴测量端(3)与光电编码器(1)相连接,另一侧的输出轴动力端(6)与用于模拟电机扰动负载的飞轮惯性负载相连;所述飞轮惯性负载的输出轴经弹性联轴器(9)与力矩传感器(10)相连;所述电机控制器经光电编码器采集电机输出轴的角速度,经力矩传感器采集飞轮惯性负载的摩擦力矩,以根据采集数据调整电机工况来进行鲁棒扰动补偿。
所述电机为设于基座(12)上的超声波电机(4)。
所述电机控制器包括超声波电机驱动控制电路(29),所述超声波电机驱动控制电路包括控制芯片电路(13)和驱动芯片电路(14),所述光电编码器的信号输出端与控制芯片电路的对应输入端相连接,控制芯片电路的输出端与驱动芯片电路的对应输入端相连接以驱动所述驱动芯片电路;
所述驱动芯片电路的驱动频率调节信号输出端和驱动半桥电路调节信号输出端分别与所述超声波电机的相应输入端相连接;所述驱动芯片电路产生驱动频率调节信号和驱动半桥电路调节信号,对超声波电机输出A、B两相PWM的频率、相位及通断进行控制,通过开通及关断PWM波的输出来控制超声波电机的启动和停止运行;通过调节输出的PWM波的频率及两相的相位差来调节电机的最佳运行状态。
所述电机动力***形成预滑动摩擦力模型,所述预滑动摩擦力模型的摩擦效应以公式表述为
J(dω/dt)=Tm-Tf-Bω 公式一;
J是总转动惯量,ω是电机角速度,Tm是电机的转矩,Tf是摩擦力矩,B是粘性阻尼系数,Tm以公式表示为:
Tm=(VA-VB)(KT/R)=(KAu-KBω) 公式二;
VA是电压放大器的输出,VB的反电动势电压,KT是电机的转矩常数,R为电枢电阻,KA是电压放大器的增益,u是控制电压,KB是反电动势常数;
预滑动摩擦力模型中,用于参数不确定***建模的公式为
其中,模型不确定性函数定义为:
式中:
当非线性摩擦力矩Tf为未知的干扰值时,使用Tef代替Tf,即公式三表述为:
当电机输出轴的角速度以下述公式表述时
其中g是积分项的非负增益,F(s)是高截止频率的低通滤波器;公式九中的滤波器F(s)用于过滤高频测量噪声;
当模型存在不确定性时,参数误差函数ρ(s)以公式定义为:
公式九可表述为
在增设补偿函数后,公式六表述为:
模型中,剩余的扰动d(s)以公式定义为:
其中d1(s)和d2(s)代表残余摩擦和残差模型的对电机动力***的不确定性干扰。
当无法完全消除残余摩擦力和模拟方案模型中的方程不完全补偿时,则结合传统控制器,以抑制残余摩擦力和方程不完全补偿引起的模型不确定性;
结合公式十二、公式十三,电机的动力学方程由以下公式表述;
上式中,
b=(KAKT)/(RJ) 公式十六;
对于已知的非负常数δ1和δ2,干扰d1(t)和d2(t),有:
d1(t)<δ1,d2(t)<δ2 公式十七;
当公式十四中的动态参数f(t)不能完全确定时,干扰δ1和δ2有界;
公式十四中的参数b的控制增益是具有已知边界的未知量,bmax、bmin为边界最大和最小值,即
bmax≥b≥bmin>0 公式十九;
当时变状态向量被定义为x(t)=[θ(t) ω(t)]T 公式二十三时,
所需的时变状态定义为xd(t)=[θd(t) ωd(t)]T 公式二十四;
补偿方法的开关状态s(t)=0,在模型的状态空间中定义为:
其中λ是严格正常数;
本发明与现有技术相比具有以下有益效果:
本发明使用基于预滑动摩擦力模型的超声波电机伺服控制***能有效的增进***的动态性能,并进一步减少***对于不确定性的影响程度,提高了控制的准确性,可以获得较好的动态特性。此外,该装置设计合理,结构简单、紧凑,制造成本低,具有很强的实用性和广阔的应用前景。
附图说明
下面结合附图和具体实施方式对本发明进一步详细的说明:
附图1是本发明的结构示意图;
附图2是本发明的控制电路原理示意图;
图中:1-光电编码器;2-光电编码器固定支架;3-输出轴测量端;4-超声波电机;5-超声波电机固定支架;6-输出轴动力端;7-飞轮惯性负载;8-飞轮惯性负载的输出轴;9-弹性联轴器;10-力矩传感器;11-力矩传感器固定支架;12-基座;13-控制芯片电路;14-驱动芯片电路;
15、16、17-光电编码器输出的A、B、Z相信号;18、19、20、21-驱动芯片电路产生的驱动频率调节信号;22-驱动芯片电路产生的驱动半桥电路调节信号;23、24、25、26、27、28-控制芯片电路产生的驱动芯片电路的信号;29-超声波电机驱动控制电路。
具体实施方式
如图所示,一种伺服电机鲁棒扰动补偿方法,所述补偿方法中,电机的控制***包括电机控制器;电机动力***中,电机一侧的输出轴测量端3与光电编码器1相连接,另一侧的输出轴动力端6与用于模拟电机扰动负载的飞轮惯性负载7相连;所述飞轮惯性负载的输出轴8经弹性联轴器9与力矩传感器10相连;所述电机控制器经光电编码器采集电机输出轴的角速度,经力矩传感器采集飞轮惯性负载的摩擦力矩,以根据采集数据调整电机工况来进行鲁棒扰动补偿。
所述电机为设于基座12上的超声波电机4。
本例中,光电编码器固定于光电编码器固定支架2处,力矩传感器固定于力矩传感器固定支架11处。
所述电机控制器包括超声波电机驱动控制电路29,所述超声波电机驱动控制电路包括控制芯片电路13和驱动芯片电路14,所述光电编码器的信号输出端与控制芯片电路的对应输入端相连接,光电编码器输出的A、B、Z相信号15、16、17被控制芯片电路接收,控制芯片电路的输出端与驱动芯片电路的对应输入端相连接以驱动所述驱动芯片电路,具体驱动通过控制芯片电路产生的驱动芯片电路的信号23、24、25、26、27、28进行;
所述驱动芯片电路的驱动频率调节信号输出端和驱动半桥电路调节信号输出端分别与所述超声波电机的相应输入端相连接;所述驱动芯片电路产生驱动频率调节信号18、19、20、21和驱动半桥电路调节信号22,对超声波电机输出A、B两相PWM的频率、相位及通断进行控制,通过开通及关断PWM波的输出来控制超声波电机的启动和停止运行;通过调节输出的PWM波的频率及两相的相位差来调节电机的最佳运行状态。
所述电机动力***形成预滑动摩擦力模型,所述预滑动摩擦力模型的摩擦效应以公式表述为
J(dω/dt)=Tm-Tf-Bω 公式一;
J是总转动惯量,ω是电机角速度,Tm是电机的转矩,Tf是摩擦力矩,B是粘性阻尼系数,Tm以公式表示为:
Tm=(VA-VB)(KT/R)=(KAu-KBω) 公式二;
VA是电压放大器的输出,VB的反电动势电压,KT是电机的转矩常数,R为电枢电阻,KA是电压放大器的增益,u是控制电压,KB是反电动势常数;
预滑动摩擦力模型中,用于参数不确定***建模的公式为
其中,模型不确定性函数定义为:
式中:
当非线性摩擦力矩Tf为未知的干扰值时,使用Tef代替Tf,即公式三表述为:
当电机输出轴的角速度以下述公式表述时
其中g是积分项的非负增益,F(s)是高截止频率的低通滤波器;公式九中的滤波器F(s)用于过滤高频测量噪声;
当模型存在不确定性时,参数误差函数ρ(s)以公式定义为:
公式九可表述为
在增设补偿函数后,公式六表述为:
模型中,剩余的扰动d(s)以公式定义为:
其中d1(s)和d2(s)代表残余摩擦和残差模型的对电机动力***的不确定性干扰。
当无法完全消除残余摩擦力和模拟方案模型中的方程不完全补偿时,则结合传统控制器,以抑制残余摩擦力和方程不完全补偿引起的模型不确定性;
结合公式十二、公式十三,电机的动力学方程由以下公式表述;
上式中,
b=(KAKT)/(RJ) 公式十六;
对于已知的非负常数δ1和δ2,干扰d1(t)和d2(t),有:
d1(t)<δ1,d2(t)<δ2 公式十七;
当公式十四中的动态参数f(t)不能完全确定时,干扰δ1和δ2有界;
公式十四中的参数b的控制增益是具有已知边界的未知量,bmax、bmin为边界最大和最小值,即
bmax≥b≥bmin>0 公式十九;
当时变状态向量被定义为x(t)=[θ(t) ω(t)]T 公式二十三时,
所需的时变状态定义为xd(t)=[θd(t) ωd(t)]T 公式二十四;
补偿方法的开关状态s(t)=0,在模型的状态空间中定义为:
其中λ是严格正常数;
以上所述仅为本发明的较佳实施例,凡依本发明申请专利范围所做的均等变化与修饰,皆应属本发明的涵盖范围。
Claims (5)
1.一种伺服电机鲁棒扰动补偿方法,其特征在于:所述补偿方法中,电机的控制***包括电机控制器;电机动力***中,电机一侧的输出轴测量端(3)与光电编码器(1)相连接,另一侧的输出轴动力端(6)与用于模拟电机扰动负载的飞轮惯性负载相连;所述飞轮惯性负载的输出轴经弹性联轴器(9)与力矩传感器(10)相连;所述电机控制器经光电编码器采集电机输出轴的角速度,经力矩传感器采集飞轮惯性负载的摩擦力矩,以根据采集数据调整电机工况来进行鲁棒扰动补偿。
2.根据权利要求1所述的一种伺服电机鲁棒扰动补偿方法,其特征在于:所述电机为设于基座(12)上的超声波电机(4)。
3.根据权利要求2所述的一种伺服电机鲁棒扰动补偿方法,其特征在于:所述电机控制器包括超声波电机驱动控制电路(29),所述超声波电机驱动控制电路包括控制芯片电路(13)和驱动芯片电路(14),所述光电编码器的信号输出端与控制芯片电路的对应输入端相连接,控制芯片电路的输出端与驱动芯片电路的对应输入端相连接以驱动所述驱动芯片电路;
所述驱动芯片电路的驱动频率调节信号输出端和驱动半桥电路调节信号输出端分别与所述超声波电机的相应输入端相连接;所述驱动芯片电路产生驱动频率调节信号和驱动半桥电路调节信号,对超声波电机输出A、B两相PWM的频率、相位及通断进行控制,通过开通及关断PWM波的输出来控制超声波电机的启动和停止运行;通过调节输出的PWM波的频率及两相的相位差来调节电机的最佳运行状态。
4.根据权利要求2所述的一种伺服电机鲁棒扰动补偿方法,其特征在于:所述电机动力***形成预滑动摩擦力模型,所述预滑动摩擦力模型的摩擦效应以公式表述为
J(dω/dt)=Tm-Tf-Bω 公式一;
J是总转动惯量,ω是电机角速度,Tm是电机的转矩,Tf是摩擦力矩,B是粘性阻尼系数,Tm以公式表示为:
Tm=(VA-VB)(KT/R)=(KAu-KBω) 公式二;
VA是电压放大器的输出,VB的反电动势电压,KT是电机的转矩常数,R为电枢电阻,KA是电压放大器的增益,u是控制电压,KB是反电动势常数;
预滑动摩擦力模型中,用于参数不确定***建模的公式为
公式三;
其中,模型不确定性函数定义为:
式中:
当非线性摩擦力矩Tf为未知的干扰值时,使用Tef代替Tf,即公式三表述为:
当电机输出轴的角速度以下述公式表述时
其中g是积分项的非负增益,F(s)是高截止频率的低通滤波器;公式九中的滤波器F(s)用于过滤高频测量噪声;
当模型存在不确定性时,参数误差函数ρ(s)以公式定义为:
公式九可表述为
在增设补偿函数后,公式六表述为:
模型中,剩余的扰动d(s)以公式定义为:
其中d1(s)和d2(s)代表残余摩擦和残差模型的对电机动力***的不确定性干扰。
5.根据权利要求4所述的一种伺服电机鲁棒扰动补偿方法,其特征在于:当无法完全消除残余摩擦力和模拟方案模型中的方程不完全补偿时,则结合传统控制器,以抑制残余摩擦力和方程不完全补偿引起的模型不确定性;
结合公式十二、公式十三,电机的动力学方程由以下公式表述;
上式中,
b=(KAKT)/(RJ) 公式十六;
对于已知的非负常数δ1和δ2,干扰d1(t)和d2(t),有:
d1(t)<δ1,d2(t)<δ2 公式十七;
当公式十四中的动态参数f(t)不能完全确定时,干扰δ1和δ2有界;
公式十四中的参数b的控制增益是具有已知边界的未知量,bmax、bmin为边界最大和最小值,即
bmax≥b≥bmin>0 公式十九;
当时变状态向量被定义为x(t)=[θ(t) ω(t)]T 公式二十三时,
所需的时变状态定义为xd(t)=[θd(t) ωd(t)]T 公式二十四;
补偿方法的开关状态s(t)=0,在模型的状态空间中定义为:
其中λ是严格正常数;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111053889.6A CN113794401A (zh) | 2021-09-09 | 2021-09-09 | 一种伺服电机鲁棒扰动补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111053889.6A CN113794401A (zh) | 2021-09-09 | 2021-09-09 | 一种伺服电机鲁棒扰动补偿方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113794401A true CN113794401A (zh) | 2021-12-14 |
Family
ID=79182883
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111053889.6A Pending CN113794401A (zh) | 2021-09-09 | 2021-09-09 | 一种伺服电机鲁棒扰动补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113794401A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115415251A (zh) * | 2022-09-15 | 2022-12-02 | 武汉理工大学 | 一种音圈电机转镜激光清洗***及其清洗方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109067271A (zh) * | 2018-09-14 | 2018-12-21 | 闽江学院 | 一种基于鲁棒扰动补偿方案的直流电机伺服控制方法 |
CN109120181A (zh) * | 2018-09-11 | 2019-01-01 | 闽江学院 | 一种基于增益限制补偿器的超声波电机伺服控制***极限环抑制设计方法 |
-
2021
- 2021-09-09 CN CN202111053889.6A patent/CN113794401A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109120181A (zh) * | 2018-09-11 | 2019-01-01 | 闽江学院 | 一种基于增益限制补偿器的超声波电机伺服控制***极限环抑制设计方法 |
CN109067271A (zh) * | 2018-09-14 | 2018-12-21 | 闽江学院 | 一种基于鲁棒扰动补偿方案的直流电机伺服控制方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115415251A (zh) * | 2022-09-15 | 2022-12-02 | 武汉理工大学 | 一种音圈电机转镜激光清洗***及其清洗方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102326329B (zh) | 交流电机的控制装置及交流电机驱动*** | |
CN101110559B (zh) | 一种混合动力车用永磁同步发电机的控制*** | |
CN100586003C (zh) | 一种用于交流异步电机的无速度传感器的矢量控制方法 | |
CN101567652B (zh) | 永磁电动机启动 | |
CN108336938A (zh) | 压力控制装置、***及方法 | |
US5444351A (en) | System and method for controlling induction motor applicable to electric motor-driven vehicle | |
CN106208807B (zh) | 基于观测器的超声波电机伺服控制***滞回补偿控制方法 | |
CN101535913A (zh) | 电动机控制方法 | |
CN102255554B (zh) | 一种旋转行波超声波电机的摩擦补偿的速度控制方法 | |
CN113794401A (zh) | 一种伺服电机鲁棒扰动补偿方法 | |
CN105915142A (zh) | 一种基于解耦自适应观测器的永磁同步电机转子位置和转速估算方法 | |
US6789023B2 (en) | Method of instant estimation of a load motor inertia | |
CN113114080A (zh) | 一种永磁同步电机无磁链环直接转矩控制方法 | |
TWI426698B (zh) | Intelligent control model for adaptive control of sensors without sensor control method | |
CN106406093A (zh) | 超声波电机伺服控制***不对称滞回补偿控制装置及方法 | |
CN112083349B (zh) | 一种永磁同步电机定子绕组匝间短路故障诊断方法 | |
Asai et al. | Evaluation of the driving performance of a surface acoustic wave linear motor | |
CN106655882A (zh) | 一种摩擦力参数不确定条件下超声波电机伺服控制***滞回控制方法 | |
CN108649852B (zh) | 一种改进电流环的永磁同步电机控制方法 | |
CN106341065A (zh) | 超声波电机伺服控制***速度死区补偿控制装置及方法 | |
EP4125205A1 (en) | System and method for damping of mechanical oscillaton of a rotor of an electric machine in a vehicle | |
CN103336523A (zh) | 超声波电机伺服控制***控制特性测试装置及其控制策略 | |
CN109067271B (zh) | 一种基于鲁棒扰动补偿方案的直流电机伺服控制方法 | |
CN105099263A (zh) | 基于广义回归神经网络辨识器的超声波电机位置与速度控制*** | |
CN106842957B (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 |