一种导引头稳定平台参数化自适应前馈控制方法
【技术领域】
[0001] 本发明属于导弹制导的技术领域,具体的涉及一种用于提高导引头的跟踪精度和 扰动抑制能力的,导引头稳定平台参数化自适应前馈控制方法。
【背景技术】
[0002] 在导弹拦截目标过程中,由于导引头安装在弹体前端,弹体的角运动和质心运动, 以及外部载荷如风、气流等引起的扰动力矩会通过多种方式耦合到导引头。因此,视线稳定 与跟踪在一定程度上要受弹体运动的影响。为实现可靠、高精度的目标跟踪,必须采用稳定 平台来隔离弹体运动。大多数导引头稳定平台采用速率陀螺作为反馈原件,利用速率陀螺 测量视轴在俯仰和偏航方向的惯性空间角速度,并直接将其反馈至稳定回路控制器控制导 引头反向偏转以实现视线在惯性空间的稳定指向。稳定平台所采用的控制方法以PID控制 加陷波器的经典控制结构为主,外部扰动的抑制主要依靠高控制增益实现。在控制系统设 计过程中,由于系统动态模型在高频段存在较大的不确定性,为维持系统的稳定性,控制增 益会受到一定的限制,由此限制扰动抑制能力。特别在稳定平台存在较大的摩擦力矩、不平 衡力矩和拖拽力矩的情况下,仅通过反馈控制很难达到理想的控制性能。较常用的提高稳 定控制性能的方法是应用扰动观测器,在闭环控制系统中引入扰动估计和补偿来改善稳定 平台的低速性能、提高扰动抑制能力。这种控制方式虽然可以有效的抑制扰动,但通常会降 低反馈控制回路的频带,在跟踪性能要求较高的场合并不适用。除此以外,在扰动信号可量 测的情况下,引入扰动前馈设计线性或者非线性前馈控制可以实现非常好的控制性能,但 扰动信号可测的前提条件限制了这种方法的应用。
【发明内容】
[0003] 为了提高导引头稳定控制回路的指令跟踪和扰动抑制性能,发明了一种结合扰动 观测器和参数化自适应前馈控制的导引头稳定平台参数化自适应前馈控制方法。
[0004] 本发明的具体步骤如下:
[0005] 一种导引头稳定平台参数化自适应前馈控制方法,所述的导引头稳定平台为多自 由度万向支架结构,平台上安装速率陀螺、光电编码器、力矩电机,分别用于敏感万向支架 的惯性空间角速率、万向支架的旋转角度和驱动平台转动;导引头稳定平台控制系统包括 扰动观测器、极点配置控制器、RLS自适应滤波器;所有控制算法在FPGA上实现;该方法包 括以下步骤:
[0006] (1)采用辨识算法计算稳定平台动力学模型,基于此模型设计扰动观测器,实现外 部扰动的第一级抑制;
[0007] (2)扰动观测器的局部反馈使其动态特性在低频段与辨识模型非常近似,基于辨 识模型设计极点配置反馈控制器;
[0008] (3) Youla-Kucera参数化反馈控制器得到使系统内稳定的所有控制器。通过控制 器和被控对象模型的互质分解,构造包含跟踪指令和负外部扰动的复合前馈信号;
[0009] (4)应用RLS自适应滤波器估计复合前馈信号,实现二自由度的控制效果。
[0010] 在上述技术方案中,所述的稳定平台为俯仰、偏航二自由度万向支架结构。
[0011] 在上述技术方案中,步骤(1)中,所述的辨识方法为子空间法。
[0012] 在上述技术方案中,步骤(2)中,所述扰动观测器的为离散域扰动观测器。
[0013] 在上述技术方案中,步骤(2)中,所述的反馈控制器应用多项式设计法来设计。
[0014] 在上述技术方案中,步骤(4)中所述的自适应滤波器与控制器参数化相互独立。
[0015] 本发明与现有方案相比有益效果为:
[0016] 1.本发明与常规PID控制加陷波器的控制方案相比,具有更好的扰动抑制能力, 通过扰动观测器的扰动估计前馈可实现比反馈控制更有效的扰动抑制效果,此外,扰动观 测器的局部反馈克服系统建模误差的影响,提高了系统鲁棒性;
[0017] 2.本发明与常规连续域控制系统设计方法相比,可直接在离散域设计扰动观测器 和极点配置控制器,简化了离散辨识数据的连续传递函数拟合、连续控制器离散化等设计 步骤,避免由离散化产生的性能下降;
[0018] 3.本发明与常规单回路控制方案相比,具有更好的指令跟踪和扰动抑制能力,通 过控制器参数化可以构造包括扰动观测器残余扰动和指令的前馈信号,实现二自由度控制 效果;
[0019] 4.本发明与常规固定参数控制方案相比,应用自适应滤波器估计扰动和指令的前 馈信号,可以放宽对模型不确定性和参数变化的要求,更容易达到尖峰控制性能。
【附图说明】
[0020] 图1为导引头稳定平台稳定控制回路结构图;
[0021] 图2为扰动观测器结构图
[0022] 图3为单通道反馈控制结构图;
[0023] 图4为控制器参数化结构图;
[0024] 图5为参数化自适应前馈控制结构图;
[0025] 图6为自适应RLS滤波器结构框图;
[0026] 图7为参数化自适应前馈控制对幅值10° /s、频率IOHz的正弦指令信号的跟踪 误差;
[0027] 图8为参数化自适应前馈控制对幅值3°、频率3Hz的正弦扰动的抑制结果。
【具体实施方式】
[0028] 本发明的发明思想为:
[0029] 一种导引头稳定平台参数化自适应前馈控制方法,包括以下步骤:
[0030] 步骤1 :建立导引头稳定平台控制系统,该系统由有刷直流力矩电机直接驱动的 二自由度万向支架、测角光电编码器和测量惯性空间速度的速率陀螺组成;
[0031] 步骤2 :针对力矩电机设计高带宽电流反馈回路,以保证其具有快速的力矩响应 能力;
[0032] 步骤3 :将俯仰和偏航通道考虑为两个独立的控制系统,交叉耦合考虑为外部扰 动力矩,对平台输入逆M序列激励并记录平台的输出响应,通过子空间辨识算法计算稳定 平台的动力学模型;
[0033] 步骤4 :设计离散形式的扰动观测器,由实际系统的输入输出以及辨识模型的参 数计算外部扰动估计,前馈至系统输入对消外部扰动形成第一级扰动抑制;
[0034] 步骤5 :应用极点配置方法设计稳定回路控制器,在控制器中添加积分作用并求 解闭环系统特征多项式,由Sylvester矩阵求解控制器参数,确保合适的自然频率和阻尼 比;
[0035] 步骤6 :将辨识模型和反馈控制器进行互质分解,利用Youla-Kucera参数化方法 得到所有使系统内稳定的控制器,构造包含跟踪指令和负外部扰动的复合前馈信号;
[0036] 步骤7 :应用递推最小二乘自适应滤波器估计构造的复合前馈信号并前馈至导引 头稳定平台,同时实现对残余扰动的第二级扰动抑制和对指令信号的前馈跟踪。
[0037] 以下结合附图,针对本发明导引头稳定平台参数化自适应前馈控制方法,仅以俯 仰控制通道的实施例进行详细的描述,但以下的实施例仅限于解释本发明。
[0038] 步骤1 :稳定平台采用俯仰一偏航二自由度万向支架结构,可以绕俯仰和偏航轴 运动,以实现对目标的跟踪与捕获。双轴速率陀螺安装于万向支架测量光轴惯性空间角速 度。光电编码器用于测量稳定平台相对于弹体的俯仰、偏航角位置。稳定回路控制器应用速 率陀螺的反馈完成控制律的计算并将运动指令送至驱动器驱动力矩电机带动万向支架绕 俯仰偏航轴偏转,从而实现万向支架的稳定。稳定控制系统原理框图如图1所示,r p和r y为 跟踪回路给出的俯仰和偏航稳定回路指令,%和τ 驱动器指令,<为俯仰轴速度测量 值,4为经余割补偿计算得到的偏航轴速度测量值。本实施例所述伺服控制器采用Altera 公司Cyclone III 3C80U484FPGA,控制系统的采样周期为lms。
[0039] 步骤2 :应用集成有刷电机驱动器MSK 4253设计力矩电机驱动器,通过调整外围 电阻电容值修改PI控制参数实现模拟电流闭环,闭环带宽为1030HZ。
[0040] 步骤3 :电锁定偏航控制通道。以逆M序列作为输入信号激励稳定平台,记录稳定 平台输出的角速率,通过子空间辨识算法计算稳定平台的动力学模型为
【主权项】
1. 一种导引头稳定平台参数化自适应前馈控制方法,所述的导引头稳定平台为多自由 度万向支架结构,平台上安装速率陀螺、光电编码器、力矩电机,分别用于敏感万向支架的 惯性空间角速率、万向支架的旋转角度和驱动平台转动;导引头稳定平台控制系统包括扰 动观测器、极点配置控制器、RLS自适应滤波器;所有控制算法在FPGA上实现;其特征在于, 该方法包括以下步骤: (1) 采用辨识算法计算稳定平台动力学模型,基于此模型设计扰动观测器,实现外部扰 动的第一级抑制; (2) 扰动观测器的局部反馈使其动态特性在低频段与辨识模型非常近似,基于辨识模 型设计极点配置反馈控制器; (3) Youla-KuCera参数化反馈控制器得到使系统内稳定的所有控制器。通过控制器和 被控对象模型的互质分解,构造包含跟踪指令和负外部扰动的复合前馈信号; (4) 应用RLS自适应滤波器估计复合前馈信号,实现二自由度的控制效果。
2. 根据权利要求1所述的导引头稳定平台参数化自适应前馈控制方法,其特征在于, 所述的稳定平台为俯仰、偏航二自由度万向支架结构。
3. 根据权利要求1所述的导引头稳定平台参数化自适应前馈控制方法,其特征在于, 步骤(1)中,所述的辨识方法为子空间法。
4. 根据权利要求1所述的导引头稳定平台参数化自适应前馈控制方法,其特征在于, 步骤(2)中,所述扰动观测器的为离散域扰动观测器。
5. 根据权利要求1所述的导引头稳定平台参数化自适应前馈控制方法,其特征在于, 步骤(2)中,所述的反馈控制器应用多项式设计法来设计。
6. 根据权利要求1所述的导引头稳定平台参数化自适应前馈控制方法,其特征在于, 步骤(4)中所述的自适应滤波器与控制器参数化相互独立。
【专利摘要】本发明提供一种导引头稳定平台参数化自适应前馈控制方法,该方法的控制系统由扰动观测器、极点配置控制器组成的反馈控制回路和参数化自适应前馈控制回路组成。反馈控制回路基于子空间辨识模型设计,主要用于扰动的抑制;前馈控制应用递推RLS算法在线更新自适应滤波器的抽头权值,使自适应滤波器近似于稳定平台动力学互质分解模型的逆,形成指令和负扰动的前馈,提高了系统的响应频带和扰动抑制能力。
【IPC分类】G05B13-04
【公开号】CN104635492
【申请号】CN201410797715
【发明人】朱明超, 刘慧 , 贾宏光, 刘立刚
【申请人】中国科学院长春光学精密机械与物理研究所
【公开日】2015年5月20日
【申请日】2014年12月19日