CN103336523A - 超声波电机伺服控制***控制特性测试装置及其控制策略 - Google Patents
超声波电机伺服控制***控制特性测试装置及其控制策略 Download PDFInfo
- Publication number
- CN103336523A CN103336523A CN2013102444290A CN201310244429A CN103336523A CN 103336523 A CN103336523 A CN 103336523A CN 2013102444290 A CN2013102444290 A CN 2013102444290A CN 201310244429 A CN201310244429 A CN 201310244429A CN 103336523 A CN103336523 A CN 103336523A
- Authority
- CN
- China
- Prior art keywords
- control
- omega
- partiald
- motor
- neuron
- 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.)
- Granted
Links
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明涉及一种行波型超声波电机伺服控制***的控制策略及控制特性测试装置,该测试装置包括电机驱动控制器以及设置在各自支架上的超声波电机、直流永磁无刷电机和光电编码器;所述的超声波电机输出轴和永磁电机的前端输出轴经第一弹性联轴器连接;所述第一弹性联轴器上设置有一力矩传感器;所述的直流永磁无刷电机的后端输出轴和光电编码器经第二弹性联轴器连接;所述的第二弹性联轴器上设置有磁粉制动器;所述的电机驱动控制器与所述的超声波电机控制端、光电编码器的输出端以及力矩传感器的输出端连接。本发明结构较简单,可根据测试需求进行电机负载力矩调整以及速度/力矩同步测量。
Description
技术领域
本发明涉及一种行波型超声波电机伺服控制***控制特性测试装置,确切地说,它是一种无铁心电机的伺服控制***控制特性测试装置。
背景技术
现有行波型超声波电机伺服控制***控制特性测试,主要是针对位置和速度的控制特性测试,对力矩的控制特性测试较少涉及。由于超声波电机的输出力矩非线性,使得力矩控制变得较为困难,因此电机在力矩伺服控制上也就难以获得较好的控制特性。
使用此超声波电机伺服控制***控制特性测试装置,用直流永磁电机模拟固定和可变负载,这样可以根据测试需要改变直流永磁无刷电机输出力矩的大小,从而使超声波电机的负载力矩可以预先进行计算,这样使得力矩调整的灵活性增加,并辅以力矩传感器,提高了伺服控制***测试结果的准确性,因此超声波电机可以获得较好的伺服控制***控制特性测试性能。
发明内容
本发明的目的是提供一种行波型超声波电机伺服控制***控制特性测试装置,能够实现超声波电机伺服***的控制特性测试。
本发明采用以下方案实现:一种行波型超声波电机伺服控制***控制特性测试装置,其特征在于:包括电机驱动控制器以及设置在各自支架上的超声波电机、直流永磁无刷电机和光电编码器;所述的超声波电机输出轴和永磁电机的前端输出轴经第一弹性联轴器连接;所述第一弹性联轴器上设置有一力矩传感器;所述的直流永磁无刷电机的后端输出轴和光电编码器经第二弹性联轴器连接;所述的第二弹性联轴器上设置有磁粉制动器;所述的电机驱动控制器与所述的超声波电机控制端、光电编码器的输出端以及力矩传感器的输出端连接。
在本发明一实施例中,所述的电机驱动控制器包括电性连接的控制芯片和驱动电路芯片,所述的控制芯片包括用于接收所述光电编码器输入的A、B、Z相信号的引脚、用于接收所述力矩传感器的输入信号的引脚、输出所述直流永磁无刷电机的控制信号的引脚以及用于产生驱动驱动电路芯片信号的引脚;所述驱动电 路芯片包括用于为驱动电路芯片产生半桥驱动频率调节信号的引脚以及产生驱动半桥电路的调节信号引脚。
本发明的另一目的是为更好的提高上述测试装置的测试性能,提供一种行波型超声波电机伺服控制***的控制策略。
本发明采用以下方案实现:一种超声波电机伺服控制***的控制策略,其特征在于:该控制策略应用于如权利要求1所述的测试装置中的行波型超声波电机伺服控制***,该控制策略包括:
(1)所述伺服控制***的控制部分由神经元自适应比例积分微分控制算法组成;输入的状态量有3个,分别是本时刻光电编码器信号与力矩传感器信号给定值与实际值的误差,本时刻信号误差与前一时刻信号误差的差,本时刻信号误差与前一时刻信号误差的微分;输出的状态量为调节频率、相位差、电压;
(2)在神经元的学习算法中,借用最优控制中二次型性能指标的思想,实现对输出误差的控制;
(3)神经元权重值修正以目标函数相应于神经元权重系数负梯度的方向进行,该神经元是一类在线自适应控制。
在本发明一实施例中,所述的3个输入量为x1(k)、x2(k)、x3(k);这里,x1(k)、x2(k)、x3(k)分别定义为
x1(k)=r(k)-y(k)=e(k)
x2(k)=e(k)-e(k-1)
x3(k)=e(k)-2e(k-1)+e(k-2)
其中e(k),e(k-1)为本时刻和上一时刻的误差,r为***给定值,y为***输出;
神经元输出u(k)为
式中k为神经元的比例系数,k>0;ω1(k)、ω2(k)、ω3(k)为神经元对x1(k)、x2(k)、x3(k)的权重系数。
在本发明一实施例中,所述步骤(2)的实现方式:取目标函数
其中,r为给定参考值,y为反馈值,对于速度控制来说,y为速度反馈值;对于位置控制来说,y为位置信号反馈值。
在本发明一实施例中,所述步骤(3)的实现方式:为保证权重值修正以J(k)相应于ωi(k)负梯度的方向进行,必须有
式中ηi为学习速率,ηi>0
由式(2),(3)能得到
由于
若令
因此得到
利用上式实现权重值的自学习;
对于传统PID控制器来说,e(k)为PID控制器的输入,u(k)为PID控制器的输出,能得到
Δu(k)=u(k)-u(k-1)=KP{e(k)+(T/TI)[e(k)-e(k-1)]+(TD/T)[e(k)-2e(k-1)+e(k-2)]}
上式中KP为传统PID控制器的比例系数;TI、TD为传统PID控制器的积分时间常数和微分时间常数;T—为采样时间;
对于神经元PID来说
比较传统PID与神经元PID的PID参数,能得到
kω1(k)=KP
kω2(k)=KPT/TI
kω3(k)=KPTD/T
因此,该神经元是一类在线自适应PID控制;
对于位置控制来说,采用神经元PID算法时,在实验中先把二相驱动信号的频率调整到40.5-43.5kHz,这样能使电机以比较高的转速运行,从而实现快速定位;然后根据光电编码器的脉冲数计算位置误差,最后对相位差进行调节,其算法如下:
式中e(k)为位置误差;为PID控制器输出的相位差;x1(k)、x2(k)、x3(k)参见前面的定义。
本发明具有结构紧凑简单,可按不同负载要求对与直流永磁无刷电机进行负载控制;电机停电后具有摩擦自锁功能,且在高频域振动,能量衰减极快,有极高动态响应特性(机械时间常数在几ms以内)、易实现高精度的速度、位置和力矩瞬态特性测试;而且超声波电机使用双电感双电容驱动电路,二相驱动输入电压基本相等,且二相驱动输入电压基本不受电机品质因数变化的影响,使得电机运行平稳,速度波动小。
附图说明
图1为行波型超声波电机伺服控制***控制特性测试装置图;
图2为电机驱动控制器的电路连接示意图。
其中:1为超声波电机、2为超声波电机固定支架、3为超声波电机输出轴、4为第一弹性联轴器、5为力矩传感器、6为第一弹性联轴器、7为直流永磁无刷电机前输出轴、8为直流永磁无刷电机、9为直流永磁无刷电机固定支架、10为直流永磁无刷电机后输出轴、11为第二弹性联轴器、12为磁粉制动器、13为第二弹性联轴器、14为光电编码器固定支架、15为光电编码器、16为测试装置底 座。17、18、19为用于接收所述光电编码器输入的A、B、Z相信号的引脚、20、21为用于接收所述力矩传感器的输入信号的引脚、34、35、36、37为输出所述直流永磁无刷电机的控制信号的引脚、26、27、28、29、30、31为用于产生驱动驱动电路芯片信号的引脚、22、23、24、25为用于为驱动电路芯片产生半桥驱动频率调节信号的引脚、33为产生驱动半桥电路的调节信号引脚,38为控制芯片,39为驱动电路芯片。
具体实施方式
下面结合附图及实施例对本发明做进一步说明。
请参见图1,图1为行波型超声波电机伺服控制***控制特性测试装置图,该行波型超声波电机伺服控制***控制特性测试装置包括电机驱动控制器以及设置在各自支架上的超声波电机1、直流永磁无刷电机8和光电编码器15;所述的超声波电机输出轴3和永磁电机的前端输出轴7经第一弹性联轴器4、6连接;所述第一弹性联轴器上设置有一力矩传感器5;所述的直流永磁无刷电机的后端输出轴10和光电编码器15经第二弹性联轴器11、13连接;所述的第二弹性联轴器11、13上设置有磁粉制动器12;所述的电机驱动控制器与所述的超声波电机控制端、光电编码器的输出端以及力矩传感器的输出端连接。
本发明通过使用直流永磁无刷电机作为负载,在不同控制变量(控制电压、频率、相位差)下通过高分辨率的光电编码器和力矩传感器测量电机的伺服控制***控制特性,由实验得到的动态力矩来确定不同控制变量下的速度和力矩特性,是此装置的主要目的。
要说明的是,本发明的电机驱动控制器包括控制芯片38和驱动电路芯片39。其中DSP控制芯片采用TMS320LF2812DSP,DSP作为控制芯片接受电机运行时检测到的光电编码器信号(图2的输入引脚为17、18、19)力矩传感器信号(图2的输入引脚为20、21)及产生驱动频率调节信号(图2的驱动信号输出引脚分别为22、23、24、25),驱动半桥电路的调节信号(图2的调节信号输入引脚为33),对电机输出A、B两相PWM的频率、相位及通断进行控制。通过开通及关断PWM波的输出来控制超声波电机的启动和停止运行;通过调节输出PWM波的频率及两相的相位差来调节电机的控制状态。
此实施方式通过直流永磁无刷电机输出力矩的变化来模拟不同负载和控制 变量下电机的伺服控制特性,实现变量(调节频率、相位差)条件下的伺服控制***控制特性测试。
控制策略为:伺服***的控制部分由神经元自适应PID(比例积分微分)控制算法组成。输入的状态量有3个,为x1(k)、x2(k)、x3(k)。这里,x1(k)、x2(k)、x3(k)分别定义为
x1(k)=r(k)-y(k)=e(k)
x2(k)=e(k)-e(k-1)
x3(k)=e(k)-2e(k-1)+e(k-2)
其中e(k),e(k-1)为本时刻和上一时刻的误差,r为***给定值,y为***输出。
神经元输出u(k)为
式中k——神经元的比例系数,k>0
ω1(k)、ω2(k)、ω3(k)——神经元对x1(k)、x2(k)、x3(k)的权重系数
在神经元的学习算法中,借用最优控制中二次型性能指标的思想,从而实现对输出误差的控制。取目标函数
其中,r为给定参考值,y为反馈值,对于速度控制来说,y为速度反馈值;对于位置控制来说,y为位置信号反馈值。
为保证权重值修正以J(k)相应于ωi(k)负梯度的方向进行,必须有
式中ηi——学习速率,ηi>0
由式(2),(3)可以得到
由于
在对象未知时,可以采用差分近似来处理(这样做同时也便于使用数字信号处理实现该算法),即
若令
因此可以得到
利用上式可以实现权重值的自学习。
对于传统PID控制器来说,e(k)为PID控制器的输入,u(k)为PID控制器的输出,可以得到
Δu(k)=u(k)-u(k-1)=KP{e(k)+(T/TI)[e(k)-e(k-1)]+(TD/T)[e(k)-2e(k-1)+e(k-2)]}
上式中KP——传统PID控制器的比例系数
TI、TD——传统PID控制器的积分时间常数和微分时间常数
T——采样时间
对于神经元PID来说
比较传统PID与神经元PID的PID参数,可以得到
kω1(k)=KP
kω2(k)=KPT/TI
kω3(k)=KPTD/T
因此,该神经元是一类在线自适应PID控制。
对于位置控制来说,采用神经元PID算法时,在实验中先把二相驱动信号的频率调整到40.5-43.5kHz,这样可以使电机以比较高的转速运行,从而实现快速定位。然后根据光电编码器的脉冲数计算位置误差,最后对相位差进行调节,其算法如下
式中e(k)——位置误差(作为PID控制器的输入)
x1(k)、x2(k)、x3(k)参见前面的定义。
以上所述仅为本发明的较佳实施例,凡依本发明申请专利范围所做的均等变化与修饰,皆应属本发明的涵盖范围。
Claims (6)
1.一种超声波电机伺服控制***控制特性测试装置,其特征在于:包括电机驱动控制器以及设置在各自支架上的超声波电机、直流永磁无刷电机和光电编码器;所述的超声波电机输出轴和永磁电机的前端输出轴经第一弹性联轴器连接;所述第一弹性联轴器上设置有一力矩传感器;所述的直流永磁无刷电机的后端输出轴和光电编码器经第二弹性联轴器连接;所述的第二弹性联轴器上设置有磁粉制动器;所述的电机驱动控制器与所述的超声波电机控制端、光电编码器的输出端以及力矩传感器的输出端连接。
2.根据权利要求1所述的超声波电机伺服控制***控制特性测试装置,其特征在于:所述的电机驱动控制器包括电性连接的控制芯片和驱动电路芯片,所述的控制芯片包括用于接收所述光电编码器输入的A、B、Z相信号的引脚(17、18、19)、用于接收所述力矩传感器的输入信号的引脚(20、21)、输出所述直流永磁无刷电机的控制信号的引脚(34、35、36、37)以及用于产生驱动驱动电路芯片信号的引脚(26、27、28、29、30、31);所述驱动电路芯片包括用于为驱动电路芯片产生半桥驱动频率调节信号的引脚(22、23、24、25)以及产生驱动半桥电路的调节信号引脚(33)。
3.一种超声波电机伺服控制***的控制策略,其特征在于:该控制策略应用于如权利要求1所述的测试装置中的行波型超声波电机伺服控制***,该控制策略包括:
(1)所述伺服控制***的控制部分由神经元自适应比例积分微分控制算法组成;输入的状态量有3个,分别是本时刻光电编码器信号与力矩传感器信号给定值与实际值的误差,本时刻信号误差与前一时刻信号误差的差,本时刻信号误差与前一时刻信号误差的微分;输出的状态量为调节频率、相位差、电压;
(2)在神经元的学习算法中,借用最优控制中二次型性能指标的思想,实现对输出误差的控制;
(3)神经元权重值修正以目标函数相应于神经元权重系数负梯度的方向进行,该神经元是一类在线自适应控制。
4.根据权利要求3所述的超声波电机伺服控制***的控制策略,其特征在于:所述的3个输入量为x1(k)、x2(k)、x3(k);这里,x1(k)、x2(k)、x3(k)分别定义为:
x1(k)=r(k)-y(k)=e(k)
x2(k)=e(k)-e(k-1)
x3(k)=e(k)-2e(k-1)+e(k-2)
其中e(k),e(k-1)为本时刻和上一时刻的误差,r为***给定值,y为***输出;
神经元输出u(k)为
式中k为神经元的比例系数,k>0;ω1(k)、ω2(k)、ω3(k)为神经元对x1(k)、x2(k)、x3(k)的权重系数。
5.根据权利要求4所述的超声波电机伺服控制***的控制策略,其特征在于:所述步骤(2)的实现方式:取目标函数
其中,r为给定参考值,y为反馈值,对于速度控制来说,y为速度反馈值;对于位置控制来说,y为位置信号反馈值。
6.根据权利要求5所述的超声波电机伺服控制***的控制策略,其特征在于:所述步骤(3)的实现方式:为保证权重值修正以J(k)相应于ωi(k)负梯度的方向进行,必须有
式中ηi为学习速率,ηi>0
由式(2),(3)能得到
由于
若令
因此得到
利用上式实现权重值的自学习;
对于传统PID控制器来说,e(k)为PID控制器的输入,u(k)为PID控制器的输出,能得到
Δu(k)=u(k)-u(k-1)=KP{e(k)+(T/TI)[e(k)-e(k-1)]+(TD/T)[e(k)-2e(k-1)+e(k-2)]}
上式中KP为传统PID控制器的比例系数;TI、TD为传统PID控制器的积分时间常数和微分时间常数;T—为采样时间;
对于神经元PID来说
比较传统PID与神经元PID的PID参数,能得到
kω1(k)=KP
kω2(k)=KPT/TI
kω3(k)=KPTD/T
因此,该神经元是一类在线自适应PID控制;
对于位置控制来说,采用神经元PID算法时,在实验中先把二相驱动信号的频率调整到40.5-43.5kHz,这样能使电机以比较高的转速运行,从而实现快速定位;然后根据光电编码器的脉冲数计算位置误差,最后对相位差进行调节,其算法如下:
式中e(k)为位置误差;为PID控制器输出的相位差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310244429.0A CN103336523B (zh) | 2013-06-19 | 2013-06-19 | 超声波电机伺服控制***的控制策略 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310244429.0A CN103336523B (zh) | 2013-06-19 | 2013-06-19 | 超声波电机伺服控制***的控制策略 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103336523A true CN103336523A (zh) | 2013-10-02 |
CN103336523B CN103336523B (zh) | 2016-03-16 |
Family
ID=49244714
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310244429.0A Expired - Fee Related CN103336523B (zh) | 2013-06-19 | 2013-06-19 | 超声波电机伺服控制***的控制策略 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103336523B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105116733A (zh) * | 2015-09-25 | 2015-12-02 | 闽江学院 | 改良型粒子群寻优神经网络超声波电机控制***及其方法 |
CN105137763A (zh) * | 2015-10-10 | 2015-12-09 | 闽江学院 | 超声波电机鲁棒性递归式神经网络滑动模态控制***及方法 |
CN108818541A (zh) * | 2018-09-11 | 2018-11-16 | 闽江学院 | 一种柔性关节机器人的自适应神经网络跟踪控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101586995A (zh) * | 2009-06-22 | 2009-11-25 | 浙江大学 | 多自由度球形行波型超声波电机力矩测量装置 |
CN203324811U (zh) * | 2013-06-19 | 2013-12-04 | 闽江学院 | 行波型超声波电机伺服控制***控制特性测试装置 |
-
2013
- 2013-06-19 CN CN201310244429.0A patent/CN103336523B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101586995A (zh) * | 2009-06-22 | 2009-11-25 | 浙江大学 | 多自由度球形行波型超声波电机力矩测量装置 |
CN203324811U (zh) * | 2013-06-19 | 2013-12-04 | 闽江学院 | 行波型超声波电机伺服控制***控制特性测试装置 |
Non-Patent Citations (3)
Title |
---|
傅平 等: "基于神经元自适应PID的超声波电机速度位置控制", 《电工技术学报》, no. 2, 26 February 2007 (2007-02-26), pages 29 - 33 * |
章阳 等: "基于MSP430的超声电机自动测试***的研究", 《中国优秀硕士学位论文全文数据库》, 15 February 2013 (2013-02-15) * |
顾菊平 等: "超声波电机测试技术的研究", 《电工技术学报》, no. 1, 26 February 2003 (2003-02-26), pages 21 - 26 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105116733A (zh) * | 2015-09-25 | 2015-12-02 | 闽江学院 | 改良型粒子群寻优神经网络超声波电机控制***及其方法 |
CN105116733B (zh) * | 2015-09-25 | 2017-12-15 | 闽江学院 | 改良型粒子群寻优神经网络超声波电机控制***及其方法 |
CN105137763A (zh) * | 2015-10-10 | 2015-12-09 | 闽江学院 | 超声波电机鲁棒性递归式神经网络滑动模态控制***及方法 |
CN105137763B (zh) * | 2015-10-10 | 2017-12-15 | 闽江学院 | 超声波电机鲁棒性递归式神经网络滑动模态控制***及方法 |
CN108818541A (zh) * | 2018-09-11 | 2018-11-16 | 闽江学院 | 一种柔性关节机器人的自适应神经网络跟踪控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103336523B (zh) | 2016-03-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103513181B (zh) | 超声波电机瞬态特性测试装置及其控制*** | |
US20080272731A1 (en) | Method and system for resolver alignment in electric motor system | |
CN106208807B (zh) | 基于观测器的超声波电机伺服控制***滞回补偿控制方法 | |
Prasetyo et al. | Controls of BLDC motors in electric vehicle Testing Simulator | |
CN103780187B (zh) | 永磁同步电机高动态响应电流控制方法及*** | |
US8901871B2 (en) | Robust controller for electro-mechanical actuators employing sliding and second control modes | |
CN104205614B (zh) | 三相交流感应电机的控制装置以及三相交流感应电机的控制方法 | |
CN102710214A (zh) | 永磁同步直线电机非线性干扰的控制方法及控制*** | |
CN103718452A (zh) | 具有电压谐波整形的电动机控制 | |
CN203324452U (zh) | 超声波电机瞬态特性测试装置 | |
Tan et al. | Bi-stable actuator measurement method based on voice coil motor | |
CN104280681A (zh) | 电机动态负载模拟*** | |
CN103336523A (zh) | 超声波电机伺服控制***控制特性测试装置及其控制策略 | |
CN105337546A (zh) | 基于变阶次分数阶滑模的永磁同步电机控制装置及方法 | |
CN203324811U (zh) | 行波型超声波电机伺服控制***控制特性测试装置 | |
Muñoz | Design, Simulation and Implementation of PMSM Drive System | |
CN102403937B (zh) | 永磁同步电机中齿槽力矩的测量及抑制***与实现方法 | |
KR102189823B1 (ko) | 전동기의 토크 맥동 저감 자동화 장치 | |
CN106341065B (zh) | 超声波电机伺服控制***速度死区补偿控制装置及方法 | |
CN103825520A (zh) | 一种异步电机最优转差频率控制方法 | |
CN103051280A (zh) | 低速直驱型永磁同步发电机转速与转子位置估算方法 | |
CN105099263A (zh) | 基于广义回归神经网络辨识器的超声波电机位置与速度控制*** | |
CN202713223U (zh) | 永磁同步直线电机非线性干扰的控制*** | |
CN102789192A (zh) | 一种反馈控制***及其频率响应测量装置 | |
CN106787940B (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 | ||
C14 | Grant of patent or utility model | ||
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: 20160316 Termination date: 20190619 |