CN111142380A - 一种火箭炮在行进间发射的位置伺服系统的控制方法 - Google Patents

一种火箭炮在行进间发射的位置伺服系统的控制方法 Download PDF

Info

Publication number
CN111142380A
CN111142380A CN201911269669.XA CN201911269669A CN111142380A CN 111142380 A CN111142380 A CN 111142380A CN 201911269669 A CN201911269669 A CN 201911269669A CN 111142380 A CN111142380 A CN 111142380A
Authority
CN
China
Prior art keywords
azimuth
axis
pitch
position servo
torque
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Withdrawn
Application number
CN201911269669.XA
Other languages
English (en)
Inventor
姚建勇
张玉航
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Science and Technology
Original Assignee
Nanjing University of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nanjing University of Science and Technology filed Critical Nanjing University of Science and Technology
Priority to CN201911269669.XA priority Critical patent/CN111142380A/zh
Publication of CN111142380A publication Critical patent/CN111142380A/zh
Withdrawn legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种火箭炮在行进间发射的位置伺服系统的控制方法,属于机电伺服控制领域。本发明基于ARC控制方法,通过线性扩张状态观测器估计未知非线性项,引入火箭炮在行进间的路面随机扰动、燃气流冲击及摩擦力矩等外部扰动,结合自适应鲁棒控制,设计了基于扰动补偿的自适应鲁棒控制器。所设计的控制器提高了火箭炮位置伺服系统在行进间发射时跟踪状态和连续燃气流冲击下的控制精度,并且抑制了路面扰动对系统的影响,具有较强的鲁棒性。

Description

一种火箭炮在行进间发射的位置伺服系统的控制方法
技术领域
本发明涉及火箭炮行进间发射伺服控制技术,具体涉及一种火箭炮在行进间发射的位置伺服系统的控制方法。
背景技术
火箭炮位置伺服系统是一个复杂的非线性系统,在发射过程中伴随着火箭炮系统转动惯量的变化,系统刚度、阻尼的变化,路面的随机扰动导致系统模型变化;在发射状态时系统受连续燃气流冲击力矩等强干扰导致炮弹的发射平台振动,偏离了初始位置,使得后续射弹在此发射环境下命中精度降低。因此,提高火箭炮武器系统的杀伤力和战场生存性能,控制策略是其核心控制技术对提高火箭炮伺服系统性能至关重要,常规的PID控制由于控制器的结构和参数固定,很难满足发射装置伺服系统动态和稳态指标的要求,更谈不上行进间发射。因此研究火箭炮发射系统控制策略,是提高火箭炮射击精度,进而提高其毁伤效率能力的有效途径之一,具有十分重要的意义。
朱林在《某型多管火箭炮发射平台控制系统的研究与设计》一文中,对某多管火箭炮控制系统进行了研究设计,其采用电机作为动力源,由于电机转速较高,所以配以减速器,通过控制算法使其得到较高的回转精度。但是没有真正给出切实可行的能解决火箭炮在行进间发射问题的方法,有较大局限性。
沈显庆等人在《基于模型参考自适应模糊神经网络的永磁直线同步电动机速度伺服系统》译文中提出了一种将模型参考自适应与神经网络相结合的控制策略,采用在线辨识参数技术,对参数变化及时补偿。但是智能控制算法复杂,计算量大,对硬件条件要求高,限制了这些方法在实际中的应用。
发明内容
本发明提供了一种火箭炮在行进间发射的位置伺服系统的控制方法,解决了火箭炮在行进间发射精度低、系统响应慢的问题。
实现本发明目的的技术解决方案为:一种火箭炮在行进间发射的位置伺服系统的控制方法,包括以下步骤:
步骤1、建立基于驱动器在转矩模式下的火箭炮行进间发射的位置伺服系统模型,包括位置伺服系统动力学模型和位置伺服系统数学模型,转入步骤2;
步骤2、针对火箭炮在行进间发射不确定性,对驱动器在转矩模式下的火箭炮在行进间发射的位置伺服系统设计基于扰动补偿的自适应鲁棒控制器,并和传统PID控制进行比较,仿真证明自适应控制性能优于PID。
本发明与现有技术相比,其显著优点在于:
(1)添加火箭炮行进间发射过程中系统扰动如系统未建模摩擦、火箭炮在行驶过程中路面扰动、燃气流冲击干扰及惯性力矩扰动。
(2)通过线性扩张状态观测器估计出扩张状态的实时作用量,并通过估计值补偿系统扰动,设计了基于扰动补偿的自适应鲁棒控制器。
(3)采用自适应鲁棒算法,有效地克服了非线性特性对系统控制精度的影响。
附图说明
图1为火箭炮两轴系统空间结构示意图。
图2为火箭炮两轴系统坐标关系变换图。
图3为两轴输出角度估计值误差曲线图,其中图a)为方位轴输出角度估计值曲线图,图b)为俯仰轴输出角度估计值曲线图。
图4为两轴未知扰动估计值误差曲线图,其中图a)方位轴未知扰动估计值曲线图,图b)为俯仰轴未知扰动估计值曲线图。
图5为本发明控制器的两轴跟踪误差曲线图,其中图a)方位轴跟踪误差曲线图,图b)为俯仰轴跟踪误差曲线图。
图6为两轴采用PID和ARC的跟踪误差曲线对比图,其中图a)方位轴跟踪误差曲线图,图b)为俯仰轴跟踪误差曲线图。
图7为本发明火箭炮在行进间发射的位置伺服系统结构原理图。
具体实施方式
本发明针火箭炮在行进间发射的位置伺服系统中不确定非线性的特点,建立了系统的模型,并在此基础上设计了线性观测器估计未知非线性项,并通过估计值补偿系统扰动,将系统补偿成线性积分器串联型,结合自适应鲁棒控制,设计了基于扰动补偿的自适应鲁棒控制器。
结合图1~图7,一种火箭炮在行进间发射的位置伺服系统的控制方法,方法步骤如下:
步骤1、建立基于驱动器在转矩模式下的火箭炮行进间发射的位置伺服系统模型,包括位置伺服系统动力学模型和位置伺服系统数学模型,具体如下:
步骤1-1、建立火箭炮在行进间发射的位置伺服系统动力学模型。
火箭炮两轴系统的空间结构示意如图1所示。火箭炮两轴系统在空间上分为俯仰系统和方位系统,以O为坐标原点,建立xyz三轴坐标系,俯仰系统绕俯仰轴y运动,方位系统绕z轴运动。
如图2所示,坐标系Oxayaza表示方位系统坐标系,坐标系Oxpypzp表示俯仰系统坐标系。方位系统绕转动轴Oza转动角度γ,俯仰系统绕转动轴Oyp转动角度β。
定义俯仰系统投影到方位系统的转移矩阵Pa
Figure BDA0002313814010000031
定义方位系统角速度矢量ωa
Figure BDA0002313814010000032
定义系统角速度矢量角速度ωp
Figure BDA0002313814010000033
假设方位系统和俯仰系统相对于各自坐标系是对称的,则俯仰系统的转动惯量矩阵Jp和方位系统的转动惯量矩阵Ja分别为:
Figure BDA0002313814010000034
Figure BDA0002313814010000035
式中:
Figure BDA0002313814010000036
分别表示俯仰系统转动惯量,
Figure BDA0002313814010000037
表示方位系统转动惯量;
则俯仰系统相对于方位系统的转动惯量矩阵Jpa为:
Figure BDA0002313814010000041
则俯仰系统相对于方位系统Oza轴转动惯量
Figure BDA0002313814010000042
为:
Figure BDA0002313814010000043
俯仰系统相对于转动轴Oyp的转动惯量
Figure BDA0002313814010000044
为:
Figure BDA0002313814010000045
两转动轴联动时,方位系统对方位轴Oza转动惯量
Figure BDA0002313814010000046
为:
Figure BDA0002313814010000047
根据刚体的欧拉动力学方程,得俯仰系统在其连体坐标系下力矩为:
Figure BDA0002313814010000048
其中,Mxp、Myp、Mzp分别为俯仰系统在x、y、z轴转矩;
而方位系统在方位系统坐标系下的力矩等于俯仰系统在其连体坐标系下的力矩在方位系统坐标系上的投影与方位系统在其连体坐标系下的力矩之和,则火箭炮全系统所受力矩在方位系统坐标系下为:
Figure BDA0002313814010000049
式中,Mxp、Myp、Mzp分别为俯仰系统在x、y、z轴转矩;Maa为方位系统在其连体坐标系下的力矩。
同理可得方位系统受系统对方位轴的转矩
Figure BDA00023138140100000410
为:
Figure BDA00023138140100000411
得两轴转台的转矩方程为:
Figure BDA00023138140100000412
Figure BDA00023138140100000413
电机输出转矩方程为:
Tea=Ktaup (14)
Tea=Ktaua (15)
式中,Tep为俯仰系统电机输出转矩,Tea为方位系统电机输出转矩,Ktp为俯仰系统电压转矩系数,kta为方位系统电压转矩系数,up为俯仰轴输入电压,ua为方位轴输入电压。
得当驱动器配置在转矩模式下时,两轴系统运动方程为:
Figure BDA0002313814010000051
式中ip为俯仰系统减速比,ia为方位系统减速比,Bp为俯仰轴粘性摩擦Ba为方位轴粘性摩擦,Tfp为俯仰轴折算到电机端的未建模摩擦力矩和干扰,Tfa方位轴折算到电机端的未建模摩擦力矩和干扰。
步骤1-2、建立火箭炮在行进间发射的位置伺服系统数学模型:
电机惯性负载的动力学运动方程为:
Figure BDA0002313814010000052
其中ω表示角位移,m表示折算到电机端的惯性负载,K表示扭矩常数,u是系统控制输入,Bp表示粘性摩擦系数,Tf表示系统折算到电机端的未建模摩擦力矩和干扰。
根据式(16)、(17),火箭炮耦合系统数学模型状态空间表达式为:
Figure BDA0002313814010000053
其中x1,x3分别表示方位系统和俯仰系统的位置角度,x2,x4分别表示方位系统和俯仰系统减速器输出角度,定义向量θa=[θ1 θ2]T为方位系统不确定性参数,同理θp=[θ3θ4]T为俯仰系统不确定性参数;dp(x,t)为俯仰未建模干扰;da(x,t)为方位系统未建模干扰。
火箭炮在行进间发射的位置伺服系统数学系统模型负载扰动主要有摩擦力矩干扰、随机路面干扰、不平衡力矩和惯性力矩、燃气流冲击干扰。
摩擦力矩干扰:火箭炮行进间发射位置伺服系统在跟踪时,存在非线性摩擦,导致系统的动态性能与静态性能都受到很大影响,直接影响系统精度。用Stribeck模型描述系统摩擦力矩,其数学模型可表示为:
当为静摩擦时:
Figure BDA0002313814010000061
当为动摩擦时:
Figure BDA0002313814010000062
式中,Tf(t)为摩擦力矩,Fm表示最大静摩擦力,FC表示库仑摩擦力,Te(t)表示负载力矩,σ1为中间变量,数值为非常小的正数,Kv表示粘性摩擦系数,v为相对速度。
随机路面干扰:在行驶过程中,由于地面不平度导致车体颠簸倾斜,会使车体在垂直、侧倾和俯仰三个方向产生振动,且相互耦合。路面随机扰动通过轮胎-悬架分别在方位轴和俯仰轴产生干扰力矩作用,从而影响发射时精度。取火箭炮在行进中相对于大地坐标系的水平倾角变化,根据角度变化值分别求出加载到方位轴和俯仰轴的力矩,作为负载扰动分别输入给位置伺服系统,通过位置控制器抗扰动设计抑制随机路面扰动。
燃气流冲击干扰:火箭发动机的燃气流作用在火箭炮上,将产生短暂的冲击为矩,这将引起弹-架系统振荡,以及电动机运动速度的波动,影响系统性能。燃气流对俯仰轴和方位轴回转机构均有冲击作用。通常将作用在发射装置各元件上的压为与有效面积的乘积作为总的冲击力,冲击力乘以力作用点距回转轴的距离作为冲击力矩。
步骤2、设计基于驱动器在转矩模式下的火箭炮耦合伺服系统设计基于扰动补偿的自适应鲁棒控制器,具体步骤如下:
步骤2-1、设计方位系统自适应鲁棒控制器:
对于方位系统未建模动态da(x,t)有:
Figure BDA0002313814010000071
其中dna为da(x,t)的常值分量,
Figure BDA0002313814010000072
为干扰估计误差,将dna略去,将方位系统状态空间形式写完:
Figure BDA0002313814010000073
其中,ua0为方位系统误差反馈律;
假设1:参数不确定性θa的大小范围已知,da(x,t)有界,即
Figure BDA0002313814010000074
式中θamax,θamin为向量θa的上确界和下确界,δd为已知有界值或函数。
假设2:方位系统参考指令x1d二阶连续,且位置指令、速度指令和加速度指令有界。
定义误差变量:
Figure BDA0002313814010000075
式中z1为方位系统跟踪误差,k1为方位系统反馈增益,z2为方位系统稳态误差,x2q为中间变量。因此设计控制器保证z2趋于零,可使跟踪误差也趋于零,系统获得更好的跟踪性能。因此,设计控制器的目标应该为使z2趋于0。
由式(22)和式(24)得
Figure BDA0002313814010000076
由式(25)设计控制器结构如下:
Figure BDA0002313814010000077
式中,uaa为方位系统自适应补偿项,
Figure BDA0002313814010000078
为θa的估计值,us为方位系统鲁棒反馈项,k2为方位系统正反馈增益,us1为方位系统线性镇定控制器,us2为方位系统鲁棒控制律,通过设计us2使系统稳定。
将式(26)代入式(25),令角度误差估计
Figure BDA0002313814010000079
得:
Figure BDA00023138140100000710
Figure BDA0002313814010000081
式中,方位系统回归器
Figure BDA0002313814010000082
为使系统稳定,us2应该满足:
Figure BDA0002313814010000083
式中ε为正的任意小的参数,us2用于支配系统模型的各种不确定性
Figure BDA0002313814010000084
Figure BDA0002313814010000085
引理1:定义中间变量ha为:
Figure BDA0002313814010000086
式中,θam=θamaxamin,设计us2如下:
Figure BDA0002313814010000087
k2为系统正反馈增益;
证明:已知ha>0,则us2满足式(28),则:
Figure BDA0002313814010000088
根据杨式不等式得:
Figure BDA0002313814010000089
Figure BDA00023138140100000810
引理1得证。
则方位系统误差反馈律ua0
Figure BDA00023138140100000811
定义参数自适应不连续映射:
Figure BDA0002313814010000091
给出参数自适应率:
Figure BDA0002313814010000092
其中Γ>0为自适应矩阵,τ为自适应函数,
引理2:对任意的自适应函数τ和不连续映射,有:
Figure BDA0002313814010000093
证明:当不连续映射不起作用时,有
Figure BDA0002313814010000094
Figure BDA0002313814010000095
且Γτ>0时有
Figure BDA0002313814010000096
Figure BDA0002313814010000097
且Γτ<0时有
Figure BDA0002313814010000098
因此
Figure BDA0002313814010000099
引理得证。
同理,对于俯仰系统未建模动态da(x,t)有:
Figure BDA00023138140100000910
其中dnp为dp(x,t)的常值分量,
Figure BDA00023138140100000911
为俯仰系统干扰估计误差,将dnp略去,俯仰系统状态空间形式可写成:
Figure BDA00023138140100000912
其中,up0为方位系统误差反馈律,
Figure BDA00023138140100000913
同样满足假设1。
定义误差变量:
Figure BDA00023138140100000914
式中z3为俯仰系统跟踪误差,x3d为俯仰系统参考指令,同样满足假设2,k3为俯仰系统反馈增益,z4为俯仰系统稳态误差,x4q为中间变量。因此设计控制器保证z4趋于零,可使跟踪误差也趋于零。
由式(44)和式(45)得
Figure BDA0002313814010000101
由式(46)设计控制器结构如下:
Figure BDA0002313814010000102
式中,upa为方位系统自适应补偿项,ups为俯仰系统鲁棒反馈项,k4为俯仰系统正反馈增益,us3为俯仰系统线性镇定控制器,us4为俯仰系统鲁棒控制律,通过设计us4使系统稳定。
与方位系统同理,为使系统稳定,us4应该满足:
Figure BDA0002313814010000103
式中,俯仰系统回归器
Figure BDA0002313814010000104
式中ε为正的任意小的参数。
参考方位系统,根据引理1和引理2,得俯仰系统误差反馈律up0
Figure BDA0002313814010000105
式中,中间变量hp>0,俯仰角度误差估计
Figure BDA0002313814010000106
Figure BDA0002313814010000107
为θp的估计值。
步骤2-2、设计火箭炮在行进间发射的位置伺服系统线性扩张状态观测器为:
Figure BDA0002313814010000108
式中,
Figure BDA0002313814010000109
是方位轴和俯仰轴位置估计;
Figure BDA00023138140100001010
是耦合系统输出角速度估计,
Figure BDA00023138140100001011
是耦合系统未建模动态估计,ω0为耦合系统观测器带宽,U(t)为耦合系统输入控制量,B(x,t)为输入矩阵,F(x,t)为已建模部分。
设计耦合系统自适应鲁棒控制器为:
Figure BDA0002313814010000111
则方位系统控制器为:
Figure BDA0002313814010000112
同理,设计俯仰系统控制器为:
Figure BDA0002313814010000113
步骤2-3、控制性能分析:
引理3:使用不连续映射自适应律,并且
Figure BDA0002313814010000114
时,设计的控制器有如下性质:
1)控制器中所有信号有界的,定义李雅普诺夫函数Vβ
Figure BDA0002313814010000115
满足如下不等式:
Figure BDA0002313814010000116
式中,λ=2k21max
2)若在某一时刻t0之后,系统只存在参数不确定性,即
Figure BDA0002313814010000117
那么控制律式(34)和式(48)下的系统渐近稳定。
证明:李雅普诺夫函数Vβ对时间微分并结合式(29)得:
Figure BDA0002313814010000118
表明Vβ有界,性质(1)得证。
Figure BDA0002313814010000119
令李雅普诺夫函数为:
Figure BDA00023138140100001110
则V对时间得微分:
Figure BDA00023138140100001111
由式(57)得
Figure BDA0002313814010000121
Barbalet引理:若x∈[0,∞)→R一致连续。且
Figure BDA0002313814010000122
存在且有界,那么limt→∞x(t)=0。
则由Barbalet引理得t→∞时z2→0,性质2得证。
方位系统积分器串联型为:
Figure BDA0002313814010000123
方位系统经过扰动补偿后,通过自适应鲁棒控制器控制。同理可得俯仰系统控制器性能分析,则耦合系统通过扰动补偿后变成线性积分器串联系统为:
Figure BDA0002313814010000124
在系统扰动和参数不确定性条件下,基于扰动补偿的自适应鲁棒控制器能使火箭炮在行进间发射的位置伺服系统闭环稳定。
仿真分析:
在MATLAB/Simulink中建立系统仿真模型,两轴系统参数如下:
Jp=8.232×10-3kg·m2,Ja=0.02×10-3kg·m2,Ba=0.014N·m/rad,Bp=0.034N·m/rad,ip=166,ia=124。
方位系统控制器参数:
θa(0)=[0,0]Tamin=[1,0.8]Tamax=[2.1,2.8]T1=2.1,θ2=1.94,k1=100,k2=40,Γ=diag[6,20],方位轴观测器带宽ω0=300rad/s。
俯仰系统控制器参数:
θp(0)=[0,0]Tpmin=[1.26,0.95]Tpmax=[1.7,1.9]T3=1.1,θ4=1.4,kp1=100,kp2=50,Γ=diag[20,30],方位轴观测器带宽ω0=300rad/s。
如图3~图6所示,自适应鲁棒控制器对耦合系统的跟踪误差远小于PID控制,且误差收敛更快,及较强的抑制连续燃气流冲击的能力。使火箭炮在行进间发射时由更好的动态性能。

Claims (5)

1.一种火箭炮在行进间发射的位置伺服系统的控制方法,方法步骤如下:
步骤1、建立基于驱动器在转矩模式下的火箭炮行进间发射的位置伺服系统模型,包括位置伺服系统动力学模型和位置伺服系统数学模型,转入步骤2;
步骤2、针对火箭炮在行进间发射不确定性,对驱动器在转矩模式下的火箭炮在行进间发射的位置伺服系统设计基于扰动补偿的自适应鲁棒控制器,并和传统PID控制进行比较,仿真证明自抗扰控制性能优于PID。
2.根据权利要求1所述的火箭炮行进间发射伺服系统的控制方法,其特征在于:步骤1中,建立基于驱动器在转矩模式下的火箭炮行进间发射的位置伺服系统模型,包括位置伺服系统动力学模型和位置伺服系统数学模型,具体如下:
步骤1-1、建立火箭炮在行进间发射的位置伺服系统动力学模型,火箭炮两轴系统在空间上分为俯仰系统和方位系统,以O为坐标原点,建立xyz三轴坐标系,俯仰系统绕俯仰轴y运动,方位系统绕z轴运动;
坐标系Oxayaza表示方位系统坐标系,坐标系Oxpypzp表示俯仰系统坐标系,方位系统绕转动轴Oza转动角度γ,俯仰系统绕转动轴Oyp转动角度β;
定义俯仰系统投影到方位系统的转移矩阵Pa
Figure FDA0002313814000000011
定义方位系统角速度矢量ωa
Figure FDA0002313814000000012
定义系统角速度矢量角速度ωp
Figure FDA0002313814000000013
假设方位系统和俯仰系统相对于各自坐标系是对称的,则俯仰系统的转动惯量矩阵Jp和方位系统的转动惯量矩阵Ja分别为:
Figure FDA0002313814000000014
Figure FDA0002313814000000015
式中:
Figure FDA0002313814000000016
分别表示俯仰系统转动惯量,
Figure FDA0002313814000000017
表示方位系统转动惯量;
则俯仰系统相对于方位系统的转动惯量矩阵Jpa为:
Figure FDA0002313814000000021
则俯仰系统相对于方位系统Oza轴转动惯量
Figure FDA0002313814000000022
为:
Figure FDA0002313814000000023
俯仰系统相对于转动轴Oyp的转动惯量
Figure FDA0002313814000000024
为:
Figure FDA0002313814000000025
两转动轴联动时,方位系统对方位轴Oza转动惯量
Figure FDA0002313814000000026
为:
Figure FDA0002313814000000027
根据刚体的欧拉动力学方程,得俯仰系统在其连体坐标系下力矩为:
Figure FDA0002313814000000028
其中,Mxp、Myp、Mzp分别为俯仰系统在x、y、z轴转矩;
而方位系统在方位系统坐标系下的力矩等于俯仰系统在其连体坐标系下的力矩在方位系统坐标系上的投影与方位系统在其连体坐标系下的力矩之和,则火箭炮全系统所受力矩在方位系统坐标系下为:
Figure FDA0002313814000000029
式中,Mxp、Myp、Mzp分别为俯仰系统在x、y、z轴转矩;Maa为方位系统在其连体坐标系下的力矩。
同理可得方位系统受系统对方位轴的转矩
Figure FDA00023138140000000210
为:
Figure FDA00023138140000000211
得两轴转台的转矩方程为:
Figure FDA00023138140000000212
Figure FDA0002313814000000031
得当驱动器配置在转矩模式下时,两轴系统运动方程为:
Figure FDA0002313814000000032
式中Ktp为俯仰系统电压转矩系数,Kta为方位系统电压转矩系数,up为俯仰轴输入电压,ua为方位轴输入电压,ip为俯仰系统减速比,ia为方位系统减速比,Bp为俯仰轴粘性摩擦Ba为方位轴粘性摩擦,Tfp为俯仰轴折算到电机端的未建模摩擦力矩和干扰,Tfa方位轴折算到电机端的未建模摩擦力矩和干扰。
步骤1-2、建立火箭炮方位和俯仰系统数学模型
电机惯性负载的动力学运动方程为:
Figure FDA0002313814000000033
其中ω表示角位移,m表示折算到电机端的惯性负载,K表示扭矩常数,u是系统控制输入,Bp表示粘性摩擦系数,Tf表示系统折算到电机端的未建模摩擦力矩和干扰。
根据式(16)、(17),火箭炮耦合系统数学模型状态空间表达式为:
Figure FDA0002313814000000034
其中x1,x3分别表示方位系统和俯仰系统的位置角度,x2,x4分别表示方位系统和俯仰系统减速器输出角度,定义向量θa=[θ1 θ2]T为方位系统不确定性参数,同理θp=[θ3 θ4]T为俯仰系统不确定性参数;dp(x,t)为俯仰未建模干扰;da(x,t)为方位系统未建模干扰。
3.根据权利要求1所述的火箭炮在行进间发射的位置伺服系统的模型,其特征在于:所述俯仰系统外部干扰和方位系统外部干扰均包括未建模摩擦、火箭炮在行驶过程中路面扰动、燃气流冲击干扰及惯性力矩扰动。
4.根据权利要求1或2所述的火箭炮在行进间发射的位置伺服系统的控制方法,其特征在于:步骤2中,对驱动器在转矩模式下的火箭炮在行进间发射的位置伺服系统设计基于扰动补偿的自适应鲁棒控制器,具体步骤如下:
步骤2-1、设计方位系统自适应鲁棒控制器:
对于方位系统未建模动态da(x,t)有:
Figure FDA0002313814000000041
其中dna为da(x,t)的常值分量,
Figure FDA0002313814000000042
为干扰估计误差,将dna略去,将方位系统状态空间形式写完:
Figure FDA0002313814000000043
其中,ua0为方位系统误差反馈律;
假设1:参数不确定性θa的大小范围已知,da(x,t)有界,即
Figure FDA0002313814000000044
式中θamax,θamin为向量θa的上确界和下确界,δd为已知有界值或函数。
假设2:方位系统参考指令x1d二阶连续,且位置指令、速度指令和加速度指令有界。
定义误差变量:
Figure FDA0002313814000000045
式中z1为方位系统跟踪误差,k1为方位系统反馈增益,z2为方位系统稳态误差,x2q为中间变量。因此设计控制器保证z2趋于零,可使跟踪误差也趋于零,系统获得更好的跟踪性能。因此,设计控制器的目标应该为使z2趋于0。
由式(22)和式(24)得
Figure FDA0002313814000000046
由式(25)设计控制器结构如下:
Figure FDA0002313814000000047
式中,uaa为方位系统自适应补偿项,
Figure FDA0002313814000000048
为θa的估计值,us为方位系统鲁棒反馈项,k2为方位系统正反馈增益,us1为方位系统线性镇定控制器,us2为方位系统鲁棒控制律,通过设计us2使系统稳定。
将式(26)代入式(25),令角度误差估计
Figure FDA0002313814000000049
得:
Figure FDA00023138140000000410
式中,方位系统回归器
Figure FDA0002313814000000051
为使系统稳定,us2应该满足:
Figure FDA0002313814000000052
式中ε为正的任意小的参数,us2用于支配系统模型的各种不确定性
Figure FDA0002313814000000053
Figure FDA0002313814000000054
引理1:定义中间变量ha为:
Figure FDA0002313814000000055
式中,θam=θamaxamin,设计us2如下:
Figure FDA0002313814000000056
证明:已知ha>0,则us2满足式(28)。则:
Figure FDA0002313814000000057
根据杨式不等式得:
Figure FDA0002313814000000058
Figure FDA0002313814000000059
引理1得证。
则方位系统误差反馈律ua0
Figure FDA00023138140000000510
定义参数自适应不连续映射:
Figure FDA00023138140000000511
给出参数自适应率:
Figure FDA00023138140000000512
其中Γ>0为自适应矩阵,τ为自适应函数,
引理2:对任意的自适应函数τ和不连续映射,有:
Figure FDA0002313814000000061
俯仰系统控制律设计与方位系统设计方法相同。
步骤2-2、设计火箭炮在行进间发射的位置伺服系统线性扩张状态观测器为:
Figure FDA0002313814000000062
式中,
Figure FDA0002313814000000063
是方位轴和俯仰轴位置估计;
Figure FDA0002313814000000064
是耦合系统输出角速度估计,
Figure FDA0002313814000000065
是耦合系统未建模动态估计,ω0为耦合系统观测器带宽,U(t)为耦合系统输入控制量,B(x,t)为输入矩阵,F(x,t)为已建模部分。
设计耦合系统自适应鲁棒控制器为:
Figure FDA0002313814000000066
则方位系统控制器为:
Figure FDA0002313814000000067
同理,设计俯仰系统控制器为:
Figure FDA0002313814000000068
up0为俯仰系统误差反馈律,设计方法与方位系统相同。
5.根据权利要求1或2所述的火箭炮在行进间发射的位置伺服系统的控制方法,其特征在于:对所述的驱动器在转矩模式下的火箭炮在行进间发射的位置伺服系统设计基于扰动补偿的自适应鲁棒控制器,对其控制性能分析:
引理3:使用不连续映射自适应律,并且
Figure FDA0002313814000000069
时,设计的控制器有如下性质:
1)控制器中所有信号有界的,定义李雅普诺夫函数Vβ
Figure FDA00023138140000000610
满足如下不等式:
Figure FDA00023138140000000611
式中,λ=2k21max
2)若在某一时刻t0之后,系统只存在参数不确定性,即
Figure FDA00023138140000000612
那么控制律(34)和(48)下的系统渐近稳定。
方位系统积分器串联型为:
Figure FDA0002313814000000071
方位系统经过扰动补偿后,通过自适应鲁棒控制器控制。同理可得俯仰系统控制器性能分析,则耦合系统通过扰动补偿后变成线性积分器串联系统为:
Figure FDA0002313814000000072
在系统扰动和参数不确定性条件下,基于扰动补偿的自适应鲁棒控制器能使火箭炮在行进间发射的位置伺服系统闭环稳定。
CN201911269669.XA 2019-12-11 2019-12-11 一种火箭炮在行进间发射的位置伺服系统的控制方法 Withdrawn CN111142380A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911269669.XA CN111142380A (zh) 2019-12-11 2019-12-11 一种火箭炮在行进间发射的位置伺服系统的控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911269669.XA CN111142380A (zh) 2019-12-11 2019-12-11 一种火箭炮在行进间发射的位置伺服系统的控制方法

Publications (1)

Publication Number Publication Date
CN111142380A true CN111142380A (zh) 2020-05-12

Family

ID=70518099

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911269669.XA Withdrawn CN111142380A (zh) 2019-12-11 2019-12-11 一种火箭炮在行进间发射的位置伺服系统的控制方法

Country Status (1)

Country Link
CN (1) CN111142380A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112696981A (zh) * 2020-12-21 2021-04-23 西北机电工程研究所 一种大地坐标系下全闭环干扰速率补偿自稳定控制方法
CN116277034A (zh) * 2023-05-15 2023-06-23 北京壹点灵动科技有限公司 应对负载变化的机器人控制方法、装置及电子设备

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104252134A (zh) * 2014-09-17 2014-12-31 南京理工大学 基于扩张状态观测器的电机伺服系统自适应鲁棒位置控制方法
CN106527126A (zh) * 2015-09-11 2017-03-22 南京理工大学 电机伺服系统非线性鲁棒自适应位置控制器的实现方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104252134A (zh) * 2014-09-17 2014-12-31 南京理工大学 基于扩张状态观测器的电机伺服系统自适应鲁棒位置控制方法
CN106527126A (zh) * 2015-09-11 2017-03-22 南京理工大学 电机伺服系统非线性鲁棒自适应位置控制器的实现方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
郑颖: "某集束火箭炮位置伺服系统自抗扰方法研究", 《中国博士学位论文全文数据库(电子期刊)》 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112696981A (zh) * 2020-12-21 2021-04-23 西北机电工程研究所 一种大地坐标系下全闭环干扰速率补偿自稳定控制方法
CN112696981B (zh) * 2020-12-21 2023-02-21 西北机电工程研究所 一种大地坐标系下全闭环干扰速率补偿自稳定控制方法
CN116277034A (zh) * 2023-05-15 2023-06-23 北京壹点灵动科技有限公司 应对负载变化的机器人控制方法、装置及电子设备
CN116277034B (zh) * 2023-05-15 2023-09-12 北京壹点灵动科技有限公司 应对负载变化的机器人控制方法、装置及电子设备

Similar Documents

Publication Publication Date Title
CN109189085B (zh) 基于事件触发的航天器网络化系统姿态控制方法
CN108942924B (zh) 基于多层神经网络的模型不确定性机械臂运动控制方法
CN110220416B (zh) 一种自适应快速弹道跟踪制导方法
WO2015013841A1 (zh) 基于滑模和自抗扰技术的坦克炮控系统的复合控制方法
CN107783422B (zh) 采用捷联惯导的火炮瞄准稳定系统控制方法
CN111142380A (zh) 一种火箭炮在行进间发射的位置伺服系统的控制方法
Yuan et al. Active disturbance rejection adaptive control of tank turret-gun control systems
Yuan et al. Nonlinear adaptive robust precision pointing control of tank servo systems
Zhao et al. Maneuver control of the hypersonic gliding vehicle with a scissored pair of control moment gyros
CN109062039B (zh) 一种三自由度Delta并联机器人的自适应鲁棒控制方法
Zheng et al. Nonlinear motor-mechanism coupling tank gun control system based on adaptive radial basis function neural network optimised computed torque control
CN112180961B (zh) 一种全状态受限平流层飞艇轨迹跟踪控制方法及系统
Lei et al. Application of ADRC in stability control of tank gun system
CN112936277A (zh) 一种水下机器人-机械手系统固定时间轨迹跟踪方法
CN112696981B (zh) 一种大地坐标系下全闭环干扰速率补偿自稳定控制方法
CN116203842A (zh) 运载火箭的自适应容错反步姿态控制设计方法
CN110673473B (zh) 两轴耦合坦克炮系统的误差符号积分鲁棒自适应控制方法
Suoliang et al. Finite-time robust control for inertially stabilized platform based on terminal sliding mode
Li et al. Adaptive robust control of muzzle vibration for marching tank based on disturbance observer
CN113212803A (zh) 一种兼顾动态跟踪与定点成像任务的联合姿态机动方法
CN112729012B (zh) 一种大地坐标下等效闭环干扰速率补偿自稳定控制方法
CN111306995A (zh) 一种面向弹体颤振抑制的组合控制器设计方法
FENG et al. Flow and pressure compound control strategy for missile hydraulic erection system
Chang et al. Research on an Anti-Disturbance Control Method for Artillery Systems
CN114454161B (zh) 一种基于球形电机驱动的机械手刚柔耦合系统

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
WW01 Invention patent application withdrawn after publication

Application publication date: 20200512

WW01 Invention patent application withdrawn after publication