CN110673473B - Error Sign Integral Robust Adaptive Control Method for Two-Axis Coupled Tank Gun System - Google Patents
Error Sign Integral Robust Adaptive Control Method for Two-Axis Coupled Tank Gun System Download PDFInfo
- Publication number
- CN110673473B CN110673473B CN201910865903.9A CN201910865903A CN110673473B CN 110673473 B CN110673473 B CN 110673473B CN 201910865903 A CN201910865903 A CN 201910865903A CN 110673473 B CN110673473 B CN 110673473B
- Authority
- CN
- China
- Prior art keywords
- tank gun
- gun system
- formula
- error
- equation
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 32
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 19
- 238000010168 coupling process Methods 0.000 claims abstract description 17
- 238000005859 coupling reaction Methods 0.000 claims abstract description 17
- 230000008878 coupling Effects 0.000 claims abstract description 16
- 238000013461 design Methods 0.000 claims description 10
- 239000011159 matrix material Substances 0.000 claims description 10
- 238000009795 derivation Methods 0.000 claims description 3
- 238000013178 mathematical model Methods 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 2
- 230000005484 gravity Effects 0.000 claims 3
- 230000006978 adaptation Effects 0.000 claims 1
- 238000005119 centrifugation Methods 0.000 claims 1
- 230000010354 integration Effects 0.000 claims 1
- 230000002441 reversible effect Effects 0.000 claims 1
- 238000012795 verification Methods 0.000 claims 1
- 238000004422 calculation algorithm Methods 0.000 abstract description 8
- 238000011161 development Methods 0.000 abstract description 4
- 230000000694 effects Effects 0.000 abstract description 4
- 230000009471 action Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 9
- 230000008569 process Effects 0.000 description 4
- 238000004088 simulation Methods 0.000 description 3
- 206010044565 Tremor Diseases 0.000 description 2
- 238000005312 nonlinear dynamic Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive 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/042—Adaptive 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
本发明公开了一种两轴耦合坦克炮系统的误差符号积分鲁棒自适应控制方法,运用其误差符号积分鲁棒自适应控制算法可以法对于这类有着强不确定性和非线性的系统进行控制。本发明是在以下的背景提出的:由于现在坦克炮的发展对于其精度的控制有了更高的要求,以往采用俯仰和方向的建模方法并且分别进行控制的方法已经不足以对于整个系统有着良好的控制效果,而两轴耦合的建模方案可以有效的还原坦克炮实际的运动情况。然而对于这类两轴耦合的坦克炮系统,由于其耦合特性和非线性,极大的增加了对于这类系统的控制难度。本发明所公开的控制方法有效的解决了两轴耦合坦克炮系统的问题,使得整个系统的控制精度得到了提升,获得了良好的跟踪性能。
The invention discloses an error sign integral robust adaptive control method for a two-axis coupled tank gun system, and the error sign integral robust adaptive control algorithm can be used to control such systems with strong uncertainty and nonlinearity. control. The present invention is proposed in the following context: Since the development of the tank gun has higher requirements for its precision control, the previous modeling method of pitch and direction and the method of separately controlling it are no longer sufficient for the whole system. Good control effect, and the two-axis coupled modeling scheme can effectively restore the actual movement of the tank gun. However, for such two-axis coupled tank gun systems, due to its coupling characteristics and nonlinearity, the control difficulty of such systems is greatly increased. The control method disclosed in the invention effectively solves the problem of the two-axis coupling tank gun system, improves the control precision of the entire system, and obtains good tracking performance.
Description
技术领域technical field
本发明涉及运动控制技术领域,具体涉及一种两轴耦合坦克炮系统的误差符号积分鲁棒自适应控制方法。The invention relates to the technical field of motion control, in particular to an error symbol integral robust adaptive control method of a two-axis coupled tank gun system.
背景技术Background technique
在现代路基武器系统中,坦克依然作为地面上主要的作战武器之一。而坦克的主要攻击方式则来自于坦克所搭载的坦克炮武器。随着新一代装甲武器装备趋于集成系统化、自动化、轻型化、无人化,无人炮塔系统在发展过程中,已经在许多军事强国竞相开发与研制,但是它在总体性能上逊色有人炮塔不少。无人炮塔又称为顶置武器炮塔,是指坦克或装甲车的武器系统安装在车体顶部,炮塔内无乘员,全部乘员都位于车体。坦克无人炮塔的发展不管对于乘车人员的内部环境,坦克搭载人员安全性和战场的维修效果都有不小的提升。所以对于这种路基移动平台所搭载的无人炮塔控制在未来陆军战争中显得非常重要,尤其是对于五代坦克的研发与制造都有着关键的作用。然而对于这类两轴耦合的坦克炮系统,由于其不确定性,未建模误差和非线性等因素,极大的增加了对于这类系统的控制难度。所以采取传统的控制方法,很有可能无法达到控制预期的目标,如果扰动量比较大,传统的控制方法甚至可能导致系统失稳。In modern road-based weapon systems, tanks are still one of the main combat weapons on the ground. The main attack method of the tank comes from the tank gun weapon carried by the tank. As the new generation of armored weapons and equipment tends to be integrated, systematic, automated, lightweight and unmanned, the unmanned turret system has been developed and developed in many military powers in the process of development, but its overall performance is inferior to manned turrets Not a lot. Unmanned turret, also known as overhead weapon turret, means that the weapon system of a tank or armored vehicle is installed on the top of the vehicle body, there is no crew in the turret, and all crew members are located in the vehicle body. The development of the unmanned turret of the tank has greatly improved the safety of the crew and the maintenance effect of the battlefield, regardless of the internal environment of the occupants. Therefore, the control of the unmanned turret carried by this road-based mobile platform is very important in the future army war, especially for the development and manufacture of the fifth-generation tanks. However, for this type of two-axis coupled tank gun system, due to its uncertainty, unmodeled error and nonlinearity, it greatly increases the control difficulty of this type of system. Therefore, if the traditional control method is adopted, the expected control goal may not be achieved. If the disturbance is relatively large, the traditional control method may even lead to system instability.
所以针对这种坦克炮两轴耦合系统的控制方法不断被相继提出。PID算法能够对于整个系统达到一定的控制,但是跟踪的精度,误差收敛的时间,尤其是外界干扰对于整个系统的影响,这几个因素使得PID算法对于整个控制系统的控制性能不能达到一个非常良好的状态。继而有人提出采取滑膜变结构控制算法(SMC)对于这样外界干扰大的系统进行控制。但是由于SMC控制的不连续性,其实际的不联系性体现在以切变面为界,切换面以上滑膜轨迹驱动方向与切换面以下滑膜驱动方向是相反的,且交于切换面,这个相交是不连续的。所以在实际系统中,尤其是本文采用的坦克炮两轴耦合系统中,这种缺点会被不断放大,导致系统震颤效应愈发明显,所以在炮角的具体调动中会增加炮口的抖动,对于整体的控制精度产生很大的影响。自抗扰控制(ADRC)对于这个控制系统能够达到一个良好的控制,但是ADRC的控制性能十分依赖算法增益参数的设置,如果对于系统的建模参数出现不准确的情况,或者在实际系统中很多因素没有考虑进去,ADRC的控制性能会有极大的下降。而ADRC控制系统中采用的状态扩张观测器(ESO)主要还是基于模型的输出误差,所以往往不能观测外部误差,而本模型的实际系统中,外部扰动同样也是不能够忽略的因素,所以同样也会减低ADRC控制算法的控制性能。Therefore, the control methods for the two-axis coupling system of this kind of tank gun have been continuously proposed. The PID algorithm can achieve a certain degree of control for the entire system, but the accuracy of tracking, the time for error convergence, and especially the impact of external disturbances on the entire system, these factors make the control performance of the PID algorithm for the entire control system not reach a very good level. status. Then someone proposed to use the Synovial Variable Structure Control (SMC) algorithm to control such a system with large external disturbance. However, due to the discontinuity of SMC control, its actual disconnection is reflected in the shear plane as the boundary, the driving direction of the synovial trajectory above the switching plane and the driving direction of the synovial film below the switching plane are opposite, and intersect the switching plane, This intersection is discontinuous. Therefore, in the actual system, especially in the two-axis coupling system of the tank gun used in this paper, this shortcoming will be continuously amplified, resulting in more obvious system tremor effect, so the specific adjustment of the gun angle will increase the muzzle jitter. It has a great impact on the overall control accuracy. Active Disturbance Rejection Control (ADRC) can achieve a good control for this control system, but the control performance of ADRC is very dependent on the setting of the algorithm gain parameters. If the modeling parameters of the system are inaccurate, or there are many If the factors are not taken into account, the control performance of ADRC will be greatly reduced. The Extended State Observer (ESO) used in the ADRC control system is mainly based on the output error of the model, so it is often impossible to observe the external error. In the actual system of this model, the external disturbance is also a factor that cannot be ignored, so it is also It will reduce the control performance of the ADRC control algorithm.
发明内容SUMMARY OF THE INVENTION
本发明的目的在于提供一种两轴耦合坦克炮系统的误差符号积分鲁棒自适应控制方法,基于传统的RISE控制方法,融合自适应控制的思想,不仅仅可以有效地处理建模不确定性的问题,而且可以获得连续的控制输入和渐近的跟踪性能。在自适应部分能够更好的解决模型不确定项系数的影响,进而有着更好的控制性能,同时解决了非线性,模型不确定,外界干扰等问题,达到系统控制精度的要求。The purpose of the present invention is to provide an error symbol integral robust adaptive control method for a two-axis coupled tank gun system. Based on the traditional RISE control method and integrating the idea of adaptive control, it can not only effectively deal with modeling uncertainty , and can obtain continuous control input and asymptotic tracking performance. In the adaptive part, it can better solve the influence of the coefficient of the model uncertainty, and then have better control performance. At the same time, it solves the problems of nonlinearity, model uncertainty, external interference, etc., and meets the requirements of system control accuracy.
实现本发明目的技术解决方案为:一种两轴耦合坦克炮系统的误差符号积分鲁棒自适应控制方法,包括以下步骤:The technical solution for realizing the object of the present invention is: a method for robust self-adaptive control method of error sign integral of two-axis coupled tank gun system, comprising the following steps:
步骤1,建立两轴耦合坦克炮系统的动力学的数学模型;
步骤2,设计误差符号积分鲁棒自适应控制器;
步骤3,运用李雅普诺夫稳定性理论进行稳定性证明,引入Barbalat引理得到系统的全局渐近稳定的结果。In
本发明与现有技术相比,其显著优点是:有效解决了传统控制方法对于本文两轴耦合坦克炮的问题,对于控制精度,误差收敛时间的减少,跟踪性能和对于外界误差的抗干扰能力都有很大的提升;仿真结果验证了其有效性。Compared with the prior art, the present invention has significant advantages as follows: it effectively solves the problems of the traditional control method for the two-axis coupled tank gun in this paper, and for the control accuracy, the reduction of error convergence time, the tracking performance and the anti-interference ability for external errors Both are greatly improved; the simulation results verify its effectiveness.
附图说明Description of drawings
图1是本发明两轴耦合坦克炮系统的误差符号积分鲁棒自适应(RISEA)控制方法原理示意图;Fig. 1 is the principle schematic diagram of the error sign integral robust adaptive (RISEA) control method of the two-axis coupling tank gun system of the present invention;
图2是两轴耦合坦克炮系统示意简图;Figure 2 is a schematic diagram of a two-axis coupled tank gun system;
图3本发明所设计的RISEA控制器作用下系统高低方向输出对期望指令的跟踪过程图;Fig. 3 is the tracking process diagram of the system high and low direction output to the desired command under the action of the RISEA controller designed by the present invention;
图4本发明所设计的RISEA控制器作用下系统水平方向输出对期望指令的跟踪过程图;Fig. 4 is a tracking process diagram of the desired command output in the horizontal direction of the system under the action of the RISEA controller designed by the present invention;
图5是RISEA控制器作用下系统高低方向的跟踪误差随时间变化的曲线图;Fig. 5 is a curve diagram of the tracking error of the system in the high and low directions with time under the action of the RISEA controller;
图6是RISEA控制器作用下系统水平方向的跟踪误差随时间变化的曲线图;Fig. 6 is the curve diagram of the tracking error in the horizontal direction of the system under the action of the RISEA controller as a function of time;
图7是系统干扰为时RISEA、RISE、PID三种控制器分别作用下系统水平方向的跟踪误差的对比曲线图;Figure 7 shows the system interference as The comparison curve of the tracking error in the horizontal direction of the system under the action of RISEA, RISE and PID controllers respectively;
图8是系统干扰为时RISEA、RISE、PID三种控制器分别作用下系统水平方向的跟踪误差的对比曲线图;Figure 8 shows the system interference as The comparison curve of the tracking error in the horizontal direction of the system under the action of RISEA, RISE and PID controllers respectively;
图9是RISEA控制器中参数θ11的估计值随时间变化的曲线图;FIG. 9 is a graph of the estimated value of the parameter θ 11 in the RISEA controller as a function of time;
图10是RISEA控制器中参数θ12的估计值随时间变化的曲线图;Figure 10 is a graph of the estimated value of the parameter θ 12 in the RISEA controller as a function of time;
图11是RISEA控制器中参数θ13的估计值随时间变化的曲线图;Figure 11 is a graph of the estimated value of the parameter θ 13 in the RISEA controller as a function of time;
图12是RISEA控制器中参数θ21的估计值随时间变化的曲线图;Figure 12 is a graph of the estimated value of the parameter θ 21 in the RISEA controller as a function of time;
图13是RISEA控制器中参数θ22的估计值随时间变化的曲线图;Figure 13 is a graph of the estimated value of the parameter θ 22 in the RISEA controller as a function of time;
图14是RISEA控制器中参数θ23的估计值随时间变化的曲线图;Figure 14 is a graph of the estimated value of the parameter θ 23 in the RISEA controller as a function of time;
图15是系统干扰为时RISEA控制器分别作用下系统高低方向的输入图;Figure 15 is the system interference as When the RISEA controller acts on the input diagram of the high and low directions of the system respectively;
图16是系统干扰为时RISEA控制器分别作用下系统水平方向的输入图。Figure 16 is the system interference as When the RISEA controller acts on the input map of the horizontal direction of the system respectively.
具体实施方式Detailed ways
下面结合附图及具体实施例对本发明作进一步详细说明。The present invention will be further described in detail below with reference to the accompanying drawings and specific embodiments.
结合图1-图2,本发明所述的两轴耦合坦克炮系统的误差符号积分鲁棒自适应控制方法,包括以下步骤:1-2, the error symbol integral robust adaptive control method of the two-axis coupled tank gun system according to the present invention includes the following steps:
步骤1,建立两轴耦合炮系统的动力学的数学模型,具体如下:
步骤1.1、考虑动力学模型建模思路综合机械臂的建模思想,采用Lagrange-Euler法建立坦克炮的动力学模型:Step 1.1. Consider the modeling idea of the dynamic model, and use the Lagrange-Euler method to build the dynamic model of the tank gun:
因此,根据Lagrange-Euler法,两轴耦合坦克炮系统的动力学方程为:Therefore, according to the Lagrange-Euler method, the dynamic equation of the two-axis coupled tank gun system is:
式(1)中转动角度为q=[q1 q2]T,其中q1为两轴耦合坦克炮系统水平方向的转动角度,q2为两轴耦合坦克炮系统高低方向的转动角度;Ma∈R2×2为惯性对称正定矩阵;Mb∈R2 ×2为科氏力离心矩阵;Mg∈R2×1为重力矩向量,Mg=[Tg1 Tg2]T,Tg1两轴耦合坦克炮系统为水平方向的重力力矩,Tg1=0,Tg2为两轴耦合坦克炮系统高低方向的重力力矩;坦克炮系统输入T=[T1 T2]T,其中T1为两轴耦合坦克炮系统的水平方向的输入,T2为两轴耦合坦克炮系统的高低方向的输入力矩;摩擦力矩Tf=[Tf1 Tf2],Tf1为两轴耦合坦克炮系统的水平方向摩擦力产生的阻力矩,Tf2为两轴耦合坦克炮系统的高低方向摩擦力产生的阻力矩,Tf采用lugre模型进行拟合逼近:In formula (1), the rotation angle is q=[q 1 q 2 ] T , where q 1 is the rotation angle in the horizontal direction of the two-axis coupling tank gun system, and q 2 is the rotation angle in the height direction of the two-axis coupling tank gun system; M a ∈R 2×2 is an inertial symmetric positive definite matrix; M b ∈ R 2 ×2 is a Coriolis centrifugal matrix; M g ∈ R 2×1 is a gravitational moment vector, M g =[T g1 T g2 ] T , T g1 The two-axis coupled tank gun system is the gravitational moment in the horizontal direction, T g1 = 0, T g2 is the gravitational moment in the height direction of the two-axis coupled tank gun system; the tank gun system input T = [T 1 T 2 ] T , where T 1 is the input in the horizontal direction of the two-axis coupling tank gun system, T 2 is the input torque in the vertical direction of the two-axis coupling tank gun system; friction torque T f = [T f1 T f2 ], T f1 is the two-axis coupling tank gun system The resistance torque generated by the friction force in the horizontal direction of the system, T f2 is the resistance torque generated by the friction force in the high and low directions of the two-axis coupled tank gun system, and T f is fitted and approximated by the lugre model:
i=1,2,其中,lij为摩擦力参数,i=1,2,j=1,2,3,vj为摩擦形状参数;两轴耦合坦克炮系统的总干扰d=[d1 d2]T,其中d1为两轴耦合坦克炮系统的水平方向干扰,其中d2为两轴耦合坦克炮系统的高低方向干扰;其中A11,A12,A21和A22为惯性正定矩阵的惯性项;其中B12,B21和B22为科氏离心矩阵的科氏离心项;令sinqi=si,cosqi=ci,i=1,2; i=1,2, where l ij is the friction parameter, i=1,2, j=1,2,3, v j is the friction shape parameter; the total disturbance of the two-axis coupled tank gun system d=[d 1 d 2 ] T , where d 1 is the horizontal direction interference of the two-axis coupled tank gun system, and d 2 is the high and low direction interference of the two-axis coupled tank gun system; where A 11 , A 12 , A 21 and A 22 are the inertial terms of the inertial positive definite matrix; where B 12 , B 21 and B 22 are the Coriolis centrifugal terms of the Coriolis centrifugal matrix; let sinq i =s i , cosq i =ci , i =1,2;
故Ma和Mb其中的参量由下式表达:Therefore, the parameters of M a and M b are expressed by the following formulas:
其中Iyy1,Ixx2,Iyy2和Izz2为转动惯量;Ixz2,Iyz2,Ixy2为惯性张量。Wherein I yy1 , I xx2 , I yy2 and I zz2 are moments of inertia; I xz2 , I yz2 , and I xy2 are inertia tensors.
步骤1.2、定义状态变量:且令u=Ti+Tgi,i=1,2,则式(1)运动方程转化为状态方程:Step 1.2, define state variables: And let u=T i +T gi , i=1,2, then the equation of motion of equation (1) is transformed into the equation of state:
式(2)中,其中定义摩擦函数参数为i=1,2,j=1,2,3,且定义参数估计为j=1,2,3,是对于θj的参数估计值;定义摩擦函数中的函数部分为: In formula (2), the friction function parameter is defined as i=1,2, j=1,2,3, and the parameter estimation is defined as j=1,2,3, is the parameter estimate for θ j ; the function part in the definition of the friction function is:
x1表示坦克炮水平转动角度和方向转动角度所构成的列向量,x2表示坦克炮水平转动角速度和方向转动角速度所构成的列向量; x 1 represents the column vector formed by the horizontal rotation angle and direction rotation angle of the tank gun, and x 2 represents the column vector formed by the horizontal rotation angular velocity and the direction rotation angular velocity of the tank gun;
为便于控制器设计,假设如下:To facilitate controller design, the following assumptions are made:
假设1两轴耦合坦克炮系统的总干扰d=[d1 d2]T足够光滑,使得均存在并有界即:Suppose 1 that the total disturbance d=[d 1 d 2 ] T of the two-axis coupled tank gun system is smooth enough such that Both exist and are bounded:
式(3)中上界参数δ1i,δ2i,i=1,2均为未知正常数,即具有不确定的上界,In formula (3), the upper bound parameters δ 1i , δ 2i , i=1, 2 are unknown constants, namely has an indeterminate upper bound,
转入步骤2。Go to step 2.
其中,坦克炮系统总的干扰包括外负载干扰、未建模摩擦、未建模动态、系统实际参数与建模参数的偏离造成的干扰。Among them, the total interference of the tank gun system includes external load interference, unmodeled friction, unmodeled dynamics, and the disturbance caused by the deviation of the actual parameters of the system from the modeled parameters.
步骤2、设计误差符号积分鲁棒自适应控制器,步骤如下:
步骤2.1、定义z1=x1-x1d为坦克炮系统的跟踪误差,x1d是坦克炮系统期望跟踪的位置指令且该指令二阶连续可微,根据式(2)中的第一个方程选取x2为虚拟控制,使方程趋于稳定状态;令x2eq为虚拟控制的期望值,x2eq与真实状态x2的误差为z2=x2-x2eq,对z1求导可得:Step 2.1. Define z 1 =x 1 -x 1d as the tracking error of the tank gun system, x 1d is the position command that the tank gun system expects to track, and the command is second-order continuous and differentiable, according to the first in formula (2) equation Choose x 2 as the dummy control so that the equation tends to a stable state; let x 2eq be the expected value of virtual control, the error between x 2eq and the real state x 2 is z 2 =x 2 -x 2eq , and derivation for z 1 can be obtained:
设计虚拟控制律:Design a virtual control law:
式(5)中可调增益k11、k12均为正数,则:Adjustable gain in formula (5) Both k 11 and k 12 are positive numbers, then:
由于z1(s)=G(s)z2(s),式中G(s)=1/(s+k1)是一个稳定的传递函数,当z2趋于0时,z1也必然趋于0;Since z 1 (s)=G(s)z 2 (s), where G(s)=1/(s+k 1 ) is a stable transfer function, when z 2 tends to 0, z 1 also must tend to 0;
步骤2.2、为获得一个额外的控制器设计自由度,定义一个辅助的误差信号r:Step 2.2. To obtain an additional controller design freedom, define an auxiliary error signal r:
式(7)中可调增益k21、k22均为正数;Adjustable gain in formula (7) k 21 and k 22 are both positive numbers;
根据式(2)和式(7),有如下r的展开式:According to equations (2) and (7), there are the following expansions of r:
根据式(8),基于模型的控制器可设计为:According to equation (8), the model-based controller can be designed as:
式(9)其中kr1,kr2均为正的反馈增益,Im为单位对角阵,ua为基于模型的补偿项,us为鲁棒控制律且其中us1为线性鲁棒反馈项,us2为非线性鲁棒项用于克服建模不确定性对系统性能的影响,定义参数估计的残差为j=1,2,3,将式(9)代入式(8)中得:Formula (9) where k r1 and k r2 are positive feedback gains, Im is a unit diagonal matrix, u a is a model-based compensation term, u s is a robust control law and where u s1 is a linear robust feedback term, u s2 For the nonlinear robust term used to overcome the influence of modeling uncertainty on system performance, the residual error of parameter estimation is defined as j=1, 2, 3, substituting formula (9) into formula (8), we get:
在式(10)中设计参数自适应律为:In formula (10), the design parameter adaptive law is:
Γi为自适应增益,均为常数;由于r的状态未知,因此采用分部积分方法处理,进而得到实际的自适应律:Γ i is the adaptive gain, which is constant; since the state of r is unknown, the integral by parts method is used to process it, and then the actual adaptive law is obtained:
根据误差符号积分鲁棒控制器设计方法,积分鲁棒项us2设计为:According to the error symbol integral robust controller design method, the integral robust term u s2 is designed as:
式(11)中控制器增益β需满足以下条件:Controller gain in equation (11) β must meet the following conditions:
其中β1为水平方向增益,β2为高低方向增益。Among them, β 1 is the gain in the horizontal direction, and β 2 is the gain in the high and low directions.
对式(10)等式两边求导并运用式(7)、(12)和(13)可得:Differentiating both sides of equation (10) and applying equations (7), (12) and (13), we get:
式中,不可估计项定义误差参量为Z=[z1 z2 r]T,由结构可得,一定存在全局可逆非减正函数ρ(||Z||)∈R+使得:In the formula, the unestimable term Define the error parameter as Z=[z 1 z 2 r] T , given by The structure can be obtained, there must be a globally invertible non-decreasing positive function ρ(||Z||)∈R + such that:
转入步骤3。Go to step 3.
步骤3、运用李雅普诺夫稳定性理论进行稳定性证明,引入Barbalat引理得到系统的全局渐近稳定的结果,具体如下:
定义辅助函数L(t),P(t):Define auxiliary functions L(t), P(t):
z2(0)、分别表示z2和的初始值;z 2 (0), denote z 2 and the initial value of ;
经证明当时,P(t)≥0。proven when When , P(t)≥0.
对该引理的证明:Proof of this lemma:
对式(19)两边积分并运用式(7)得:Integrate both sides of Equation (19) and apply Equation (7) to get:
对式(20)进行分部积分可得:Integrating Eq. (20) by parts can get:
故Therefore
从式(22)可以看出,若β的选取满足式所示的条件时,P(t)≥0成立,即引理得证。It can be seen from formula (22) that if the selection of β satisfies the formula When the conditions shown, P(t)≥0 is established, that is, the lemma is proved.
根据上述引理证明可知当P(t)≥0,因此定义李雅普诺夫函数如下:According to the above proof, it can be seen that when P(t)≥0, so the Lyapunov function is defined as follows:
对式(23)求导并将式(6)、(7)、(16)、(22)代入可得:Taking the derivative of equation (23) and substituting equations (6), (7), (16), and (22) into equations (23), we can get:
又因为则:also because but:
其中参数为保证的半负定行,需要r≥0,即由式(25)可知V(t)≤V(0),因此V∈L∞范数,进而可以得出z1,z2,r均有界。where parameters to guarantee The semi-negative definite line of , requires r ≥ 0, i.e. From formula (25), it can be known that V(t)≤V(0), so V∈L ∞ norm, and it can be concluded that z 1 , z 2 , and r are bounded.
对式(25)积分可得:Integrating Equation (25) can get:
由式(25)可知z1,z2,r∈L2范数,且根据式(6)、(7)、(13)和假设1可得:From equation (25), it can be known that z 1 , z 2 , r∈L 2 norm, and according to equations (6), (7), (13) and
范数,因此W是一致连续的,由Barbalat引理可知:t→∞时,W→0。故t→∞时,z1→0。 norm, so W is consistent and continuous, according to Barbalat's lemma: when t→∞, W→0. Therefore, when t→∞, z 1 →0.
因此有结论:针对两轴耦合坦克炮(2)设计的误差符号积分鲁棒控制器可以使系统得到全局渐近稳定的结果,调节增益k1、k2、kr及β可以使系统的跟踪误差在时间趋于无穷的条件下趋于零。两轴耦合坦克炮系统误差符号积分鲁棒自调节(RISEA)控制原理示意图如图2所示。Therefore, there is a conclusion: the error symbol integral robust controller designed for the two-axis coupled tank gun (2) can make the system obtain a globally asymptotically stable result, and adjusting the gains k 1 , k 2 , k r and β can make the system track The error tends to zero under the condition that time tends to infinity. The schematic diagram of the control principle of the two-axis coupled tank gun system error sign integral robust self-adjustment (RISEA) is shown in Figure 2.
实施例Example
为考核所设计的控制器性能,在仿真中取如下参数对两轴耦合坦克炮统进行建模:In order to evaluate the performance of the designed controller, the following parameters are taken to model the two-axis coupled tank gun system in the simulation:
惯性张量矩阵参数为:Iyy1=2547kg·m2、Ixx2=5400kg·m2、Iyy2=5443kg、Izz2=224kg·m2、Ixy2=-2.8kg·m2、Iyz2=13.7kg·m2、Izx2=0.8kg·m2;采用lugre摩擦模型中的形状参数为:v1=200、v2=10、v3=160。The inertia tensor matrix parameters are: I yy1 =2547kg·m 2 , I xx2 =5400kg·m 2 , I yy2 =5443kg, I zz2 =224kg·m 2 , I xy2 =-2.8kg·m 2 , I yz2 =13.7 kg·m 2 , I zx2 =0.8kg·m 2 ; the shape parameters in the lugre friction model are: v 1 =200, v 2 =10, v 3 =160.
给定系统的期望指令为 The expected instructions for a given system are
本次仿真的系统工况为时变扰动是: The system operating conditions of this simulation are time-varying disturbances:
取如下的控制器以作对比:Take the following controllers for comparison:
误差符号积分鲁棒自调节(RISEA)控制器:取控制器参数k11=150,k12=15,kr=50000;β1=100,k11=150,k12=10,kr=50000,β2=100;自适应增益为Γ1=diag[80 300],Γ2=diag[8 25],Γ1=diag[1.8 8]。Error Sign Integral Robust Self-Adjusting (RISEA) controller: take the controller parameters k 11 =150, k 12 =15, k r =50000; β 1 =100, k 11 =150, k 12 =10, k r = 50000, β 2 =100; the adaptive gain is Γ 1 =diag[80 300], Γ 2 =diag[8 25], Γ 1 =diag[1.8 8].
PID控制器:PID控制器参数的选取步骤是:首先在忽略两轴耦合坦克炮系统非线性动态的情况下,通过Matlab中的PID参数自整定功能获得一组控制器参数,然后在将系统的非线性动态加上后对已获得的自整定参数进行微调使系统获得最佳的跟踪性能。选取的高低方向的控制器参数为kP=318000,kI=100,kD=120000;选取的水平方向的控制器参数为kP=220000,kI=100,kD=850000;PID controller: The selection steps of the PID controller parameters are as follows: first, in the case of ignoring the nonlinear dynamics of the two-axis coupled tank gun system, a set of controller parameters are obtained through the PID parameter self-tuning function in Matlab, and then the system is adjusted. After the nonlinear dynamic is added, the obtained self-tuning parameters are fine-tuned so that the system can obtain the best tracking performance. The controller parameters of the selected high and low directions are k P =318000, k I =100, k D =120000; the selected controller parameters of the horizontal direction are k P =220000,k I =100,k D =850000;
RISEA控制器作用下系统输出对期望指令的跟踪如图3和图4所示,可以看出其期望指令和系统输出基本重合有良好的跟踪性能;RISEA控制器跟踪误差、RISE控制器与PID控制器的跟踪误差对比分别如图5、图6、图7和图8所示。由图5和图6可知,在RISEA控制器作用下,直驱电机系统的位置输出对指令的跟踪精度很高,稳态跟踪误差的幅值约为1×10-4(rad),从图7和图8中两种控制器的跟踪误差对比可以看出本发明所提出的RISEA控制器的跟踪误差相较于PID控制器要小很多,PID控制器的稳态跟踪误差的幅值约为2.1×10-2(rad),且相较于RISE算法而言其震颤情况也减少了很多。The tracking of the system output to the desired command under the action of the RISEA controller is shown in Figure 3 and Figure 4. It can be seen that the expected command and the system output basically overlap and have good tracking performance; the tracking error of the RISEA controller, the RISE controller and the PID control The tracking errors of the sensors are compared in Figure 5, Figure 6, Figure 7, and Figure 8, respectively. It can be seen from Figure 5 and Figure 6 that under the action of the RISEA controller, the position output of the direct drive motor system has a high tracking accuracy for the command, and the amplitude of the steady-state tracking error is about 1×10 -4 (rad). 7 and Fig. 8 compare the tracking errors of the two controllers, it can be seen that the tracking error of the RISEA controller proposed by the present invention is much smaller than that of the PID controller, and the magnitude of the steady-state tracking error of the PID controller is about 2.1×10 -2 (rad), and compared with the RISE algorithm, its tremor is also reduced a lot.
图9-图14是本发明RISEA控制器增益θ估计值随时间变化的曲线,从图中可以看出,该增益的初始值虽然是人们根据经验给定的,但是由于自适应律的作用,随着时间的变化该增益值将自动收敛到一个合适的值,因此在传统RISE算法的基础上,能够更加完善模型的摩擦参数,为实际系统应用提升性能。Figures 9 to 14 are the curves of the estimated value of the gain θ of the RISEA controller of the present invention changing with time. It can be seen from the figures that although the initial value of the gain is given by people based on experience, due to the effect of the adaptive law, The gain value will automatically converge to an appropriate value over time, so on the basis of the traditional RISE algorithm, the friction parameters of the model can be more perfected, and the performance can be improved for practical system applications.
图15和图16是系统干扰为时RISEA控制器作用下两轴耦合坦克炮控制输入随时间变化的曲线图。从图中可以看出,所获得的控制输入是低频连续的信号,更利于在实际应用中的执行。Figure 15 and Figure 16 are the system interference as The curve diagram of the control input of the two-axis coupled tank gun under the action of the RISEA controller over time. As can be seen from the figure, the obtained control input is a low-frequency continuous signal, which is more conducive to the implementation in practical applications.
Claims (2)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910865903.9A CN110673473B (en) | 2019-09-09 | 2019-09-09 | Error Sign Integral Robust Adaptive Control Method for Two-Axis Coupled Tank Gun System |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910865903.9A CN110673473B (en) | 2019-09-09 | 2019-09-09 | Error Sign Integral Robust Adaptive Control Method for Two-Axis Coupled Tank Gun System |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110673473A CN110673473A (en) | 2020-01-10 |
| CN110673473B true CN110673473B (en) | 2022-06-28 |
Family
ID=69078002
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910865903.9A Active CN110673473B (en) | 2019-09-09 | 2019-09-09 | Error Sign Integral Robust Adaptive Control Method for Two-Axis Coupled Tank Gun System |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110673473B (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117389156B (en) * | 2023-12-09 | 2024-03-22 | 中信重工机械股份有限公司 | Hydraulic mechanical arm self-adaptive integral robust control method based on friction compensation |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH10133703A (en) * | 1996-10-31 | 1998-05-22 | Fujitsu Ltd | Adaptive robust controller |
| CN104184379A (en) * | 2014-08-11 | 2014-12-03 | 南京理工大学 | Self-regulating error symbol integration robust control method for direct-drive motor system |
| CN104914851A (en) * | 2015-05-21 | 2015-09-16 | 北京航空航天大学 | Adaptive fault detection method for airplane rotation actuator driving device based on deep learning |
| US9296474B1 (en) * | 2012-08-06 | 2016-03-29 | The United States of America as represented by the Administrator of the National Aeronautics & Space Administration (NASA) | Control systems with normalized and covariance adaptation by optimal control modification |
| CN106527126A (en) * | 2015-09-11 | 2017-03-22 | 南京理工大学 | Implementation method for nonlinear robust adaptive position controller of motor servo system |
| CN107121932A (en) * | 2017-06-12 | 2017-09-01 | 南京理工大学 | Motor servo system error symbol integrates Robust Adaptive Control method |
| CN108415249A (en) * | 2018-02-09 | 2018-08-17 | 南京理工大学 | A kind of electrohydraulic servo system adaptive robust control method based on low frequency study |
| CN108983606A (en) * | 2018-07-09 | 2018-12-11 | 南京理工大学 | A kind of Sliding mode self-adaptation control method of mechanical arm system |
-
2019
- 2019-09-09 CN CN201910865903.9A patent/CN110673473B/en active Active
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH10133703A (en) * | 1996-10-31 | 1998-05-22 | Fujitsu Ltd | Adaptive robust controller |
| US9296474B1 (en) * | 2012-08-06 | 2016-03-29 | The United States of America as represented by the Administrator of the National Aeronautics & Space Administration (NASA) | Control systems with normalized and covariance adaptation by optimal control modification |
| CN104184379A (en) * | 2014-08-11 | 2014-12-03 | 南京理工大学 | Self-regulating error symbol integration robust control method for direct-drive motor system |
| CN104914851A (en) * | 2015-05-21 | 2015-09-16 | 北京航空航天大学 | Adaptive fault detection method for airplane rotation actuator driving device based on deep learning |
| CN106527126A (en) * | 2015-09-11 | 2017-03-22 | 南京理工大学 | Implementation method for nonlinear robust adaptive position controller of motor servo system |
| CN107121932A (en) * | 2017-06-12 | 2017-09-01 | 南京理工大学 | Motor servo system error symbol integrates Robust Adaptive Control method |
| CN108415249A (en) * | 2018-02-09 | 2018-08-17 | 南京理工大学 | A kind of electrohydraulic servo system adaptive robust control method based on low frequency study |
| CN108983606A (en) * | 2018-07-09 | 2018-12-11 | 南京理工大学 | A kind of Sliding mode self-adaptation control method of mechanical arm system |
Non-Patent Citations (1)
| Title |
|---|
| 电液伺服系统多模型鲁棒自适应控制;成旭华;《西安交通大学学报》;20181130;第51卷(第11期);第156-163页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110673473A (en) | 2020-01-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108983606B (en) | A Robust Sliding Mode Adaptive Control Method for Manipulator System | |
| CN106502260B (en) | Attitude takeover control method for space tethered robot after capturing flexible target satellite | |
| CN103970138B (en) | Based on active disturbance rejection and the smooth ALV crosswise joint methods of differential | |
| CN109189085A (en) | Spacecraft networked system attitude control method based on event triggering | |
| CN107607101B (en) | Sliding Mode Control Method of MEMS Gyro Based on Disturbance Observer | |
| CN107678282B (en) | Intelligent Control Method of MEMS Gyro Considering Unknown Dynamics and External Disturbance | |
| CN107607103B (en) | MEMS gyroscope Hybrid Learning control method based on interference observer | |
| CN110824925A (en) | Adaptive robust fault-tolerant control method for tilting type three-rotor unmanned aerial vehicle | |
| CN114019997B (en) | Finite time control method for fixed-wing UAV position tracking deviation constraint | |
| CN107607102B (en) | Sliding Mode Chattering Suppression Method for MEMS Gyroscope Based on Disturbance Observer | |
| CN113741188A (en) | Backstep adaptive fault-tolerant control method for fixed-wing UAV under actuator failure | |
| CN112936277A (en) | Underwater robot-manipulator system fixed time trajectory tracking method | |
| CN109597426A (en) | Based on L1The four-rotor helicopter Trajectory Tracking Control method of self adaptive control | |
| CN116039754B (en) | A preset performance control method for an intelligent vehicle steering system | |
| CN109514558A (en) | Flexible mechanical arm time-scale separation robust control method based on singular perturbation | |
| CN116225037B (en) | Self-adaptive event trigger control method for flight attitude of four-rotor unmanned aerial vehicle | |
| CN108170151A (en) | The adaptive motion control device and its method of a kind of underwater robot | |
| Yuan et al. | Active disturbance rejection adaptive control of tank turret-gun control systems | |
| CN111142380A (en) | A control method of a position servo system for launching a rocket launcher during travel | |
| CN118331062B (en) | Adaptive fuzzy fractional-order sliding mode fault-tolerant control method and system for unmanned aerial vehicle with hanging load | |
| CN110673473B (en) | Error Sign Integral Robust Adaptive Control Method for Two-Axis Coupled Tank Gun System | |
| CN112835372B (en) | Fixed time control method of four-rotor unmanned aerial vehicle | |
| CN109975788A (en) | A kind of self-adaptation control method of laser radar scanning mechanism | |
| CN117762015A (en) | A control method for trajectory tracking of shoulder joint rehabilitation robot | |
| CN105867134A (en) | Control method for continuous switching movement of double-framework airplane skin detection robot |
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 | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |
















































































































