一种伺服电机鲁棒扰动补偿方法
阅读说明：本技术 一种伺服电机鲁棒扰动补偿方法 (Robust disturbance compensation method for servo motor ) 是由 傅平 于 2021-09-09 设计创作，主要内容包括：本发明提出一种伺服电机鲁棒扰动补偿方法,所述补偿方法中,电机的控制系统包括电机控制器；电机动力系统中,电机一侧的输出轴测量端(3)与光电编码器(1)相连接,另一侧的输出轴动力端(6)与用于模拟电机扰动负载的飞轮惯性负载相连；所述飞轮惯性负载的输出轴经弹性联轴器(9)与力矩传感器(10)相连；所述电机控制器经光电编码器采集电机输出轴的角速度,经力矩传感器采集飞轮惯性负载的摩擦力矩,以根据采集数据调整电机工况来进行鲁棒扰动补偿；本发明能有效的增进系统的控制效能,并进一步减少电机控制系统对于不确定性的影响程度。(The invention provides a robust disturbance compensation method for a servo motor, wherein in the compensation method, a control system of the motor comprises a motor controller; in the motor power system, an output shaft measuring end (3) at one side of a motor is connected with a photoelectric encoder (1), and an output shaft power end (6) at the other side of the motor is connected with a flywheel inertial load for simulating motor disturbance load; the output shaft of the flywheel inertial load is connected with a torque sensor (10) through an elastic coupling (9); the motor controller collects the angular speed of the output shaft of the motor through a photoelectric encoder, and collects the friction torque of the inertia load of the flywheel through a torque sensor so as to adjust the working condition of the motor according to the collected data to perform robust disturbance compensation; the invention can effectively improve the control efficiency of the system and further reduce the influence degree of the motor control system on the uncertainty.)
技术领域
本发明涉及电机控制技术领域，尤其是一种伺服电机鲁棒扰动补偿方法。
背景技术
现有的超声波电机伺服控制系统，根据预摩擦模型的性质，可以发现该模型是高度非线性的，并且获得包括反转点状态在内的所有状态信息是物理上不可能实现的。
此外，由于无法完全消除该类系统内的未知摩擦和建模，若该控制方案可与传统控制器相结合，则有助于抑制残余摩擦力和方程不完全补偿引起的模型不确定性。
发明内容
本发明提出一种伺服电机鲁棒扰动补偿方法，能有效的增进系统的控制效能，并进一步减少电机控制系统对于不确定性的影响程度。
本发明采用以下技术方案。
一种伺服电机鲁棒扰动补偿方法，所述补偿方法中，电机的控制系统包括电机控制器；电机动力系统中，电机一侧的输出轴测量端(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是反电动势常数；
预滑动摩擦力模型中，用于参数不确定系统建模的公式为
其中在公式三的项中，加在字母上的“^”代表标称参数，而“Δ”表示在参数的变化；名义传递函数为表示为：
其中，模型不确定性函数定义为：
式中：
P(s)和ΔP(s)是未知量，为对系统采集信息的识别量；
当非线性摩擦力矩Tf为未知的干扰值时，使用Tef代替Tf，即公式三表述为：
当Tef为可估算值时，则补偿函数可用于消除摩擦力矩和模型不确定性的影响；
当电机输出轴的角速度以下述公式表述时
此时
补偿函数为
其中g是积分项的非负增益，F(s)是高截止频率的低通滤波器；公式九中的滤波器F(s)用于过滤高频测量噪声；
当模型存在不确定性时，参数误差函数ρ(s)以公式定义为:
公式九可表述为
公式十一中，等于等价函数Tef(s)和参数误差函数ρ(s)的差，ρ(s)具有高增益g；当增益g被设计为较大值时，模型的跟踪效果得到改善，即通过补偿函数减小了摩擦力矩和参数误差函数对电机系统的影响；
在增设补偿函数后，公式六表述为：
模型中，剩余的扰动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有界；
动态参数f(t)和估计值之间的估计误差由下列已知函数确定：
公式十四中的参数b的控制增益是具有已知边界的未知量，bmax、bmin为边界最大和最小值，即
bmax≥b≥bmin＞0 公式十九；
控制增益的估计值为公式十九给出的几何平均值：
边界以公式表述为：
公式二十一中
当时变状态向量被定义为x(t)＝[θ(t) ω(t)]T 公式二十三时，
所需的时变状态定义为xd(t)＝[θd(t) ωd(t)]T 公式二十四；
跟踪误差矢量定义为：
补偿方法的开关状态s(t)＝0，在模型的状态空间中定义为：
其中λ是严格正常数；
补偿方法的控制律u(t)为
其中
其中η是严格正常数，
本发明与现有技术相比具有以下有益效果：
本发明使用基于预滑动摩擦力模型的超声波电机伺服控制系统能有效的增进系统的动态性能，并进一步减少系统对于不确定性的影响程度，提高了控制的准确性，可以获得较好的动态特性。此外，该装置设计合理，结构简单、紧凑，制造成本低，具有很强的实用性和广阔的应用前景。
附图说明
下面结合附图和
具体实施方式
对本发明进一步详细的说明：
附图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是反电动势常数；
预滑动摩擦力模型中，用于参数不确定系统建模的公式为
其中在公式三的项中，加在字母上的“^”代表标称参数，而“Δ”表示在参数的变化；名义传递函数为表示为：
其中，模型不确定性函数定义为：
式中：
P(s)和ΔP(s)是未知量，为对系统采集信息的识别量；
当非线性摩擦力矩Tf为未知的干扰值时，使用Tef代替Tf，即公式三表述为：
当Tef为可估算值时，则补偿函数可用于消除摩擦力矩和模型不确定性的影响；
当电机输出轴的角速度以下述公式表述时
此时
补偿函数为
其中g是积分项的非负增益，F(s)是高截止频率的低通滤波器；公式九中的滤波器F(s)用于过滤高频测量噪声；
当模型存在不确定性时，参数误差函数ρ(s)以公式定义为:
公式九可表述为
公式十一中，等于等价函数Tef(s)和参数误差函数ρ(s)的差，ρ(s)具有高增益g；当增益g被设计为较大值时，模型的跟踪效果得到改善，即通过补偿函数减小了摩擦力矩和参数误差函数对电机系统的影响；
在增设补偿函数后，公式六表述为：
模型中，剩余的扰动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有界；
动态参数f(t)和估计值之间的估计误差由下列已知函数确定：
公式十四中的参数b的控制增益是具有已知边界的未知量，bmax、bmin为边界最大和最小值，即
bmax≥b≥bmin＞0 公式十九；
控制增益的估计值为公式十九给出的几何平均值：
边界以公式表述为：
公式二十一中
当时变状态向量被定义为x(t)＝[θ(t) ω(t)]T 公式二十三时，
所需的时变状态定义为xd(t)＝[θd(t) ωd(t)]T 公式二十四；
跟踪误差矢量定义为：
补偿方法的开关状态s(t)＝0，在模型的状态空间中定义为：
其中λ是严格正常数；
补偿方法的控制律u(t)为
其中
其中η是严格正常数，
以上所述仅为本发明的较佳实施例，凡依本发明申请专利范围所做的均等变化与修饰，皆应属本发明的涵盖范围。