Lecture 32
Lecture 32
Lecture – 32
Motivation
To fuse the estimation, guidance and control loops
at various levels
Benefits arise because integrated designs are
capable of retaining and exploiting the synergy
between various subsystems
Integrated design approaches proposed in literature
can be broadly classified into three groups:
• Integrated guidance and control (IGC)
• Integrated estimation and guidance (IEG)
• Integrated estimation guidance and control (IEGC)
Philosophy
Concept:
Xɺ (t ) = f ( X , U , t ) + G (t ) W (t )
Model
Y = h ( X k ) + Vk
Xˆ − ( t 0 ) = X 0
Initialization
P0− = E Xɶ − ( t 0 ) Xɶ −T
( t 0 )
−1
Gain
K e k ( t ) = Pk− C k− T C k− Pk− C k− T + R
Computation ∂h
w h e re, C k− =
∂ X Xˆ k−
OPTIMAL CONTROL, GUIDANCE AND ESTIMATION 9
Prof. Radhakant Padhi, AE Dept., IISc-Bangalore
( )
Xˆ k+ = Xˆ k− + K ek Y k − h Xˆ k−
Updation (
Pk+ = I − K ek C k )P (I − K
k
−
ek Ck )
T
+ K ek R k K eTk
( preferable )
(
= I − K ek C k )P k
−
( not preferable )
ɺ
Propagation
Xˆ (t ) = f ( Xˆ , U , t ); Xˆ k+ → Xˆ k−+1
Pɺ (t ) = AP + PAT + GQG T ; Pˆk+ → Pˆk−+1
where A(t ) =
∂f
∂X Xˆ ( t )
OPTIMAL CONTROL, GUIDANCE AND ESTIMATION 10
Prof. Radhakant Padhi, AE Dept., IISc-Bangalore
Problem Formulation
State, Measurement
& Desired Output Equations
ZEM-Dynamics in 1-D
& Time-to-go Dynamics
ZEM in y-direction
ZEM y = ∆y + ∆Vy Tgo
d
dt
( ZEM y ) = ∆yɺ + ∆Vɺy Tgo + ∆Vy Tɺgo
∆R
∆Vɺy = aTy − aM y
Time-to-go (Tgo)
∆Rɺ ∆Rɺ − ∆R ∆R
ɺɺ ∆R ∆R ɺɺ
Tgo = − ( ∆R / ∆Rɺ ) Tɺgo = − = − 1 −
∆Rɺ 2
∆Rɺ
2
Inertial
Components
Measurement Equation
(in LOS frame)
Using
Note: Measurements are available in seeker gimbal frame, LOS frame information
is obtained through a series of transformations.
where,
Nonlinear Controller
(Using Dynamic Inversion)
INNER LOOP:
Body Rate Tracking
This commands are decomposed to fin deflection commands and fed to the actuators.
(passed though second-order dynamics, rate and magnitude bounds, and then combined
Back to feed into the 6-DOF dynamics for realistic simulations)
RESULTS
1. Maneuvering Aircraft
• Step Maneuver
• Sinusoidal Maneuver
2. Ballistic Target
Estimated Range, Range Rate, Gimbal angles and LOS rates Error
OPTIMAL CONTROL, GUIDANCE AND ESTIMATION 27
Prof. Radhakant Padhi, AE Dept., IISc-Bangalore
Estimated Range, Range Rate, Gimbal angles and LOS rates Error
OPTIMAL CONTROL, GUIDANCE AND ESTIMATION 34
Prof. Radhakant Padhi, AE Dept., IISc-Bangalore
Results with Maneuvering A/C with
Sinusoidal Maneuver
Estimated Range, Range Rate, Gimbal angles and LOS rates Error
OPTIMAL CONTROL, GUIDANCE AND ESTIMATION 42
Prof. Radhakant Padhi, AE Dept., IISc-Bangalore
Results with Ballistic Target
Conclusions
A new Integrated Estimation and Guidance algorithm
is introduced for Interceptors in Terminal Phase.
The design implicitly uses the time-to-go as well as
guidance parameter like zero-effort-miss in the
estimation process to reduce the consequences of
estimation errors and delay on guidance performance.
This new IEG formulation has been applied for
various targets, which demonstrated a substantial
improvement in the result
This scheme also possesses the potential to satisfy
the hit-to-kill requirement.
OPTIMAL CONTROL, GUIDANCE AND ESTIMATION 46
Prof. Radhakant Padhi, AE Dept., IISc-Bangalore
A ZEM Dynamics Based Integrated Estimation
Guidance and Control of Interceptors
Reference
P. N. Dwivedi, S. N. Tiwari, A.
Bhattacharya and Radhakant Padhi, A
ZEM Dynamics Based Integrated
Estimation Guidance and Control of
Interceptors for High Speed Targets,
AIAA Guidance, Navigation and Control
Conference, 2011, Portland, USA.
Conventional Approach
Measurement Equation The measurement variables are the direct output of seeker
in ‘seeker polar frame’ (range, range rate, gimbal angles and gimbal angles rates)
Time-to-go (Tgo)
∆Rɺ ∆Rɺ − ∆R ∆R
ɺɺ ∆R ∆R ɺɺ
Tgo = − ( ∆R / ∆Rɺ ) Tɺgo = − = − 1 −
∆Rɺ 2
∆Rɺ
2
Inertial
Components
Where
Z : ZERO effort miss
∆V : Relative velocity
at: Target acceleration
am: Interceptor acceleration
Tgo : Time to go
∆R : Relative range
Measurement Equation
(in LOS frame)
Using
Note: Measurements are available in seeker gimbal frame, LOS frame information
is obtained through a series of transformations.
Where
rm= range
Φym= gimbal angle along y
Φzm= gimbal angle along z
ωgym= gimbal angle rate along y
ωgzm= gimbal angle rate along z
C : Transformation matrix
However, 0
where
However
Hence
Inner Loop:
DI Based Nonlinear Autopilot
For tracking of demanded body rate feedback
linearized Dynamic Inversion Autopilot has been used as:
RESULTS
R matrix :
Diagonal matrix
with square of
1σ measurement noise
3-D Trajectory
Case2:
Case3:
Conclusions
A new Integrated Estimation, Guidance and Control
algorithm is developed.
The design implicitly uses the time-to-go as well as
guidance parameter like zero effort miss in the
estimation process.
Second order ZEM dynamics has been used for the
integration purpose.
New IEGC formulation has shown a substantial
improvement for various interception scenarios
Topics
Integrated Estimation and Guidance
• P. N. Dwivedi, S. N. Tiwari, A. Bhattacharya and
Radhakant Padhi, A ZEM Based Effective Integrated
Estimation and Guidance of Interceptors in Terminal
Phase, AIAA Guidance, Navigation and Control
Conference, 2010, Toronto, Canada.