CN106341065B - 超声波电机伺服控制系统速度死区补偿控制装置及方法 - Google Patents
超声波电机伺服控制系统速度死区补偿控制装置及方法 Download PDFInfo
- Publication number
- CN106341065B CN106341065B CN201610889669.XA CN201610889669A CN106341065B CN 106341065 B CN106341065 B CN 106341065B CN 201610889669 A CN201610889669 A CN 201610889669A CN 106341065 B CN106341065 B CN 106341065B
- Authority
- CN
- China
- Prior art keywords
- control system
- supersonic motor
- dead zone
- control
- chip circuit
- 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
- 238000000034 method Methods 0.000 title claims abstract description 10
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 claims abstract description 9
- 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
- 230000005611 electricity Effects 0.000 claims description 6
- 238000013178 mathematical model Methods 0.000 claims description 6
- 239000013256 coordination polymer Substances 0.000 claims description 3
- 241000208340 Araliaceae Species 0.000 claims 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 claims 1
- 235000003140 Panax quinquefolius Nutrition 0.000 claims 1
- 238000013016 damping Methods 0.000 claims 1
- 235000008434 ginseng Nutrition 0.000 claims 1
- 238000005259 measurement Methods 0.000 claims 1
- 230000000694 effects Effects 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000005622 photoelectricity Effects 0.000 description 1
- 238000002604 ultrasonography Methods 0.000 description 1
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
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/02—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明涉及一种超声波电机伺服控制系统速度死区补偿控制装置及方法,该装置包括控制系统、基座和设于基座上的超声波电机。超声波电机一侧输出轴与光电编码器连接,另一侧输出轴与飞轮惯性负载连接,飞轮惯性负载的输出轴经联轴器与力矩传感器连接,光电编码器、力矩传感器的信号输出端分别接至控制系统。该控制系统由死区补偿控制器和电机组成,整个控制器的系统建立在死区补偿控制器的基础上,在控制器的设计上也以辨识误差最小为其调整函数,从而能获得更好的控制效能。该装置及其控制系统不仅控制准确度高,而且结构简单、紧凑,使用效果好。
Description
技术领域
本发明涉及电机控制器领域,特别是一种基于速度死区补偿的超声波电机伺服控制装置及方法。
背景技术
现有的超声波电机伺服控制系统的设计中由于速度死区的存在,使得系统的性能受到影响,对周期重复信号控制时有一定的误差。
为了改善系统的跟随性能,我们设计了基于速度死区补偿的超声波电机伺服控制系统。从速度跟随的实作结果中,我们发现系统在速度关系基本是线性,且参数的变动、噪声、交叉耦合的干扰和摩擦力等因素几乎无法对于速度输出造成影响,故基于速度死区补偿的超声波电机伺服控制系统能有效的增进系统的控制效能,并进一步减少系统对于不确定性的影响程度,因此电机的力矩与速度控制可以获得较好的动态特性。
发明内容
本发明的目的在于提供一种基于速度死区补偿的超声波电机伺服控制系统,该装置及其控制系统不仅控制准确度高,而且结构简单、紧凑,使用效果好。
为实现上述目的,本发明的技术方案是:一种超声波电机伺服控制系统速度死区补偿控制装置,包括控制系统、基座及设置于所述基座上的超声波电机,其特征在于:所述超声波电机一侧输出轴与光电编码器相连接,另一侧输出轴与飞轮惯性负载相连接,所述飞轮惯性负载的输出轴经一联轴器与力矩传感器相连接,所述光电编码器的信号输出端、力矩传感器的信号输出端分别接至控制系统;所述控制系统包括一速度死区补偿控制器。
进一步的,所述控制系统包括超声波电机驱动控制电路;所述超声波电机驱动控制电路包括控制芯片电路和驱动芯片电路;所述光电编码器的信号输出端与所述控制芯片电路的相应输入端相连接;所述控制芯片电路的输出端与所述驱动芯片电路的相应输入端相连接,以驱动所述驱动芯片电路,所述驱动芯片电路的驱动频率调节信号输出端和驱动半桥电路调节信号输出端分别与所述超声波电机的相应输入端相连接;所述速度死区补偿控制器设于所述控制芯片电路中。
本发明还提供一种超声波电机伺服控制系统速度死区补偿控制方法,其特征在于:控制系统中输入信号先经过死区逆算子得到结果,然后输入死区进行控制;具体包括以下步骤:步骤S1:超声波电机驱动系统的动态方程描述为:其中Ap=-B/J,BP=J/Kt,CP=-1/J;B为阻尼系数,J为转动惯量,J>0,Kt为电流因子(Kt>0),Tf(v)为摩擦阻力力矩,TL为负载力矩,U(t)是电机的输出力矩,θr(t)为通过光电编码器测量得到的位置信号;
步骤S2:假设速度死区是对称,不对称的死区由此类比得到,死区的数学模型为:其中v(t)为输入信号,Ω[v](t)为系统的输出信号,gi为每个死区算子Jdi[v](t)的权重系数;
死区算子为:
以上的死区算子为对称型算子,每个死区范围为[-di,di],gi、di为系统待辨识的初始参数,初始参数由系统先由给定输入控制信号得到的输出计算得到初步结果,再经过辨识修正参数:其中Ω(v,g)为死区的数学模型计算得到结果,Y(v,g)为实际测量结果,
死区逆算子为:其中对于v(t)≥0情况,计算如下:n、K均为自然数; 对于v(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-超声波电机驱动控制电路。
具体实施方式
下面结合附图和具体实施例对本发明做进一步解释。
本发明超声波电机控制系统,如图1所示,包括基座12和设于基座12上的超声波电机4,所述超声波电机4一侧输出轴3与光电编码器1相连接,另一侧输出轴6与飞轮惯性负载7相连接,所述飞轮惯性负载7的输出轴8经弹性联轴器9与力矩传感器10相连接,所述光电编码器1的信号输出端、所述力矩传感器10的信号输出端分别接至控制系统。所述控制系统包括一速度死区补偿控制器。
上述超声波电机4、光电编码器1、力矩传感器10分别经超声波电机固定支架5、光电编码器固定支架2、力矩传感器固定支架11固定于所述基座12上。
如图2所示,上述控制系统包括超声波电机驱动控制电路29,所述超声波电机驱动控制电路29包括控制芯片电路13和驱动芯片电路14,所述光电编码器1的信号输出端与所述控制芯片电路13的相应输入端相连接,所述控制芯片电路13的输出端与所述驱动芯片电路14的相应输入端相连接,以驱动所述驱动芯片电路14,所述驱动芯片电路14的驱动频率调节信号输出端和驱动半桥电路调节信号输出端分别与所述超声波电机4的相应输入端相连接。所述驱动芯片电路14产生驱动频率调节信号和驱动半桥电路调节信号,对超声波电机输出A、B两相PWM的频率、相位及通断进行控制。通过开通及关断PWM波的输出来控制超声波电机的启动和停止运行;通过调节输出的PWM波的频率及两相的相位差来调节电机的最佳运行状态。
本发明还提出一种基于上述死区补偿的超声波电机伺服控制装置的方法,由基于死区补偿的超声波电机伺服控制系统和电机来估测未知的死区特性动态函数。如上所述,在本实施例中,所述控制系统的硬件电路包括超声波电机驱动控制电路,所述超声波电机驱动控制电路包括控制芯片电路和驱动芯片电路,所述基于死区补偿的超声波电机伺服控制器设于所述控制芯片电路中。
本发明的控制方法的整个控制器的系统建立在死区补偿的基础上,在补偿器的设计上也以观测误差最小为其调整函数,从而能获得更好的控制效能。
超声波电机驱动系统的动态方程可以写为:
其中Ap=-B/J,BP=J/Kt>0,CP=-1/J;B为阻尼系数,J为转动惯量,Kt为电流因子,Tf(v)为摩擦阻力力矩,TL为负载力矩,U(t)是电机的输出力矩,θr(t)为通过光电编码器测量得到的位置信号。
由于电机的速度在控制是存在死区,使其输入输出关系为非线性,为了消除电机速度死区造成的影响,我们使用速度死区补偿控制。
假设速度死区是对称,不对称的死区可以由此类比得到。死区的数学模型为
其中v(t)为输入信号,Ω[v](t)为系统的输出信号,gi为每个死区算子Jdi[v](t)的权重系数。
死区算子为
以上的死区算子为对称型算子,每个死区范围为[-di,di]。gi、di为系统待辨识的初始参数。初始参数由系统先由给定输入控制信号得到的输出计算得到初步结果,再经过辨识修正参数,辨识公式为
其中Ω(v,g)为死区的数学模型计算得到结果,Y(v,g)为实际测量结果。
死区逆算子为
其中对于v(t)≥0情况,计算如下:
n为自然数;
对于v(t)<0情况,计算如下:
系统中输入信号先经过死区逆算子得到结果,然后输入死区进行控制,这样可以在一定程度上消除死区对伺服系统带来的影响。我们使用速度死区补偿控制使得系统输入信号与输出速度的特性接近线性关系。
以上是本发明的较佳实施例,凡依本发明技术方案所作的改变,所产生的功能作用未超出本发明技术方案的范围时,均属于本发明的保护范围。
Claims (3)
1.一种超声波电机伺服控制系统速度死区补偿控制方法,其特征在于:控制系统中输入信号先经过死区逆算子得到结果,然后输入死区进行控制;具体包括以下步骤:
步骤S1:超声波电机驱动系统的动态方程描述为:
其中Ap=-B/J,BP=J/Kt,CP=-1/J;B为阻尼系数,J为转动惯量,J>0,Kt为电流因子,Kt>0,Tf(v)为摩擦阻力力矩,TL为负载力矩,U(t)是电机的输出力矩,θr(t)为通过光电编码器测量得到的位置信号;
步骤S2:假设速度死区是对称,不对称的死区由此类比得到,死区的数学模型为:其中v(t)为输入信号,Ω[v](t)为系统的输出信号,gi为每个死区算子Jdi[v](t)的权重系数;
死区算子为:
以上的死区算子为对称型算子,每个死区范围为[-di,di],gi、di为系统待辨识的初始参数,初始参数由系统先由给定输入控制信号得到的输出计算得到初步结果,再经过辨识修正参数:其中Ω(v,g)为死区的数学模型计算得到结果,Y(v,g)为实际测量结果,
死区逆算子为:其中对于v(t)≥0情况,计算如下:n为自然数;对于v(t)<0情况,计算如下:
2.根据权利要求1所述的超声波电机伺服控制系统速度死区补偿控制方法,其特征在于:提供一控制装置,所述控制装置包括控制系统、基座及设置于所述基座上的超声波电机,所述超声波电机一侧输出轴与光电编码器相连接,另一侧输出轴与飞轮惯性负载相连接,所述飞轮惯性负载的输出轴经一联轴器与力矩传感器相连接,所述光电编码器的信号输出端、力矩传感器的信号输出端分别接至控制系统;所述控制系统包括一速度死区补偿控制器。
3.根据权利要求2所述的超声波电机伺服控制系统速度死区补偿控制方法,其特征在于:所述控制系统包括超声波电机驱动控制电路;所述超声波电机驱动控制电路包括控制芯片电路和驱动芯片电路;所述光电编码器的信号输出端与所述控制芯片电路的相应输入端相连接;所述控制芯片电路的输出端与所述驱动芯片电路的相应输入端相连接,以驱动所述驱动芯片电路,所述驱动芯片电路的驱动频率调节信号输出端和驱动半桥电路调节信号输出端分别与所述超声波电机的相应输入端相连接;所述速度死区补偿控制器设于所述控制芯片电路中。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610889669.XA CN106341065B (zh) | 2016-10-12 | 2016-10-12 | 超声波电机伺服控制系统速度死区补偿控制装置及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610889669.XA CN106341065B (zh) | 2016-10-12 | 2016-10-12 | 超声波电机伺服控制系统速度死区补偿控制装置及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106341065A CN106341065A (zh) | 2017-01-18 |
CN106341065B true CN106341065B (zh) | 2018-09-18 |
Family
ID=57838840
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610889669.XA Expired - Fee Related CN106341065B (zh) | 2016-10-12 | 2016-10-12 | 超声波电机伺服控制系统速度死区补偿控制装置及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106341065B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110501976A (zh) * | 2019-07-29 | 2019-11-26 | 北京精密机电控制设备研究所 | 一种用于机器人高性能伺服控制驱动的方法 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107154749B (zh) * | 2017-06-29 | 2019-05-03 | 闽江学院 | 基于功能函数输出反馈反步控制的压电电机死区控制方法 |
CN113839583B (zh) * | 2021-08-31 | 2022-06-17 | 哈尔滨工业大学 | 一种超声型压电推杆电机及其死区补偿方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103197562B (zh) * | 2013-04-11 | 2015-04-22 | 浙江工业大学 | 转台伺服系统神经网络控制方法 |
CN103513181B (zh) * | 2013-07-10 | 2016-03-02 | 闽江学院 | 超声波电机瞬态特性测试装置及其控制系统 |
US9956874B2 (en) * | 2014-03-03 | 2018-05-01 | Deere & Company | Traction control method and apparatus for a work vehicle with independent drives |
CN105093927B (zh) * | 2015-07-28 | 2017-07-25 | 中国科学院长春光学精密机械与物理研究所 | 电动舵机死区换向替代补偿方法 |
-
2016
- 2016-10-12 CN CN201610889669.XA patent/CN106341065B/zh not_active Expired - Fee Related
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110501976A (zh) * | 2019-07-29 | 2019-11-26 | 北京精密机电控制设备研究所 | 一种用于机器人高性能伺服控制驱动的方法 |
CN110501976B (zh) * | 2019-07-29 | 2020-12-18 | 北京精密机电控制设备研究所 | 一种用于机器人高性能伺服控制驱动的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106341065A (zh) | 2017-01-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109143868B (zh) | 一种针对电子节气门系统的非线性抗干扰控制方法及装置 | |
CN106341065B (zh) | 超声波电机伺服控制系统速度死区补偿控制装置及方法 | |
CN106208807B (zh) | 基于观测器的超声波电机伺服控制系统滞回补偿控制方法 | |
CN107992110B (zh) | 一种基于谐波减速器的磁悬浮控制力矩陀螺框架角速率伺服系统 | |
JP5816826B2 (ja) | モータ駆動装置 | |
CN106406093B (zh) | 超声波电机伺服控制系统不对称滞回补偿控制装置 | |
CN106505909B (zh) | 一种超声波电机非线性死区补偿控制系统及方法 | |
US9876448B2 (en) | Position control apparatus | |
CN102820844A (zh) | 一种柔性臂振动抑制方法 | |
JP6481792B2 (ja) | 動力系の試験装置 | |
CN102195545B (zh) | 电动机的控制装置 | |
CN103256188A (zh) | 一种风力发电机组传动链的扭转振动控制方法及装置 | |
CN103532442A (zh) | 无轴承永磁电机悬浮系统优化自抗扰控制器的构造方法 | |
CN107026585B (zh) | 一种超声波电机伺服控制系统摩擦力滞回控制方法 | |
CN103336523B (zh) | 超声波电机伺服控制系统的控制策略 | |
CN106787940B (zh) | 一种改进的超声波电机反步自适应伺服控制方法 | |
CN1773837A (zh) | 直流电机位置控制方法 | |
CN106253744B (zh) | 超声波电机力矩滞回控制方法 | |
CN106842957A (zh) | 一种基于输出反馈控制器的超声波电机伺服控制方法 | |
CN112304336B (zh) | 一种高频角振动转台控制方法 | |
CN109120181A (zh) | 一种基于增益限制补偿器的超声波电机伺服控制系统极限环抑制设计方法 | |
CN106655882A (zh) | 一种摩擦力参数不确定条件下超声波电机伺服控制系统滞回控制方法 | |
CN109217716B (zh) | 基于预滑动摩擦力模型的超声波电机轮廓控制器 | |
CN108832836B (zh) | 一种超声波电机伺服控制系统滑模控制方法 | |
JPWO2013164930A1 (ja) | 電子制御式バルブの制御装置および制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into 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: 20180918 |
|
CF01 | Termination of patent right due to non-payment of annual fee |