本发明涉及电机控制器领域,具体涉及一种基于状态观测器的超声波电机伺服控制系统轮廓控制方法。
背景技术
现有的超声波电机伺服控制系统,由于轴只配备了线性或角位置编码器,它导致了只有系统的位置信息可用。然而,当系统以低速运行时其产生的速度信号往往非常嘈杂。在低速运行时,噪声很容易控制测量信号。为了避免这种情况的发生,控制系统的实践必须解决状态信息的不足,控制器的操作只能依赖于位置信息。在此部分,提出了一种基于滑动摩擦模型的输出反馈轮廓控制器设计方法。通过将状态观测器设计纳入控制方案中,整个方法可以只利用位置信息完成轮廓控制器设计,也避免了许多输出反馈设计实例中出现的设计约束。
技术实现要素:
有鉴于此,本发明的目的在于提供一种基于状态观测器的超声波电机伺服控制系统轮廓控制方法,能有效的增进系统的控制效能,并进一步减少系统对于不确定性的影响程度。
为实现上述目的,本发明采用如下技术方案:
一种基于状态观测器的超声波电机伺服控制系统轮廓控制方法,提供一种超声波电机包括控制系统、基座和设于基座上的超声波电机,所述超声波电机一侧输出轴与光电编码器相连接,另一侧输出轴与飞轮惯性负载相连接,所述飞轮惯性负载的输出轴经联轴器与力矩传感器相连接,所述光电编码器的信号输出端、所述力矩传感器的信号输出端分别接至控制系统;所述控制系统包括一基于状态观测器的轮廓控制器。
进一步的,所述控制系统包括超声波电机驱动控制电路,所述超声波电机驱动控制电路包括控制芯片电路和驱动芯片电路,所述光电编码器的信号输出端与所述控制芯片电路的相应输入端相连接,所述控制芯片电路的输出端与所述驱动芯片电路的相应输入端相连接,以驱动所述驱动芯片电路,所述驱动芯片电路的驱动频率调节信号输出端和驱动半桥电路调节信号输出端分别与所述超声波电机的相应输入端相连接。
进一步的,该方法具体实现为:
超声波电机驱动系统的动态方程可以写为:
其中ap=-b/j,bp=j/kt>0,cp=-1/j;b为阻尼系数,j为转动惯量,kt为电流因子,tf(v)为摩擦阻力力矩,tl为负载力矩,u(t)是电机的输出力矩,θr(t)为通过光电编码器测量得到的位置信号;x是电机转子的位移,
考虑一个由x轴和y轴表示的二维坐标,在轮廓误差模型的基础上,将轮廓误差εc定义为法线方向,记为
εc=-sinφ·ex+cosφ·ey(1)
相应的就具有切线方向分量,记为
εt=cosφ·ex+sinφ·ey(2)
其中,ex和ey表示x轴和y轴的轴向跟踪误差;
φ为一个随时间变化的量,用φ(t)表示;并且根据工作坐标系,通过关系式将物理坐标(x,y)中的轴向跟踪误差转换为任务坐标(εc,εt),关系式如下:
可以用矩阵表示为:
εp=tep(4)
其中εp=[εcεt]t表示轮廓误差向量;ep=[exey]t表示系统的跟踪误差向量;t表示变换矩阵;t满足单一性,可以表述为:
tt=t和t-1=t(5)
基于单一性质,公式(4)其相反式写为:
ep=tεp(6)
对方程(4)和(6)分别求一阶导数和二阶导数,其中一阶导数为:
二阶导数为:
考虑到φ(t)的时变特性,
和
轮廓控制器设计:
设定x和y轴相关的变量或参数简单地用指数i表示,其中i=1和2分别表示x和y;根据牛顿第二定律,系统的运动方程可写为:
其中p=[p1p2]t和u=[u1u2]t分别表示位置矢量和输入矢量;fr=[fr1fr2]t表示摩擦力矢量;m表示惯性矩阵,由于多级系统的非耦合性质;
然后根据滑动摩擦模型,fr可写为:
其中z=[z1z2]t表示直立变形状态向量;
z是符合下式的动态状态:
其中γ(v)是由下式定义的向量函数:
函数gi(vi)是非线性的,定义如下:
gi(vi)=[fci+(fsi-fci)exp(-(vi/vsi)2)]/σ0i(16)
fci,fsi和vsi是轴的相应正系数;gi(·)是正函数,用0<fci/σ0i≤gi(vi)≤fsi/σ0i表示;
方程(11)~(16)形成整个动力学系统,表示为:
直立挠度矢量z总是一个有界的量,定义为:
存在一个集合ωz使得如果z(0)∈ωz则有z(t)∈ωz
根据(14)和(15)的控制方程,令lyapunov函数z为vz=1/2ztz,则vz的时间导数为:
当|z1|>g1(v1)和|z2|>g2(v2)时,
根据公式(16),
g1(v1)和g2(v2)的正边界分别为0<g1(v1)≤fs1/σ01和0<g2(v2)≤fs2/σ02;
如果|z1|>fs1/σ01和|z2|>fs2/σ02,则
将上述方程从物理坐标转换到任务坐标,位置跟踪误差向量定义为ep=p-pd;
在误差动力学中,(11)中运动的系统方程为:
基于(8)的原导出转换,并在(5)中应用单式属性,则可以将上述误差动态转换为任务坐标:
方程(14)~(16)和(19)构成了整个系统动力学在任务坐标中的表述;
基于(17)中运动的摩擦方程,构造一个状态空间表示的观测器:
其中
其中矢量函数
增益l1和l2使矩阵
引入一个李雅普诺夫状态转换,新状态定义为
其中矩阵ξ=m-1σ2m-1σ1根据定义为对角矩阵;上述系统相当于由线性子系统和非线性子系统组成的互联系统,线性子系统是时不变的,表示为:
其中
非线性子系统为:
设pd是两倍时间差的轴的位置指令向量,将跟踪误差向量定义为:
通过向前推进
可以合成如下:
将上式代入方程(18),则动态跟踪误差变为
根据矩阵t的单一性质,将方程(8)中的任务坐标变换到状态的时间导数为:
通过上述关系,任务坐标中的等式(27)变换成:
设输入向量
其中kp和kv是两个常量矩阵;
根据式(31)可获取关于
而且,
将方程(30~32)代入方程(29),得出:
将方程(21)中的观察误差动力学并入,并将增量状态空间表示中的误差动态写入得:
令增益kp和kv使得矩阵
引入一个新的非奇异变换,则新的状态定义为:
这也是所有时间的lyapunov变换,则新坐标中的方程(2.34)变成:
根据上述方程的结构,系统可以被划分为两个子系统,其中一个正好是方程(23)中的观测误差系统,另一个是
根据方程(9)和(10)的定义,上述方程中的时变项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-超声波电机驱动控制电路。
具体实施方式
下面结合附图及实施例对本发明做进一步说明。
请参照图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)为通过光电编码器测量得到的位置信号;x是电机转子的位移,
考虑一个由x轴和y轴表示的二维坐标,在轮廓误差模型的基础上,将轮廓误差εc定义为法线方向,记为
εc=-sinφ·ex+cosφ·ey(1)
相应的就具有切线方向分量,记为
εt=cosφ·ex+sinφ·ey(2)
其中,ex和ey表示x轴和y轴的轴向跟踪误差;
φ为一个随时间变化的量,用φ(t)表示;并且根据工作坐标系,通过关系式将物理坐标(x,y)中的轴向跟踪误差转换为任务坐标(εc,εt),关系式如下:
可以用矩阵表示为:
εp=tep(4)
其中εp=[εcεt]t表示轮廓误差向量;ep=[exey]t表示系统的跟踪误差向量;t表示变换矩阵;t满足单一性,可以表述为:
tt=t和t-1=t(5)
基于单一性质,公式(4)其相反式写为:
ep=tεp(6)
对方程(4)和(6)分别求一阶导数和二阶导数,其中一阶导数为:
二阶导数为:
考虑到φ(t)的时变特性,
和
轮廓控制器设计:
设定x和y轴相关的变量或参数简单地用指数i表示,其中i=1和2分别表示x和y;根据牛顿第二定律,系统的运动方程可写为:
其中p=[p1p2]t和u=[u1u2]t分别表示位置矢量和输入矢量;fr=[fr1fr2]t表示摩擦力矢量;m表示惯性矩阵,由于多级系统的非耦合性质;
然后根据滑动摩擦模型,fr可写为:
其中z=[z1z2]t表示直立变形状态向量;
z是符合下式的动态状态:
其中γ(v)是由下式定义的向量函数:
函数gi(vi)是非线性的,定义如下:
gi(vi)=[fci+(fsi-fci)exp(-(vi/vsi)2)]/σ0i(16)
fci,fsi和vsi是轴的相应正系数;gi(·)是正函数,用0<fci/σ0i≤gi(vi)≤fsi/σ0i表示;
方程(11)~(16)形成整个动力学系统,表示为:
直立挠度矢量z总是一个有界的量,定义为:
存在一个集合ωz使得如果z(0)∈ωz则有z(t)∈ωz
根据(14)和(15)的控制方程,令lyapunov函数z为vz=1/2ztz,则vz的时间导数为:
当|z1|>g1(v1)和|z2|>g2(v2)时,
根据公式(16),
g1(v1)和g2(v2)的正边界分别为0<g1(v1)≤fs1/σ01和0<g2(v2)≤fs2/σ02;
如果|z1|>fs1/σ01和|z2|>fs2/σ02,则
将上述方程从物理坐标转换到任务坐标,位置跟踪误差向量定义为ep=p-pd;
在误差动力学中,(11)中运动的系统方程为:
基于(8)的原导出转换,并在(5)中应用单式属性,则可以将上述误差动态转换为任务坐标:
方程(14)~(16)和(19)构成了整个系统动力学在任务坐标中的表述;
基于(17)中运动的摩擦方程,构造一个状态空间表示的观测器:
其中
其中矢量函数
增益l1和l2使矩阵
引入一个李雅普诺夫状态转换,新状态定义为
其中矩阵ξ=m-1σ2m-1σ1根据定义为对角矩阵;上述系统相当于由线性子系统和非线性子系统组成的互联系统,线性子系统是时不变的,表示为:
其中
非线性子系统为:
因为除了后面的情况v和z被
设pd是两倍时间差的轴的位置指令向量,将跟踪误差向量定义为:
通过向前推进
可以合成如下:
将上式代入方程(18),则动态跟踪误差变为
根据矩阵t的单一性质,将方程(8)中的任务坐标变换到状态的时间导数为:
通过上述关系,任务坐标中的等式(27)变换成:
设输入向量
其中kp和kv是两个常量矩阵;
根据式(31)可获取关于
而且,
将方程(30~32)代入方程(29),得出:
将方程(21)中的观察误差动力学并入,并将增量状态空间表示中的误差动态写入得:
令增益kp和kv使得矩阵
引入一个新的非奇异变换,则新的状态定义为:
这也是所有时间的lyapunov变换,则新坐标中的方程(2.34)变成:
根据上述方程的结构,系统可以被划分为两个子系统,其中一个正好是方程(23)中的观测误差系统,另一个是
根据方程(9)和(10)的定义,上述方程中的时变项t和
以上所述仅为本发明的较佳实施例,凡依本发明申请专利范围所做的均等变化与修饰,皆应属本发明的涵盖范围。