Professional Documents
Culture Documents
December 7, 2020.
Digital Object Identifier 10.1109/ACCESS.2020.3038830
ABSTRACT This thesis studies the problem of three-dimensional guidance considering maneuvering
acceleration and input saturation based on the background of missile intercepting maneuvering target. On the
basis of the three-dimensional guidance model with impact angle constraints, a three-dimensional guidance
law is designed by using the integral sliding mode control and adaptive control. To solve the problem of input
saturation, an adaptive anti-saturation integral sliding mode three-dimensional guidance law is designed by
introducing an auxiliary system. The stability of the designed guidance law is proved by Lyapunov theory,
which ensures that the sliding mode manifold converges to zero in finite time. The effectiveness of the
designed guidance law is verified by simulation analysis.
INDEX TERMS Three-dimensional guidance law, input saturation, integral sliding mode control, adaptive
control.
This work is licensed under a Creative Commons Attribution 4.0 License. For more information, see https://creativecommons.org/licenses/by/4.0/
211474 VOLUME 8, 2020
T. Li, H. Qian: Design of Three-Dimensional Guidance Law With Impact Angle Constraints and Input Saturation
Lemma 1 [13]: Considering system ẋ = f (x, t), x ∈ guidance law is designed using the adaptive control as
Rn , suppose V (x) is a C1 smooth positive definite func- follows
tion (defined on U ⊂ Rn ) and V̇ (x) + ζ V δ (x) is negative
semi-definite on U ⊂ Rn for δ ∈ (0, 1) and ζ ∈ R+ ,then u = −B−1 F + k3 s + k4 sign(s) + M
there exists an area U0 ⊂ Rn such that any V (x) which stars
from U0 ⊂ Rn can reach V (x) ≡ 0 in finite time. Moreover, s
1−δ (x ) + k5 tanh(D̂) (15)
if Tr is the time needed to reach V (x) ≡ 0, then Tr ≤ Vζ (1−δ)0
, ksk
Z t
where V (x0 ) is the initial value of V (x). ˙ = −p s
3̂1 1 1 (k1 sigα1 (x1 ) + k2 sigα2 (ẋ1 ))dt (16)
Lemma 2 [9]: Consider the following n order integral 0
system ˙ = −p s
Z t
3̂2 2 2 (l1 sigβ1 (x1 ) + l2 sigβ2 (ẋ2 ))dt (17)
ẋ1 = x2 , · · · , ẋn−1 = xn , ẋn = u (11) 0
˙ = γ cosh2 (D̂) ksk
D̂ (18)
If ε ∈ (0, 1) that satisfies for any αn ∈ (1 − ε, 1), and the k5
design controller is
where k3 , k4 , k5 , γ , p1 and p2 are positive constants.
u = −k1 sigα1 (x1 ) − k2 sigα2 (x2 ) − · · · − kn sigαn (xn ) (12) Theorem 1: Considering system model (10) select-
ing the sliding modemanifold (13), under thedesigned
where α1 , α2 , · · · , αn satisfies αi−1 = 2ααi+1 i αi+1
−αi , i = three-dimensional guidancelaw (15), the s sconverges to
2, 3, · · · , n, αn+1 = 1. λn + kn λn−1 + · · · + k2 λ + k1 is the zeroin finite time, then theline of sight angularrate θ̇L and φ̇L
polynomial of Hurwitz. Then, the system is globally finite and will convergeto zero in finite time.
time stable. Proof: Choose the Lyapunov function candidate as
Choose the Lyapunov function candidate as maneuverability for the missile in the final guidance stage,
1 1 2 which leads to the fact that the power actuator of the mis-
V2 = sT s + D̄ − k5 tanh(D̂) (22) sile can only provide limited acceleration. So it is of great
2 γ
significance to design the guidance law with acceleration
where D̄ is positive constant, satisfying D̄ > D̂ and saturation.
D̄ > D.
The time derivative of the V2 can be written as B. DESIGN OF ANTI-SATURATION ADAPTIVE INTEGRAL
2k5 1 SLIDING MODE CONTROLLER
˙
V̇2 = sT ṡ − D̄ − k5 tanh(D̂) D̂ Considering the input saturation, the (10) can be rewritten as
γ 2
cosh (D̂)
= sT (Bu + D + F + M ẍ = F + Bsat(u) + D (25)
˙ R t (k sigα1 (x ) + k sigα2 (ẋ ))dt
" #!
3̂ 1 0 1 1 2 1 In order to cope with input saturation, the auxiliary sys-
+ ˙ R t (l sigβ1 (x ) + l sigβ2 (ẋ ))dt
3̂ 2 0 1 2 2 2 tem (26) is introduced, as shown at the bottom of the page,
2k5 1 ˙ where 1u = u − uc , uc is the actual control input, η is the
− D̄ − k5 tanh(D̂) D̂ state of the auxiliary system, σ, kη , kη1 and γ1 are positive
γ cosh2 (D̂)
s constants, 0 < γ1 < 1.
= −k3 sT s − k4 sT sign(s) + n + D − k5 tanh(D̂)) An adaptive anti-saturation three dimensional guidance
ksk
2k5 1 law is designed as
˙
− D̄ − k5 tanh(D̂) D̂
γ cosh2 (D̂) uc = −B−1 (F + k3 s + k4 sign(s) + M
≤ −k3 sT s − k4 sT sign(s) + D̄ ksk − k5 tanh(D̂)
s
R 2 + k5 tanh(D̂) − kη η (27)
2 t α1 α2 ksk
p s
1 1 0 1 (k sig (x1 ) + k2 sig (ẋ1 ))dt Z t
−
R 2 ˙ = −p s
3̂ (k1 sigα1 (x1 ) + k2 sigα2 (ẋ1 ))dt
2 t β1 β2 1 1 1 (28)
p1 s2 0 (l1 sig (x2 ) + l2 sig (ẋ2 ))dt 0
2k5 1 ˙ ˙ = −p s
Z t
−
γ
D̄ − k4 tanh(D̂) 2
D̂ 3̂2 2 2 (l1 sigβ1 (x1 ) + l2 sigβ2 (ẋ2 ))dt (29)
cosh (D̂) 0
≤ −k4 ksk − D̄ − k5 tanh(D̂) ksk ˙ = γ cosh2 (D̂) ksk
D̂ (30)
1/2 k5
≤ −ρV2 (23)
√ √ Theorem 2: Considering the system model (10) sujecting
where ρ = min( 2k4 , γ ksk). Considering (23) and to input saturation, selecting the sliding mode surface (14),
Lemma1, it can conclude that the sliding mode manifold s and under the adaptive anti-saturation integral sliding mode
converges to zero in finite time. guidance law (27), the line of sight angular rate θ̇L and φ̇L
According to (13), the inequality is satisfied converge to zero in finite time.
Z t Proof : Choose the Lyapunov function V3 as
˙
ẍ1 = −3̂ (k1 sigα1 (x1 ) + k2 sigα2 (ẋ1 ))dt
1
1 T 1 1 2
0
α1 α2
V3 = s s + ηT η + D̃ (31)
− k1 3̂1 sig (x1 ) − k2 3̂1 sig (ẋ1 ) 2 2 2γ
Z t
˙ Applying (27), the time derivative of V3 can be written as
ẍ2 = −3̂2 (l1 sigβ1 (x2 ) + l2 sigβ2 (ẋ2 ))dt − l1 3̂2 sigβ1 (x2 )
0 1 ˙
− l2 3̂2 sigβ2 (ẋ2 ) (24) V̇3 = sT ṡ + ηT η̇ + D̃D̃
γ
As can be seen from the [9], x1 and x2 converges to zero in Bsat(u) + D + F + M
finite time, that is, the line of sight angular rate θ̇L and φ̇L will ˙ Rt
= sT 3̂1 0 (k1 sigα1 (x1 ) + k2 sigα2 (ẋ1 ))dt
converge to zero in finite time. +
˙ R t (l sigβ1 (x ) + l sigβ2 (ẋ ))dt
3̂
Theorem 1 is proved. 2 0 1 2 2 2
Remark 1: In the guidance law (15), the design con-
k5 1 ˙
straints of the guidance law are not considered, but in the + ηT η̇ − D̃ D̂
actual guidance process, only the aerodynamic force provides γ cosh2 (D̂)
−k η − η
1 T
η s T
B1 1u + 1u 1u + 1u − kη1 sig(η)γ1 , kηk ≥ σ
η̇ = kηk2 2 (26)
0, kηk < σ
s 2k5 1 ˙
= sT (−k3 s − k4 sign(s) + D − k5 tanh(D̂)) + n − kη1 ηT sig(η)γ − D̄ − k5 tanh(D̂) D̂
ksk γ cosh2 (D̂)
k5 1 ˙ (37)
+ sT B1u + kη sT η + ηT η̇ − D̃ D̂
γ cosh2 (D̂)
According to (33) and (34), (37) can be rewritten as
s
≤ sT (−k3 s − k4 sign(s) + D − k5 tanh(D̂))
1
T T
kη1 + 1 η η
T
ksk V̇4 ≤ −k3 s s − k4 s sign(s) − kη −
2
1
+ n + kη sT η − kη ηT η − sT B1u + 1uT 1u − kη1 ηT sig(η)γ1 + n + sT (D − k5
s
tanh(D̂))
2 ksk
k5 1 ˙ 2k5 1
+ ηT 1u − kη1 ηT sig(η)γ − D̃ ˙
D̂ (32) − D̄ − k5 tanh(D̂) D̂
γ cosh2 (D̂) γ cosh2 (D̂)
As 1
≤ −k3 sT s − k4 sT sign(s) − kη − 1 ηT η
2
sT B1u− sT B1u ≤ 0 (33) − kη1 ηT sig(η)γ1 + D̄ ksk − k5 tanh(D̂) ksk
1 T 1 1 2k5 1 ˙
kη sT η + ηT 1u ≤ kη +1 ηT η + 1uT 1u
kη s s + − D̄ − k4 tanh(D̂) D̂
2 2 2 γ 2
cosh (D̂)
(34)
1
≤ −k3 sT s − k4 sT sign(s) − kη − 1 ηT η
According to (33) and (34), then (32) can be rewritten as 2
γ1
− kη1 η sig(η) − D̄ − k5 tanh(D̂) ksk
T
1
T T
kη + 1 η η
T
V̇2 ≤ −k3 s s − k4 s sign(s) − kη −
2
k5 1 ≤ −k4 sT sign(s)− kη1 ηT sig(η)γ1 − D̄ − k5 tanh(D̂) ksk
− kη1 ηT sig(η)γ1+Dksk−k5 tanh(D̂)ksk− D̃ ˙
D̂ √
γ cosh2 (D̂) γ1 +1 √
1/2 (γ +1)/2
≤ −min 2k4 , 2 2 kη1 , γ ,ksk min V4 ,V4
1
≤ −k3 sT s − k4 sT sign(s) − kη − kη + 1 η T η
2 (38)
k 1 ˙
− kη1 ηT sig(η)γ1 + D̃ ksk − D̃ From (38) and lemma1, it can be seen the sliding mode
5
D̂
γ cosh2 (D̂) manifold s can converge to zero.
1
≤ −k4 sT sign(s)− kη +1 ηT η−kη1 ηT sig(η)γ1 − k3 sT s
2 IV. SIMULATION RESULTS
≤0 (35) In order to show the effectiveness of the designed guidance
law, the simulation parameters is given in Table 1.
From (35), it can get that V3 is bounded. Meanwhile, it can
A. SIMULATION ANALYSIS OF ADAPTIVE INTEGRAL
conclude that D̂ is bounded, which means the existence of
SLIDING MODE GUIDANCE LAW
positive constant D̄ > 0, satisfying D̂ ≤ D̄.
Proof : Choose the Lyapunov function candidate as In order to verify the effectiveness of the adaptive integral
sliding mode guidance law (15), compared with the guidance
1 1 1 2
V4 = sT s + ηT η + D̄ − k5 tanh(D̂) (36) law NTSMGL in reference " [14] and external disturbances
γ cos θt
#
2 2 azt
are considered as D = R . The
cos φt sin θt sin φt
Applying (27), the time derivative of (36)can be written as R cos θL ayt − R cos θL azt
Bsat(u) +D+F+M parameters of the observer are selected as: k1 = 0.25, k2 =
˙ R t (k sigα1 (x ) + k sigα2 (ẋ ))dt 0.2, k3 = 0.5, k4 = 0.3, k5 = 1.5, γ = 0.7, l1 = 0.5,
" #
V̇4 = sT 3̂
+ ˙ 1 R0t 1 1 2 1
l2 = 0.5, α1 = 0.6, α2 = 0.65, β1 = 0.75, β2 = 0.75,
3̂2 0 (l1 sigβ1 (x2 ) + l2 sigβ2 (ẋ2 ))dt
p1 = 0.02, p2 = 0.02. The maximum acceleration of the
2k5 1 ˙
+ ηT η̇ − D̄ − k5 tanh(D̂) D̂ missile is um = 25g. The simulation results are shown
γ 2
cosh (D̂) in fig. 2.
T s
= s (−k3 s − k4 sign(s) + D − k5 tanh(D̂))
ksk
TABLE 1. Initial engagement parameters for the missile and target.
+ n + sT B1u + kη sT η + ηT η̇
2k5 1 ˙
− D̄ − k4 tanh(D̂) D̂
γ cosh2 (D̂)
s
≤ sT (−k3 s − k4 sign(s) + n + D − k5 tanh(D̂))
ksk
1
− kη ηT η − sT B1u + 1uT 1u + ηT 1u
2
211478 VOLUME 8, 2020
T. Li, H. Qian: Design of Three-Dimensional Guidance Law With Impact Angle Constraints and Input Saturation
The trajectory and relative distance curve of missile and tends to be stable value after a period of time compared with
target under the NTSMG and proposed guidance law are that of NTSMG. From the adaptive parameter curve given in
given in Fig.2 a)-(b), respectively. it can be seen that these two Fig.2(f), it can be seen that it can tend to a steady state in a
guidance laws can intercept the target successfully. Fig.2(c)- short time, which shows that the adaptive law is effective in
(d) gives the curves of θ̇L and φ̇L of line-of-sight angular rate the guidance process.
respectively. It can be seen from the simulation result that
the line-of-sight angular rate θ̇L and φ̇L can converge to zero B. SIMULATION ANALYSIS OF ANTI-SATURATION
fast under the two kinds of guidance laws, and have faster ADAPTIVE SLIDING MODE GUIDANCE LAW
convergence rate and higher convergence accuracy than the In order to demonstrate the effectiveness of theanti-
NTSMG. From the acceleration curve of the missile given saturation adaptive slidingmode guidance law (27), the fol-
in Fig.2(e), it can be seen that the acceleration saturation lowing two forms of target maneuvering are simulated and
phenomenon of the guidance law designed in this paper and analyzed.
Case1 : azt = ayt = 8 m/s2; that the missile can hit the target accurately. From the curve
Case2 : ayt = azt = 8 cos(4t) m/s2. of missile acceleration given in Fig.3 (e), it can be seen that
The guidance law parameters are chosen as: σ = 0.01, after a period of time, the the acceleration curve tends to be
kη = 1.25, kη1 = 0.5 and γ1 = 0.72, other guidance steady value, and the control amplitude is always within the
parameters are the same as in section 4.1, the simulation constraint range in the whole control process, which satisfies
results are shown in Fig. 3. the input constraint. From the adaptive parameter curve given
Fig.3 (a)-(b) gives the trajectory curve and relative distance in Fig.3 (f), it can be seen that the adaptive estimation value
curve of missile and target under two forms of target maneu- can tend to a steady state value in a short time.
verability. It can be seen that the missile can accurately inter-
cept the target and satisfy the guidance accuracy. Fig.3(c)-(d) V. CONCLUSION
show the curves of θ̇L and φ̇L of line-of-sight angular rate, In this paper, a three-dimensional guidance scheme with
which can fast converge to zero in finite time, and that ensures impact angle constraints and input saturation is designed for
intercepting maneuvering targets. The main results are as [14] S. R. Kumar and D. Ghose, ‘‘Three-dimensional impact angle guidance
follows: with coupled engagement dynamics,’’ Proc. Inst. Mech. Eng. G, J. Aerosp.
Eng., vol. 231, no. 4, pp. 621–641, Mar. 2017.
(1) An adaptive algorithm is introduced to estimate the [15] S. He and D. Lin, ‘‘Adaptive nonsingular sliding mode based guidance
upper bound of the maneuvering acceleration of the target, law with terminal angular constraint,’’ Int. J. Aeronaut. Space Sci., vol. 15,
which relaxes the requirement of the prior information of the no. 2, pp. 146–152, Jun. 2014.
[16] Z. Zhang, C. Man, S. Li, and S. Jin, ‘‘Finite-time guidance laws for
maneuvering acceleration of the target. three-dimensional missile-target interception,’’ Proc. Inst. Mech. Eng. G,
(2) The adaptive three-dimensional guidance law and J. Aerosp. Eng., vol. 230, no. 2, pp. 392–403, Feb. 2016.
anti-saturation three-dimensional guidance law are designed [17] J.-P. Dong, J.-G. Sun, Y. Guo, and S.-M. Song, ‘‘Guidance laws against
towed decoy based on adaptive back-stepping sliding mode and anti-
based on the integral terminal sliding mode control, respec- saturation methods,’’ Int. J. Control, Autom. Syst., vol. 16, no. 4,
tively, which can ensure that the line of sight angular rate pp. 1724–1735, Aug. 2018.
converges to zero in finite time. [18] G. Hexner and A. W. Pila, ‘‘Practical stochastic optimal guidance law for
bounded acceleration missiles,’’ J. Guid., Control, Dyn., vol. 34, no. 2,
(3) The system state is proved to be finite time stable under pp. 437–445, Mar. 2011.
the designed guidance strategy by using Lyapunov theory, and [19] D. Zhou and B. Xu, ‘‘Adaptive dynamic surface guidance law with input
the effectiveness of the guidance scheme is verified by digital saturation constraint and autopilot dynamics,’’ J. Guid., Control, Dyn.,
vol. 39, no. 5, pp. 1–8, 2016.
simulation. [20] W. Wang, S. Xiong, S. Wang, S. Song, and C. Lai, ‘‘Three dimensional
impact angle constrained integrated guidance and control for missiles
REFERENCES with input saturation and actuator failure,’’ Aerosp. Sci. Technol., vol. 53,
pp. 169–187, Jun. 2016.
[1] G. Li and Y. Wu, ‘‘Nonsingular adaptive-gain super-twisting guidance with [21] X. L. Liang, M. Z. Hou, and G. R. Duan, ‘‘Adaptive dynamic surface
an impact angle constraint,’’ Proc. Inst. Mech. Eng., G, J. Aerosp. Eng., control for integrated missile guidance and autopilot in the presence of
vol. 233, no. 5, pp. 1705–1714, Apr. 2019. input saturation,’’ J. Aerosp. Eng., vol. 28, no. 5, pp. 1–8, 2015.
[2] X. B. Li, G. R. Zhao, S. Liu, and X. Han, ‘‘Adaptive integral sliding [22] D. Zhou and B. Xu, ‘‘Adaptive dynamic surface guidance law with input
mode guidance law with impact angle constraint considering autopilot saturation constraint and autopilot dynamics,’’ J. Guid., Control, Dyn.,
lag,’’ J. Phys., Conf. Ser., vol. 1267, Jul. 2019, Art. no. 012081. vol. 39, no. 5, pp. 1155–1162, May 2016.
[3] K. S. Erer and O. Merttopçuoglu, ‘‘Indirect impact-angle-control against [23] B. Xu and D. Zhou, ‘‘Three dimensional adaptive dynamic surface guid-
stationary targets using biased pure proportional navigation,’’ J. Guid., ance law accounting for autopilot lag,’’ in Proc. Amer. Control Conf.,
Control, Dyn., vol. 35, no. 2, pp. 700–704, Mar. 2012. Jun. 2014, pp. 578–583.
[4] C.-H. Lee, T.-H. Kim, and M.-J. Tahk, ‘‘Interception angle control guid-
ance using proportional navigation with error feedback,’’ J. Guid., Control,
Dyn., vol. 36, no. 5, pp. 1556–1561, Sep. 2013.
[5] S. K. Pandit, B. Panchal, and S. E. Talole, ‘‘Design of 3D guidance law for
tactical missiles,’’ Proc. Int. Conf. Modern Res. Aerosp. Eng. Singapore:
Springer, 2018, pp. 61–68.
TONG LI received the M.E. degree in automa-
[6] W. Pang, X. Xie, and T. Sun, ‘‘Improved bias proportional navigation
with multiple constraints for guide ammunition,’’ J. Syst. Eng. Electron., tion from Harbin Engineering University, Harbin,
vol. 2017, vol. 28, no. 6, pp. 1193–1202. China, in 2015. He is currently pursuing the Ph.D.
[7] B.-G. Park, T.-H. Kim, and M.-J. Tahk, ‘‘Range-to-go weighted opti- degree in engineering. His current research interest
mal guidance with impact angle constraint and seeker’s look angle lim- includes navigation guidance and control.
its,’’ IEEE Trans. Aerosp. Electron. Syst., vol. 52, no. 3, pp. 1241–1256,
Jun. 2016.
[8] X. Chen and J. Wang, ‘‘Optimal control based guidance law to control both
impact time and impact angle,’’ Aerosp. Sci. Technol., vol. 84, pp. 454–463,
Jan. 2019.
[9] J. G. Sun, S. M. Song, and H. T. Chen, ‘‘Finite-time tracking control of
hypersonic aircrafts with input saturation,’’ Proc. Inst. Mech. Eng. G, J.
Aerosp. Eng., vol. 232, no. 7, pp. 1373–1389, 2018.
[10] H. Sun, S. Li, and C. Sun, ‘‘Finite time integral sliding mode control
of hypersonic vehicles,’’ Nonlinear Dyn., vol. 73, nos. 1–2, pp. 229–244, HUAMING QIAN is currently a Professor with
Jul. 2013. the College of Automation, Harbin Engineering
[11] V. I. Utkin and H. C. Chang, ‘‘Sliding mode control on electro-mechanical University. His current research interests include
systems,’’ Math. Problems Eng., vol. 8, no. 4, pp. 451–473, 2002. sensor technology and intelligent systems, and
[12] S. Lyu, Z. H. Zhu, S. Tang, and X. Yan, ‘‘Fast nonsingular terminal sliding integrated navigation technology.
mode to attenuate the chattering for missile interception with finite time
convergence,’’ IFAC-PapersOnLine, vol. 49, no. 17, pp. 34–39, 2016.
[13] Y. Si and S. Song, ‘‘Three-dimensional adaptive finite-time guidance law
for intercepting maneuvering targets,’’ Chin. J. Aeronaut., vol. 30, no. 6,
pp. 1985–2003, Dec. 2017.