CN102510251B - 驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法 - Google Patents
驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法 Download PDFInfo
- Publication number
- CN102510251B CN102510251B CN2011103927896A CN201110392789A CN102510251B CN 102510251 B CN102510251 B CN 102510251B CN 2011103927896 A CN2011103927896 A CN 2011103927896A CN 201110392789 A CN201110392789 A CN 201110392789A CN 102510251 B CN102510251 B CN 102510251B
- Authority
- CN
- China
- Prior art keywords
- circuit
- dsp
- current
- motor
- adaptive
- 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
Images
Landscapes
- Feedback Control In General (AREA)
- Control Of Motors That Do Not Use Commutators (AREA)
Abstract
驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法,所采用的控制系统,包括电机、霍尔传感器、光电编码器、电流采样电路、电机位置与速度检测电路、DSP、单路光耦隔离电路、电源电路、整流滤波电路、IPM智能功率模块;DSP外围设有Fault信号采集电路、晶振电路、复位电路、存储器、通讯接口和JTAG接口。控制方法:确定驱动复合摆头电机转子的初始相位;确定电机转子的电角速度;电流、位置和速度量在DSP内比较后,执行自适应鲁棒控制算法;DSP产生相应的六路PWM脉冲信号,驱动电机运行。采用自适应控制技术减小参数不确定性形成的稳态误差,提高跟踪精度。
Description
技术领域
本发明涉及自动控制技术领域,特别涉及驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法,采用本方法对五轴联动数控系统中的复合摆头进行控制,可提高系统的伺服性能。
背景技术
随着高新技术的发展和高精产品对零件精度要求越来越高,现代数控加工正向高速度化、高精度化、高智能化、高柔性化、高自动化和高可靠性方向发展,五轴联动数控系统应运而生。五轴联动加工可以提高空间自由曲面的加工精度、质量和效率,已成为当今世界数控机床研究与开发的热点。
复合摆头是五轴联动数控机床中的关键部件,其结构和性能在很大程度上决定了整台机床的性能,对其进行良好的控制可提高系统的伺服性能,因此成为五轴联动数控机床市场竞争的焦点之一。目前,为实现复合摆头的高速高精性能,国际上一般采用先进的永磁环形力矩电机直接驱动技术。直接驱动消除了中间传动机构(齿轮减速系统等)引起的消耗及产生的限制,能直接提供推力给执行机构,具有推力大、损耗低、电气时间常数小、响应速度快等特点,可以获得很高的动态响应速度和加速度,较高的刚度和定位精度,可实现平滑的无差运动。永磁环形力矩电机将机床传动链长度缩短为零,直接驱动摆头运动,省去齿轮等各种中间环节,实现“零传动”,可得到良好的动态性能和较高的定位精度,其结构如图1所示。
永磁环形力矩电机直接驱动也有其局限性,外界及自身的任何扰动将无缓冲地作用在电机上,系统对外部扰动、参数不确定性和转矩脉动更为敏感,这是造成系统伺服性能下降的主要原因。另外,其它参数变化、位置和速度检测噪声等不确定因素都可能影响系统的稳定性和控制精度。随着复杂型零件对加工精度要求不断提高,采用传统控制方法控制策略已无法满足多轴联动数控系统中高速高精的控制要求。
由于数控机床直接驱动系统不确定性(如未建模动态特性,参数变化以及外界负载扰动不确定性),设法保持系统的稳定鲁棒性和品质鲁棒性,通过设计确定鲁棒控制器满足系统对性能指标的要求。确定鲁棒控制方法可以保证系统暂态性能,并且实现确定的跟踪精度;其缺陷是控制器采用固定的参数,所以参数不确定性不能被减小或消除。要减小最终跟踪误差,就要诉之于高增益。然而实际系统带宽有限,故可用的增益是有限制的,这决定了系统的实际跟踪误差不能任意小。所以,将参数自适应引入确定鲁棒控制技术以减小来自参数不确定项对系统稳态误差的影响。自适应控制的优点在于通过在线参数自适应,可以减少可线性参数化的模型不确定项对系统性能的影响。因而,在不需要高增益的情况下可以获得渐近稳定并且跟踪误差趋近于零。
发明内容
针对现有技术存在的问题,本发明提供一种驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法。
本发明驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法所采用的控制系统,包括电机、霍尔传感器、光电编码器、电流采样电路、电机位置与速度检测电路、DSP、单路光耦隔离电路、电源电路、整流滤波电路、IPM智能功率模块;DSP外围设有Fault信号采集电路、晶振电路、复位电路、存储器、通讯接口和JTAG接口。
电机输出端分别接霍尔传感器和光电编码器输入端,霍尔传感器的输出端连接至电流采样电路输入端,电流采样电路的输出端接至DSP的ADC端口,光电编码器的输出端连接位置与速度检测电路输入端,位置与速度检测电路输出端接至DSP的QEP端口,DSP外接有Fault信号采集电路、晶振电路、复位电路、存储器、通讯接口和JTAG接口,光耦隔离电路接至DSP的PWM端口,电源电路接至DSP的供电端口,光耦隔离电路的输出端、电源电路输出端和整理滤波电路输出端均接至IPM智能功率模块输入端,IPM智能功率模块输出端接至电机。
驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法,具体步骤包括:
步骤1:确定驱动复合摆头的电机转子的初始相位;
采用霍尔传感器测量电机的电流,将数据经电流采样电路送入DSP;采用光电编码器采集电机的转子位置和速度信号,转换为数字信号后,经位置与速度检测电路输出两相正交方波脉冲信号和零位脉冲三路脉冲信号,从两相正交方波脉冲信号的脉冲个数可知转子的位置偏移,确定电机转子的初始相位,并输出至DSP。
由于一般永磁同步电机的电流环调节时间很短,当只考虑基波分量时,可采用d-q轴系下的模型,令电流内环d轴电流分量id=0,使定子电流矢量和永磁体磁场在空间上正交,则复合A/C轴永磁环形力矩电机运动方程表示为:
其中,J——电机转动惯量;
ω——转子的电角速度;
Te,Tc——为电机电磁转矩和齿槽转矩;
B——粘滞摩擦系数;
d——外部扰动。
电机电磁转矩可写成
Te=KTiq (2)
其中,KT是转矩系数,iq为电机q轴电流。
齿槽转矩与转子位置θ相关,表达式为:
其中,Ti为i次谐波的齿槽转矩峰值;Nc是定子齿数与极数的公倍数;Ksk是电机斜槽系数。
齿槽转矩Tc以基波为主要影响因素,设
Tc=AcSc(θ)(4)
其中,Ac为未知量,Sc(θ)为齿槽转矩基波的形态函数。
复合摆头进行工件加工时,其外部扰动
将式(2),(4)和式(5)代入式(1),可得系统动态方程为:
令状态变量x=[θ,ω]T=[x1,x2]T,则伺服系统状态方程为:
θ=x1(8)
其中u=KTiq为控制输入。
步骤2:确定电机转子的电角速度;
电流信号A/D转换后,与给定电流比较,产生电流控制信号;脉冲信号送入DSP的正交编码脉冲输入单元QEP,进行四倍频处理,提高编码器分辨率,同时通用定时器设置成定向增/减计数模式,由两相脉冲的超前关系可得转子的转向,从而得出转子的电角速度;
步骤3:电流、位置和速度量在DSP内比较后,执行自适应鲁棒控制算法,具体如下:
伺服系统实际运行中,参数J,B,Ac和d1均可能会变化。为了提高系统性能,降低不确定性因素对系统的影响,需要对参数进行在线估计。定义参数向量
ξ=[ξ1,ξ2,ξ3,ξ4]T=[J,B,Ac,d1]T
则系统状态空间方程可表示为
实际系统参数J,B,Ac和d均有界,且边界已知或可测,故做如下假设:假设:
ξ∈Ωξ={ξ:ξmin<ξ<ξmax}(11)
其中ξmin=[ξ1min,...,ξ4min]T,ξmax=[ξ1max,...,ξ4max]T且ξmin,ξmax和δd是已知的。
为便于ARC设计,定义中间量:
其中,e=x1-x1d为输出跟踪误差,x1d为x1的期望轨迹,k1>0为反馈增益。由式(13)可知,Gp(s)=e(s)/z(s)=1/(s+k1)为稳定传递函数,则如果z趋于0,则e也趋于0。将式(13)代入式(10),得
令θd为参考运动轨迹,自适应鲁棒控制的目标就设计出一个控制输入u,使得存在外部扰动和参数不确定性的情况下,输出θ对θd(t)的跟踪误差尽可能小。其中u是控制输入,u是由两部分构成:自适应控制项和鲁棒控制项,给出以下控制律为:
u=ua+us
其中ua为自适应控制项,us为鲁棒控制项。
1)鲁棒控制
采用鲁棒控制项削弱模型不确定性的影响。首先计算出位置输出跟踪误差e=θ-θd,定义中间量
这是因为Gp(s)=e(s)/z(s)=1/(s+k1)为稳定传递函数,则如果z趋于0,则e也趋于0。
构建鲁棒控制项,鲁棒控制由两项构成
其中,us1是反馈稳定控制项,用来稳定标称系统;us2为鲁棒反馈控制项,用以削弱模型不确定性的影响。上式中,设计参数ks1>0,h为连续函数,满足ε为任意小的参数且满足式(21)。
由于确定鲁棒控制只能处理固定参数模型补偿,通常情况下确定鲁棒控制设计不能直接用来设计所需的控制律。因此在进行鲁棒控制计算的同时,还要通过参数辨识逼近参数真值。
2)参数辨识
存在参数不确定性的情况下,要通过适当的模型补偿实现零跟踪误差,则需要在线参数辨识,进而实现参数自适应。采用传统的自适应控制方法求出自适应律,以更新参数估计。
为了提高系统性能,降低不确定性因素对系统的影响,需要对参数进行在线估计。
参数辨识采用不连续投影算法,如下:
其中Γ>0为对角矩阵,τ为自适应函数。
3)可调整模型补偿
由于系统不确定性而导致伺服性能降低,为了实现跟踪参考信号,需要调整模型补偿项以获得期望的控制行为。自适应鲁棒算法在参数辨识后,要将得到的估计值对系统模型进行补偿以提高系统性能。
本发明通过修正传统的自适应律,使得参数估计值在出现不确定非线性时一直保持在一定的范围内。这种修正并不损害对参数化不确定项的正确估计。
自适应鲁棒控制算法中,自适应控制项为
在假设(11)条件下,不连续投影自适应律如下:
其中Γ>0为对角矩阵,τ为自适应函数,定义不连续投影映射为
对于任何自适应函数τ,式(17)的投影映射可以保证
P1
P2
将式(15)代入(14),可得
鲁棒控制项由两项构成
us=us1+us2us1=-k2z (20)
其中,us1稳定标称系统,us2削弱模型不确定性的影响。根据假设1和(18)中的P1,存在us2满足以下条件:
ii)zus2≤0
其中ε是任意小的设计参数,us2满足
选取自适应律为
则永磁环形力矩电机的自适应鲁棒控制系统结构如图3所示。
所述自适应鲁棒控制算法控制律具有以下性质:
A)系统所有信号均有上界,定义正定函数
其上界为
其中λ=2k2/θ1max。
零跟踪误差,即当t→∞时,e→0且z→0。
证明:对式(24)中的正定函数Vs求导:
将式(19)和(20)代入上式,
根据式(21)条件i),取λ=min{2k2/ξ1max,k1},可得
定理中A)得证。
由式(18)中P2和式(21)中ii)以及式(26)得:
自适应控制项为
其中为ξ的估计值。
4)协调机制
协调机制主要是协调鲁棒控制项和自适应控制项。由上述步骤可得:
u=ua+us
其中ua为自适应控制项,us为鲁棒控制项。
步骤4:DSP产生相应的六路PWM脉冲信号,驱动永磁环形力矩电机运行。
通过光电隔离驱动电路将DSP输出的PWM信号转换成驱动信号,整流滤波电路把三相交流电转换成直流电给智能功率模块IPM供电,IPM根据DSP产生的六路PWM脉冲信号对六个IGBT开关元件的导通与关断进行控制,驱动永磁环形力矩电机运行。
有益效果:本发明采用确定鲁棒控制器作为基础控制器,以保证对于参数不确定项和扰动系统的暂态性能。在此基础上,使用自适应控制技术来减小参数不确定性形成的稳态误差,提高系统的跟踪精度。通过修正传统的自适应律,使得参数估计值在出现不确定非线性时一直保持在一定的范围内。这种修正并没有损害对参数化不确定项的正确估计。
附图说明
图1是永磁环形力矩电机的结构示意图,1为支撑框架,2为水冷(内部/外部),3为定子,4为密封条(O型环),5为转子;
图2是本发明实施例自适应鲁棒控制框图;
图3是本发明实施例伺服系统自适应鲁棒控制结构图;
图4是本发明实施例控制系统结构框图;
图5是本发明实施例电机电路原理图;
图6是本发明实施例电流采样电路原理图;
图7是本发明实施例电机位置与速度检测电路原理图;
图8是本发明实施例单路光耦隔离电路原理图;
图9是本发明实施例电源电路原理图;
图10是本发明是实施例DSP外围电路连接框图;
图11是本发明实施例Fault信号采集电路原理图;
图12是本发明实施例DSP的外围晶振电路原理图;
图13是本发明实施例DSP的复位电路原理图;
图14是本发明实施例DSP外部程序存储器引脚及连接图;
图15是本发明实施例DSP与PC机通讯接口电路原理图;
图16是本发明实施例JTAG接口电路原理图;
图17是本发明实施例环形力矩电机驱动控制过程流程图;
图18是本发明实施例环形力矩电机控制过程保护中断处理过程流程图;
图19是本发明实施例控制方法中TI中断处理子程序流程图;
图20是本发明实施例复合摆头环形永磁力矩电机的位置跟踪误差曲线图;
图21是本发明实施例复合摆头环形永磁力矩电机的位置响应跟踪曲线图;
图22是本发明实施例电机转动惯量J参数识别过程仿真图;
图23是本发明实施例电机齿槽转矩Tc参数识别过程仿真图;
图24是本发明实施例电机外部扰动d参数识别过程仿真图。
具体实施方式
下面结合附图对本发明做进一步说明。
本发明的控制系统包括:电机、霍尔传感器、光电编码器、电流采样电路、电机位置与速度检测电路、DSP、单路光耦隔离电路、电源电路、整流滤波电路、IPM智能功率模块;DSP外围设有Fault信号采集电路、晶振电路、复位电路、存储器、通讯接口和JTAG接口。控制系统结构如图4所示。
本实施例选用CyTec公司的R166/100型永磁环形力矩电机,选用LEM公司的霍尔电流传感器LTS25-N对电流进行测量,通过电流采样电路对系统电流进行采样,电流采样电路如图6所示,将数据送入型号为TMS320LF2407A的DSP中的A/D模块。电机位置与速度检测采样的转子位置检测元件为2500个脉冲/转的增量式光电编码器,输出两相正交方波脉冲信号(A,B)和零位脉冲(Z)三路脉冲信号,从A,B两相脉冲的脉冲个数可知转子的位置偏移,因此可确定电机转子的初始相位。将脉冲信号输入DSP2407的正交编码脉冲输入单元(QEP),该单元可对输入正交脉冲信号进行四倍频处理,提高编码器分辨律,同时,将通用定时器设置成定向增/减计数模式,根据两相脉冲的超前关系得知转子的转向,进而得出转子的电角速度,电机位置与速度检测电路如图7所示。光耦隔离电路隔离器件选用光电耦合器TLP559,光耦隔离电路如图8所示。DSP芯片、光电耦合器和IPM智能功率模块需要直流电压供电,直流供电稳压电源电路如图9所示。
DSP2407外围接有Fault信号采集电路(如图11所示)、晶振电路(如图12所示)、复位电路(如图13所示)、存储器IS61LV6416TSOPZ(如图14所示)、通讯接口(如图15所示)和JTAG接口(如图16所示)。
系统接通电源,智能功率模块IPM的各个保护环节检验正常,继电器闭合使主回路通路,通过整流滤波电路将三相交流电转换成直流电,输出至智能功率模块IPM,为该模块供电,IPM根据DSP产生的六路PWM脉冲信号对六个IGBT开关元件的导通与关断进行控制,从而驱动永磁环形力矩电机的运行。电机主电路如图5所示。在电机运行过程中,需要对系统的电流,速度和位置等信号进行实时测量,然后进行相应的运算,以实现良好的伺服性能。
本发明方法步骤如下:
步骤1:确定驱动复合摆头的电机转子的初始相位;
采用霍尔传感器测量电机的电流,通过电流采样电路将数据送入DSP;光电编码器采集电机的转子位置和速度信号,转换为数字信号后,经位置与速度检测电路输出两相正交方波脉冲信号(A,B)和零位脉冲(Z)三路脉冲信号,从两相正交方波脉冲信号的脉冲个数可知转子的位置偏移,确定电机转子的初始相位,并输出至DSP。
由于一般永磁同步电机的电流环调节时间很短,当只考虑基波分量时,可采用d-q轴系下的模型,令电流内环d轴电流分量id=0,使定子电流矢量和永磁体磁场在空间上正交,则复合A/C轴永磁环形力矩电机运动方程表示为:
其中,J——电机转动惯量;
ω——转子的电角速度;
Te,Tc——为电机电磁转矩和齿槽转矩;
B——粘滞摩擦系数;
d——外部扰动。
电机电磁转矩可写成
Te=KTiq(2)
其中,KT是转矩系数,iq为电机q轴电流。
齿槽转矩与转子位置θ相关,表达式为:
其中,Ti为i次谐波的齿槽转矩峰值;Nc是定子齿数与极数的公倍数;Ksk是电机斜槽系数。
齿槽转矩Tc以基波为主要影响因素,设
Tc=AcSc(θ)(4)
其中,Ac为未知量,Sc(θ)为齿槽转矩基波的形态函数。
复合摆头进行工件加工时,其外部扰动
令状态变量x=[θ,ω]T=[x1,x2]T,则伺服系统状态方程为:
θ=x1(8)
其中u=KTiq为控制输入。
步骤2:确定电机转子的电角速度;
具体地:电流信号A/D转换后,与电机主回路中的给定电流比较,产生电流控制信号;脉冲信号送入DSP的正交编码脉冲输入单元QEP,进行四倍频处理,提高编码器分辨率,同时通用定时器设置成定向增/减计数模式,由两相脉冲的超前关系可得转子的转向,从而得出转子的电角速度;
步骤3:电流、位置和速度量在DSP内比较后,执行自适应鲁棒控制算法;
伺服系统实际运行中,参数J,B,Ac和d1均可能会变化。为了提高系统性能,降低不确定性因素对系统的影响,需要对参数进行在线估计。定义参数向量
ξ=[ξ1,ξ2,ξ3,ξ4]T=[J,B,Ac,d1]T
则系统状态空间方程可表示为
实际系统参数J,B,Ac和d均有界,且边界已知或可测,故做如下假设:假设:
ξ∈Ωξ={ξ:ξmin<ξ<ξmax}(11)
其中ξmin=[ξ1min,...,ξ4min]T,ξmax=[ξ1max,...,ξ4max]T且ξmin,ξmax和δd是已知的。
为便于ARC设计,定义中间量:
其中,e=x1-x1d为输出跟踪误差,x1d为x1的期望轨迹,k1>0为反馈增益。由式(13)可知,Gp(s)=e(s)/z(s)=1/(s+k1)为稳定传递函数,则如果z趋于0,则e也趋于0。将式(13)代入式(10),得
上式中,
令θd为参考运动轨迹,自适应鲁棒控制的目标就设计出一个控制输入u,使得存在外部扰动和参数不确定性的情况下,输出θ对θd(t)的跟踪误差尽可能小。其中u是控制输入,u是由两部分构成:自适应控制项和鲁棒控制项,给出以下控制律为:
u=ua+us
其中ua为自适应控制项,us为鲁棒控制项。
1)鲁棒控制
采用鲁棒控制项削弱模型不确定性的影响。首先计算出位置输出跟踪误差e=θ-θd,定义中间量
这是因为Gp(s)=e(s)/z(s)=1/(s+k1)为稳定传递函数,则如果z趋于0,则e也趋于0。
构建鲁棒控制项,鲁棒控制由两项构成
us=us1+us2us1=-ks1z
其中,us1是反馈稳定控制项,用来稳定标称系统;us2为鲁棒反馈控制项,用以削弱模型不确定性的影响。上式中,设计参数ks1>0,h为连续函数,满足ε为任意小的参数且满足式(21)。
由于确定鲁棒控制只能处理固定参数模型补偿,通常情况下确定鲁棒控制设计不能直接用来设计所需的控制律。因此在进行鲁棒控制计算的同时,还要通过参数辨识逼近参数真值。
2)参数辨识
存在参数不确定性的情况下,要通过适当的模型补偿实现零跟踪误差,则需要在线参数辨识,进而实现参数自适应。采用传统的自适应控制方法求出自适应律,以更新参数估计。
为了提高系统性能,降低不确定性因素对系统的影响,需要对参数进行在线估计。定义参数向量ξ=[ξ1,ξ2,ξ3,ξ4]T=[J,B,Ac,d1]T。则系统状态空间方程可表示为
实际系统参数J,B,Ac和d均有界,且边界已知或可测,故做如下假设:
假设:
ξ∈Ωξ={ξ:ξmin<ξ<ξmax}(11)
其中ξmin=[ξ1min,...,ξ4min]T,ξmax=[ξ1max,...,ξ4max]T且ξmin,ξmax和δd是已知的。
将(13)代入(10),可得
上式中,参数辨识采用不连续投影算法,如下:
其中Γ>0为对角矩阵,τ为自适应函数。
3)可调整模型补偿
由于系统不确定性而导致伺服性能降低,为了实现跟踪参考信号,需要调整模型补偿项以获得期望的控制行为。自适应鲁棒算法在参数辨识后,要将得到的估计值对系统模型进行补偿以提高系统性能。
本发明通过修正传统的自适应律,使得参数估计值在出现不确定非线性时一直保持在一定的范围内。这种修正并不损害对参数化不确定项的正确估计。
自适应鲁棒控制算法中,其中自适应控制项为
在假设(11)条件下,不连续投影自适应律如下:
其中Γ>0为对角矩阵,τ为自适应函数,定义不连续投影映射为
对于任何自适应函数τ,式(17)的投影映射可以保证
P1
P2
将式(15)代入(14),可得
ξ加粗(19)
鲁棒控制项由两项构成
us=us1+us2us1=-k2z (20)
其中,us1稳定标称系统,us2削弱模型不确定性的影响。根据假设1和(18)中的P1,存在us2满足以下条件:
ii)zus2≤0
其中ε是任意小的设计参数,us2满足
选取自适应律为
则永磁环形力矩电机的自适应鲁棒控制系统结构如图3所示。
所述自适应鲁棒控制算法控制律具有以下性质:
A)系统所有信号均有上界,定义正定函数
其上界为
其中λ=2k2/θ1max。
零跟踪误差,即当t→∞时,e→0且z→0。
自适应控制项为
4)协调机制
协调机制主要是协调鲁棒控制项和自适应控制项。由上述步骤可得:
u=ua+us
其中ua为自适应控制项,us为鲁棒控制项。
步骤4:DSP产生相应的六路PWM脉冲信号,驱动永磁环形力矩电机运行。
通过光电隔离驱动电路将DSP输出的PWM信号转换成驱动信号,整流滤波电路把三相交流电转换成直流电给智能功率模块IPM供电,IPM根据DSP产生的六路PWM脉冲信号对六个IGBT开关元件的导通与关断进行控制,驱动永磁环形力矩电机按照要求运行。
本发明方法由嵌入DSP2407处理器中的控制程序实现,程序流程如图17所示,其控制过程按以下步骤执行:
步骤一、系统初始化;
步骤二、电机转子初始位置;
步骤三、允许INT1、INT2中断;
步骤四、启动T1下溢中断;
步骤五、中断等待;
步骤六、T1中断处理;
步骤七、保护中断处理;
步骤八、结束。
其中步骤七中保护中断处理过程按以下步骤执行(如图18所示):
步骤1禁止所有中断;
步骤2封锁IPM;
步骤3中断返回。
步骤六中T1中断处理过程按以下步骤执行(如图9所示):
步骤1保护现场;
步骤2判断是否进行位置调节,是进入步骤3,否则进入步骤9;
步骤3位置采样,并与给定值比较后获得位置偏差;
步骤4位置ARC进行调节;
步骤5转速采样,位置调节器输出信号比较后获得转速偏差;
步骤6速度调节;
步骤7电流采样;
步骤8对电流值进行3S/2R变换;
步骤9利用q轴电流计算转矩;
步骤10求出转矩偏差作为电流调节器的输入信号;
步骤11电流调节器进行电流调节;
步骤12对控制器输出电流值进行2R/3S变换;
步骤13用变换得到的电流值作为载波与三角载波调制获得PWM信号;
步骤14恢复现场;
步骤15中断返回。
为了验证该算法的有效性,以CyTec公司的R166/100型永磁环形力矩电机为例,该电机参数如下:额定转速ωn=12.6rad/s,额定转矩Ten=232N·m,转矩系数KT=9.4N·m/A,转动惯量J=0.205kg·m2,额定电流In=42.1A,粘滞摩擦系数B=0.09N·m·rad/s,极对数p=15,电机槽数Q=36。采用MATLAB7.1进行仿真。
为使算法易于表示,根据式(20)和(22),令反馈增益ks满足如下条件:
根据所提供电机模型,依照所设计控制算法设计自适应鲁棒控制器。经MATLAB反复调试,使得效果最优,所设参数如下:k1=2000,ks=220,参数估计初始值选取为由于在伺服系统运行过程中,电机的粘滞摩擦系统变化很小,为了验证方便,假定粘滞摩擦系数B不变。故自适应律参数选为Γ=diag{2,0,0.5,2000},取齿槽转矩为Tc=5sin(180θd)N·m,给定跟踪轨迹为θd=0.5sin(2πt)rad。复合摆头环形永磁力矩电机的位置跟踪误差曲线如图20所示。由图20可以看出,在无外部扰动情况下,当给定轨迹θd=0.5sin(2πt)rad时,采用所设计自适应鲁棒算法可将伺服系统的跟踪误差控制在6×10-6rad范围内,满足了复合摆头永磁环形力矩电机伺服系统对高精度的要求。
为了验证复合摆头伺服系统加工工件时的性能,即系统鲁棒性,在t=2s时,突加d=200N·m的阶跃扰动,其位置响应跟踪曲线如图21所示。由图21可知,系统在收到较大外部扰动后,自适应鲁棒控制器可使跟踪误差快速趋近于零,具有良好的鲁棒性,提高了系统的伺服性能。图22、23和图24分别是电机转动惯量J、齿槽转矩Tc和外部扰动d的参数辨识过程。由仿真图可以看出,控制系统可快速逼近参数和扰动的实际值,提高了系统的跟踪精度,验证了该算法的有效性。
Claims (3)
1.一种驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法,其特征在于:具体步骤包括:
步骤1:确定驱动复合摆头的电机转子的初始相位;
采用霍尔传感器测量电机的电流,将霍尔传感器测得的数据经电流采样电路送入DSP;采用光电编码器采集电机的转子位置和速度信号,转换为数字信号后,经位置与速度检测电路输出两相正交方波脉冲信号和零位脉冲三路脉冲信号,从两相正交方波脉冲信号的脉冲个数可知转子的位置偏移,确定电机转子的初始相位,并输出至DSP;
步骤2:确定电机转子的电角速度;
电流信号A/D转换后,与给定电流比较,产生电流控制信号;脉冲信号送入DSP的正交编码脉冲输入单元QEP,进行四倍频处理,提高编码器分辨率,同时通用定时器设置成定向增/减计数模式,由两相脉冲的超前关系可得转子的转向,从而得出转子的电角速度;
步骤3:电流、位置和速度量在DSP内比较后,执行自适应鲁棒控制算法;具体如下:
1)鲁棒控制
首先计算出位置输出跟踪误差,然后构建鲁棒控制项;
定义参数向量ξ
ξ=[ξ1,ξ2,ξ3,ξ4]T=[J,B,Ac,dl]T
其中,J为电机转动惯量,B为粘滞摩擦系数,Ac为未知量,dl为负载扰动;
则系统状态空间方程可表示为
假设:
ξ∈Ωξ={ξ:ξmin<ξ<ξmax} (11)
其中ξmin=[ξ1min,...,ξ4min]T,ξmax=[ξ1max,...,ξ4max]T且ξmin,ξmax和δd是已知的;
首先计算出位置输出跟踪误差e=θ–θd,定义中间量z
其中,e=x1-x1d为输出跟踪误差,θ为转子位置,θd为参考运动轨迹,θ=x1,x1d为x1的期望轨迹,k1>0为反馈增益,由式(13)可知,Gp(s)=e(s)/z(s)=1/(s+k1)为稳定传递函数,则如果z趋于0,则e也趋于0;
将式(13)代入式(10),得
上式中,
构建鲁棒控制项us,鲁棒控制由两项构成
us=us1+us2 us1=-ks1z
ii)zus2≤0
2)参数辨识
参数辨识采用不连续投影算法,如下:
其中Γ>0为对角矩阵,τ为自适应函数;
3)可调整模型补偿
将得到的估计值对系统模型进行补偿以提高系统性能,自适应鲁棒控制算法中,自适应控制项ua为
在假设(11)条件下,不连续投影自适应律如下:
其中Γ>0为对角矩阵,τ为自适应函数,定义不连续投影映射为
对于任何自适应函数τ,式(17)的投影映射可以保证
将式(15)代入(14),可得
鲁棒控制项us由两项构成
us=us1+us2 us1=-k2z (20)
其中,us1是反馈稳定控制项,用来稳定标称系统;us2为鲁棒反馈控制项,用以削弱模型不确定性的影响;k2为反馈增益;根据假设(11)和(18)中的P1,存在us2满足以下条件:
ii)zus2≤0
选取自适应律为
4)协调机制
协调鲁棒控制项和自适应控制项,可得:
u=ua+us
其中ua为自适应控制项,us为鲁棒控制项;
步骤4:DSP产生相应的六路PWM脉冲信号,驱动永磁环形力矩电机运行;
将DSP输出的PWM信号转换成驱动信号,整流滤波电路把三相交流电转换成直流电给智能功率模块IPM供电,IPM根据DSP产生的六路PWM脉冲信号对六个IGBT开关元件的导通与关断进行控制,驱动永磁环形力矩电机运行。
2.根据权利要求1所述的驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法,其特征在于:该方法由嵌入DSP中控制程序实现,具体步骤如下:
步骤一、系统初始化;
步骤二、电机转子初始位置;
步骤三、允许INT1、INT2中断;
步骤四、启动T1下溢中断;
步骤五、中断等待;
步骤六、T1中断处理;
步骤七、保护中断处理;
步骤八、结束;
所述步骤七中保护中断处理过程按以下步骤执行:
步骤1 禁止所有中断;
步骤2 封锁IPM;
步骤3 中断返回;
所述步骤六中T1中断处理过程按以下步骤执行:
步骤1 保护现场;
步骤2 判断是否进行位置调节,是进入步骤3,否则进入步骤9;
步骤3 位置采样,并与给定值比较后获得位置偏差;
步骤4 位置ARC进行调节;
步骤5 转速采样,位置调节器输出信号比较后获得转速偏差;
步骤6 速度调节;
步骤7 电流采样;
步骤8 对电流值进行3S/2R变换;
步骤9 利用q轴电流计算转矩;
步骤10 求出转矩偏差作为电流调节器的输入信号;
步骤11 电流调节器进行电流调节;
步骤12 对控制器输出电流值进行2R/3S变换;
步骤13 用变换得到的电流值作为载波与三角载波调制获得PWM信号;
步骤14 恢复现场;
步骤15 中断返回。
3.权利要求1所述的驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法采用的控制系统,其特征在于:该控制系统包括电机、霍尔传感器、光电编码器、电流采样电路、电机位置与速度检测电路、DSP、单路光耦隔离电路、电源电路、整流滤波电路、IPM智能功率模块;DSP外围设有Fault信号采集电路、晶振电路、复位电路、存储器、通讯接口和JTAG接口;
电机输出端分别接霍尔传感器和光电编码器输入端,霍尔传感器的输出端连接至电流采样电路输入端,电流采样电路的输出端接至DSP的ADC端口,光电编码器的输出端连接位置与速度检测电路输入端,位置与速度检测电路输出端接至DSP的QEP端口,DSP外接有Fault信号采集电路、晶振电路、复位电路、存储器、通讯接口和JTAG接口,光耦隔离电路接至DSP的PWM端口,电源电路接至DSP的供电端口,光耦隔离电路的输出端、电源电路输出端和整理滤波电路输出端均接至IPM智能功率模块输入端,IPM智能功率模块输出端接至电机。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2011103927896A CN102510251B (zh) | 2011-11-30 | 2011-11-30 | 驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2011103927896A CN102510251B (zh) | 2011-11-30 | 2011-11-30 | 驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102510251A CN102510251A (zh) | 2012-06-20 |
CN102510251B true CN102510251B (zh) | 2013-12-25 |
Family
ID=46222309
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2011103927896A Expired - Fee Related CN102510251B (zh) | 2011-11-30 | 2011-11-30 | 驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102510251B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103580558B (zh) * | 2012-08-10 | 2017-02-01 | 金华英科尔电机有限公司 | 一种基于直流无刷电机相电流相位角的控制装置及方法 |
CN103950392B (zh) * | 2014-04-29 | 2015-11-04 | 无锡台翔电子技术发展有限公司 | 防篡改电动车控制器与电机之间的互识系统 |
CN103944463A (zh) * | 2014-05-14 | 2014-07-23 | 金陵科技学院 | 一种能自适应110v和220v电压的无刷电机控制器 |
CN104270042B (zh) * | 2014-09-24 | 2017-02-15 | 深圳市正弦电气股份有限公司 | 伺服电机编码器偏移角度自动学习方法及系统 |
CN106100469B (zh) * | 2015-04-21 | 2018-11-13 | 南京理工大学 | 基于自适应的电机伺服系统鲁棒位置控制器的实现方法 |
CN108155833B (zh) * | 2017-12-16 | 2020-09-18 | 南京理工大学 | 考虑电气特性的电机伺服系统渐近稳定控制方法 |
CN110405751B (zh) * | 2018-04-28 | 2022-10-18 | 深圳果力智能科技有限公司 | 机器人及其控制方法 |
CN113206628B (zh) * | 2021-06-10 | 2023-09-05 | 大连法斯特尔机电有限责任公司 | 一种精确控制交流伺服电机转速的装置及其控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2447511A (en) * | 2007-03-14 | 2008-09-17 | Ugcs | Induction motor controller |
CN102035456A (zh) * | 2010-12-14 | 2011-04-27 | 长春工业大学 | 基于终端滑模的永磁同步电机直接转矩控制系统 |
-
2011
- 2011-11-30 CN CN2011103927896A patent/CN102510251B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2447511A (en) * | 2007-03-14 | 2008-09-17 | Ugcs | Induction motor controller |
CN102035456A (zh) * | 2010-12-14 | 2011-04-27 | 长春工业大学 | 基于终端滑模的永磁同步电机直接转矩控制系统 |
Non-Patent Citations (5)
Title |
---|
Astronautics》.2007,第24卷(第1期), * |
Chen Weidong.ROBUST ADAPTIVE CONTROL SCHEME FOE INPROVING LOW-SPEED PROFILE TRACKING PERFORMANCE OF HYBRID STEPPING MOTOR SERVO DRIVE.《Transactions of Nanjing University of Aeronautics & Astronautics》.2007,第24卷(第1期), |
Chen Weidong.ROBUST ADAPTIVE CONTROL SCHEME FOE INPROVING LOW-SPEED PROFILE TRACKING PERFORMANCE OF HYBRID STEPPING MOTOR SERVO DRIVE.《Transactions of Nanjing University of Aeronautics & * |
具有弱磁调速的轧机速度系统H∞鲁棒跟踪控制器设计;方一鸣;《中国电机工程学报》;20040531;第24卷(第5期);第100-103页 * |
方一鸣.具有弱磁调速的轧机速度系统H∞鲁棒跟踪控制器设计.《中国电机工程学报》.2004,第24卷(第5期), |
Also Published As
Publication number | Publication date |
---|---|
CN102510251A (zh) | 2012-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102510251B (zh) | 驱动复合摆头的永磁环形力矩电机的自适应鲁棒控制方法 | |
CN102497141B (zh) | 大功率交流伺服驱动器大扭矩启动方法 | |
GB2572458A (en) | An adaptive sliding-mode control method of the permanent magnet synchronous motor based on dynamic surface technology | |
CN103414419A (zh) | 基于模糊rbf网络滑模的双直线电机轮廓补偿装置与方法 | |
CN109495048A (zh) | 基于mrac观测器的永磁同步电机无速度传感器控制方法 | |
CN105159227B (zh) | 一种双轴运动平台的定位与动态轨迹跟踪控制装置及方法 | |
CN105223809A (zh) | H型平台的模糊神经网络补偿器的同步控制系统及方法 | |
CN110350840B (zh) | 一种提高永磁直线同步电动机伺服加工精度的装置及方法 | |
CN105676780B (zh) | 基于模糊小脑模型关节控制器的xy运动平台轮廓控制装置 | |
CN102033508A (zh) | 提高直接驱动xy平台轮廓加工精度方法 | |
CN106533303A (zh) | 一种永磁无刷直流电机驱动器控制方法 | |
CN106330038B (zh) | 一种基于自适应增益滑模观测器的pmlsm无传感器控制方法 | |
CN102291062A (zh) | 一种基于fpga的高精度多电机控制方法 | |
CN110868128B (zh) | 提高永磁直线同步电动机鲁棒跟踪控制精度的装置及方法 | |
CN104483897B (zh) | 一种直驱龙门式运动平台轮廓控制装置及方法 | |
CN102684577B (zh) | 永磁同步电机驱动系统的容错控制方法 | |
CN103051274A (zh) | 基于变阻尼的二自由度永磁同步电机的无源性控制方法 | |
CN103956953B (zh) | 基于滑模观测器的无刷直流电机状态估计方法 | |
CN105932918A (zh) | 高精数控机床的控制直线伺服系统运行速度的方法及装置 | |
CN106685301A (zh) | 基于改进型滑模观测器的bldcm控制系统及控制方法 | |
CN110034709B (zh) | 一种适用于表贴式永磁同步电机的转子位置估计方法 | |
CN105024612A (zh) | 一种基于参数辨识的电机电流控制方法及系统 | |
Chenxing et al. | Sensorless vector control of three-phase permanent magnet synchronous motor based on model reference adaptive system | |
CN203896241U (zh) | 基于模糊rbf网络积分滑模的双直线电机轮廓补偿装置 | |
CN111865167A (zh) | 一种基于滑模观测器的pmslm无位置传感器矢量控制方法 |
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 |
Granted publication date: 20131225 Termination date: 20151130 |
|
EXPY | Termination of patent right or utility model |