首页 / 专利库 / 电路 / 电流 / 一种基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法

一种基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法

阅读:353发布:2024-02-10

专利汇可以提供一种基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法专利检索,专利查询,专利分析的服务。并且一种基于扩张状态观测器的磁悬浮球系统预测 跟踪 控制方法,包括以下步骤:1)建立磁悬浮球系统模型;2)将通过ESO估计得到的总扰动通过前向补偿的方式消除其对系统的不利影响;3)根据预测方程获得输出预测值,并定义预测控制性能指标;4)通过将性能指标最小化,求得系统最优控制输入,完成轨迹跟踪任务。本 发明 将不可测的状态变量通过扩张状态观测器(ESO)估计得到,更符合于工程实际的应用;还可以通过ESO得到总扰动的估计值,将其通过前馈控制的方式补偿,从而提高系统的抗干扰能 力 ;MPC 控制器 可以使系统跟踪上期望轨迹。,下面是一种基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法专利的具体信息内容。

1.一种基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法,其特征在于,所述方法包括以下步骤:
1)建立磁悬浮球系统模型;
定义m为磁悬浮小球质量,g为重加速度,h为电磁表面与球之间的瞬时间隙,i为通过电磁线圈的瞬时电流,F为电磁力,u为施加到电磁线圈的受控电压,R为电磁线圈的等效电阻,L为电磁线圈的自感,K为电磁线圈的互感,则根据物理定律将磁悬浮球系统建模为:
对电磁力F(i,h)在平衡点(i0,h0)泰勒级数展开如下
F(i,h)=F(i0,h0)+ki(i-i0)+kh(h-h0)+O(i,h)           (2)
其中F(i0,h0)=mg, O(i,h)是F(i,h)的高
阶项;
于是,系统(1)改写为
令h=x1, 定义状态变量x=[x1 x2]T,磁悬浮球系统的状态空间方程表示为其中 C=[1  0],y是测量输出,
此项视为系统的总扰动,包括系统未建模动态、线性化
误差以及外部干扰;
2)扩张状态观测器的设计;
针对系统(4),将总扰动d扩张成一个新的状态变量,即x3=d,则得到的扩张状态系统表示为
其中
采样周期为Ts,则系统(4)的离散时间模型表示为
其中 Cd=C;
扩张状态系统(5)的离散时间模型表示为
其中
对系统(7)设计扩张状态观测器如下
其中 为扩张状态观测器的状态量, 为观测器估计输出,L为需
要设计的观测增益矩阵;
3)闭环控制器设计;
将上述由ESO估计得到的系统状态估计值 以及总扰动估计值 综合到系统控制器设计中;
结合式(6)和式(8),忽略总扰动d,得到名义系统的增量离散时间预测模型其中 为k+1步的状态估计值增量, 为k步的
状态估计值增量,ΔuC(k)=uC(k)-uC(k-1)为k步的控制增量;
设定预测时域为Np,控制时域为Nc且Nc≤Np,为了推导系统的预测方程,令控制时域之外的控制量不变,即ΔuC(k+i)=0,i=Nc,Nc+1,...,Np-1;
由式(9)推导出系统的输出k+i步的预测方程为
定义Np步输出预测向量和Nc步输入增量向量如下
根据式(10)、(11),系统Np步输出预测由以下预测方程计算得到
其中
定义目标函数为
J=||Γy(Yp(k+1|k)-R(k+1))||2+||ΓuΔUC(k)||2           (14)
其中Γy和Γu分别为跟踪误差和控制增量的权重矩阵,R(k+1)为期望轨迹;
将式(12)代入式(14),对ΔUC(k)求导,令 则最优控制序列 表示

其中
取最优控制序列的第一个元素作用于系统,则控制增量由下式计算
ΔuC(k)=KmpcEp(k+1|k)               (17)
其中Kmpc为预测控制增益,表示为
由式(17)得系统最优控制输入为
uC(k)=uC(k-1)+ΔuC(k)               (19)
则考虑干扰补偿的闭环控制律为
根据上述分析得基于扩张状态观测器的磁悬浮球系统预测跟踪控制过程为:
S1:由式(13)计算Sx,Su和Ι,再由式(18)计算Kmpc;
S2:在k时刻,得到ESO估计的状态量 和总扰动 计算 由式(16)计算误
差Ep(k+1|k);
S3:由式(17)计算控制增量ΔuC(k),从而通过式(19)计算得到预测控制最优控制输入uC(k),再由式(20)计算系统闭环控制律u(k);
S4:在k+1时刻,令k=k+1,返回步骤S1。

说明书全文

一种基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法

技术领域

[0001] 本发明涉及磁悬浮球系统的轨迹跟踪领域,具体涉及一种基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法,主要适用于系统部分状态不能由传感器直接测得且易受外部扰动影响的磁悬浮球系统。

背景技术

[0002] 磁悬浮是一种通过非接触模式悬挂物体的技术。该技术消除了运动部件和静止部件之间的机械接触,因此它具有无摩擦、无磨损、无噪音、寿命长等一系列优点。随着控制理论以及新型电磁材料等学科的发展,磁悬浮技术也取得了飞速发展。目前,磁悬浮技术在工业领域得到了广泛的应用,如磁悬浮列车、磁悬浮轴承、磁浮隔振器、微电子封装等。因此,磁悬浮球系统轨迹跟踪控制的研究成果,不仅为磁悬浮系统的运动控制增添了理论成果,而且为磁悬浮系统的实际应用打下坚实的基础
[0003] 模型预测控制(MPC)作为一种先进控制方法,具有控制效果好,鲁棒性强,可有效克服系统的不确定性并能显式处理系统约束等优点,然而,磁悬浮球系统是一个典型的强非线性,开环不稳定系统,在未建模动态、模型参数摄动、外加干扰和测量噪声的作用下,预测模型往往很难真实反映被控对象的实际动学模型,这很大程度上降低了预测控制的控制性能。扩张状态观测器(ESO)可以将影响被控输出的总扰动扩张成一个新的状态变量,因此将ESO估计得到的系统状态量和总扰动同模型预测控制方法相结合,可以提高磁悬浮球系统的轨迹跟踪性能和抗干扰能力。

发明内容

[0004] 为了克服磁悬浮球系统中速度信号不能由传感器直接测得以及系统不可避免受外部扰动干扰的问题,本发明提出了一种基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法,首先将模型不确定性和外部扰动视为总扰动,采用扩张状态观测器(ESO)对总扰动进行估计,并通过前向补偿的方式消除扰动的影响,提高系统的抗干扰能力。然后,对总扰动以外的名义系统采用模型预测控制方法进行优化控制,实现轨迹跟踪。
[0005] 本发明解决其技术问题所采用的技术方案是:
[0006] 一种基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法,所述方法包括以下步骤:
[0007] 1)建立磁悬浮球系统模型;
[0008] 定义m为磁悬浮小球质量,g为重力加速度,h为电磁表面与球之间的瞬时间隙,i为通过电磁线圈的瞬时电流,F为电磁力,u为施加到电磁线圈的受控电压,R为电磁线圈的等效电阻,L为电磁线圈的自感,K为电磁线圈的互感,则根据物理定律将磁悬浮球系统建模为:
[0009]
[0010] 对电磁力F(i,h)在平衡点(i0,h0)泰勒级数展开如下
[0011] F(i,h)=F(i0,h0)+ki(i-i0)+kh(h-h0)+O(i,h)    (2)
[0012] 其中F(i0,h0)=mg, O(i,h)是F(i,h)的高阶项;
[0013] 于是,系统(1)改写为
[0014]
[0015] 令h=x1, 定义状态变量x=[x1 x2]T,磁悬浮球系统的状态空间方程表示为[0016]
[0017] 其中 C=[1  0],y是测量输出,此项视为系统的总扰动,包括系统未建模动态、线性化
误差以及外部干扰;
[0018] 2)扩张状态观测器的设计;
[0019] 针对系统(4),将总扰动d扩张成一个新的状态变量,即x3=d,则得到的扩张状态系统表示为
[0020]
[0021] 其 中
[0022] 设采样周期为Ts,则系统(4)的离散时间模型表示为
[0023]
[0024] 其中 Cd=C;
[0025] 扩张状态系统(5)的离散时间模型表示为
[0026]
[0027] 其中
[0028] 对系统(7)设计扩张状态观测器如下
[0029]
[0030] 其中 为扩张状态观测器的状态量, 为观测器估计输出,L为需要设计的观测增益矩阵;
[0031] 3)闭环控制器设计;
[0032] 将上述由ESO估计得到的系统状态估计值 以及总扰动估计值 综合到系统控制器设计中;
[0033] 结合式(6)和式(8),忽略总扰动d,得到名义系统的增量离散时间预测模型[0034]
[0035] 其中 为k+1步的状态估计值增量, 为k步的状态估计值增量,ΔuC(k)=uC(k)-uC(k-1)为k步的控制增量;
[0036] 设定预测时域为Np,控制时域为Nc且Nc≤Np,为了推导系统的预测方程,令控制时域之外的控制量不变,即ΔuC(k+i)=0,i=Nc,Nc+1,...,Np-1;
[0037] 由式(9)推导出系统的输出k+i步的预测方程为
[0038]
[0039] 定义Np步输出预测向量和Nc步输入增量向量如下
[0040]
[0041] 根据式(10)、(11),系统Np步输出预测由以下预测方程计算得到[0042]
[0043] 其中
[0044]
[0045]
[0046] 定义目标函数为
[0047] J=||Γy(Yp(k+1|k)-R(k+1))||2+||ΓuΔUC(k)||2    (14)
[0048] 其中Γy和Γu分别为跟踪误差和控制增量的权重矩阵,R(k+1)为期望轨迹;
[0049] 将式(12)代入式(14),对ΔUC(k)求导,令 则最优控制序列表示为
[0050]
[0051] 其中
[0052]
[0053] 取最优控制序列的第一个元素作用于系统,则控制增量由下式计算[0054] ΔuC(k)=KmpcEp(k+1|k)    (17)
[0055] 其中Kmpc为预测控制增益,表示为
[0056]
[0057] 由式(17)得系统最优控制输入为
[0058] uC(k)=uC(k-1)+ΔuC(k)    (19)
[0059] 则考虑干扰补偿的闭环控制律为
[0060]
[0061] 根据上述分析得基于扩张状态观测器的磁悬浮球系统预测跟踪控制过程为:
[0062] S1:由式(13)计算Sx,Su和Ι,再由式(18)计算Kmpc;
[0063] S2:在k时刻,得到ESO估计的状态量 和总扰动 计算 由式(16)计算误差Ep(k+1|k);
[0064] S3:由式(17)计算控制增量ΔuC(k),从而通过式(19)计算得到预测控制最优控制输入uC(k),再由式(20)计算系统闭环控制律u(k);
[0065] S4:在k+1时刻,令k=k+1,返回步骤S1。
[0066] 本发明的技术构思为:首先将模型不确定性和外部扰动视为总扰动,采用扩张状态观测器(ESO)对总扰动进行估计,并通过前向补偿的方式消除扰动的影响,提高系统的抗干扰能力。然后,对总扰动以外的名义系统采用模型预测控制方法进行优化控制,实现轨迹跟踪。
[0067] 本发明的有益效果主要表现在:将不可测的状态变量通过扩张状态观测器(ESO)估计得到,更符合于工程实际的应用;还可以通过ESO得到总扰动的估计值,将其通过前馈控制的方式补偿,从而提高系统的抗干扰能力;MPC控制器可以使系统跟踪上期望轨迹。附图说明
[0068] 图1为磁悬浮球系统机械本体示意图,其中,1为外部支架,2为励磁电磁铁固定螺纹杆,3为励磁电磁铁,4为小铁球,5为激光位移传感器,6为激光位移传感器固定支架;
[0069] 图2为基于扩张状态观测器的磁悬浮球系统预测跟踪控制结构框图
[0070] 图3为基于扩张状态观测器的磁悬浮球系统预测跟踪控制仿真图。

具体实施方式

[0071] 下面结合附图对本发明作进一步描述。
[0072] 参照图1~图3,一种基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法,包括以下步骤:
[0073] 1)建立磁悬浮球系统模型;
[0074] 定义m为磁悬浮小球质量,g为重力加速度,h为电磁铁表面与钢球之间的瞬时间隙,i为通过电磁线圈的瞬时电流,F为电磁力,u为施加到电磁线圈的受控电压,R为电磁线圈的等效电阻,L为电磁线圈的自感,K为电磁线圈的互感,则根据物理定律可以将磁悬浮球系统建模为:
[0075]
[0076] 对电磁力F(i,h)在平衡点(i0,h0)泰勒级数展开如下
[0077] F(i,h)=F(i0,h0)+ki(i-i0)+kh(h-h0)+O(i,h)    (2)
[0078] 其中F(i0,h0)=mg, O(i,h)是F(i,h)的高阶项;
[0079] 于是,系统(1)改写为
[0080]
[0081] 令h=x1, 定义状态变量x=[x1 x2]T,磁悬浮球系统的状态空间方程表示为[0082]
[0083] 其中 C=[1  0],y是测量输出,此项视为系统的总扰动,包括了系统未建模动态、线性
化误差以及外部干扰;。
[0084] 2)扩张状态观测器的设计;
[0085] 针对系统(4),将总扰动d扩张成一个新的状态变量,即x3=d,则得到的扩张状态系统表示为
[0086]
[0087] 其中
[0088] 设采样周期为Ts,则系统(4)的离散时间模型表示为
[0089]
[0090] 其中 Cd=C;
[0091] 扩张状态系统(5)的离散时间模型表示为
[0092]
[0093] 其中
[0094] 对系统(7)设计扩张状态观测器如下
[0095]
[0096] 其中 为扩张状态观测器的状态量, 为观测器估计输出,L为需要设计的观测增益矩阵;
[0097] 3)闭环控制器设计;
[0098] 将上述由ESO估计得到的系统状态估计值 以及总扰动估计值 综合到系统控制器设计中;
[0099] 结合式(6)和式(8),忽略总扰动d,得到名义系统的增量离散时间预测模型[0100]
[0101] 其中 为k+1步的状态估计值增量, 为k步的状态估计值增量,ΔuC(k)=uC(k)-uC(k-1)为k步的控制增量;
[0102] 设定预测时域为Np,控制时域为Nc且Nc≤Np,为了推导系统的预测方程,令控制时域之外的控制量不变,即ΔuC(k+i)=0,i=Nc,Nc+1,...,Np-1;
[0103] 由式(9)推导出系统k+i步的输出预测方程为
[0104]
[0105] 定义Np步输出预测向量和Nc步输入增量向量如下
[0106]
[0107] 根据式(10)、(11),系统Np步输出预测由以下预测方程计算得到[0108]
[0109] 其中
[0110]
[0111]
[0112] 定义目标函数为
[0113] J=||Γy(Yp(k+1|k)-R(k+1))||2+||ΓuΔUC(k)||2    (14)
[0114] 其中Γy和Γu分别为跟踪误差和控制增量的权重矩阵,R(k+1)为期望轨迹;
[0115] 将式(12)代入式(14),对ΔUC(k)求导,令 则最优控制序列表示为
[0116]
[0117] 其中
[0118]
[0119] 取最优控制序列的第一个元素作用于系统,则控制增量由下式计算[0120] ΔuC(k)=KmpcEp(k+1|k)    (17)
[0121] 其中Kmpc为预测控制增益,表示为
[0122]
[0123] 由式(17)可得系统最优控制输入为
[0124] uC(k)=uC(k-1)+ΔuC(k)    (19)
[0125] 则考虑干扰补偿的闭环控制律为
[0126]
[0127] 根据上述分析得基于扩张状态观测器的磁悬浮球系统预测跟踪控制过程为:
[0128] S1:由式(13)计算Sx,Su和Ι,再由式(18)计算Kmpc;
[0129] S2:在k时刻,得到ESO估计的状态量 和总扰动 计算 由式(16)计算误差Ep(k+1|k);
[0130] S3:由式(17)计算控制增量ΔuC(k),从而通过式(19)计算得到预测控制最优控制输入uC(k),再由式(20)计算系统闭环控制律u(k);
[0131] S4:在k+1时刻,令k=k+1,返回步骤S1。
[0132] 结合图3设置Γy=[1 1 1 3 3],Γu=[0.1 0.1],仿真实验从初始状态x=[0 0]T开始,并在t=10s时加入扰动,利用基于扩张状态观测器的磁悬浮球系统预测跟踪控制方法使磁悬浮小球跟踪到指定轨迹h=0.0425m,并有效抑制扰动的影响。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈