Appn. of ADRC in Stablity Control of Tank Gun System (1.07MB)
Appn. of ADRC in Stablity Control of Tank Gun System (1.07MB)
Abstract: Overcoming the disturbance of vehicle body is an important function of the tank gun control system. Therefore, the
tank artillery can be stabilized to a given angle in space. However, due to the change of load factors such as inertia, friction and
clearance, the stability precision of the gun control system cannot be further improved, and hitting probability will drop under the
condition of tank high speed maneuverability. In this paper, the tank gun control system and the disturbance model were analyzed,
and the active disturbance rejection controller was designed. The control performance of this active disturbance rejection
controller was verified by MATLAB simulation and the experiments of analog prototype. The results showed that the application
of the ADRC is more effective than the traditional PID controller in improving the stability precision of gun control system.
Key Words: active disturbance rejection control (ADRC), tank gun control system, stable control, stability precision
•
Fig.1: The block diagram of tank gun control system Ku − + iq iq
ωr
La
−
2.1 Mathematical Model of Gyroscope
It shows that gyroscope is a sensitive measuring element Rs
for gun control system from Fig.1. The azimuth and vertical La
angles and angular velocities of the artillery can be measured
by the gyroscopes. The measurement data is used to produce Fig.2: Relationship of voltage, speed and current of PMSM
an electrical signal that is stable and aimed. The transfer
function is, The state equation for permanent magnet synchronous
kp (1) motor can be written as follows,
T ( s) = e−Ts
1 Rs φf uq
s +1 • − −
2π f i La q La
i (5)
q = La +
where kp is the magnification of the gyroscope, and its • K ω
B r T
actual demarcation value is 0.995. f is the closed loop ω r t − − l
J J J
bandwidth of the gyroscope, and its value is 100Hz. T is the So we get the following block diagram, as shown in Fig.3.
output delay time of the gyroscope, and its value is 1ms. Tl
uq Rs + La p ωr La iq ωrφ f
u = −ω L + (2) Fig.3: The structure of PMSM
d r a Rs + La p id 0
The instantaneous torque equation is, 2.3 Establishment of Disturbance Model
T em = Kt iq = Tl + BΩr + JpΩr (3)
Due to the influence of nonlinear friction, the dynamic and
where Rs is the stator resistance, La is armature inductance, static characteristics of tank gun control system become
J is the moment of inertia of the motor, φ f is magnetic flux worse. The stabilization precision of the system is down and
the limit cycle of the system is even concussion. Friction
produced by permanent magnets( φ f is a constant value), force is considered as the main form of external disturbance
to the gun control system when the vehicle body is moving.
ωr is angular frequency of rotor, B is viscous friction In this paper, Coulomb friction and viscous friction are
coefficient, p is differential operator, Tl is load torque, simplified and used to establish a disturbance friction model.
The expression is as follows,
K t is torque coefficient, ud , uq , id and iq are the voltage Fk
Vr , Vr < Dv
and current of the d axes and q axes, Ω r is angular velocity Ff = Dv (6)
of rotor. F , Vr > Fk
k
For the motor driver which is shown in Fig.1, the
where F f is friction force, Vr is relative velocity, Dv is
controlling method of SVPWM which id equals 0 is used to
describe the model. Then, we can get the equation, the critical point of velocity, Fk is the maximal friction
• uqR ωφ force.
iq = − s iq − r f (4)
La L a La
DDCLS'18
671
In this model, the characteristics of the friction force at the control system. In this way, the disturbance of the gun is
zero point of the relative sliding velocity are linearly reduced and the adaptability is enhanced, which is more
represented by a straight line with a certain slope. The slope conducive to the aiming and shooting in high-speed
of the straight line is determined by Dv and Fk which is the maneuvering. b) Using TD to extract differential signal, and
improve the speed of tank gun control system, and realize
maximum static frictional force. In this way, the friction
small overshoot and small state error control. Thus, the gun
model can be simplified to a single function model of relative
control system has better dynamic performance and higher
velocity.
control precision, which can quickly track and attack target.
Mechanical clearance is an unavoidable nonlinear
c) Using NLSEF, it can arrange the composition of control
disturbance in the transmission of power. There are two main
quantity, which can improve the efficiency of the feedback
types of nonlinear perturbations from the gun control system.
and the system performance at low speed.
One is the relative motion between the system driving part
Based on above ideas, the ADRC controller is designed
and the driven part in the mechanical clearance. The other is
for the speed loop and position loop of the gun control
the instantaneous impact and elastic deformation process
system. The structure model is shown in Fig.5.
caused by the difference of the speed between the driving p _ ref =0
and the driven parts when they contact again at the end of the β1
mechanical clearance. The first kind of disturbance would
cause the drive delay of the system. The elastic deformation
of the second kinds of disturbances would change the
v _ ref
β2 1 u y
b0
oscillation of the system. The model, as shown in Fig.4, is z2
established for the nonlinear disturbance of mechanical b0
clearance.
τ
u 1 1 ω 1 Δθ 1 ωm
Kt 1/ s
R + Ls Js s Jms
Fig.5: Internal structure model of ADRC
Ke
In Fig.5, ESO represents the second order expansion state
observer, TD represents the tracking differentiator, and other
Fig.4: The mathematical model of mechanical clearance parts are nonlinear state error feedback (NLSEF). The design
structures of ESO, TD, and NLSEF are described in detail
As shown in Fig.4, Error! Reference source not below.
found. τ ( s ) is the output torque of the clearance link. The 3.1 Extended State Observer
model can be described as follows,
The input of extended state observer (ESO) is the actual
k[Δ(θ ) − a] Δ(θ ) > a speed of the load and the current command. The output of
(7)
τ ( s ) = 0 −a ≤ Δ(θ ) ≤ a ESO is the error estimate of the system. The order of ESO is
k[Δ(θ ) + a] Δ(θ ) < a second in the model, and the discrete form is as follows,
where Δ(θ ) is the relative displacement of gear clearance, e = z1 − y
2a is the width of gear clearance, k is the coefficient of z1 (k + 1) = z1 (k ) + h [ z2 (k ) − β 01 fal (e1 , a1 , δ1 ) + b0u ] (9)
rigidity. According to the mechanical design manual, the
calculation formula of torsional rigidity of the solid axis of z2 (k + 1) = z2 (k ) + h [ − β 02 fal (e2 , a2 , δ 2 ) ]
unit length is as follows. where y is the speed of the controlled object, u is the
T observation of actual current, z1 is the state of the ESO,
k = 7350 4 (8)
d z 2 is the output of the ESO, b0 、 β 01 、 β 02 are the gain of
Where T is the torque transmitted by a shaft, d is the
diameter of the axis. ESO, h is the sampling step length, fal is the nonlinear
function, which is shown as below,
3 ADRC Controller Design
e
For the disturbance of load change, ADRC controller is 1− a , e ≤ δ (10)
fal (e, a, δ ) = δ
designed to compensate. The designed ADRC controller e a sign(e), e > δ
consists of three parts. First, the tracking differentiator (TD)
is used to correctly extract differential signals. The second is where e is the input error, a is the nonlinear coefficient,
the extended state observer (ESO), which is used to estimate δ is the critical point of error.
system disturbance. The third is the nonlinear state error
feedback (NLSEF), which is used for the rational 3.2 Tracking Differentiator
combination of system signals. Tracking differentiator (TD) is designed to handle the
The main idea of designation is as follows. a) Using ESO, transition process of reference signals. The input of the TD is
it has a good transition process and the ability to detect the the speed command. The output of the TD is the speed
undetermined disturbance, which can solve the influence of command after the transition process. The discrete form of
non-uniform friction torque and gear clearance in the gun TD is designed as follows,
DDCLS'18
672
e = z1 − y
(11)
z1 (k + 1) = z1 (k ) + h [ − β * fal (e, a, δ )]
where y is the input of differentiator, z1 is the state of
differentiator, h is the sampling step length.
3.3 Nonlinear State Error Feedback (NLSEF)
The structure of nonlinear state error feedback (NLSEF) is
reflected in Fig.5. The signal was combined by NLSEF. The
output of NLSEF is the q axis current command, and the
discrete form is as follows,
e1 = p _ ref − position
(12)
e2 = v _ ref − v
iq _ ref = β * fal (e , a , δ ) + β * fal (e , a , δ ) − d Fig.7: Azimuthal disturbance (30km/h)
1 1 1 1 2 2 2 2
where, e1 is the position error, e2 is the speed error, When the tank is affected by the disturbance which is
shown in Fig.7, the stabilization effect of the PID controller
p _ ref is the position command, position is the actual and ADRC is shown in Fig.8. It can be calculated that the
position, v _ ref is the speed command, v is the actual stability precision of PID controller is 0.8mil, while ADRC
speed, d is the output of ESO, β1 is the position error gain, controller is 0.72mil.
DDCLS'18
673
loaded on the simulation prototype. The practical
photograph is shown in Fig.12.
Prototype of tank
gun control system Target sheet
SDOF
Platform
DDCLS'18
674
PID ADRC [5] D. H. Lin, Z. Teng, T. Chen, S. Yang, H. Zhang, H. Chi,
Improved fuzzy control method for temperature in water tank
stabilization stabilization
Frequency of intelligent viscometer, Proceedings of Information and
precision precision
(Hz) Automation, Changsha, China, 2008: 1106–1110.
(mil) (mil)
[6] D. Wang, H. Yan, and J. H. Qiao, Robust control research on
0.3 0.3274 0.3059 adaptive wavelet neural netwaor identification for tank
0.6 0.4173 0.3262 all-electric gun control system. Inrelligent Control and
sinusoidal
Information Processing(ICICIP), 2011: 375-379.
disturbance 0.9 0.4416 0.4031 [7] D. G. Kumar, P.Y. Tiwari, V. Marcopoli, M.V. Kothare, A
in azimuth
1.2 0.5192 0.4395 study of a gun-turret assembly in an armored tank using
model predictive control, in Proceedings of American
1.5 0.5605 0.4877
Control Conference, St. Louis, MO, 2009: 4848–4853.
1.8 0.6156 0.5403 [8] D. Z. Gao, R. R. Rhinehart, Theory vs. practice forum, in
2.1 0.6388 0.5414 Proceedings of American Control Conference, Boston, MA,
2004: 1341–1349.
From the above data, it is not hard to know that the control [9] Y. Q. Xia, Q. Yuan, F. U. Meng-Yin, Z. H. Zhi, X. M. Ren,
Recent development in sliding mode control and active
effect of the ADRC controller is better than the traditional
disturbance rejection control, Control Theory& Applications,
PID controller in the frequency 0.3-2.1Hz of sinusoidal vol.30(2): 137-145, 2013
interference. It is proved that the ADRC algorithm works [10] J. Han, Control theory: is it a theory of model or control,
better in the stabilization precision of tank gun control Systems Science and Mathematical Sciences, 1(4): 328 –
system. 335,1989.
[11] J. Han, From PID to active disturbance rejection control.
6 Conclusions and Further Remarks IEEE Transactions on Industrial Electronics, 31(3):
900–906, 2009.
Aiming at the stabilization precision reduction of gun [12] J. Han, Active Disturbance Rejection Control Technique - the
control system, the active disturbance rejection control Technique for Estimating and Compensating the
method was adopted when the controlled device changes in Uncertainties. Beijing: National Defense Industry Press,
this paper. In this method, the load fluctuation such as 2008, 35-52.
friction, inertia and mechanical clearance of gun were [13] Z. Gao, Active disturbance rejection control: a paradigm shift
attributed to ‘unknown disturbance’. Then, the input and in feedback control system design, in Proceedings of tje
American Control Conference. Piscataway, NJ: IEEE, 2006:
output data of the model were used to estimate and 2399–2405.
compensate for the unknown disturbance. The control [14] Y. Huang, W. Xue, and C. Gao, Active disturbance rejection
method was proved to be able to improve the stabilization control: methodology and theoretical analysis, Journal of
precision of gun control system greater than the traditional Sysems Science and Mathematical Sciences, 31(9):
PID control through the MATLAB simulation and physical 1111–1129, 2011.
testing. It has showed good robustness and adaptive ability [15] T. G. Pedro, G. Germain, Design of an Optimal PID
and provides a strong guarantee for the precise strike of tanks Controller for a Coupled Tanks System employing ADRC,
in the future. IEEE LATIN AMERICA TRANSACTIONS. Vol 15(2),
189-196, 2017.
References [16] J. F. Sun, L. Shan, Z. D. Qi, Y. X. Qu, J. Li, Fraction order
ADRC algorithm to ship servo system, in Proceedings of the
[1] D. R. Dana, E. Kreindler, Variable structure control of a tank 35th Chinese Control Conference. 2016: 1086-1091.
gun, in Proceedings of Control Applications, Dayton, 1992: [17] C. Z. Zhao, Y. L. Xue, C. E. Huang, Tuning ADRC for
928–933. Multi-Variable System Based on Existing PID Parameters,
[2] D. L. Feng, X. J. Ma, Z. F. Yan, H. Li, Method of adaptive Internation Conference on Control, 2016:1272-1277.
fuzzy sliding mode control of gun control system of tank, [18] J. Li, X. H. Qi, Y. Q. Xia, D. L. Ma, S. F. Li, Y. W. Xu, On
Dian ji yu Kong Zhi Xue bao/ Electric Machines and Control the absolute stability of nonlinear ADRC for SISO systems,
11(1), 2007: 65–69. in Proceedings of the 34th Chinese Control Conference.
[3] D. Son, Kuswadi, M. N. Tamara, H. W. Dwi, Gun turret 2015:1571-1576.
automatic weapon control system design and realizatuin, [19] Z. H. Wang, Z. H. Liu, Application of active disturbance
Electronics and Smart Devices(ISESD), International rejection controller in wheeled mobile robot servo system,
Symposium on, 2016: 30-34 Navigation and Control Conference (CGNCC), 2014:
[4] J. Ma, D. D. Zhang, and W. Q. Yuan, et al, Electromagnetic 324-329.
gun loading control system based on cloud model, Industrial [20] S. J. Ma, M. W. Sun, Z. Q. Chen, Interactive ADRC design
Electronics and Applications (ICIEA), 2016 IEEE 11th for flight attitude control. Data Driven Control and Learning
Conferenca on, 2016: 957-962. System (DDCLS), 2017:611-616.
DDCLS'18
675