CN106208807B - 基于观测器的超声波电机伺服控制系统滞回补偿控制方法 - Google Patents

基于观测器的超声波电机伺服控制系统滞回补偿控制方法 Download PDF

Info

Publication number
CN106208807B
CN106208807B CN201610829585.7A CN201610829585A CN106208807B CN 106208807 B CN106208807 B CN 106208807B CN 201610829585 A CN201610829585 A CN 201610829585A CN 106208807 B CN106208807 B CN 106208807B
Authority
CN
China
Prior art keywords
msub
mrow
mover
centerdot
tau
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
Application number
CN201610829585.7A
Other languages
English (en)
Other versions
CN106208807A (zh
Inventor
傅平
程敏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Minjiang University
Original Assignee
Minjiang University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Minjiang University filed Critical Minjiang University
Priority to CN201610829585.7A priority Critical patent/CN106208807B/zh
Publication of CN106208807A publication Critical patent/CN106208807A/zh
Application granted granted Critical
Publication of CN106208807B publication Critical patent/CN106208807B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/142—Small signal circuits; Means for controlling position or derived quantities, e.g. speed, torque, starting, stopping, reversing

Landscapes

  • Control Of Electric Motors In General (AREA)
  • Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)

Abstract

本发明涉及一种基于观测器的超声波电机伺服控制系统滞回补偿控制方法。提供一超声波电机伺服控制系统，包括基座和设于基座上的超声波电机，所述超声波电机一侧输出轴与光电编码器相连接，超声波电机另一侧输出轴与飞轮惯性负载相连接，所述飞轮惯性负载的输出轴经联轴器与力矩传感器相连接，所述光电编码器的信号输出端、力矩传感器的信号输出端分别接至控制系统；该方法基于观测器基础，采用滞回补偿控制对系统进行控制，在消除观测器的动态误差同时也使得系统滞回最小，从而能获得更好的控制效能。本发明方法中整个控制器的系统建立在观测器的基础上，在观测器的设计上也以误差最小为其调整函数，从而能获得更好的控制效能。

Description

基于观测器的超声波电机伺服控制系统滞回补偿控制方法
技术领域
本发明涉及电机控制器领域，特别是一种基于观测器的超声波电机伺服控制系统滞回补偿控制方法。
背景技术
现有的超声波电机伺服控制系统的设计中由于力矩-速度滞回的存在，使得系统的性能受到影响，对周期重复信号控制时有一定的误差。为了改善跟随的控制效果，我们设计了基于观测器的超声波电机伺服控制系统滞回补偿控制。从轨迹跟随的实作结果中，我们发现系统在运动滞回减少效果上有着显著的改善，且参数的变动、噪声、交叉耦合的干扰和摩擦力等因素几乎无法对于运动系统效果造成影响，故基于观测器的超声波电机伺服控制系统滞回补偿控制能有效的增进系统的控制效能，并进一步减少系统对于不确定性的影响程度，因此电机的位置与速度控制可以获得较好的动态特性。
发明内容
本发明的目的在于提供一种基于观测器的超声波电机伺服控制系统滞回补偿控制方法，该方法建立在观测器的基础上，在观测器的设计上也以误差最小为其调整函数，从而能获得更好的控制效能。
为实现上述目的，本发明的技术方案是：一种基于观测器的超声波电机伺服控制系统滞回补偿控制方法，提供一超声波电机伺服控制系统，包括基座和设于基座上的超声波电机，所述超声波电机一侧输出轴与光电编码器相连接，超声波电机另一侧输出轴与飞轮惯性负载相连接，所述飞轮惯性负载的输出轴经联轴器与力矩传感器相连接，所述光电编码器的信号输出端、力矩传感器的信号输出端分别接至控制系统；该方法基于观测器基础，采用滞回补偿控制对系统进行控制，在消除观测器的动态误差同时也使得系统滞回最小，从而能获得更好的控制效能。
在本发明一实施例中，所述控制系统包括超声波电机驱动控制电路，所述超声波电机驱动控制电路包括控制芯片电路和驱动芯片电路，所述光电编码器的信号输出端与所述控制芯片电路的相应输入端相连接，所述控制芯片电路的输出端与所述驱动芯片电路的相应输入端相连接，以驱动所述驱动芯片电路，所述驱动芯片电路的驱动频率调节信号输出端和驱动半桥电路调节信号输出端分别与所述超声波电机的相应输入端相连接。
在本发明一实施例中，该方法具体实现如下，
超声波电机驱动系统的动态方程可以写为：
其中，Ap＝-B/J,BP＝J/Kt＞0,CP＝-1/J；B为阻尼系数，J为转动惯量，Kt为电流因子，Tf(v)为摩擦阻力力矩，TL为负载力矩，U(t)是电机的输出力矩，θr(t)为通过光电编码器测量得到的位置信号；
先假设系统的参数都是已知的，外力干扰、交叉耦合干扰和摩擦力都是不存在的，则电机的标准模型为下式所示：
其中，An为Ap之标准值，Bn为BP之标准值；
假如产生不确定项，此时控制系统的动态方程修改成：
其中，Cn为CP之标准值，ΔA，ΔB、ΔC代表微小变化量，D(t)为总集不确定项，定义为：
此处将总集不确定项的边界假设为已知，如|D(t)|≤ρ，ρ为一个给定的正常数项；为了消除电机力矩-速度特性的滞回现象造成的影响，使用基于观测器的超声波电机伺服控制系统滞回补偿控制对其进行控制；
对滞回系统中的观测器输出记为并定义实际执行机构的输出y，电机的估计输出为它们的误差为e1
滞回系统的输出为τpr，滞回观测器输出为定义
观测器设计为：
式(8)的定义为：
其中，是可测量的电机速度；L1是与误差的修正系数，L2是e1的修正系数，Ka是的修正系数，为Ka的观测值，为Ka的观测值误差；Kpr是的修正系数；为控制器实际输出；
观测器的误差动态是基于以下模型：
其中，是控制器输出的估计误差；
通过滞回观测器的输出可知控制信号τpd和的误差为
信号的微分为
滞回补偿器设计为：
由控制器输出和补偿器输出误差的导数得到：
此外,补偿器的更新规则μ和参数被设计成按照相同的投影算符进行运算：
投影算符proj的定义为：
式中,Yd为给定的跟踪信号，rp为给定的跟踪信号与输出信号之间误差的一阶滤波值，β为滤波系数；
更新参数的规则如下
γ为系统定义的参数；
因此，自适应控制器和控制参数的更新规则为：
通过上述过程，即可获得基于观测器的超声波电机伺服控制器来控制电机转子的旋转角度。
在本发明一实施例中，所述基于观测器的超声波电机伺服控制器设于所述控制芯片电路中。
相较于现有技术，本发明具有以下有益效果：本发明方法使得系统在运动跟踪效果上有着显著的改善且参数的变动、噪声、交叉耦合的干扰和摩擦力等因素几乎无法对于运动系统效果造成影响，本发明方法通过将整个控制器的系统建立在观测器的基础上，在观测器的设计上也以误差最小为其调整函数，从而能获得更好的控制效能。
附图说明
图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)为通过光电编码器测量得到的位置信号；
先假设系统的参数都是已知的，外力干扰、交叉耦合干扰和摩擦力都是不存在的，则电机的标准模型为下式所示：
其中，An为Ap之标准值，Bn为BP之标准值；
假如产生不确定项，此时控制系统的动态方程修改成：
其中，Cn为CP之标准值，ΔA，ΔB、ΔC代表微小变化量，D(t)为总集不确定项，定义为：
此处将总集不确定项的边界假设为已知，如|D(t)|≤ρ，ρ为一个给定的正常数项；为了消除电机力矩-速度特性的滞回现象造成的影响，使用基于观测器的超声波电机伺服控制系统滞回补偿控制对其进行控制；
对滞回系统中的观测器输出记为并定义实际执行机构的输出y，电机的估计输出为它们的误差为e1
滞回系统的输出为τpr，滞回观测器输出为定义
观测器设计为：
式(8)的定义为：
其中，是可测量的电机速度；L1是与误差的修正系数，L2是e1的修正系数，Ka是的修正系数，为Ka的观测值，为Ka的观测值误差；Kpr是的修正系数；为控制器实际输出；
观测器的误差动态是基于以下模型：
其中，是控制器输出的估计误差；
通过滞回观测器的输出可知控制信号τpd和的误差为
信号的微分为
滞回补偿器设计为：
由控制器输出和补偿器输出误差的导数得到：
此外,补偿器的更新规则μ和参数被设计成按照相同的投影算符进行运算：
投影算符proj的定义为：
式中,Yd为给定的跟踪信号，rp为给定的跟踪信号与输出信号之间误差的一阶滤波值，β为滤波系数；
更新参数的规则如下
γ为系统定义的参数；
因此，自适应控制器和控制参数的更新规则为：
通过上述过程，即可获得基于观测器的超声波电机伺服控制器来控制电机转子的旋转角度；所述基于观测器的超声波电机伺服控制器设于所述控制芯片电路中。
以上是本发明的较佳实施例，凡依本发明技术方案所作的改变，所产生的功能作用未超出本发明技术方案的范围时，均属于本发明的保护范围。

Claims (2)

1.一种基于观测器的超声波电机伺服控制系统滞回补偿控制方法，其特征在于：提供一超声波电机伺服控制系统，包括基座和设于基座上的超声波电机，所述超声波电机一侧输出轴与光电编码器相连接，超声波电机另一侧输出轴与飞轮惯性负载相连接，所述飞轮惯性负载的输出轴经联轴器与力矩传感器相连接，所述光电编码器的信号输出端、力矩传感器的信号输出端分别接至控制系统；该方法基于观测器基础，采用滞回补偿控制对系统进行控制，在消除观测器的动态误差同时也使得系统滞回最小，从而能获得更好的控制效能；所述控制系统包括超声波电机驱动控制电路，所述超声波电机驱动控制电路包括控制芯片电路和驱动芯片电路，所述光电编码器的信号输出端与所述控制芯片电路的相应输入端相连接，所述控制芯片电路的输出端与所述驱动芯片电路的相应输入端相连接，以驱动所述驱动芯片电路，所述驱动芯片电路的驱动频率调节信号输出端和驱动半桥电路调节信号输出端分别与所述超声波电机的相应输入端相连接；该方法具体实现如下，
超声波电机驱动系统的动态方程可以写为：
<mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>A</mi> <mi>p</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mn>1</mn> <msub> <mi>B</mi> <mi>P</mi> </msub> </mfrac> <mi>U</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>C</mi> <mi>P</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>T</mi> <mi>L</mi> </msub> <mo>+</mo> <msub> <mi>T</mi> <mi>f</mi> </msub> <mo>(</mo> <mi>v</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
其中，Ap＝-B/J,BP＝J/Kt＞0,CP＝-1/J；B为阻尼系数，J为转动惯量，Kt为电流因子，Tf(v)为摩擦阻力力矩，TL为负载力矩，U(t)是电机的输出力矩，θr(t)为通过光电编码器测量得到的位置信号；
先假设系统的参数都是已知的，外力干扰、交叉耦合干扰和摩擦力都是不存在的，则电机的标准模型为下式所示：
<mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>A</mi> <mi>n</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>B</mi> <mi>n</mi> </msub> <mi>U</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>
其中，An为Ap之标准值，Bn为BP之标准值；
假如产生不确定项，此时控制系统的动态方程修改成：
<mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>A</mi> <mi>n</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>B</mi> <mi>n</mi> </msub> <mi>U</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>D</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
其中，Cn为CP之标准值，ΔA，ΔB、ΔC代表微小变化量，D(t)为总集不确定项，定义为：
<mrow> <mi>D</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>&amp;Delta;</mi> <mi>A</mi> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>&amp;Delta;</mi> <mi>B</mi> <mi>U</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mi>n</mi> </msub> <mo>+</mo> <mi>&amp;Delta;</mi> <mi>C</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msub> <mi>T</mi> <mi>L</mi> </msub> <mo>+</mo> <msub> <mi>T</mi> <mi>f</mi> </msub> <mo>(</mo> <mi>v</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>
此处将总集不确定项的边界假设为已知，如|D(t)|≤ρ，ρ为一个给定的正常数项；为了消除电机力矩-速度特性的滞回现象造成的影响，使用基于观测器的超声波电机伺服控制系统滞回补偿控制对其进行控制；
对滞回观测器输出记为并定义实际执行机构的输出y，电机的估计输出为它们的误差为e1
<mrow> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>=</mo> <mi>y</mi> <mo>-</mo> <mover> <mi>y</mi> <mo>^</mo> </mover> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
滞回系统的输出为τpr，滞回观测器输出为定义
<mrow> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>=</mo> <msub> <mi>&amp;tau;</mi> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>^</mo> </mover> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
滞回观测器设计为：
<mrow> <mover> <mover> <mi>y</mi> <mo>^</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mover> <mi>y</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <msub> <mi>L</mi> <mn>1</mn> </msub> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mover> <mover> <mi>&amp;tau;</mi> <mo>^</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <mo>=</mo> <msub> <mover> <mi>K</mi> <mo>~</mo> </mover> <mi>a</mi> </msub> <mover> <mi>v</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <msub> <mover> <mi>F</mi> <mo>^</mo> </mover> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>L</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>K</mi> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <msub> <mover> <mi>&amp;tau;</mi> <mo>^</mo> </mover> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>
式(8)的定义为：
<mrow> <msub> <mover> <mi>K</mi> <mo>~</mo> </mover> <mi>a</mi> </msub> <mo>=</mo> <msub> <mi>K</mi> <mi>a</mi> </msub> <mo>-</mo> <msub> <mover> <mi>K</mi> <mo>^</mo> </mover> <mi>a</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>
其中，是可测量的电机速度；L1是与误差的修正系数，L2是e1的修正系数，Ka是的修正系数，为Ka的观测值，为Ka的观测值误差；Kpr是的修正系数；为控制器实际输出；
滞回观测器的误差动态是基于以下模型：
<mrow> <msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>L</mi> <mn>1</mn> </msub> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <msub> <mover> <mi>K</mi> <mo>~</mo> </mover> <mi>a</mi> </msub> <mover> <mi>v</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>-</mo> <msub> <mover> <mi>F</mi> <mo>~</mo> </mover> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>L</mi> <mn>1</mn> </msub> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <msub> <mover> <mi>&amp;tau;</mi> <mo>^</mo> </mover> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>
其中，是控制器输出的估计误差；
通过滞回观测器的输出可知控制信号τpd和的误差为
<mrow> <msub> <mover> <mi>&amp;tau;</mi> <mo>~</mo> </mover> <mrow> <mi>p</mi> <mi>e</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>&amp;tau;</mi> <mrow> <mi>p</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>^</mo> </mover> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>12</mn> <mo>)</mo> </mrow> </mrow>
信号的微分为
<mrow> <msub> <mover> <mover> <mi>&amp;tau;</mi> <mo>~</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>p</mi> <mi>e</mi> </mrow> </msub> <mo>=</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>p</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mover> <mi>K</mi> <mo>^</mo> </mover> <mi>a</mi> </msub> <mover> <mi>v</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <msub> <mover> <mi>F</mi> <mo>^</mo> </mover> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>L</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <msub> <mover> <mi>&amp;tau;</mi> <mo>^</mo> </mover> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>13</mn> <mo>)</mo> </mrow> </mrow>
滞回补偿器设计为：
<mrow> <mover> <mi>v</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mover> <mi>&amp;mu;</mi> <mo>^</mo> </mover> <mo>&amp;lsqb;</mo> <msub> <mi>k</mi> <mi>b</mi> </msub> <msub> <mover> <mi>&amp;tau;</mi> <mo>~</mo> </mover> <mi>e</mi> </msub> <mo>+</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>p</mi> <mi>d</mi> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>F</mi> <mo>^</mo> </mover> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>r</mi> <mi>p</mi> </msub> <mo>&amp;rsqb;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>14</mn> <mo>)</mo> </mrow> </mrow>
由控制器输出和补偿器输出误差的导数得到：
<mrow> <msub> <mover> <mover> <mi>&amp;tau;</mi> <mo>~</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>p</mi> <mi>e</mi> </mrow> </msub> <mo>=</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <msub> <mover> <mi>K</mi> <mo>^</mo> </mover> <mi>a</mi> </msub> <mover> <mi>&amp;mu;</mi> <mo>^</mo> </mover> <mo>)</mo> </mrow> <msub> <mi>&amp;tau;</mi> <mrow> <mi>p</mi> <mi>d</mi> </mrow> </msub> <mo>-</mo> <msub> <mover> <mi>K</mi> <mo>^</mo> </mover> <mi>a</mi> </msub> <mover> <mi>&amp;mu;</mi> <mo>^</mo> </mover> <msub> <mi>k</mi> <mi>b</mi> </msub> <msub> <mover> <mi>&amp;tau;</mi> <mo>~</mo> </mover> <mrow> <mi>p</mi> <mi>e</mi> </mrow> </msub> <mo>+</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <msub> <mover> <mi>K</mi> <mo>^</mo> </mover> <mi>a</mi> </msub> <mover> <mi>&amp;mu;</mi> <mo>^</mo> </mover> <mo>)</mo> </mrow> <msub> <mover> <mi>F</mi> <mo>^</mo> </mover> <mn>2</mn> </msub> <mo>-</mo> <msub> <mover> <mi>K</mi> <mo>^</mo> </mover> <mi>a</mi> </msub> <mover> <mi>&amp;mu;</mi> <mo>^</mo> </mover> <msub> <mi>r</mi> <mi>p</mi> </msub> <mo>-</mo> <msub> <mi>L</mi> <mn>2</mn> </msub> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <msub> <mover> <mi>&amp;tau;</mi> <mo>^</mo> </mover> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> </mrow> </mrow>
此外,补偿器的更新规则μ和参数被设计成按照相同的投影算符进行运算：
<mrow> <mover> <mover> <mi>&amp;mu;</mi> <mo>^</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mi>p</mi> <mi>r</mi> <mi>o</mi> <mi>j</mi> <mrow> <mo>(</mo> <mover> <mi>&amp;mu;</mi> <mo>^</mo> </mover> <mo>,</mo> <mi>&amp;eta;</mi> <mo>&amp;CenterDot;</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>~</mo> </mover> <mrow> <mi>p</mi> <mi>e</mi> </mrow> </msub> <mo>&amp;lsqb;</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>p</mi> <mi>d</mi> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>F</mi> <mo>^</mo> </mover> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>r</mi> <mi>p</mi> </msub> <mo>&amp;rsqb;</mo> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>16</mn> <mo>)</mo> </mrow> </mrow>
投影算符proj的定义为：
式中,Yd为给定的跟踪信号，rp为给定的跟踪信号与输出信号之间误差的一阶滤波值，β为滤波系数；
更新参数的规则如下
<mrow> <msub> <mover> <mover> <mi>K</mi> <mo>^</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mi>a</mi> </msub> <mo>=</mo> <mi>p</mi> <mi>r</mi> <mi>o</mi> <mi>j</mi> <mrow> <mo>(</mo> <msub> <mover> <mi>K</mi> <mo>^</mo> </mover> <mi>a</mi> </msub> <mo>,</mo> <mi>&amp;gamma;</mi> <mover> <mi>&amp;mu;</mi> <mo>^</mo> </mover> <mo>&amp;CenterDot;</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>~</mo> </mover> <mrow> <mi>p</mi> <mi>e</mi> </mrow> </msub> <mo>&amp;lsqb;</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>p</mi> <mi>d</mi> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>F</mi> <mo>^</mo> </mover> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>r</mi> <mi>p</mi> </msub> <mo>&amp;rsqb;</mo> <mo>+</mo> <mover> <mi>v</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>&amp;CenterDot;</mo> <msub> <mover> <mi>&amp;tau;</mi> <mo>~</mo> </mover> <mrow> <mi>p</mi> <mi>e</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>18</mn> <mo>)</mo> </mrow> </mrow>
γ为系统定义的参数；
因此，自适应控制器和控制参数的更新规则为：
<mrow> <msub> <mi>&amp;tau;</mi> <mrow> <mi>p</mi> <mi>d</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>k</mi> <mrow> <mi>p</mi> <mi>d</mi> </mrow> </msub> <msub> <mi>r</mi> <mi>p</mi> </msub> <mo>+</mo> <msubsup> <mi>Y</mi> <mi>d</mi> <mi>T</mi> </msubsup> <msub> <mover> <mi>&amp;theta;</mi> <mo>^</mo> </mover> <mi>p</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>19</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mover> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>^</mo> </mover> <mi>p</mi> </msub> <mo>=</mo> <msub> <mi>proj</mi> <msub> <mover> <mi>&amp;theta;</mi> <mo>^</mo> </mover> <mi>p</mi> </msub> </msub> <mrow> <mo>(</mo> <msub> <mover> <mi>&amp;theta;</mi> <mo>^</mo> </mover> <mi>p</mi> </msub> <mo>,</mo> <msub> <mi>&amp;beta;Y</mi> <mi>d</mi> </msub> <msub> <mi>r</mi> <mi>p</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>20</mn> <mo>)</mo> </mrow> </mrow>
通过上述过程，即可获得基于观测器的超声波电机伺服控制器来控制电机转子的旋转角度。
2.根据权利要求1所述的基于观测器的超声波电机伺服控制系统滞回补偿控制方法，其特征在于：所述基于观测器的超声波电机伺服控制器设于所述控制芯片电路中。
CN201610829585.7A 2016-09-19 2016-09-19 基于观测器的超声波电机伺服控制系统滞回补偿控制方法 Expired - Fee Related CN106208807B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610829585.7A CN106208807B (zh) 2016-09-19 2016-09-19 基于观测器的超声波电机伺服控制系统滞回补偿控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610829585.7A CN106208807B (zh) 2016-09-19 2016-09-19 基于观测器的超声波电机伺服控制系统滞回补偿控制方法

Publications (2)

Publication Number Publication Date
CN106208807A CN106208807A (zh) 2016-12-07
CN106208807B true CN106208807B (zh) 2018-01-05

Family

ID=58067680

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610829585.7A Expired - Fee Related CN106208807B (zh) 2016-09-19 2016-09-19 基于观测器的超声波电机伺服控制系统滞回补偿控制方法

Country Status (1)

Country Link
CN (1) CN106208807B (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106877774B (zh) * 2017-04-21 2019-06-07 闽江学院 输入饱和条件下超声波电机伺服自适应控制系统及方法
CN110299868B (zh) * 2018-03-23 2021-07-23 河南科技大学 一种超声波电机转速的控制方法及装置
CN109120181B (zh) * 2018-09-11 2020-04-10 闽江学院 一种基于增益限制补偿器的超声波电机伺服控制系统极限环抑制设计方法
CN109150004B (zh) * 2018-09-13 2019-10-11 闽江学院 一种超声波电机伺服控制系统神经网络控制方法
CN108832836B (zh) * 2018-09-13 2019-06-04 闽江学院 一种超声波电机伺服控制系统滑模控制方法
CN109217716B (zh) * 2018-09-14 2019-12-10 闽江学院 基于预滑动摩擦力模型的超声波电机轮廓控制器
CN109039152B (zh) * 2018-09-15 2019-08-06 闽江学院 一种超声波电机伺服控制系统轮廓控制方法
CN108988682B (zh) * 2018-09-15 2019-08-06 闽江学院 基于状态观测器的超声波电机伺服控制系统轮廓控制方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101383566A (zh) * 2008-06-30 2009-03-11 扬州大学 一种基于arm的超声波电机嵌入式驱动控制器
CN103124149A (zh) * 2013-01-30 2013-05-29 东南大学 空间调相环形行波超声波电机结构误差补偿控制方法
CN103513181A (zh) * 2013-07-10 2014-01-15 闽江学院 超声波电机瞬态特性测试装置及其控制系统

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9344012B2 (en) * 2012-02-09 2016-05-17 Vital Biomedical Technologies Inc. Control system for ultrasonic motors

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101383566A (zh) * 2008-06-30 2009-03-11 扬州大学 一种基于arm的超声波电机嵌入式驱动控制器
CN103124149A (zh) * 2013-01-30 2013-05-29 东南大学 空间调相环形行波超声波电机结构误差补偿控制方法
CN103513181A (zh) * 2013-07-10 2014-01-15 闽江学院 超声波电机瞬态特性测试装置及其控制系统

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
考虑滞回非线性的飞行姿态backstepping;李飞等;《系统工程与电子技术》;20150930;第37卷(第9期);第2115-2122页 *

Also Published As

Publication number Publication date
CN106208807A (zh) 2016-12-07

Similar Documents

Publication Publication Date Title
CN106208807B (zh) 基于观测器的超声波电机伺服控制系统滞回补偿控制方法
CN108818541B (zh) 一种柔性关节机器人的自适应神经网络跟踪控制方法
CN107612445B (zh) 具有负载加速度反馈的随动调速系统控制方法
CN104242769A (zh) 基于连续终端滑模技术的永磁同步电机速度复合控制方法
CN107992110A (zh) 一种基于谐波减速器的磁悬浮控制力矩陀螺框架角速率伺服系统
WO2007096993A1 (ja) モータ制御装置
CN106877774B (zh) 输入饱和条件下超声波电机伺服自适应控制系统及方法
Sun et al. A novel cascade control principle for feed drives of machine tools
CN110649845A (zh) 基于鲁棒广义预测控制的光电转台位置跟踪控制方法
CN106406093B (zh) 超声波电机伺服控制系统不对称滞回补偿控制装置
CN106341065B (zh) 超声波电机伺服控制系统速度死区补偿控制装置及方法
CN105048922B (zh) 一种永磁同步直线电机稳定自适应鲁棒位置控制方法
CN109120181B (zh) 一种基于增益限制补偿器的超声波电机伺服控制系统极限环抑制设计方法
CN106842957B (zh) 一种基于输出反馈控制器的超声波电机伺服控制方法
CN105137763B (zh) 超声波电机鲁棒性递归式神经网络滑动模态控制系统及方法
CN107026585B (zh) 一种超声波电机伺服控制系统摩擦力滞回控制方法
CN106655882B (zh) 一种超声波电机伺服控制系统滞回控制方法
CN109067271B (zh) 一种基于鲁棒扰动补偿方案的直流电机伺服控制方法
CN103336523B (zh) 超声波电机伺服控制系统的控制策略
CN106787940A (zh) 一种改进的超声波电机反步自适应伺服控制方法
CN109217716B (zh) 基于预滑动摩擦力模型的超声波电机轮廓控制器
CN109150004B (zh) 一种超声波电机伺服控制系统神经网络控制方法
CN108832836B (zh) 一种超声波电机伺服控制系统滑模控制方法
Sun Adaptive robust motion control of an ironless permanent magnet linear synchronous motor with dead-zone compensation
CN107276455B (zh) 基于输出反馈反步控制的压电电机死区控制系统及方法

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
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20180105