一种基于PID控制器的稳定平台控制方法及装置转让专利

申请号 : CN201610458212.3

文献号 : CN105867138B

文献日 :

基本信息:

PDF:

法律信息:

相似专利:

发明人 : 张兰勇耿文杰刘胜李冰刘洪丹杜逸璇曹岸

申请人 : 哈尔滨工程大学

摘要 :

本发明公开了一种基于PID控制器的稳定平台控制方法及装置,包括步骤:建立被控对象的广义预测算法控制模型;获取被控对象的历史和未来的输入信息,根据输入信息经广义预测算法控制模型计算得出输出信息;根据输入信息和输出信息进行多步骤的输出预测;根据预测结果设置目标函数计算得到最优控制率;根据最优控制率,基于隐式预测的自动校正算法进行自动校正。该装置包括用于建立模型单元;获取输出单元;多步输出单元;设置函数单元;自动校正单元。本发明提高了系统鲁棒性,对控制量加权,输出误差的二次性能高,隐式方式可直接辨识控制规律的参数,解决了运算量和运算时间的问题。

权利要求 :

1.一种基于PID控制器的稳定平台控制方法,其特征在于,包括:步骤A,建立被控对象的广义预测算法控制模型;

步骤B,获取被控对象的历史和未来的输入信息,根据所述输入信息经所述广义预测算法控制模型计算得出输出信息;

步骤C,根据所述输入信息和输出信息进行多步骤的输出预测;

步骤D,根据预测结果设置目标函数,将目标函数对未来控制量ΔU(k)求导,目的是使得目标函数最小,进而计算得到最优控制率;

步骤E,根据所述最优控制率,基于隐式预测的自动校正算法进行自动校正;

步骤E基于隐式预测的自动校正算法进行自动校正步骤如下:步骤E1,设置隐式预测自动校正控制算法的矢量矩阵计算表达式,如下:Yp(k+1)=GΔU(k)+FΔU(k-1)+S(z-1)y(k)+Rj(z-1)ε(k+j)-1 -1

将公式Yp(k+1)=GΔU(k)+FΔU(k-1)+S(z )y(k)+Rj(z )ε(k+j)展开,得公式y(k+1)=g0Δuf(k)+E1(z-1)Δu(k-1)+S1(z-1)y(k)+R1(z-1)ε(k+1)y(k+2)=g1Δuf(k)+g0Δuf(k+1)+E2(z-1)Δu(k-1)+S2(z-1)y(k)+R2(z-1)ε(k+2)y(k+p)=gp-1Δuf(k)+gp-2Δuf(k+1)+…+g0Δuf(k+P-1)+EP(z-1)Δu(k-1)+Sp(z-1)y(k)+Rp(z-1)ε(k+P)步骤E2,将F(z-1),G(z-1)辨识出,求解公式f(k+p)=FP(z-1)+SP(z-1)y(k)步骤E3,取公式

y(k+1)=g0Δuf(k)+E1(z-1)Δu(k-1)+S1(z-1)y(k)+R1(z-1)ε(k+1)y(k+2)=g1Δuf(k)+g0Δuf(k+1)+E2(z-1)Δu(k-1)+S2(z-1)y(k)+R2(z-1)ε(k+2)y(k+p)=gp-1Δuf(k)+gp-2Δuf(k+1)+…+g0Δuf(k+P-1)+EP(z-1)Δu(k-1)+Sp(z-1)y(k)+Rp(z-1)ε(k+P)的最后一行公式,如公式y(k+P)=gP-1Δuf(k)+gP-2Δuf(k+1)+...+g0Δuf(k+p-1)+EP(z-1)Δu(k-1)+SP(z-1)y(k)+RP(z-1)ε(k+P)公式中,

式中, 是根据系统过去和当前的监测值{y(k),u(k)}确定的,右边的噪声Rj(z-1)ε(k+j)参数包括的是系统未来时刻的随机干扰;

步骤E4, 正交,求得最优预测值为输出预测值;

得辨识方程为公式

步骤E5,采用公式 计算最小二乘辨识,辨识出 最后得 即公式

求得

步骤E6将公式

y(k+1)=g0Δuf(k)+E1(z-1)Δu(k-1)+S1(z-1)y(k)+R1(z-1)ε(k+1)y(k+2)=g1Δuf(k)+g0Δuf(k+1)+E2(z-1)Δu(k-1)+S2(z-1)y(k)+R2(z-1)ε(k+2)y(k+p)=gp-1Δuf(k)+gp-2Δuf(k+1)+…+g0Δuf(k+P-1)-1 -1 -1

EP(z )Δu(k-1)+Sp(z )y(k)+Rp(z )ε(k+P)的前P-1行,改写为预测的输出值即为公式

步骤E7,由控制率公式

得出,当(k-1)时刻,求出一系列控制律函数Δu(k),Δu(k+1),Δu(k+p-2),在k时刻Δu(k+i-1)(i=1,2,3…P-1)是已知的,同时在每个时刻k都可以求解P步预测值,如公式可由公式

计算求得,得到控制器的所有参数;

2.如权利要求1所述一种基于PID控制器的稳定平台控制方法,其特征在于,步骤A中所述建立被控对象的广义预测算法控制模型包括建立CARIMA模型的差分方程:A(z-1)y(t)=B(z-1)u(t-1)+C(z-1)ε(t)/Δ式中,A(z-1)、B(z-1)、C(z-1),都是后移算子z-1的多项式,如下:

2 -1

其中,y是系统输出,u是系统输入,ε是均值为零、方差为σ的噪声,Δ=1-z 是差分算子;

对公式A(z-1)y(t)=B(z-1)u(t-1)+C(z-1)ε(t)/Δ进行简化,用Δ乘以两边得到公式其中

3.如权利要求2所述的一种基于PID控制器的稳定平台控制方法,其特征在于,步骤C根据所述输入信息和输出信息进行多步骤的输出预测包括步骤:引入Diophantine方程,选用直到K时刻的输入输出数据,经过下列公式运算,预测K+1时刻的系统输出:步骤C1,

公式 中的R(z-1),

如下述公式:

degRj=j-1;

degSj=na;

步骤C2,用Rj(z-1)乘以公式得公式

步骤C3,将公式 带入公式

简化后可得公式

其中:

degGj=j-1

步骤C4,前两项为预测优化,第三项为误差预测,如公式y(k+j)=yp((k+j)/k)+Rj(z-1)ε(k+j)在j步骤前的最优化的预测为

式中参数说明:

j,预测的步骤(j=1,2…,P);

P,最大的预测时域长度;

当预测时域长度j从1取值直到P时,多步的预测输出值都可以利用上述公式求取:步骤C5,现在和未来待求的控制量部分过去的已知部分,相当于初值

Yp(k+1)=GΔU(k)+F0ΔU(k-1)+S(z-1)y(k)其中,

Yp(k+1)=[yp((k+1)/k),yp((k+2)/k),…yp((k+p)k)]TT

ΔU(k)=[Δu(k),Δu(k+1),…Δu(k+p-1)]ΔU(k-1)=[Δu(k-nb),Δu(k-nb+1),…Δu(k-1)]TS(z-1)=[S1(z-1),S2(z-1)…Sp(z-1)]T

4.如权利要求3所述一种基于PID控制器的稳定平台控制方法,其特征在于,所述步骤D包括步骤:步骤D1,

公式参数说明:

p,最大的预测时域长度;

N1,最小的预测长度;

M,控制时域长度;

λ,控制增量加权与输出预测误差系数;

yr(k+1),输入参考轨迹,

步骤D2,对假定值柔化处理,获取的参考轨迹,如公式yr(k+1)=ary(k)+(1+ar)yr(j=1,2…)yr(k+j)=ary(k)+(1-ar)yr(j=1,2,…)参数说明:

yr,假定值;

y(k),输出值;

yr(k+j),参考轨迹;

a,柔化系数,0

步骤D3,将公式

变成矢量的形式,得公

式:

Jp=E[Y(k+1)-Yr(k+j)]T[Y(k+1)-Yr(k+j)]+ΔUT(k)ΔU(k)步骤D4,把公式

预测方程代入公式Jp

T T

=E[Y(k+1)-Yr(k+j)][Y(k+1)-Yr(k+j)]+ΔU(k)ΔU(k)得公式Jp=E{[GΔU(k)+FaΔU(k-1)+S(z-1)y(k)+ε(k+1)-Yr(k+1)]T[GΔU(k)+FaΔU(k-1)+S(z-1)y(k)+ε(k+1)-Yr(k+1)-Yr(k+1)]+ΔUT(k)ΔU(k)}参数说明:T

Y(k+1)=[y(k+1),y(k+2),…,y(k+p)]Yr(k+1)=[yr(k+1),yr(k+2),…,yr(k+p)]TΔU(k)=[Δu(k),Δu(k+1),…,Δu(k+M-1)]Tε(k+1)=[R1(z-1)ε(k+1),R2(z-1)ε(k+2),…,Rp(z-1)ε(k+p)]Tλ=diag(λ1,λ2,…,λM)控制时域长度,取值M

Jp=E{[GΔU(k)+FaΔU(k-1)+S(z-1)y(k)+ε(k+1)-Yr(k+1)]T[GΔU(k)+FaΔU(k-1)+S(z-1)y(k)+ε(k+1)-Yr(k+1)-Yr(k+1)]+ΔUT(k)ΔU(k)}对未来控制量ΔU[k]求导,并令其等于零,得最优控制率为公式ΔU[k]=(GTG+λ)-1GT[Yr(k+1)-F0ΔU(k-1)-S(z-1)y(k)]。

5.一种基于PID控制器的稳定平台控制装置,其特征在于,包括:用于建立被控对象的广义预测算法控制模型的建立模型单元;

用于获取被控对象的历史和未来的输入信息,根据输入信息经广义预测算法控制模型计算得出输出信息的获取输出单元;

用于根据所述输入信息和输出信息进行多步骤的输出预测的多步输出单元;

用于根据预测结果设置目标函数计算得到最优控制率的设置函数单元;

用于根据所述最优控制率,基于隐式预测的自动校正算法进行自动校正的自动校正单元;

基于隐式预测的自动校正算法进行自动校正步骤如下:步骤E1,设置隐式预测自动校正控制算法的矢量矩阵计算表达式,如下:Yp(k+1)=GΔU(k)+FΔU(k-1)+S(z-1)y(k)+Rj(z-1)ε(k+j)将公式Yp(k+1)=GΔU(k)+FΔU(k-1)+S(z-1)y(k)+Rj(z-1)ε(k+j)展开,得公式y(k+1)=g0Δuf(k)+E1(z-1)Δu(k-1)+S1(z-1)y(k)+R1(z-1)ε(k+1)-1 -1 -1

y(k+2)=g1Δuf(k)+g0Δuf(k+1)+E2(z )Δu(k-1)+S2(z )y(k)+R2(z )ε(k+2)y(k+p)=gp-1Δuf(k)+gp-2Δuf(k+1)+...+g0Δuf(k+P-1)+EP(z-1)Δu(k-1)+Sp(z-1)y(k)+Rp(z-1)ε(k+P)步骤E2,将F(z-1),G(z-1)辨识出,求解公式-1 -1

f(k+p)=FP(z )+SP(z )y(k)步骤E3,取公式

y(k+1)=g0Δuf(k)+E1(z-1)Δu(k-1)+S1(z-1)y(k)+R1(z-1)ε(k+1)y(k+2)=g1Δuf(k)+g0Δuf(k+1)+E2(z-1)Δu(k-1)+S2(z-1)y(k)+R2(z-1)ε(k+2)y(k+p)=gp-1Δuf(k)+gp-2Δuf(k+1)+…+g0Δuf(k+P-1)+EP(z-1)Δu(k-1)+Sp(z-1)y(k)+Rp(z-1)ε(k+P)的最后一行公式,如公式y(k+P)=gP-1Δuf(k)+gP-2Δuf(k+1)+...+g0Δuf(k+p-1)+EP(z-1)Δu(k-1)+SP(z-1)y(k)+RP(z-1)ε(k+P)公式中,

式中, 是根据系统过去和当前的监测值{y(k),u(k)}确定的,右边的噪声Rj(z-1)ε(k+j)参数包括的是系统未来时刻的随机干扰;

步骤E4, 正交,求得最优预测值为输出预测值;

得辨识方程为公式

步骤E5,采用公式 计算最小二乘辨识,辨识出 最后得 即公式

求得

步骤E6将公式

y(k+1)=g0Δuf(k)+E1(z-1)Δu(k-1)+S1(z-1)y(k)+R1(z-1)ε(k+1)y(k+2)=g1Δuf(k)+g0Δuf(k+1)+E2(z-1)Δu(k-1)+S2(z-1)y(k)+R2(z-1)ε(k+2)y(k+p)=gp-1Δuf(k)+gp-2Δuf(k+1)+…+g0Δuf(k+P-1)+EP(z-1)Δu(k-1)+Sp(z-1)y(k)+Rp(z-1)ε(k+P)的前P-1行,改写为预测的输出值即为公式

步骤E7,由控制率公式

得出,当(k-1)时刻,求出

一系列控制律函数Δu(k),Δu(k+1),Δu(k+p-2),在k时刻Δu(k+i-1)(i=1,2,3...P-1)是已知的,同时在每个时刻k都可以求解P步预测值,如公式可由公式

计算求得,得到控制器的所有参数;

说明书 :

一种基于PID控制器的稳定平台控制方法及装置

技术领域

[0001] 本发明涉及稳定平台的控制技术,特别涉及一种基于PID控制器的稳定平台控制方法及装置。

背景技术

[0002] 船用稳定平台控制技术具有广泛的军用价值,民用价值和商用价值。当舰船在海浪中航行时,由于海浪的作用,船体出现不稳定的摇摆,这样会使船体上的装载设备不能处于稳定的水平状态而无法正常工作,船用水平稳定平台就是用来保障安装在平台上的负载装置,能够在与水平面平行的平台上正常工作。
[0003] 通常,选用PID(全称为Proportion Integration Differentiation)作为调节器的伺服控制系统,具有原理简单、高鲁棒性和高适用性等诸多优点。近几年,为了达到对系统模型复杂度降低、在线计算简便、增强适应外界扰动能力等要求,接连出现了一些控制算法,例如:广义预测控制算法,广义预测控制算法是基于计算机为媒介来实现的,所以建立其数学模型、推导其控制算法,是基于离散的空间和时间的,首先预测模型建立很方便,再者采用在线持续优化的方法,这是与传统最优控制算法的最大区别,最后采用基于模型的误差反馈闭环优化。
[0004] 但是广义预测控制算法的显示预测方式适用于被控参数的数值变慢或为未知数的情况,其求解控制规律参数的过程是获取对象的模型参数并计算,这个过程采用最小递推二乘法进行在线估算,需要很大的运算量和运算时间。

发明内容

[0005] 本发明的目的是提供一种实时的最优控制技术,用于对稳定平台的实时控制。
[0006] 为实现上述目的,本发明提供了如下方案:
[0007] 一种基于PID控制器的稳定平台控制方法,包括步骤:
[0008] 步骤A,建立被控对象的广义预测算法控制模型;
[0009] 步骤B,获取被控对象的历史和未来的输入信息,根据输入信息经广义预测算法控制模型计算得出输出信息;
[0010] 步骤C,根据输入信息和输出信息进行多步骤的输出预测;
[0011] 步骤D,根据预测结果设置目标函数计算得到最优控制率;
[0012] 步骤E,根据最优控制率,基于隐式预测的自动校正算法进行自动校正。
[0013] 可选的,步骤A中步骤建立被控对象的的广义预测算法控制模型包括建立CARIMA模型的差分方程:
[0014] A(z-1)y(t)=B(z-1)u(t-1)+C(z-1)ε(t)/Δ
[0015] 式中,A(z-1)、B(z-1)、C(z-1),都是后移算子z-1的多项式,如下:
[0016]
[0017]
[0018]
[0019] 其中,y是系统输出,u是系统输入,ε是均值为零、方差为σ2的噪声,Δ=1-z-1是差分算子;
[0020] 对公式A(z-1)y(t)=B(z-1)u(t-1)+C(z-1)ε(t)/Δ进行简化,用Δ乘以两边得到公式
[0021] 其中
[0022] 可选的,步骤C根据所述输入信息和输出信息进行多步骤的输出预测包括步骤:引入Diophantine方程,选用直到K时刻的输入输出数据,经过下列公式运算,预测K+1时刻的系统输出:
[0023] 步骤C1,
[0024] 公式 中的R(z-1),
[0025] 如下述公式:
[0026]
[0027]
[0028] degRj=j-1;
[0029] degSj=na;
[0030] 步骤C2,用Rj(z-1)乘以公式 得公式
[0031]
[0032] 步骤C3,将公式 带入公式
[0033]
[0034] 简化后可得公式
[0035]
[0036] 其中:
[0037]
[0038]
[0039] deg Gj=j-1
[0040] 步骤C4,将前两项看做预测优化,第三项为误差预测,如公式
[0041] y(k+j)=yp((k+j)/k)+Rj(z-1)ε(k+j)
[0042] 在j步骤前的最优化的预测为
[0043]
[0044] 式中参数说明:
[0045] j,预测的步骤(j=1,2…,P);
[0046] P,最大的预测时域长度。
[0047] 当预测时域长度j从1取值直到P时,多步的预测输出值都可以利用上述公式求取:
[0048]
[0049] 步骤C5,现在和未来待求的控制量部分
[0050]
[0051] 过去的已知部分,相当于初值
[0052]
[0053] Yp(k+1)=GΔU(k)+F0ΔU(k-1)+S(z-1)y(k)
[0054] 其中,
[0055] Yp(k+1)=[yp((k+1)/k),yp((k+2)/k),…yp((k+p)/k)]T
[0056] ΔU(k)=[Δu(k),Δu(k+1),…Δu(k+p-1)]T
[0057] ΔU(k-1)=[Δu(k-nb),Δu(k-nb+1),…Δu(k-1)]T
[0058] S(z-1)=[S1(z-1),S2(z-1)…Sp(z-1)]T
[0059]
[0060]
[0061] 可选的,步骤D,根据预测结果设置目标函数计算得到最优控制率,步骤如下:
[0062] 步骤D1,
[0063] 公式参数说明:
[0064] p,最大的预测时域长度;
[0065] N1,最小的预测长度;
[0066] M,控制时域长度;
[0067] λ,控制增量加权与输出预测误差系数;
[0068] yr(k+1),输入参考轨迹,
[0069] 步骤D2,对假定值柔化处理,获取的参考轨迹,如公式
[0070] yr(k+1)=ary(k)+(1+ar)yr (j=1,2…)
[0071] 参数说明:
[0072] yr,假定值;
[0073] y(k),输出值;
[0074] yr(k+j),参考轨迹;
[0075] a,柔化系数,0
[0076] 令被控对象的输出值无限趋近于设定值,使目标函数达到最小值,通过优化求取Δu(k),Δu(k+1),Δu(k+m-1)。
[0077] 步骤D3,将公式 变成矢量的形式,得公式:
[0078] Jp=E[Y(k+1)-Yr(k+j)]T[Y(k+1)-Yr(k+j)]+ΔUT(k)ΔU(k)
[0079] 步骤D4,把公式 预测方程代入T T
公式Jp=E[Y(k+1)-Yr(k+j)][Y(k+1)-Yr(k+j)]+ΔU(k)ΔU(k)得公式
[0080] Jp=E{[GΔU(k)+FaΔU(k-1)+S(z-1)y(k)+ε(k+1)-Yr(k+1)]T [GΔU(k)+FaΔU(k-1)+S(z-1)y(k)+ε(k+1)-Yr(k+1)-Yr(k+1)]+ΔUT(k)ΔU(k)}
[0081] 参数说明:
[0082] Y(k+1)=[y(k+1),y(k+2),…,y(k+p)]T
[0083] Yr(k+1)=[yr(k+1),yr(k+2),…,yr(k+p)]T
[0084] ΔU(k)=[Δu(k),Δu(k+1),…,Δu(k+M-1)]T
[0085] ε(k+1)=[R1(z-1)ε(k+1),R2(z-1)ε(k+2),…,Rp(z-1)ε(k+p)]T[0086] λ=diag(λ1,λ2,…,λM)
[0087] 控制时域长度,取值M
[0088]
[0089] 步骤D4,把公式
[0090] Jp=E{[GΔU(k)+FaΔU(k-1)+S(z-1)y(k)+ε(k+1)-Yr(k+1)]T [GΔU(k)+FaΔU(k--1 T1)+S(z )y(k)+ε(k+1)-Yr(k+1)-Yr(k+1)]+ΔU (k)ΔU(k)}对未来控制量ΔU[k]求导,并令其等于零,得最优控制率为公式
[0091] ΔU[k]=(GTG+λ)-1GT[Yr(k+1)-F0ΔU(k-1)-S(z-1)y(k)]。
[0092] 可选的,步骤E基于隐式预测的自动校正算法进行自动校正步骤如下:
[0093] 步骤E1,设置隐式预测自动校正控制算法的矢量矩阵计算表达式,如下:
[0094] Yp(k+1)=GΔU(k)+FΔU(k-1)+S(z-1)y(k)+Rj(z-1)ε(k+j)
[0095] 将公式Yp(k+1)=GΔU(k)+FΔU(k-1)+S(z-1)y(k)+Rj(z-1)ε(k+j)展开,得公式[0096] y(k+1)=g0Δuf(k)+E1(z-1)Δu(k-1)+S1(z-1)y(k)+R1(z-1)ε(k+1)[0097] y(k+2)=g1Δuf(k)+g0Δuf(k+1)+E2(z-1)Δu(k-1)+S2(z-1)y(k)+R2(z-1)ε(k+2)[0098] y(k+p)=gp-1Δuf(k)+gp-2Δuf(k+1)+…+g0Δuf(k+P-1) +EP(z-1)Δu(k-1)+Sp(z-1)y(k)+Rp(z-1)ε(k+P)
[0099] 步骤E2,将F(z-1),G(z-1)辨识出,求解公式
[0100] f(k+p)=FP(z-1)+SP(z-1)y(k)
[0101] 步骤E3,取公式
[0102] y(k+1)=g0Δuf(k)+E1(z-1)Δu(k-1)+S1(z-1)y(k)+R1(z-1)ε(k+1)[0103] y(k+2)=g1Δuf(k)+g0Δuf(k+1)+E2(z-1)Δu(k-1)+S2(z-1)y(k)+R2(z-1)ε(k+2)[0104] y(k+p)=gp-1Δuf(k)+gp-2Δuf(k+1)+…+g0Δuf(k+P-1) +EP(z-1)Δu(k-1)+Sp(z-1)y(k)+Rp(z-1)ε(k+P)的最后一行公式,如公式
[0105] y(k+P)=gP-1Δuf(k)+gP-2Δuf(k+1)+…+g0Δuf(k+p-1) +EP(z-1)Δu(k-1)+SP(z-1)y(k)+RP(z-1)ε(k+P)
[0106] 公式中,
[0107]
[0108]
[0109] 式中, 是根据系统过去和当前的监测值{y(k),u(k)}确定的,右边的噪声Rj(z-1)ε(k+j)参数包括的是系统未来时刻的随机干扰;
[0110] 步骤E4, 正交,求得最优预测值为输出预测值;
[0111] 或
[0112] 得辨识方程为公式
[0113]
[0114] 步骤E5,采用公式 计算最小二乘辨识,辨识出最后得 即公式
[0115]
[0116] 求得
[0117]
[0118] 步骤E6将公式y(k+1)=g0Δuf(k)+E1(z-1)Δu(k-1)+S1(z-1)y(k)+R1(z-1)ε(k+1)[0119] y(k+2)=g1Δuf(k)+g0Δuf(k+1)+E2(z-1)Δu(k-1)+S2(z-1)y(k)+R2(z-1)ε(k+2)[0120] y(k+p)=gp-1Δuf(k)+gp-2Δuf(k+1)+…+g0Δuf(k+P-1) +EP(z-1)Δu(k-1)+Sp(z-1 -1)y(k)+Rp(z )ε(k+P)的前P-1行,改写为
[0121]
[0122] 预测的输出值即为公式
[0123]
[0124] 步骤E7,由控制率公式 得出,当 (k-1)时刻,求出一系列控制律函数Δu(k),Δu(k+1),Δu(k+p-2),在k时刻Δu(k+i-1)(i=1,
2,3…P-1)是已知的,同时在每个时刻k都可以求解P步预测值,如公式
[0125]
[0126] 可由公式 计算求得,得到控制器的所有参数;
[0127]
[0128] 一种基于PID控制器的稳定平台控制装置,包括:用于建立被控对象的广义预测算法控制模型的建立模型单元;
[0129] 用于获取被控对象的历史和未来的输入信息,根据输入信息经广义预测算法控制模型计算得出输出信息的获取输出单元;
[0130] 用于根据所述输入信息和输出信息进行多步骤的输出预测的多步输出单元;
[0131] 用于根据预测结果设置目标函数计算得到最优控制率的设置函数单元;
[0132] 用于根据所述最优控制率,基于隐式预测的自动校正算法进行自动校正的自动校正单元。
[0133] 本发明的有益效果:
[0134] 1.原理上采用近来的先进算法思想。
[0135] 1)广义预测算法预测模型建立方便,可以根据对象的未来输入和历史信息预测未来输出,传统的传递函数等可作为预测模型,使得建模较为方便。
[0136] 2)是一种实时的处理方式,采用在线优化,不采用批处理的方法,使得数据实时评估,确保信息的准确性。
[0137] 3)信息误差的闭环控制,用实际检测到的信息进行调整广义预测算法,对未来误差做出预测的同时进行补偿,持续进行优化,使得最终的预测输出更加准确。
[0138] 2.模型的实际预测体系合理性更强。
[0139] 1)建立数学预测模型之后,采用多步骤的输出预测,选用直到K时刻的输入输出数据,得到预测的K+1时刻的系统输出。
[0140] 2)预测输出时,不考虑对系统有影响的未来噪声,最终结果中,有优化项也有误差项,使误差项最小,得到控制量的影响,即得到最优控制率的结果。
[0141] 3)采用隐式自校正器,包括有两种方式,显示预测和隐式预测,显示预测用在被控参数变慢或者是未知数的情况,而且其采用最小二乘递推进行在线估计,运算量大,耗费时间长。隐式预测可以直接识别控制规律和参数,解决运算量和运算时间的问题。
[0142] 3.仿真分析验证。实际过程中,系统模型中的伺服系统由于受到船舶的持续不确定的干扰,而使得模型变为慢时变系统,此时广义预测算法更适于跟踪慢时变系统,最终给出了预测的仿真结果。

附图说明

[0143] 为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
[0144] 图1为本发明一种基于PID控制器的稳定平台控制方法及装置的流程示意图;
[0145] 图2为本发明一种基于PID控制器的稳定平台控制方法及装置的伺服控制系统的控制结构仿真模型;
[0146] 图3为本发明一种基于PID控制器的稳定平台控制方法及装置的方波信号及其误差跟踪曲线图;
[0147] 图4为本发明一种基于PID控制器的稳定平台控制方法及装置的方波信号的系统误差曲线图;
[0148] 图5为本发明一种基于PID控制器的稳定平台控制方法及装置的正弦信号及其跟踪曲线图
[0149] 图6为本发明一种基于PID控制器的稳定平台控制方法及装置的正弦信号的系统误差曲线图;
[0150] 图7为本发明一种基于PID控制器的稳定平台控制方法及装置的广义预测控制算法的方波信号跟踪参数设置对话框1;
[0151] 图8为本发明一种基于PID控制器的稳定平台控制方法及装置的方波信号跟踪参数设置对话框2;
[0152] 图9为本发明一种基于PID控制器的稳定平台控制方法及装置的正弦信号跟踪参数设置对话框1;
[0153] 图10为本发明一种基于PID控制器的稳定平台控制方法及装置的正弦信号跟踪参数设置对话框2;
[0154] 图11为本发明一种基于PID控制器的稳定平台控制方法及装置的方波信号参数设置对话框
[0155] 图12为本发明一种基于PID控制器的稳定平台控制方法及装置的广义预测控制算法的正弦信号参数设置对话框;
[0156] 图13为本发明一种基于PID控制器的稳定平台控制方法及装置的方波仿真跟踪特性曲线;
[0157] 图14为本发明一种基于PID控制器的稳定平台控制方法及装置的仿真的正弦信号跟踪曲线;
[0158] 图15为本发明一种基于PID控制器的稳定平台控制方法及装置的广义预测控制算法的仿真图。

具体实施方式

[0159] 下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
[0160] 为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
[0161] 实施例一
[0162] 本发明提供了一种基于PID控制器的稳定平台控制方法,所述方法包括以下步骤:
[0163] 首先建立广义预测控制算法的数学模型,预测模型具有预测功能,根据测到的对象的历史信息与未来的输入信息经过控制算法后,得出未来的输出。然后在进行多步骤的输出预测,不考虑对系统有影响的未来噪声,只着重考虑优化预测部分。为提高系统鲁棒性,GPC(Generalized Predictive Control,广义预测控制)为了提高对控制量加权、输出误差的二次性能,考虑到目标函数中,现在时刻的控制影响系统未来的时刻。同时该控制方法采用隐式预测的方法,可以减少计算量,直接辨识控制规律的参数,又称为隐式预测的自校正器。
[0164] 参见图1所示,包括:
[0165] 步骤S101,建立被控对象的广义预测算法控制模型;
[0166] 步骤S102,获取被控对象的历史和未来的输入信息,根据所述输入信息经所述广义预测算法控制模型计算得出输出信息;
[0167] 步骤S103,根据所述输入信息和输出信息进行多步骤的输出预测;
[0168] 步骤S104,根据预测结果设置目标函数计算得到最优控制率;
[0169] 步骤S105,根据所述最优控制率,基于隐式预测的自动校正算法进行自动校正。
[0170] 实施例二
[0171] 步骤S201、建立被控对象的数学模型,也就是CARIMA模型的差分方程。 A(z-1)y(t)=B(z-1)u(t-1)+C(z-1)ε(t)/Δ   (1-1)
[0172] 式中,A(z-1)、B(z-1)、C(z-1),都是后移算子z-1的多项式,如下:
[0173]
[0174]
[0175] 式中参数说明,y是系统输出,u是系统输入,ε是均值为零、方差为σ2的噪声,Δ=1-z-1是差分算子;
[0176] 对公式(1-1)进行简化,用Δ乘以两边得公式(1-2)
[0177]
[0178] 公式(1-2)中的 如公式(1-3)
[0179] 其中
[0180] 步骤S202多步骤的输出预测,即以预测理论为依据,并引入Diophantine 方程,选用直到K时刻的输入输出数据,经过公式(2-1)运算,可以预测K+1 时刻的系统输出。
[0181]
[0182] 公式(2-1)中的R(z-1),如下述公式:
[0183]
[0184]
[0185] degRj=j-1
[0186] degSj=na
[0187] ②用Rj(z-1)乘以公式 可得公式 (2-2);
[0188]
[0189] ③将公式(2-1)带入公式(2-2),简化后可得公式(2-3):
[0190]
[0191] 公式(2-3)中
[0192]
[0193]
[0194] degGj=j-1
[0195] ④因为是预测未来的输出,所以可以不考虑会对系统有影响的未来噪声,将前两项看做预测优化的话,可以的第三项为误差预测,如公式(2-4)。
[0196] y(k+j)=yp((k+j)/k)+Rj(z-1)ε(k+j)   (2-4)
[0197] 所以,在j步骤前的最优化的预测为
[0198]
[0199] 式中参数说明:
[0200] j,预测的步骤(j=1,2…,P);
[0201] P,最大的预测时域长度。
[0202] 当预测时域长度j从1取值直到P时,多步的预测输出值都可以利用上述公式求取:
[0203]
[0204] ⑤现在和未来待求的控制量部分
[0205]
[0206] 过去的已知部分,相当于初值
[0207]
[0208] Yp(k+1)=GΔU(k)+F0ΔU(k-1)+S(z-1)y(k)   (2-7)
[0209] 公式(4-17)中参数说明:
[0210] Yp(k+1)=[yp((k+1)/k),yp((k+2)/k),…yp((k+p)/k)]T   (2-8)[0211] ΔU(k)=[Δu(k),Δu(k+1),…Δu(k+p-1)]T   (2-9)
[0212] ΔU(k-1)=[Δu(k-nb),Δu(k-nb+1),…Δu(k-1)]T   (2-10)
[0213] S(z-1)=[S1(z-1),S2(z-1)…Sp(z-1)]T
[0214]
[0215]
[0216] 公式(2-7)为,当j=1到p时,多步预测输出的计算公式。
[0217] 步骤S203目标函数的处理,为提高系统鲁棒性,GPC为了提高对控制量加权、输出误差的二次性能,考虑到目标函数中,现在时刻的控制影响系统未来的时刻,目标函数如公式(3-1)
[0218]
[0219] 公式(4-23)参数说明:
[0220] p,最大的预测时域长度;
[0221] N1,最小的预测长度;
[0222] M,控制时域长度;
[0223] λ,控制增量加权与输出预测误差系数;
[0224] yr(k+1),输入参考轨迹。
[0225] ②对假定值柔化处理,获取的参考轨迹,如公式(3-2)。
[0226] yr(k+1)=ary(k)+(1+ar)yr (j=1,2…)   (3-2)
[0227] 公式(3-2)参数说明:
[0228] yr,假定值;
[0229] y(k),输出值;
[0230] yr(k+j),参考轨迹;
[0231] a,柔化系数,0
[0232] 广义预测控制的任务是,令被控对象的输出值无限趋近于设定值;广义预测控制的问题是,使目标函数达到最小值,就需要通过优化求取Δu(k),Δu(k+1),Δu(k+m-1)。
[0233] ③将公式(3-1)变成矢量的形式,可得公式(3-3):
[0234] Jp=E[Y(k+1)-Yr(k+j)]T[Y(k+1)-Yr(k+j)]+ΔUT(k)ΔU(k)   (3-3)[0235] ④把公式(2-5),即预测方程代入公式(3-3)得公式(3-4)。
[0236] Jp=E{[GΔU(k)+FaΔU(k-1)+S(z-1)y(k)+ε(k+1)-Yr(k+1)]T [GΔU(k)+FaΔU(k-1)+S(z-1)y(k)+ε(k+1)-Yr(k+1)-Yr(k+1)]+ΔUT(k)ΔU(k)} (3-4)
[0237] 公式(3-4)参数说明:
[0238] Y(k+1)=[y(k+1),y(k+2),…,y(k+p)]T   (3-5)
[0239] Yr(k+1)=[yr(k+1),yr(k+2),…,yr(k+p)]T   (3-6)
[0240] ΔU(k)=[Δu(k),Δu(k+1),…,Δu(k+M-1)]T   (3-7)
[0241] ε(k+1)=[R1(z-1)ε(k+1),R2(z-1)ε(k+2),…,Rp(z-1)ε(k+p)]T   (3-8)[0242] λ=diag(λ1,λ2,…,λM)
[0243] 因为控制时域长度,取值M
[0244]
[0245] ⑤把公式(3-4)对未来控制量ΔU[k]求导,并令其等于零,可得最优控制率为公式(3-10)
[0246] ΔU[k]=(GTG+λ)-1GT[Yr(k+1)-F0ΔU(k-1)-S(z-1)y(k)]   (3-10)[0247] 步骤S204隐式预测的自校正器。该广义预测算法采用隐式预测方式,可直接辨识控制规律的参数。
[0248] ①隐式预测自动校正控制算法的矢量矩阵计算表达式:
[0249] Yp(k+1)=GΔU(k)+FΔU(k-1)+S(z-1)y(k)+Rj(z-1)ε(k+j)   (4-1)[0250] 将公式(4-1)展开,可得公式(4-2)。
[0251] y(k+1)=g0Δuf(k)+E1(z-1)Δu(k-1)+S1(z-1)y(k)+R1(z-1)ε(k+1)[0252] y(k+2)=g1Δuf(k)+g0Δuf(k+1)+E2(z-1)Δu(k-1)+S2(z-1)y(k)+R2(z-1)ε(k+2)[0253] y(k+p)=gp-1Δuf(k)+gp-2Δuf(k+1)+…+g0Δuf(k+P-1)+EP(z-1)Δu(k-1) +Sp(z-1)y(k)+Rp(z-1)ε(k+P)   (4-2)
[0254] ②如果要辨识参数G,可以对公式(4-2)中的方程组经过求解辨识,不过这样不可行,因为计算量会非常大。但是从公式(4-2)可得知,矩阵的所有参数g0,g1,…,gP-1,都列在公式的尾行,求得矩阵的所有参数只需要对尾行的方程求解即可,此时随之将F(z-1),G(z-1)辨识出,最后可以求解公式(4-3)。
[0255] f(k+p)=FP(z-1)+SP(z-1)y(k)   (4-3)
[0256] 按照公式(4-3)的计算,这样就只要计算一次最小二乘即可。
[0257] ③取公式(4-2)的最后一行公式,如公式(4-4)。
[0258] y(k+P)=gP-1Δuf(k)+gP-2Δuf(k+1)+…+g0Δuf(k+p-1) +EP(z-1)Δu(k-1)+SP(z-1)y(k)+RP(z-1)ε(k+P)   (4-4)
[0259] 公式(4-4)中,
[0260]
[0261]
[0262] 式中, 是根据系统过去和当前的监测值{y(k),u(k)}确定的,右边的噪声Rj(z-1)ε(k+j)参数包括的是系统未来时刻的随机干扰
[0263] ④ 正交,可求得最优预测值为输出预测值。
[0264] 或
[0265] 所以,可得辨识方程为公式(4-5)。
[0266]
[0267] ⑤采用公式(4-5),计算最小二乘辨识,可以辨识出 还有最后可得 即公式(4-6)。
[0268]
[0269] 接着下步工作就是求得
[0270]
[0271] ⑥将公式(4-2)的前P-1行,如果改写为
[0272]
[0273] 因此,其预测的输出值即为公式(4-8)。
[0274]
[0275] ⑦由控制率公式(4-8)可以求得,当(k-1)时刻,就可以求出一系列控制律函数Δu(k),Δu(k+1),Δu(k+p-2),所以在k时刻Δu(k+i-1)(i=1,2,3…P-1)是已知的。同时在每个时刻k都可以求解P步预测值,如公式(4-9)。
[0276]
[0277] 这样的话, 可由公式(4-8)计算求得,且不用再进行辨识,所以可以得到控制器的所有参数。
[0278]
[0279] 综上所述,隐式的广义预测算法中的自动校正算法有如下步骤:
[0280] (1)设定初值P,M,na,λ,a, P(0);
[0281] (2)由公式(4-5)辨识 及 最后计算
[0282] (3)根据公式(4-10)可求得
[0283] (4)由(4-2)计算控制律;
[0284] 再按照步骤(2)计算。
[0285] 实施例3
[0286] 一种基于PID控制器的稳定平台控制装置,包括:用于建立被控对象的广义预测算法控制模型的建立模型单元;用于获取被控对象的历史和未来的输入信息,根据输入信息经广义预测算法控制模型计算得出输出信息的获取输出单元;用于根据所述输入信息和输出信息进行多步骤的输出预测的多步输出单元;用于根据预测结果设置目标函数计算得到最优控制率的设置函数单元;用于根据所述最优控制率,基于隐式预测的自动校正算法进行自动校正的自动校正单元。
[0287] 本发明的仿真以及对比PID算法的说明
[0288] PID算法仿真分析
[0289] 采用Matlab7软件仿真,速度稳定环的仿真,调整好速度稳定环的PID参数,再对位置稳定环仿真,调整好位置稳定环的PID系数,横摇伺服控制系统的控制仿真模型,如图2所示。
[0290] 如图3、图4,对系统的俯仰伺服控制系统的跟踪性能进仿真,输入幅值为1、周期为1s的位置方波跟踪信号。
[0291] 由图3、图4可知,系统无超调、反应快、调节时间是0.075ms,系统位于方波下降沿和上升沿时,瞬间出现的误差较大,最大的幅值等于2,但随着时间推移,误差也逐渐变小,最后为零。
[0292] 如图5、图6,输入幅值为1、周期为1s的正弦波跟踪信号,图示了俯仰伺服系统的跟踪曲线、系统的跟踪误差曲线的仿真结果。
[0293] 由图5、图6的仿真可得,正弦跟踪曲线的效果比较好,系统误差较小、小于等于0.06,响应速度很快。
[0294] 广义预测算法仿真分析
[0295] 因为稳定平台伺服控制系统的两个轴控制基本相同,所以对这里只对横摇轴的伺服控制系统进行仿真。
[0296] 横摇轴伺服控制系统的传递函数,如公式(4-11)。
[0297] G(s)=ω(s)/U(s)=(1/Ce)/(TmS+1)(TeS+1)=12.945/(2.4s+1)(1.53s+1)   (4-11)
[0298] 在用Matlab7对算法进行仿真之前,应利用软件自带的control工具箱,用其提供的丰富的离散工具离散化传递函数。
[0299] 调用命令为:
[0300] Sys=tf(num,den);
[0301] Sysd=c2d(sys,ts,method);
[0302] 调用说明为:
[0303] Sys,被离散化的系统;
[0304] num,定义分母和分子;
[0305] Ts,采样时间;
[0306] method,离散化算法,如果没有具体说明,则为zoh。
[0307] Gz=(0.0007116z+0.0007065)/(z2-1.978z+0.9785)   (4-12)
[0308] 伺服控制系统的数学模型CARMA,如公式(4-13)。
[0309] A(z-1)y(k)=B(z-1)u(k-1)+C(z-1)ξ(k)/Δ   (4-13)
[0310] 式中参数说明:
[0311] A,n,n的的多项式;
[0312] B,m的(z-1)的多项式;
[0313] C,n阶的(z-1)的多项式;
[0314] Δ=1-z-1;
[0315] y(k),系统输出;
[0316] u(k),系统输入;
[0317] ξ(k),零均值的白噪声序列。
[0318] 为了计算简便,设C(z-1)=1。
[0319] 经变换后,可得系统模型的表达式,如公式(4-14):
[0320] y(k)-1.978y(k-1)+0.9785y(k-2)=0.0007116u(k-1)+0.0007065u(k-2)+ξ(k)/ Δ   (4-14)
[0321] 对公式(4-14)接着进行整理、推导,可得系统的模型如公式(4-15)。
[0322] y(k)=1.978y(k-1)-0.9785y(k-2)+0.0007116u(k-1)+0.0007065u(k-2)+ξ(k)/ Δ   (4-15)
[0323] 对公式(4-15)进行仿真,预设如下参数:
[0324] 预测长度,n=6;
[0325] 控制长度,m=2;
[0326] 控制加权系数,λ=0.8;
[0327] 参考轨迹的柔化系数,α=0.3;
[0328] 采样周期(单位:s),T=0.1。
[0329] 设置参数的截图,参考图7、图8、图9、图10、图11、图12所示。
[0330] 由图11、图12的结果数据可以发现,控制系统出现较大误差处均在方波的上升沿和方波下降沿(最大值可达0.48),但误差在此后伴随着系统中产生重叠的输入和输出方波信号逐渐向零逼近,在方波上升沿和方波下降沿后,控制增量曲线也都开始变得相对平缓。
[0331] 在方波信号的周期值等于1s且幅值等于1,正弦信号的周期值等于1s且幅值等于1的条件下,图13为方波信号仿真跟踪特性曲线。
[0332] 由此上图知,系统误差在最先的100步之后向零趋近,控制增量曲线也变缓。
[0333] 通过上面使用Matlab7软件对PID和预测控制两种算法进行仿真,从结果来看,两种算法均适用于非时变系统,系统模型通常会在伺服控制系统因为船舶行驶受到很多干扰的情况下产生很多变化。在这种情况下,应将系统模型变为慢时变系统,因为广义预测控制算法基于三个基本原则可跟踪慢时变伺服控制系统的曲线,这可以利用人为干预的办法来验证广义预测控制算法的自动适应性。
[0334] 假设:改变系统模型的周期定位100步,具体过程如下:
[0335] 前100步,采用原始的系统模型(1);
[0336] 100–200步,采用系统模型(2);
[0337] …
[0338] 500–600步,采用系统模型(6)。
[0339] 系统模型(1)-(6)如下:
[0340] (1)y(k)=1.978y(k-1)-0.9785y(k-2)+0.0007116u(k-1)+0.0007065u(k-2)+ξ (k)/Δ
[0341] (2)y(k)=1.978y(k-)1-0.9785y(k-2)+0.0007116u(k-2)+0.0007065u(k-2)+ξ (k)/Δ
[0342] (3)y(k)=1.978y(k-1)-0.9785y(k-2)+0.0007116u(k-3)+0.0007065u(k-2)+ξ (k)/Δ
[0343] (4)y(k)=1.978y(k-1)-0.9785y(k-2)+0.0007116u(k-4)+0.0007065u(k-2)+ξ (k)/Δ
[0344] (5)y(k)=1.978y(k-1)-0.9785y(k-2)+0.0007116u(k-5)+0.0007065u(k-2)+ξ (k)/Δ
[0345] (6)y(k)=1.978y(k-1)-0.9785y(k-2)+0.0007116u(k-6)+0.0007065u(k-2)+ξ (k)/Δ
[0346] 广义预测控制算法的仿真模型结果,如图15所示。
[0347] 由图15所示可知,在系统模型慢时变时,数学模型的偏差会在使用广义预测控制算法经过一段时间的及时补偿后会逐渐向零趋近。可见广义预测控制算法在非线性系统中,会有相对良好的控制结果。所以,在复杂海况下使用的船用稳定跟踪平台,选用广义预测控制算法能够较好的实现自适应性强的智能预测控制。
[0348] 本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。