本发明涉及基于模型参数精确辨识的仿真转台自校正控制方法。
背景技术:
在飞行器半实物仿真和测试中,飞行仿真转台是常用的硬件设备之一,它能够真实地复现飞行器在空中飞行时的各种姿态运动和其运动学特性,提供精确的运动测试基准。为了实现高精度和高动态的指标要求,多数转台都采用了直接驱动的工作方式,这种方式使得转台的性能对其参数变化十分敏感,而系统的结构尺寸或负载变化都会导致被控对象数学模型发生变化。工程上常用的转台数学模型参数的确定方法为开环扫频测定法,其主要思想是:给伺服系统加入正弦输入激励信号,则系统的输出响应也是同一频率的正弦信号,通过改变输入信号的频率,对输入的信号和输出端信号进行数据处理,可获得被测系统或对象的频率特性,这种方法需要耗费较长的时间。并且,在多数情况下,由于环境条件的变化、框架之间的力矩耦合以及其它干扰因素的存在等,被控对象数学模型的参数可能在正常运行期间发生变化。这样就会影响以被控对象数学模型为基础设计的固定参数的控制方法的品质,使其性能下降,不能达到给定的动态或静态指标要求,严重时甚至会影响系统的稳定性,使系统无法正常工作。转台在实际应用中,为适应不同型号飞行器实验需求,往往会安装不同惯量的负载,固定参数的控制方法对这种负载的变化适应能力差。为使系统在负载变化或存在其它干扰影响的条件下仍能够稳定且满足指标要求,目前的解决的方法是针对几种典型的负载,对控制对象进行重新建模,重新设计控制方法,设计几套匹配的控制方法参数来保证系统的稳定性和性能,使用时,用户会根据安装负载的转动惯量来选择最接近的控制方法参数。然而,当用户负载较多,变化较大时,可能会出现几套控制方法参数都不能保证系统的最佳性能,甚至无法保证稳定。
技术实现要素:
本发明的目的是为了解决现有的开环扫频测定法需要耗费较长时间、固定参数的控制方法对负载变化适应能力差,及可能会出现几套控制方法参数都不能保证系统的最佳性能,甚至无法保证系统稳定的缺点,而提出一种基于模型参数精确辨识的仿真转台自校正控制方法。
一种基于模型参数精确辨识的仿真转台自校正控制方法具体过程为:
步骤一、根据转台伺服系统的结构建立转台伺服系统机理模型,包括转台伺服系统开环传递函数模型g(s)和摩擦模型
步骤二、测量抵消库仑摩擦力矩tc所需的控制量da值,对步骤一中转台伺服系统开环传递函数模型g(s)的控制输入信号进行补偿;
步骤三、使用扩展卡尔曼滤波器对步骤二中补偿后的转台伺服系统开环传递函数模型g(s)中的待辨识参数τe、τm和k进行精确辨识,得到精确参数
步骤四、设计自校正控制环节j(s)的控制律,并根据辨识得到的
本发明的有益效果为:
提出了基于模型参数精确辨识的仿真转台自校正控制方法。为了实现上述目的,本发明的基于模型参数精确辨识的仿真转台自校正控制方法为:根据转台伺服系统的机理结构建立开环传递函数模型并测量非线性环节参数,使用扩展卡尔曼滤波器对转台模型参数进行精确辨识,得到的模型参数用于调整自校正控制环节,进而使系统在负载改变后保证良好的动态性能,满足“双十”指标。
相较于现有技术,本发明基于模型参数精确辨识的仿真转台自校正控制方法在转台系统负载发生改变时,步骤三使用扩展卡尔曼滤波器辨识出精确的转台模型参数,对比现有的开环扫频测定法具有实现简单、所需时间短的优点;步骤四通过调整自校正控制方法参数使转台在负载发生变化时,仍能够保证系统的闭环传递函数不变,系统具有良好的动态性能,满足系统要求的“双十”指标,对比现有的固定参数的控制方法,能够抵消转台参数变化对系统特性的影响,对负载变化的适应能力强,使系统获得更好的性能;本发明设计的自校正控制方法不需要设计几套控制方法参数,具有设计方便、实现简单、节省人力物力的优点,解决了几套控制方法参数都不能保证系统的最佳性能,甚至无法保证系统稳定的缺点;结合图9a、9b和表1可以看到,在负载发生改变后,系统在“双十”指标要求的10hz频带内,自校正控制方法动态性能变化小,即fft幅值和fft相角差与负载变化前更接近。当频率为2hz,信号幅值为0.35v时,负载变化前fft幅值为1.0162,固定参数控制方法fft幅值为0.9805,而自校正控制方法fft幅值为0.9982,负载变化前fft相角差为-1.241,固定参数控制方法fft相角差为-4.194,而自校正控制方法fft相角差为-3.187。当频率为10hz,信号幅值为0.35v时,负载变化前fft幅值为1.0316,固定参数控制方法fft幅值为0.9577,而自校正控制方法fft幅值为0.9951,负载变化前fft相角差为-0.865,固定参数控制方法fft相角差为2.578,而自校正控制方法fft相角差为0.666。
附图说明
图1为本发明在转台伺服系统中实现的原理示意图,其中:θ*为系统输入,θ为转台实际位置输出,u为输入到被控对象的控制输入信号,
图2为本发明转台伺服系统的结构机理图,其中:u为控制输入信号,s为拉普拉斯算子,iq为交轴电流,ω为电机机械角速度,θ为转台实际位置输出;r为等效电阻;kf为电流反馈放大系数设为1;kps为驱动器放大系数;kv为电流放大系数;反电势系数为ke;电机力矩系数为kt;l为电枢电感;jσ为轴系总转动惯量;te为驱动器输出力矩;tl为干扰力矩,包含摩擦力矩及波动力矩;
图3为本发明中摩擦补偿流程图,其中u为输入到被控对象的控制输入信号,tfp及tfn为测量得到的正反向摩擦da值;
图4为本发明中参数辨识结果收敛判断及输出流程图;
图5为使用扩展卡尔曼滤波器对转台模型参数进行辨识的流程图;
图6为实施例中参数辨识所使用的输入信号示意图;
图7a为实施例中使用扩展卡尔曼滤波器辨识空载转台系统模型参数τe辨识结果图;
图7b为实施例中使用扩展卡尔曼滤波器辨识空载转台系统模型参数τm辨识结果图;
图7c为实施例中使用扩展卡尔曼滤波器辨识空载转台系统模型参数k辨识结果图;
图8a为实施例中使用扩展卡尔曼滤波器辨识搭载中负载的转台系统模型参数τe辨识结果图;
图8b为实施例中使用扩展卡尔曼滤波器辨识搭载中负载的转台系统模型参数τm辨识结果图;
图8c为实施例中使用扩展卡尔曼滤波器辨识搭载中负载的转台系统模型参数k辨识结果图;
图9a为实施例中使用fft法分析固定参数控制方法与自校正控制方法的转台分别输入1~10hz正弦信号得到的指令位置差的幅值比对比图;
图9b为实施例中使用fft法分析固定参数控制方法与自校正控制方法的转台分别输入1~10hz正弦信号得到的指令位置差的相角差对比图;
图10为实施例中以输入信号频率为4hz幅值为0.5v的正弦信号为例,展示了负载变化后自校正控制方法的跟踪效果优于固定参数控制方法的效果图。
具体实施方式
具体实施方式一:本实施方式的一种基于模型参数精确辨识的仿真转台自校正控制方法具体过程为:
为解决转台模型由于参数改变而引起的无法满足动态性能指标的问题,有必要设计一种离线或在线的转台模型参数辨识方法,对变化的被控对象数学模型进行辨识,并运用所辨识得到的参数对原有的伺服控制系统进行调整,使系统能够有效克服负载变化带来的影响。
步骤一、根据转台伺服系统的结构(图2)建立转台伺服系统机理模型,包括转台伺服系统开环传递函数模型g(s)和摩擦模型
步骤二、测量抵消库仑摩擦力矩tc所需的控制量da值,对步骤一中转台伺服系统开环传递函数模型g(s)的控制输入信号进行补偿;
步骤二是步骤一中对输入信号u的处理方法;根据步骤一中设计的u的形式,通过步骤二补偿,用到步骤三中;
步骤三、使用扩展卡尔曼滤波器对步骤二中补偿后的转台伺服系统开环传递函数模型g(s)中的待辨识参数τe、τm和k进行精确辨识,得到精确参数
步骤四、设计自校正控制环节j(s)的控制律,并根据辨识得到的
具体实施方式二:本实施方式与具体实施方式一不同的是:所述步骤一中根据转台伺服系统的结构(图2)建立转台伺服系统机理模型,包括转台伺服系统开环传递函数模型g(s)和摩擦模型
转台伺服系统机理模型为:
式中,id,iq为同步旋转d-q坐标系中的直轴电流和交轴电流,d为直轴,q为交轴;ωr为电机机械角速度;r为电机电枢电阻;r'=r+kvkpskf为电机等效电阻,kf为电机电流反馈放大系数,kps为电机驱动器放大系数,kv为电机电流放大系数;l为电机电枢电感;jσ为轴系总转动惯量;d为电机旋转时的摩擦系数;tl为干扰力矩,包含摩擦力矩及波动力矩;pm为电机极对数;ψf为转子永磁效应对应的每对磁极磁通;ud,uq为旋转d-q坐标系中的直轴电压和交轴电压;
上式中建立了d轴和q轴的动态方程,但实际对电机进行矢量控制时,通常忽略转台伺服系统机理模型中id的影响,通过控制iq来直接控制电机的力矩输出,即
根据式(2),将电机电流反馈放大系数kf设为1,并忽略电机旋转时的摩擦系数d,令反电势系数
式中,g(s)为转台伺服系统开环传递函数模型,s为拉普拉斯算子;记
对于一般的转台伺服系统,总能够满足τm>>τe,所以上式(4)又简化为:
至此,转台伺服系统开环传递函数模型g(s)建立完毕;
转台伺服系统工作时,由于自身设计及外界环境的影响和干扰使转台系统中存在较多的非线性因素,其中摩擦力矩对模型辨识影响最大,因此本发明使用库仑模型对摩擦进行描述。
库仑摩擦模型只考虑了库仑摩擦的作用,其表达式为:
其中,tc为库仑摩擦力矩,
至此,摩擦模型
其它步骤及参数与具体实施方式一相同。
具体实施方式三:本实施方式与具体实施方式一或二不同的是:所述步骤一中转台伺服系统控制输入信号u具体形式为:
系统辨识要求输入信号在系统带宽范围内有持续激励,因此系统辨识一般采用白噪声或m序列作为输入信号。然而在转台系统中,剧烈变化的输入信号会导致指令加速度很大,甚至超过转台的能力范围,一方面会使系统进入饱和状态,另一方面也会对被测设备和转台自身造成负面影响;若输入信号的幅值较小,则摩擦死区等非线性的作用明显,这会严重影响辨识结果。因此在选择辨识输入信号时,应尽可能使输入信号能量够大,变化平滑。
尽管正弦信号的频率单一,无法理想地反映全频段内系统的频率特性,但其各阶导数均连续且在实际系统中容易获取。本发明考虑到持续激励的要求,设计了选取不同频率、幅值的正弦信号进行叠加得到的输入控制信号,既满足了信号变化平滑的要求,又满足输入信号包含丰富的频率成分的要求。同时,根据转台模型的特点要求控制信号的频率大于1/τmrad,因此正弦基频不能低于1/2πτmhz。正弦幅值选取时应注意叠加后的信号强度也应满足驱动器输出电压的限制,避免系统输入饱和。
综合考虑,设计转台伺服系统控制输入信号为
其中,a为信号幅值,f为基频,t为时间,n为叠加的信号数量,取值为正整数,2πf≥1/τm,2π(2n-1)f≥ωc,ωc为系统带宽。
其它步骤及参数与具体实施方式一或二相同。
具体实施方式四:本实施方式与具体实施方式一至三之一不同的是:所述步骤二中测量抵消库仑摩擦力矩tc所需的控制量da值,对步骤一中转台伺服系统开环传递函数模型g(s)的控制输入信号进行补偿;具体过程为:
首先,对转台伺服系统的库仑摩擦力矩tc进行测量;
根据转台运动原理可知,当转台做闭环的匀速运动时,电机输出力矩只用于克服摩擦做功,此时控制方法输出的da值为克服摩擦力矩运动所需的da大小。因此对摩擦力矩的测量可以转化为对匀速运动时da值的测量。同时,由于辨识时使用的输入信号为叠加的正弦信号,其速度大小和方向不断变化,导致摩擦值在正负向运动时会有一定偏差,因此测量时给定不同速度不同方向的斜坡信号,对同一方向不同速度的斜坡信号的控制量da值取均值,得到取均值后的控制量da值(比如斜坡信号分为5°/s和10°/s,将5°/s和10°/s的控制量da值取均值);将不同方向得到的取均值后的控制量da记为:正向摩擦da值tfp和反向摩擦da值tfn,(比如+5°/s测量得到的摩擦da值为正向摩擦da值;-5°/s测量得到的摩擦da值为反向摩擦da值);
以减少因速度变化导致的摩擦力矩测量偏差。
然后,用测量得到的取均值后的控制量da值对控制输入信号进行补偿,具体补偿方法为:
①若控制量da值小于取均值后的控制量da值,控制输入信号u为0,否则执行②;
②若测量得到的位置输出θ比上一采样时刻增加,则控制输入信号u′=u-tfp,u′为经tfp修正后的控制输入信号,否则执行③;
③控制输入信号u″=u+tfn,u″为经tfn修正后的控制输入信号,补偿结束。
补偿流程图如附图3所示。
其它步骤及参数与具体实施方式一至三之一相同。
具体实施方式五:本实施方式与具体实施方式一至四之一不同的是:所述步骤三中使用扩展卡尔曼滤波器对步骤二中补偿后的转台伺服系统开环传递函数模型g(s)中的待辨识参数τe、τm和k进行精确辨识,得到精确参数
首先介绍基于扩展卡尔曼滤波器的转台伺服系统模型参数辨识方法:
实际转台伺服系统工作时,由于系统的复杂性,只能够提供有限的准确对应传递函数的输出数据,因此在辨识系统的输入输出选取时,本发明选取可靠性高的两组数据,即光电码盘输出的位置输出θ和输入被控对象的控制输入信号u。
扩展卡尔曼滤波器的待辨识模型为:
其中,τe、τm和k为转台伺服系统模型待辨识参数;
选取观测向量:
x=[x1x2x3x4x5x6]t(8)
其中x1=θ,x4=1/τe,x5=1/τm,x6=k,x2和x3为不可观状态变量,ts为选取的采样时间;t为转置;
建立状态方程为:
式中,
建立状态方程时需注意,被控对象输出应与待辨识参数具有一定的相关性,即输出为包含待辨识参数的表达式;同时,应注意避免几个待辨识参数相乘的情况,若辨识参数耦合度高,辨识过程会变得漫长且误差较大。为了提高辨识速度并减小误差,将τm、τe和k分别设计在x1、x2和x3的表达式中,以避免辨识参数的耦合。
建立转台伺服系统的离散化状态方程为
x(k+1)=ax(k)+bu(k)+w(k)
y(k+1)=cx(k)+v(k)(10)
式中,x(k+1)、x(k)分别是tk+1、tk时刻的状态变量,a、b、c均为参数矩阵,u为控制输入信号,y(k+1)为tk+1时刻的输出,w、v分别是转台伺服系统噪声和测量噪声,两者为不相关的零均值高斯白噪声,满足
其中:
式中,ts为选取的采样时间;
计算出转台伺服系统的梯度矩阵和变换矩阵为:
利用公式(10)-(12),通过如下扩展卡尔曼滤波算法实现对转台伺服系统模型参数的精确辨识,得到精确参数
其它步骤及参数与具体实施方式一至四之一相同。
具体实施方式六:本实施方式与具体实施方式一至五之一不同的是:所述利用公式(10)-(12),通过如下扩展卡尔曼滤波算法实现对转台伺服系统模型参数的精确辨识,得到精确参数
第一步,预测:
设已知tk时刻的最优估计值
式中,
在此基础上求出卡尔曼滤波增益k*:
式中,h(k+1)为变换矩阵;k*(k+1)为tk+1时刻的卡尔曼滤波增益;
第二步,校正:
根据观测误差以及最小方差原则对预测出的先验估计值
式中,i为单位矩阵;
对于参数初值的选取有以下说明:
①辨识初值
②由于缺少足够多的信息来计算
③协方差矩阵初值
④扩展卡尔曼滤波器实现时,测量噪声协方差r一般可以由离线获取一些系统观测值来计算估计。r的值越大,表明测量值越容易受噪声影响,即测量值的可信度越低,包含噪声越多。
⑤过程噪声协方差q表示了电机模型的统计特性,包括系统的干扰、建模的不确定性、输入信号的噪声等等。增大q的元素表明系统参数存在较大的不确定性,同时会增加扩展卡尔曼滤波增益k*,从而使滤波收敛更快。
在已知辨识初始值
其它步骤及参数与具体实施方式一至五之一相同。
具体实施方式七:本实施方式与具体实施方式一至六之一不同的是:所述辨识终止时间n的取值具体判断如下:
在每一步得到校正后的
若辨识时间超过1秒,超过1秒之后的每0.5秒取
其它步骤及参数与具体实施方式一至六之一相同。
具体实施方式八:本实施方式与具体实施方式一至七之一不同的是:所述步骤四中设计自校正控制环节j(s)的控制律,并根据辨识得到的
通过控制环节参数的调整抵消被控对象的变化,进而使转台伺服系统在负载改变后保证良好的动态性能;
在辨识出精确的
转台系统现有的频域控制方法为:首先,通过开环扫频测定法获得系统的开环传递函数,根据系统的开环频率特性结合性能指标使用超前滞后校正法设计控制环节;然后,对控制环节采用双线性变化法进行离散化;最后,通过编程实现控制环节。
自校正控制方法在现有频域控制方法的基础上,设计自校正环节,根据步骤三得到的精确转台模型参数
其中,g1(s)为指令预处理环节,g2(s)为前馈环节,c(s)为校正环节,传递函数模型g(s)作为被控对象,θ为位置输出,θ*为系统输入;
对于前馈环节,一般取:
其中,t1′,t2′为辅助系数,保证了前馈环节的物理可实现性。
转动惯量变化后,未加入自校正环节的转台伺服系统传递函数变为:
其中:
式中
在辨识得到精确参数
在τm、τe和k发生改变后,根据辨识得到的精确参数
然后在校正环节c(s)后直接串联自校正环节j(s),因此加入自校正环节后的闭环传递函数为:
推导τm、τe和k发生改变后的转台伺服系统的闭环传递函数如下:
即闭环传递函数未发生改变,因此转台伺服系统性能不会受到影响。
根据上述原理,即可得到本发明设计的自校正控制环节。
其它步骤及参数与具体实施方式一至七之一相同。
采用以下实施例验证本发明的有益效果:
实施例一:
本实施例一种基于模型参数精确辨识的仿真转台自校正控制方法具体过程为:
下面采用以下实施例验证本发明的有益效果:
为验证本发明的有效性,以某型两轴飞行仿真转台的主轴为被控对象,为了获得准确的模型参数,通过扫频的方式获得了空载的频率特性曲线,并利用最小二乘拟合方法获得了模型参数。空载时被控对象的数学模型可以描述为
1)对转台系统的摩擦力矩进行测量。给定不同速度不同方向的斜坡信号,对同一方向不同速度的斜坡信号的控制量da值取均值,得到取均值后的控制量da值,并将不同方向得到的取均值后的控制量da值分别测量,以减少因速度变化导致的摩擦力矩测量偏差,测量得到tfp=0.13351757,tfn=0.12517413。
2)根据图5所示流程,使用扩展卡尔曼滤波器对转台模型参数进行辨识,具体描述如下:
(a)运行初始化,对扩展卡尔曼滤波器中的滤波参数进行设定,本实施例中设定
(b)采集当前时刻转台的开环指令da及码盘板读取的位置信息
(c)利用1)中测量的摩擦力矩,根据图3所示的原理,补偿当前时刻da
(d)运行扩展卡尔曼滤波迭代过程(13)-(17),进行模型参数计算
(e)利用图4所示的流程判断滤波迭代过程是否收敛,若收敛则进行下一步,若不收敛则跳至(b)
3)保存辨识结果,结束辨识过程
通过以上步骤辨识得到的转台模型参数为
本实施例中,根据选取原则选择到参数a=5,f=3,n=6,得到的输入控制信号如图6所示。
根据本发明中自校正控制环节的设计方法,得到本实施例的自校正环节为:
在实际系统中,由于工控机的全数字一体化特点,需要对连续的控制环节进行离散化处理,使用离散化程序进行系统控制。对自校正控制方法的离散化处理分为两个部分,一部分为超前滞后校正控制环节的离散化,一部分为自校正环节的离散化。其中,前者的离散化可以使用转台助手进行计算,在初始设计转台控制环节时加入到控制环节程序中。对自校正环节的离散化使用双线性变换,离散化后的自校正环节为:
为验证自校正控制方法的有效性,分别用固定参数控制方法及本发明设计的自校正控制方法对转台进行控制,测量其达到“双十”指标所允许的最大带宽,得到实验结果如表1所示。可以看出,在转台更换负载后,固定参数的控制方法和自校正控制方法都能够达到≥10hz的“双十”指标要求。将两种控制方法的fft数据与负载变化前控制方法的fft数据进行对比,如图9a、9b所示,自校正控制方法的幅值比和相角差变化均比固定参数控制方法更接近于0,即在转台更换负载后,使用自校正控制方法的闭环系统动态性能变化较小。最后,如图10所示,以使用不同控制方法的转台系统在频率为4hz,幅值为0.5v的正弦指令信号下的跟踪效果为例,展示了本发明提出的自校正控制方法比固定参数的控制方法具有更好的跟踪效果。
表1固定参数控制方法与自校正控制方法实验对比
本发明还可有其它多种实施例,在不背离本发明精神及其实质的情况下,本领域技术人员当可根据本发明作出各种相应的改变和变形,但这些相应的改变和变形都应属于本发明所附的权利要求的保护范围。