# Patent

## Title
System and method for periodically adaptive guidance and control

## Abstract

A system and method that guides a device to an object using periodically adaptive guidance. The guidance and control system creates a reconstructed line-of-sight (LOS) vector to avoid system destabilization associated with small angle approximation during high bore sight engagements. The guidance system adaptively estimates the periodic maneuver of evasive objects with a set of harmonically balance Kalman filter banks. The Harmonically Balanced Kalman filter banks generate a set of probabilities that weight the effect of each individual Kalman filters on a resultant guidance command signal. The guidance command signal generated by the system acts perpendicular to the object LOS. The guidance and control system uses vectored proportional navigation guidance laws, optimal proportion navigation laws and periodically adaptive augmented guidance laws to generate a guidance command signal to supply to an autopilot.

## Background
BACKGROUND OF THE INVENTION
1. Field of the Invention
The present invention relates to guidance and control systems, and more particularly, to adaptive guidance and control systems.
2. Background Information
When guiding a device, such as an interceptor missile, toward a moveable object or target, it is known to address target maneuvering in the control of the missile. For example, the object may be configured to induce a miss distance by initiating an acceleration maneuver. Against a missile utilizing a proportional guidance system, target maneuvering can be controlled as a function of any known missile parameters, such as the missile's autopilot time constant (its agility) and effective navigation ratio. If the target does not have a priori knowledge of the missile parameters, does not know time to intercept, and/or does not have visual or electronic contact with the missile, then periodic maneuver sequences such as a barrel roll or weave maneuver can be executed. In addition to calculated maneuvering, targets such as tactical ballistic missiles (TBM) can unintentionally spiral or weave into resonance as they re-enter the atmosphere due to either mass or configuration asymmetries.
The control of a moving object to a maneuverable target is discussed in the book, “Tactical and Strategic Missile Guidance”, Third Edition, Volume 176, by Zarchan, and in a Zarchan article, “Proportional Navigation and Weaving targets”, Journal of Guidance, Control, and Dynamics, Volume 18, No. 5, September-October 1995, pages 969-974, both of which are incorporated herein by reference. Zarchan discloses a scalar classical pro nav guidance law as: 



  
    
      
        
          n
          c
        
        =
        
          
            
              N
              l
            
            ⁢
            
              V
              c
            
            ⁢
            
              λ
              .
            
          
          =
          
            
              
                
                  
                    N
                    l
                  
                  ⁡
                  
                    (
                    
                      y
                      +
                      
                        
                          y
                          .
                        
                        ⁡
                        
                          (
                          
                            t
                            go
                          
                          )
                        
                      
                    
                    )
                  
                
                
                  t
                  go
                  2
                
              
              ⁢
              
                 
              
              ⁢
              where
              ⁢
              
                 
              
              ⁢
              λ
            
            =
            
              (
              
                y
                
                  R
                  TM
                
              
              )
            
          
        
      
    
    
      
        (
        1
        )
      
    
  




wherein the missile acceleration command (nc) is perpendicular to the target line-of-sight vector for small line-of-sight angles (λ) as evidenced by the λ=(y/RTM) approximation. Small angle approximations are used to simplify modern guidance laws that use scalar Y axis Cartesian Kalman filter estimates of target-to-missile range and velocity (y and {dot over (y)}). For a dual-range air-to-air missile, however, guidance laws with these small line-of-sight angle approximations result in excessive missile divert requirements, which waste valuable on-board energy, and can degrade performance.

“Line of Sight Reconstruction for Faster Homing Guidance”, presented as Paper 83-2170 at the AIAA Guidance and Control Conference, Gatlinburg, Tenn., Aug. 15-17, 1983; received Aug. 24, 1983: revision received Jan. 3, 1984. Copyright® 1983, by F. W. Nesline and P. Zarchan, which is incorporated herein by reference, describes line-of-sight ( LOS) reconstruction. This Zarchan document discloses another scalar pro nav guidance law as: 



  
    
      
        
          n
          c
        
        =
        
          
            
              
                N
                l
              
              ⁡
              
                (
                
                  y
                  +
                  
                    
                      y
                      .
                    
                    ⁡
                    
                      (
                      
                        t
                        go
                      
                      )
                    
                  
                  +
                  
                    ZEM
                    TM
                  
                
                )
              
            
            
              t
              go
              2
            
          
          -
          
            
              C
              4
            
            ⁢
            
              n
              L
            
          
        
      
    
    
      
        (
        2
        )
      
    
  
  
    
      
        
          where
          ⁢
          
             
          
          ⁢
          
            ZEM
            TM
          
        
        =
        
          0.5
          ⁢
          
             
          
          ⁢
          
            t
            go
            2
          
          ⁢
          
            n
            T
          
        
      
    
    
      
        (
        3
        )
      
    
  




The missile acceleration command (nc) is over amplified by N′ and negated by an achieved missile acceleration quantity (C4 nL) to make-up for expected dynamics lag in the missile's autopilot. Zarchan also describes a weaving target guidance law with a priori estimates of the target weaving frequency. Equation (2) uses an estimated target acceleration (nT) presented in Equation (3) as the zero effort miss (ZEMTM) due to a target maneuver.
Zero effort miss is defined as the distance the missile would miss if the target continued along its present trajectory and there were no more missile acceleration commands. A condition of Equation (3) is that the zero effort miss is caused by constant target acceleration for all time-to-go before intercept. Zarchan derives the zero effort miss due to a target maneuver frequency (ωT) with target acceleration and acceleration rate magnitudes (nT and {dot over (n)}T), and documents the scalar weaving target guidance law as: 



  
    
      
        
          ZEM
          TM
        
        =
        
          
            
              (
              
                
                  1
                  -
                  
                    cos
                    ⁢
                    
                       
                    
                    ⁢
                    
                      ω
                      M
                    
                    ⁢
                    
                      t
                      go
                    
                  
                
                
                  ω
                  T
                  2
                
              
              )
            
            ⁢
            
              n
              T
            
          
          +
          
            
              (
              
                
                  
                    
                      ω
                      M
                    
                    ⁢
                    
                      t
                      go
                    
                  
                  -
                  
                    sin
                    ⁢
                    
                       
                    
                    ⁢
                    
                      ω
                      M
                    
                    ⁢
                    
                      t
                      go
                    
                  
                
                
                  ω
                  M
                  3
                
              
              )
            
            ⁢
            
              
                n
                .
              
              T
            
          
        
      
    
    
      
        (
        4
        )
      
    
  




However, known systems do not address how to estimate a target maneuver frequency (ωT) for the weaving target guidance law, and use small angle approximations.
U.S. Pat. No. 4,494,202 (Yueh), the disclosure of which is hereby incorporated by reference, describes a fourth order predictive augmented proportional navigation system terminal guidance design with missile attached target decoupling. In Yueh's system, the estimated value of target lateral displacement is derived from a representation of the measured LOS angle combined with radome error and noise in the system, and small angle approximations are used. The gain C3 associated with a predetermined estimate of target maneuver augments the target acceleration term into a proportional navigation design. However, this gain is not adaptive, and relies on the target bandwidth (i.e., a predetermined value based on expected target maneuver). Thus, Yueh discloses an angular guidance approach which allows guidance for all line-of-sight (LOS) angles, yet maintains the conventional use of small angle approximation. Yueh does not support the framework for building a fully descriptive target state equation for adaptively estimating a target maneuver frequency in Cartesian space.
Warren, Price, Gelb and Vander Velder in “Direct Statistical Evaluation of Nonlinear guidance systems” AIAA Paper No. 73-836, which is incorporated herein by reference, disclose several missile guidance laws. In particular two optimal linear guidance laws C and D are shown that use Kalman filters which are synonymous with the classical optimal guidance control laws of Zarchan. Guidance law C minimizes the performance index, neglecting autopilot dynamics, resulting in C4=0 and C3 is a function of the target bandwidth, λt. Guidance law D is derived including the first-order autopilot model dynamics and the resulting n′ and C4 are both functions of λm and tgo. The gains and navigation ratios for the Classical optimal guidance control laws of Warren et al., and Yueh are shown in Table 1.











TABLE 1







C3
C4
n′ (γ = 0)



















Law C




  
    
      e
      
        -
        
          X
          T
        
      
    
    +
    
      X
      T
    
    -
    1
  
  
    X
    T
    2
  




0
3


Law D





  
    
      e
      
        -
        
          X
          M
        
      
    
    +
    
      X
      M
    
    -
    1
  
  
    X
    M
    2
  








  
    6
    ⁢
    
       
    
    ⁢
    
      X
      M
      2
    
    ⁢
    
       
    
    ⁢
    
      (
      
        
          e
          
            -
            
              X
              M
            
          
        
        +
        
          X
          M
        
        -
        1
      
      )
    
  
  
    
      
        
          
            2
            ⁢
            
               
            
            ⁢
            
              X
              M
              3
            
          
          +
          3
          +
          
            6
            ⁢
            
               
            
            ⁢
            
              X
              M
              2
            
          
          -
        
      
    
    
      
        
          
            12
            ⁢
            
               
            
            ⁢
            
              X
              M
            
            ⁢
            
              e
              
                -
                
                  X
                  M
                
              
            
          
          -
          
            3
            ⁢
            
               
            
            ⁢
            
              e
              
                
                  -
                  2
                
                ⁢
                
                  X
                  M
                
              
            
          
        
      
    
  









where: XT = λT {circumflex over (t)}go, XM = λM{circumflex over (t)}go; {circumflex over (t)}go = Estimated Time-to-Go [sec]


λT = Target Maneuver Bandwidth [rad/sec]


λM = Missile Autopilot/Airframe Bandwidth [rad/sec]


γ = Optimal quadratic Cost Function Weighting Factor 






As with the systems disclosed by Zarchan, Yueh's system and those disclosed in Warren, are subject to the classical augmented proportional navigation problem, the zero or constant maneuver frequency assumptions, thus wasting valuable energy against highly maneuverable targets.
SUMMARY OF THE INVENTION
The present invention is directed to a system and method for adaptively guiding a moving device toward a maneuverable object. Exemplary embodiments include means for generating a guidance command signal from a vectored line-of-sight (LOS) between a device and an object using a position parameter of the object relative to a guidance frame, and an estimated object state produced in the guidance frame using the vectored line-of-sight; and means for transmitting the guidance command signal to an on-board guidance control of the device.
Exemplary embodiments include means for generating a signal representing a predicted position of the object from object position parameters relative to a guidance frame and periodically adaptive estimated object state produced in the guidance frame using the object position parameters; and, means for transmitting the signal to an on-board guidance control of the device.



BRIEF DESCRIPTION OF THE DRAWINGS
These and other features and advantages of the claimed subject matter will become more apparent from the detailed description and accompanying drawings, in which:
FIG. 1 is a periodically adaptive all angle guidance system in accordance with an exemplary embodiment of the present invention;
FIG. 2 is representation of normalized target acceleration power spectral density of a harmonically balanced Kalman filter bank in accordance with an exemplary embodiment of the present invention;
FIG. 3 is a block diagram of Vectored LOS reconstruction for a Gimbaled seeker in accordance with an exemplary embodiment of the present invention;
FIG. 4 is a block diagram of Vectored LOS reconstruction for an electronically steered seeker in accordance with an exemplary embodiment of the present invention;
FIG. 5 is a block diagram of a periodically adaptive guidance system in accordance with an exemplary embodiment of the present invention;
FIG. 6 is a block diagram of a three dimensional periodically adaptive target state estimation system;
FIG. 7 is a block diagram of a harmonically balanced Kalman filter bank in accordance with an exemplary embodiment of the present invention;
FIGS. 8a-8b are representative paths and power spectral density charts for a missile intercepting a target according to Classical Optimum Control and Periodically Adaptive Control, respectively, in accordance with exemplary embodiments of the present invention;
FIGS. 9a-9d are exemplary response capability diagrams produced using periodically adaptive all angle guidance for a periodic maneuver target, a constant acceleration target, a time varying jinking target, and a constant velocity target, respectively;
FIG. 10 is a block diagram of a guidance system with LOS and range vectors in accordance with an exemplary embodiment of the present invention;
FIG. 11 is a representation of a fire control guidance system for a missile in accordance with an exemplary embodiment of the present invention; and
FIG. 12 is a block diagram of periodically adaptive guidance for fire control in accordance with an exemplary embodiment of the present invention.



DETAILED DESCRIPTION OF INVENTION
FIG. 1 shows a guidance system 400 for guiding a device toward an object according to an exemplary embodiment of the present invention.
The system 400 includes means 460 for generating a guidance command signal from a vectored line-of-sight (LOS) between a device and an object using a position parameter of the object relative to a guidance frame, and an estimated object state produced in the guidance frame using the vectored line-of-sight, and means 463 for transmitting the guidance command signal to an on-board guidance control of the device. The guidance command signal generating means can be configured using a single processor, computer or other electronic means, or via any number of processors, computers, etc., or combination thereof for implementing the function. The guidance command signal generating means can include means for creating a vectored line-of-sight (LOS) between the device and the object using the position parameter, generally represented as 461. The means for creating a vectored LOS can include LOS reconstruction. Line-of-sight reconstruction (LOS) provides an ability to have a fast missile autopilot time constant without causing guidance loop destabilization because of the relatively lower bandwidth of the seeker tracking control loop. Vectored LOS reconstruction is direction cosine rate integration of the seeker gyro rates and vector addition of the tracking errors. The result is a reconstructed target line-of-sight vector that is accurate for all LOS angles, thus creating an object line-of sight (LOS) in a guidance frame. Vectored LOS reconstruction combined with missile (IMU) information 450 transforms the target range, seeker gyro rates and tracking error measurements into a target-to-missile range measurement vector with components in a three-dimensional inertial guidance frame.
Estimated object states are produced relative to the guidance frame using a sequential object line-of-sight LOS. The estimated object state producing means is a periodically adaptive object state estimator represented by block 464, can include object state estimators with Kalman filters. Three-dimensional object state estimators are decoupled into three single dimension object state estimators that each operate independently on one of the range measurement vector components. The linear independent models describe the target-to-missile dynamics in each guidance frame axis. The three uncoupled object state estimators quickly and accurately adapt to the object acceleration frequency observed in each guidance frame axis by using a harmonically balanced multiple model Kalman filtering algorithm, as disclosed in “Multiple Model Adaptive Estimation and Prediction With The Harmonically Balanced Kalman Filter Bank”, A Thesis Presented To The Faculty Of California State Polytechnic University, Pomona, by Randall Joseph Muravez, 1989 which is incorporated herein by reference. In addition, the three uncoupled periodically adaptive target state estimators and the multiple model Kalman filters within them can be executed in parallel to maximize processor throughput (i.e. digital array processing).
In the system 400, an interdependent group of variables (states) work together as a unified whole. The states of a system can be arbitrarily defined. The object states utilized in exemplary embodiments of periodically adaptive all angle guidance include range, velocity, acceleration and a further time derivative (i.e. acceleration rate).
The Means for creating guidance command signals using the estimated object state can include the implementation of various guidance and control laws. All Angle Guidance and Control 465 can include guidance command laws including All Angle Classical Pro Nav Guidance, Periodically Adaptive Guidance and All Angle Augmented Pro Nav Guidance which are applied to create guidance command signals perpendicular to the target LOS vector for all LOS angles, in order to null the angular rate of the target LOS vector with the missile acceleration commands.
A missile or device acceleration guidance command signal is fed to the missile autopilot 456 via wire or wireless means 463. The missile autopilot 456 communicates with the missiles inertial measurement unit (IMU) 450 as well as a propulsion system and/or control mechanism (i.e., aerodynamic control surfaces) of the interceptor (i.e., missile, device).
FIG. 1 also shows means for obtaining an object position parameter, generally 425. In an exemplary embodiment object position parameters are determined from target to seeker range and angular measurements.
“All Angle Guidance” means that for all possible target-to-missile line-of-sight angles, the guidance algorithms will perform accurately because vector algorithms are used to eliminate small angle approximations. Applying “All Angle Guidance” vector algorithms to current algorithms leads to higher probability of kill and lower missile agility requirements for all types of engagement geometries. An example of where “All Angle Guidance” vector algorithms can be required is for a short-range “dogfight” engagement where, the close proximity of the object and the interceptor create a dynamic environment were small angle approximations can be of no value. These algorithms can also be beneficial for the final aim-point portion of longer range engagements.
An all angle classical proportional navigation (pro nav) guidance law is derived by applying “All Angle” vector algorithms to Zarchan's classical pro nav guidance law of Equation (1) so that the missile acceleration command vector (nc) is always perpendicular to the target line-of-sight unit vector (IT): 



  
    
      
        
          
            
              n
              _
            
            
              c
              
                1
                ⁢
                
                  L
                  _
                
                ⁢
                OS
              
            
          
          =
          
            
              
                N
                l
              
              ⁢
              
                
                  V
                  c
                
                ⁡
                
                  [
                  
                    
                      
                        λ
                        .
                      
                      _
                    
                    ×
                    
                      
                        I
                        _
                      
                      T
                    
                  
                  ]
                
              
            
            =
            
              
                (
                
                  
                    N
                    l
                  
                  
                    t
                    go
                    2
                  
                
                )
              
              ⁢
              
                
                  I
                  _
                
                T
              
              ×
              
                [
                
                  
                    
                      
                        x
                        +
                        
                          
                            x
                            .
                          
                          ⁢
                          
                             
                          
                          ⁢
                          
                            t
                            go
                          
                        
                      
                    
                  
                  
                    
                      
                        y
                        +
                        
                          
                            y
                            .
                          
                          ⁢
                          
                             
                          
                          ⁢
                          
                            t
                            go
                          
                        
                      
                    
                  
                  
                    
                      
                        z
                        +
                        
                          
                            z
                            .
                          
                          ⁢
                          
                             
                          
                          ⁢
                          
                            t
                            go
                          
                        
                      
                    
                  
                
                ]
              
              ×
              
                
                  I
                  _
                
                T
              
            
          
        
        ]
      
    
    
      
        (
        5
        )
      
    
  
  
    
      
        
          where
          ⁢
          
             
          
          ⁢
          
            
              I
              _
            
            T
          
        
        =
        
          [
          
            
              R
              TM
            
            
              R
              TM
            
          
          ]
        
      
    
    
      
        (
        6
        )
      
    
  




The closing velocity (Vc) and approximated time-to-go (tgo) are defined as

Vc=−(VTM·IT)  (7)

tgo≅(RTM/Vc)  (8)

and the “All Angle” line-of-sight rate vector () to be nulled is defined as: 



  
    
      
        
          
            λ
            .
          
          _
        
        =
        
          
            
              
                [
                
                  
                    
                      R
                      _
                    
                    TM
                  
                  ×
                  
                    
                      V
                      _
                    
                    TM
                  
                
                ]
              
              
                R
                TM
                2
              
            
            ⁢
            
               
            
            ⁢
            where
            ⁢
            
               
            
            ⁢
            
              
                R
                _
              
              TM
            
          
          =
          
            
              
                [
                
                  
                    
                      x
                    
                  
                  
                    
                      y
                    
                  
                  
                    
                      z
                    
                  
                
                ]
              
              ⁢
              
                 
              
              ⁢
              and
              ⁢
              
                 
              
              ⁢
              
                
                  V
                  _
                
                TM
              
            
            =
            
              [
              
                
                  
                    
                      x
                      .
                    
                  
                
                
                  
                    
                      y
                      .
                    
                  
                
                
                  
                    
                      z
                      .
                    
                  
                
              
              ]
            
          
        
      
    
    
      
        (
        9
        )
      
    
  




The navigation gain (N′) for the classical pro nav guidance law is typically a constant. The target-to-missile range and velocity vectors (RTM and VTM) come from combining estimates from the three uncoupled target state estimators. The line-of-sight rate vector () of the “All Angle” classical pro nav guidance law near the left-hand side of Equation (5) illustrates more intuitively that () is to be nulled, and does not use the time-to-go approximation.
An all angle optimal augmented pro nav guidance law is derived from applying “All Angle” vector algorithms to Zarchan's scalar modern optimal augmented pro nav guidance law of Equation (2) so that the missile acceleration command vector (nc) is always perpendicular to the target LOS unit vector IT: 



  
    
      
        
          
            n
            _
          
          
            c
            
              1
              ⁢
              
                L
                _
              
              ⁢
              OS
            
          
        
        =
        
          
            
              N
              l
            
            ⁢
            
              
                V
                c
              
              ⁡
              
                [
                
                  
                    
                      λ
                      .
                    
                    _
                  
                  ×
                  
                    
                      I
                      _
                    
                    T
                  
                
                ]
              
            
          
          +
          
            
              (
              
                
                  N
                  l
                
                
                  t
                  go
                  2
                
              
              )
            
            ⁡
            
              [
              
                
                  
                    I
                    _
                  
                  T
                
                ×
                
                  
                    ZEM
                    _
                  
                  TM
                
                ×
                
                  
                    I
                    _
                  
                  T
                
              
              ]
            
          
          -
          
            
              C
              4
            
            ⁢
            
              
                n
                _
              
              L
            
          
        
      
    
    
      
        (
        10
        )
      
    
  
  
    
      
        
          where
          ⁢
          
             
          
          ⁢
          
            
              ZEM
              _
            
            TM
          
        
        =
        
          
            0.5
            ⁢
            
               
            
            ⁢
            
              t
              go
              2
            
            ⁢
            
              
                n
                _
              
              T
            
          
          =
          
            0.5
            ⁢
            
               
            
            ⁢
            
              
                t
                go
                2
              
              ⁡
              
                [
                
                  
                    
                      
                        n
                        TX
                      
                    
                  
                  
                    
                      
                        n
                        TY
                      
                    
                  
                  
                    
                      
                        n
                        TZ
                      
                    
                  
                
                ]
              
            
          
        
      
    
    
      
        (
        11
        )
      
    
  




The relationship shown in Equation (4) is used to keep the classical pro nav part of the new law intact as function of , which is more intuitive and does not use the time-to-go (tgo) approximation of Equation (3). Zarchan's modern navigation gain (N′) and the achieved missile acceleration quantity (C4 nL) that optimally make-up for the expected dynamics lag in the missile autopilot remain unchanged. The classical guidance augmentation using estimated target acceleration (nT) is presented in Equation (11) as the zero effort miss vector (ZEMTM) caused by a constant target maneuver. An important enhancement of the new law in Equation (10) is the application of two cross-products to ZEMTM using the target line-of-sight unit vector (IT). This results in properly applying the ZEMTM augmentation so as to always be perpendicular to the target LOS unit vector IT.
Thus, the “All Angle Guidance” law of Equation (10) can lead to higher probability of kill and lower missile agility requirements for all types of engagement geometries.
Another feature used in accordance with exemplary embodiments is “Periodically Adaptive Guidance.” This means that the target acceleration frequency (spiraling, weaving, none) is periodically adaptively estimated and used to successfully improve missile guidance. The result can lead to higher probability of kill and lower missile divert requirements for a wide range of maneuvering targets.
A periodically adaptive guidance law is derived from improved prediction of ZEMTM based on probability weighted multiple models of different target maneuver frequencies and their target acceleration and acceleration rate states as described for one dimension in “Multiple Adaptive Estimation and prediction with the harmonically balanced Kalman Filter Bank”: 



  
    
      
        
          
            ZEM
            _
          
          TM
        
        =
        
          [
          
            
              
                
                  
                    
                      
                        ∑
                        NMB
                      
                      
                        m
                        =
                        1
                      
                    
                    ⁢
                    
                      
                        C
                        
                          3
                          ⁢
                          m
                        
                        Gx
                      
                      ⁢
                      
                        
                          
                            A
                            ^
                          
                          _
                        
                        Tm
                        Gx
                      
                    
                  
                  +
                  
                    
                      C
                      
                        
                          3
                          ′
                        
                        ⁢
                        m
                      
                      Gx
                    
                    ⁢
                    
                      
                        
                          A
                          
                            .
                            ^
                          
                        
                        _
                      
                      Tm
                      Gx
                    
                  
                
              
            
            
              
                
                  
                    
                      
                        ∑
                        NMB
                      
                      
                        m
                        =
                        1
                      
                    
                    ⁢
                    
                      
                        C
                        
                          3
                          ⁢
                          m
                        
                        Gy
                      
                      ⁢
                      
                        
                          
                            A
                            ^
                          
                          _
                        
                        Tm
                        Gy
                      
                    
                  
                  +
                  
                    
                      C
                      
                        
                          3
                          ′
                        
                        ⁢
                        m
                      
                      Gy
                    
                    ⁢
                    
                      
                        
                          A
                          
                            .
                            ^
                          
                        
                        _
                      
                      Tm
                      Gy
                    
                  
                
              
            
            
              
                
                  
                    
                      
                        ∑
                        NMB
                      
                      
                        m
                        =
                        1
                      
                    
                    ⁢
                    
                      
                        C
                        
                          
                            3
                            ′
                          
                          ⁢
                          m
                        
                        Gz
                      
                      ⁢
                      
                        
                          
                            A
                            ^
                          
                          _
                        
                        Tm
                        Gz
                      
                    
                  
                  +
                  
                    
                      C
                      
                        
                          3
                          ′
                        
                        ⁢
                        m
                      
                      Gz
                    
                    ⁢
                    
                      
                        
                          A
                          
                            .
                            ^
                          
                        
                        _
                      
                      Tm
                      Gz
                    
                  
                
              
            
          
          ]
        
      
    
    
      
        (
        12
        )
      
    
  
  
    
      
        
          
            where
            ⁢
            
               
            
            ⁢
            
              C
              
                3
                ⁢
                m
              
              G
            
          
          =
          
            
              
                W
                _
              
              m
              G
            
            ⁢
            
              
                Φ
                
                  13
                  ⁢
                  m
                
                PCA
              
              ⁡
              
                (
                
                  
                    t
                    ^
                  
                  go
                
                )
              
            
          
        
        ,
        
          
            C
            
              
                3
                ′
              
              ⁢
              m
            
            G
          
          =
          
            
              
                W
                _
              
              m
              G
            
            ⁢
            
              
                Φ
                
                  14
                  ⁢
                  m
                
                PCA
              
              ⁡
              
                (
                
                  
                    t
                    ^
                  
                  go
                
                )
              
            
          
        
      
    
    
      
         
      
    
  
  
    
      
        
          
            where
            ⁢
            
               
            
            ⁢
            
              
                W
                _
              
              m
            
          
          =
          
            [
            
              
                
                  
                    
                      
                        
                          W
                          Xm
                        
                      
                    
                    
                      
                        
                          W
                          Ym
                        
                      
                    
                  
                
              
              
                
                  
                    W
                    Zm
                  
                
              
            
            ]
          
        
        ,
        
          
            
              A
              ^
            
            Tm
            G
          
          =
          
            
            
              
                
                  
                    
                      
                        
                          
                            A
                            ^
                          
                          Tm
                          Gx
                        
                      
                    
                    
                      
                        
                          
                            A
                            ^
                          
                          Tm
                          Gy
                        
                      
                    
                  
                
              
              
                
                  
                    
                      A
                      ^
                    
                    Tm
                    Gz
                  
                
              
            
            
          
        
        ,
        
          
            
              
                A
                
                  .
                  ^
                
              
              _
            
            Tm
            G
          
          =
          
            
              
              
                
                  
                    
                      
                        
                          
                            
                              
                                A
                                
                                  .
                                  ^
                                
                              
                              _
                            
                            Tm
                            Gx
                          
                        
                      
                      
                        
                          
                            
                              
                                A
                                
                                  .
                                  ^
                                
                              
                              _
                            
                            Tm
                            Gy
                          
                        
                      
                    
                  
                
                
                  
                    
                      
                        
                          A
                          
                            .
                            ^
                          
                        
                        _
                      
                      Tm
                      Gz
                    
                  
                
              
              
            
            ⁢
            
               
            
            ⁢
            and
          
        
      
    
    
      
        (
        13
        )
      
    
  
  
    
      
        
          [
          
            
              
                
                  
                    Φ
                    
                      13
                      ⁢
                      m
                    
                  
                  ⁡
                  
                    (
                    
                      t
                      go
                    
                    )
                  
                
              
            
            
              
                
                  
                    Φ
                    
                      14
                      ⁢
                      m
                    
                  
                  ⁡
                  
                    (
                    
                      t
                      go
                    
                    )
                  
                
              
            
          
          ]
        
        =
        
          [
          
            
              
                
                  
                    Φ
                    13
                  
                  ⁡
                  
                    (
                    
                      
                        t
                        go
                      
                      ,
                      
                        ω
                        Tm
                      
                      ,
                      
                        T
                        Cm
                      
                    
                    )
                  
                
              
            
            
              
                
                  
                    Φ
                    14
                  
                  ⁡
                  
                    (
                    
                      
                        t
                        go
                      
                      ,
                      
                        ω
                        Tm
                      
                      ,
                      
                        T
                        Cm
                      
                    
                    )
                  
                
              
            
          
          ]
        
      
    
    
      
        (
        14
        )
      
    
  
  
    
      
        
          
            Φ
            m
            PCA
          
          ⁡
          
            (
            τ
            )
          
        
        =
        
          [
          
            
              
                1
              
              
                τ
              
              
                
                  
                    Φ
                    
                      13
                      ⁢
                      m
                    
                    PCA
                  
                  ⁡
                  
                    (
                    τ
                    )
                  
                
              
              
                
                  
                    Φ
                    
                      14
                      ⁢
                      m
                    
                    PCA
                  
                  ⁡
                  
                    (
                    τ
                    )
                  
                
              
            
            
              
                0
              
              
                1
              
              
                
                  
                    Φ
                    
                      23
                      ⁢
                      m
                    
                    PCA
                  
                  ⁡
                  
                    (
                    τ
                    )
                  
                
              
              
                
                  
                    Φ
                    
                      24
                      ⁢
                      m
                    
                    PCA
                  
                  ⁡
                  
                    (
                    τ
                    )
                  
                
              
            
            
              
                0
              
              
                0
              
              
                
                  
                    Φ
                    
                      33
                      ⁢
                      m
                    
                    PCA
                  
                  ⁡
                  
                    (
                    τ
                    )
                  
                
              
              
                
                  
                    Φ
                    
                      34
                      ⁢
                      m
                    
                    PCA
                  
                  ⁡
                  
                    (
                    τ
                    )
                  
                
              
            
            
              
                0
              
              
                0
              
              
                
                  
                    Φ
                    
                      43
                      ⁢
                      m
                    
                    PCA
                  
                  ⁡
                  
                    (
                    τ
                    )
                  
                
              
              
                
                  
                    Φ
                    
                      44
                      ⁢
                      m
                    
                    PCA
                  
                  ⁡
                  
                    (
                    τ
                    )
                  
                
              
            
          
          ]
        
      
    
    
      
        (
        15
        )
      
    
  
  
    
      
        
          
            Φ
            
              13
              ⁢
              m
            
            PCA
          
          ⁡
          
            (
            τ
            )
          
        
        =
        
          
            (
            
              
                Φ
                Bm
              
              +
              
                
                  Φ
                  Am
                
                ⁢
                
                  τ
                  S
                
              
            
            )
          
          +
          
            (
            
              
                e
                
                  
                    -
                    
                      λ
                      Tm
                    
                  
                  ⁢
                  τ
                
              
              ⁢
              
                sin
                ⁡
                
                  (
                  
                    
                      
                        ω
                        Tm
                      
                      ⁢
                      τ
                    
                    +
                    
                      3
                      ⁢
                      
                        θ
                        m
                      
                    
                  
                  )
                
              
              ⁢
              
                /
              
              ⁢
              
                

              
              ⁢
              
                (
                
                  
                    ω
                    Nm
                  
                  ⁢
                  
                    ω
                    Tm
                  
                
                )
              
            
            )
          
        
      
    
    
      
        (
        16
        )
      
    
  
  
    
      
        
          
            Φ
            
              23
              ⁢
              m
            
            PCA
          
          ⁡
          
            (
            τ
            )
          
        
        =
        
          
            Φ
            Am
          
          -
          
            (
            
              
                e
                
                  
                    -
                    
                      λ
                      Tm
                    
                  
                  ⁢
                  τ
                
              
              ⁢
              
                sin
                ⁡
                
                  (
                  
                    
                      
                        ω
                        Tm
                      
                      ⁢
                      τ
                    
                    +
                    
                      2
                      ⁢
                      
                        θ
                        m
                      
                    
                  
                  )
                
              
              ⁢
              
                /
              
              ⁢
              
                ω
                Tm
              
            
            ]
          
        
      
    
    
      
         
      
    
  
  
    
      
        
          
            Φ
            
              33
              ⁢
              m
            
            PCA
          
          ⁡
          
            (
            τ
            )
          
        
        =
        
          
            
              e
              
                
                  -
                  
                    λ
                    Tm
                  
                
                ⁢
                τ
              
            
            ⁢
            
              cos
              ⁡
              
                (
                
                  
                    ω
                    Tm
                  
                  ⁢
                  τ
                
                )
              
            
          
          +
          
            
              λ
              Tm
            
            ⁢
            
              
                Φ
                
                  34
                  ⁢
                  m
                
                PCA
              
              ⁡
              
                (
                τ
                )
              
            
          
        
      
    
    
      
         
      
    
  
  
    
      
        
          
            Φ
            
              43
              ⁢
              m
            
            PCA
          
          ⁡
          
            (
            τ
            )
          
        
        =
        
          
            -
            
              ω
              Nm
              2
            
          
          ⁢
          
            
              Φ
              
                34
                ⁢
                m
              
              PCA
            
            ⁡
            
              (
              τ
              )
            
          
        
      
    
    
      
         
      
    
  
  
    
      
        
          
            Φ
            
              14
              ⁢
              m
            
            PCA
          
          ⁡
          
            (
            τ
            )
          
        
        =
        
          
            (
            
              τ
              -
              
                
                  Φ
                  
                    23
                    ⁢
                    m
                  
                  PCA
                
                ⁡
                
                  (
                  τ
                  )
                
              
            
            )
          
          ⁢
          
            /
          
          ⁢
          
            ω
            Nm
            2
          
        
      
    
    
      
         
      
    
  
  
    
      
        
          
            Φ
            
              24
              ⁢
              m
            
            PCA
          
          ⁡
          
            (
            τ
            )
          
        
        =
        
          
            (
            
              1
              -
              
                
                  Φ
                  
                    33
                    ⁢
                    m
                  
                  PCA
                
                ⁡
                
                  (
                  τ
                  )
                
              
            
            )
          
          ⁢
          
            /
          
          ⁢
          
            ω
            Nm
            2
          
        
      
    
    
      
         
      
    
  
  
    
      
        
          
            Φ
            
              34
              ⁢
              m
            
            PCA
          
          ⁡
          
            (
            τ
            )
          
        
        =
        
          
            e
            
              
                -
                
                  λ
                  Tm
                
              
              ⁢
              τ
            
          
          ⁢
          
            sin
            ⁡
            
              (
              
                
                  ω
                  Tm
                
                ⁢
                τ
              
              )
            
          
          ⁢
          
            /
          
          ⁢
          
            ω
            Tm
          
        
      
    
    
      
         
      
    
  
  
    
      
        
          
            Φ
            
              44
              ⁢
              m
            
            PCA
          
          ⁡
          
            (
            τ
            )
          
        
        =
        
          
            
              Φ
              
                33
                ⁢
                m
              
              PCA
            
            ⁡
            
              (
              τ
              )
            
          
          -
          
            2
            ⁢
            
              λ
              Tm
            
            ⁢
            
              
                Φ
                
                  34
                  ⁢
                  m
                
                PCA
              
              ⁡
              
                (
                τ
                )
              
            
          
        
      
    
    
      
         
      
    
  
  
    
      
        where
        ⁢
        
          :
        
      
    
    
      
         
      
    
  
  
    
      
        
          θ
          M
        
        =
        
          atan
          ⁢
          
             
          
          ⁢
          2
          ⁢
          
            (
            
              
                ω
                Tm
              
              ,
              
                λ
                Tm
              
            
            )
          
        
      
    
    
      
        (
        17
        )
      
    
  
  
    
      
        
          ω
          Nm
          2
        
        =
        
          
            λ
            Tm
            2
          
          +
          
            ω
            Tm
            2
          
        
      
    
    
      
         
      
    
  
  
    
      
        
          Φ
          Am
        
        =
        
          2
          ⁢
          
            λ
            Tm
          
          ⁢
          
            /
          
          ⁢
          
            ω
            Nm
            2
          
        
      
    
    
      
         
      
    
  
  
    
      
        
          Φ
          Bm
        
        =
        
          
            (
            
              1
              -
              
                (
                
                  4
                  ⁢
                  
                    λ
                    Tm
                    2
                  
                  ⁢
                  
                    /
                  
                  ⁢
                  
                    ω
                    Nm
                    2
                  
                
                )
              
            
            )
          
          ⁢
          
            /
          
          ⁢
          
            ω
            Nm
            2
          
        
      
    
    
      
         
      
    
  




As indicated in FIG. 1, the multiple model probability weighting vectors (Wm) defined in Equations (12) and (13) originate from the periodically adaptive target state estimators that are based on multiple model Kalman filtering. The probability weighting vectors (Wm) indirectly represent a three-dimensional estimate of the target maneuver frequency ωt and its correlation time constant TCm. The probability weighting vectors (Wm) contain weights, wherein the sum of the probability weights for any axis of the guidance frame is unity, and they uniquely make the “Periodically Adaptive Guidance” law of Equation (12) periodically adaptive.
As shown in Equation (12) using the vector definitions of Equations (13) and (14), the mth Kalman filter model's estimated target acceleration and acceleration rate state vectors ( and ) are multiplied by the mth model's state transition elements Φ13m(tgo) and Φ14m(tgo). Then they are multiplied by the probability weighting vectors Wm and summed over the total number of models in the Kalman filter bank (NMB). The mth model's state transition elements Φ13m(tgo) and Φ14m(tgo) are time-to-go predictive coefficients based on an mth model's a priori hypothesis of expected target maneuver frequency (ωtm) and its correlation time constant (Tcm). The state transition elements are presented in equations (13) and (14), their derivation is shown in “Multiple Model Adaptive Estimation and Prediction with the harmonically Balanced Bank”.
The mth model state transition elements are obtained using equations (15) through (17), with the variables λTm and ωTm established through parameterization of the harmonically balanced Kalman filter bank. To periodically adaptively estimate states of a maneuvering target, it is desired to adapt to a constant acceleration target (TC≈Tcmax [Sec], ωM=0 [R/S]), to a constant velocity target (TC≈0.2 [Sec], ωM=0 [R/S]), and to a jinking or other type of maneuvering target (TC=unknown [Sec], ωM=unknown [R/S]). The common parameterization design approach is to determine each Kalman filter's dynamical parameters by discretizing a continuous parameter space, which is accomplished by dispersing a set of dynamical parameter vectors [d1 . . . dNMB] throughout a region of reasonable parameter vector values.
FIG. 2 shows an exemplary harmonically balanced Kalman filter bank model 200. The parameterization of the “harmonically balanced Kalman filter bank,” shown in FIG. 1, is accomplished with the mth periodic dynamical parameter vector dm shown by Equation 18: 



  
    
      
        
          d
          m
        
        =
        
          [
          
            
              
                
                  λ
                  Tm
                
              
            
            
              
                
                  ω
                  Tm
                
              
            
          
          ]
        
      
    
    
      
        (
        18
        )
      
    
  




where λTm=mth model target bandwidth, and ωTm=mth model target maneuver frequency.

A hypothesis set of periodic dynamical parameter vectors is split into two parts: 



  
    
      
        
          
            
              
                
                  
                    [
                    
                      d
                      m
                    
                    ]
                  
                  
                    NMB
                    ⁢
                    
                       
                    
                  
                
                ⁢
                
                  -
                  Δ
                
                ⁢
                 
                ⁢
                
                  [
                  
                    
                      d
                      1
                    
                    ⁢
                    
                       
                    
                    ⁢
                    ...
                    ⁢
                    
                       
                    
                    ⁢
                    
                      d
                      NMB
                    
                  
                  ]
                
              
            
          
          
            
              
                =
                
                ⁢
                
                  [
                  
                    
                      
                        d
                        1
                      
                      ⁡
                      
                        [
                        
                          d
                          m
                        
                        ]
                      
                    
                    
                      2
                      ⁢
                      
                        :
                      
                      ⁢
                      NMB
                    
                  
                  ]
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            
              where
              ⁢
              
                

              
              [
              
                d
                m
              
              ]
            
            
              2
              ⁢
              
                :
              
              ⁢
              NMB
            
          
          ⁢
          
            
              
                 
              
              -
              
                 
              
            
            Δ
          
          ⁢
          
            [
            
              
                d
                2
              
              ⁢
              
                 
              
              ⁢
              ...
              ⁢
              
                 
              
              ⁢
              
                d
                NMB
              
            
            ]
          
        
      
    
    
      
        (
        19
        )
      
    
  




The first dynamical parameter vector d1 defines the highly time-correlated “zero-frequency” system dynamics hypothesis model. For Periodically Adaptive Guidance Control, dm at m=1 defines the constant target acceleration hypothesis, shown in equation (20): 



  
    
      
        
          d
          1
        
        =
        
          
            [
            
              
                
                  
                    λ
                    Tl
                  
                
              
              
                
                  
                    ω
                    Tl
                  
                
              
            
            ]
          
          =
          
            [
            
              
                
                  
                    1
                    
                      4
                      ×
                      
                        T
                        C
                      
                      ⁢
                      
                        MAX
                        ⁢
                        
                           
                        
                        [
                        Sec
                        ]
                      
                    
                  
                
              
              
                
                  
                    0.01
                    ⁡
                    
                      [
                      
                        R
                        ⁢
                        
                          /
                        
                        ⁢
                        S
                      
                      ]
                    
                  
                
              
            
            ]
          
        
      
    
    
      
        (
        20
        )
      
    
  




where TCMAX [Sec] is the maximum periodic system dynamics time constant. The remaining set of the periodic parameter vectors [dm]2:NMB encompass a periodic parameter space 201 bounded by TCMAX, shown as line 202 and the maximum system dynamics maneuver frequency ωTMAX represented as line 203. The periodic parameter space 201 with these maximum boundaries is the domain of the normalized PCA power spectral density function. Each periodic parameter vector included in [dm]2:NMB has an identical balanced maximum time constant TCMAX [Sec] or damping coefficient, which is equal to 2/TCMAX [1/Sec]. And, each periodic parameter vector is harmonically separated by a constant half-power bandwidth: 1/TCMAX [Rad/Sec]. Therefore, the parameterization design of the “harmonically balanced Kalman filter bank” is completed with the following set of periodic dynamical parameter vectors: 



  
    
      
        
          
            [
            
              d
              m
            
            ]
          
          
            2
            ⁢
            
              :
            
            ⁢
            NMB
          
        
        =
        
          
            
              [
              
                
                  
                    
                      λ
                      Tm
                    
                  
                
                
                  
                    
                      ω
                      Tm
                    
                  
                
              
              ]
            
            
              2
              ⁢
              
                :
              
              ⁢
              NMB
            
          
          =
          
            
              [
              
                
                  
                    
                      1
                      
                        
                          T
                          C
                        
                        ⁢
                        
                          MAX
                          ⁢
                          
                             
                          
                          [
                          Sec
                          ]
                        
                      
                    
                  
                
                
                  
                    
                      
                        
                          [
                          
                            m
                            -
                            1
                          
                          ]
                        
                        
                          
                            T
                            C
                          
                          ⁢
                          MAX
                        
                      
                      ⁢
                      
                         
                      
                      [
                      
                        Rad
                        ⁢
                        
                          /
                        
                        ⁢
                        Sec
                      
                      ]
                    
                  
                
              
              ]
            
            
              2
              ⁢
              
                :
              
              ⁢
              NMB
            
          
        
      
    
    
      
        (
        21
        )
      
    
  




The total minimum number of parameter hypothesis models in the “harmonically balanced Kalman filter bank” (NMB) is simply a “periodic parameter space area” bounded by the maximum periodic dynamical parameters TCMAX [Sec], and ωTMAX [Rad/Sec], plus one hypothesis model shown as line 204 based on the “zero-frequency” dynamical parameter vector d1,:
 NMB=ωTMAX TCMAX+1  (22)
and models based on dm;m=2 to NMB are represented generally in FIG. 2 as waveforms 206.
The maximum periodic parameters TCMAX and ωTMAX are specified based on a designer's discretion for a particular application. As a result, many arrangements of the “harmonically balanced Kalman filter bank” are possible from the laws of Eqs. (20) and (21).
The minimum time constant TCMIN, shown as line 205, is defined as the height of an “equally weighted” harmonically balanced PCA spectral density function, which is a band limited white noise acceleration or constant velocity model with minimum correlation time constant TCMIN, similar to an ideal low-pass filter. The minimum system dynamics time constant for the “harmonically balanced Kalman filter bank” is inversely proportional to the maximum system dynamics maneuver frequency: 



  
    
      
        
          
            T
            C
          
          ⁢
          M
          ⁢
          
             
          
          ⁢
          I
          ⁢
          
             
          
          ⁢
          N
        
        ≈
        
          
            π
            
              
                ω
                T
              
              ⁢
              M
              ⁢
              
                 
              
              ⁢
              AX
            
          
          ⁢
          
             
          
          [
          Sec
          ]
        
      
    
    
      
        (
        23
        )
      
    
  




The other maximum periodic parameter, the maximum maneuver frequency ωTMAX , is bounded by the maximum realistically expected target maneuver frequency for a particular target based on a priori knowledge. In addition, ωTMAX should be maximized according to Eq. (23) so as to minimize the target acceleration time constant TCMIN for adequately describing a constant velocity target.
The “Periodically Adaptive Guidance” law of Equation (12) can improve missile guidance. As the estimated target maneuver frequency gets higher, the probability weighted state transition elements cause the estimated target acceleration and acceleration rate states to have less affect on the zero effort miss due to a target maneuver. This is reflected in physics: an acceleration sine wave of frequency ω that is twice integrated affects its position magnitude by 1/ω2. Thereby, the zero effort miss of Equation (12) used to augment the “All Angle Guidance” law of Equation (10) will be smaller for higher target maneuver frequencies. For lower target maneuver frequencies the opposite is true, and for zero frequency or constant target acceleration, the zero effort miss due to a target maneuver becomes the classical augmentation of Equation (11). Additionally for a non-maneuvering constant velocity target, the probability weighting vectors can become equally weighted and can successfully cancel out the augmentation.
Thus, the “Periodically Adaptive Guidance” law of Equation (12) can lead to higher probability of kill and lower missile divert requirements for a wide range of maneuvering targets.
1. System Integration
FIG. 1 is a simplified block diagram of a guidance system in accordance with an exemplary embodiment of the present invention. FIG. 1 also shows means for obtaining object position parameters as used in exemplary embodiments.
The target's actual velocity and acceleration vectors within the guidance frame are shown as VGT and AGT and are shown in the target portion of the diagram 400. Vectors are generally represented with a capital letter that is underlined. The reference frame associated with vectors is a superscript to the right of the vector, for example VG is a velocity vector in the G reference frame. Measured parameters are indicated with a “*” and subscripts are used to associate the parameter with an object, for example VtG* is a measured velocity vector associated with a target. A “^” over a scalar or a vector indicates an estimated value and a “” indicates a rate, for example  the estimated change of the range with respect to time.
The relative geometry of the target in relationship to the missile is shown in the relative geometry portion 410 of the diagram where the VGTM represents the closing velocity in vectored form between the missile and the target. Subsequently, the range vector are RGTM represents the end state miss distance between the target and the missile in vector form and IGT represents the target LOS vector. The target LOS angles λel and λaz are the actual azimuth and elevation angles from the missile to the target. The description of the relative geometry is merely a representation of the physical dynamics of the target with respect to the guidance frame and the missile. This portion of FIG. 1 need not be performed by the guidance system, but serve as a representation for illustrative purposes.
In the radome portion of the diagram λel and λaz are operated on by block 421 [1+r], where r is the radome slope error. The modified LOS angles are combined at 422 with representation of Ψel and Ψaz which are the missile body axis angles with respect to the guidance frame, multiplied by r, the radome slope error in block 423. The output of the combiner 422 is a measurement of the LOS in λ′el and λ′az which is forwarded to the Gimbaled seeker 430. Radome compensation is addressed in U.S. Pat. No. 3,316,549. The Gimbaled seeker track loop has Gimbal rates as an input which are the rates of change obtained from a rate gyro of the angle between the antenna axis and the missile axis. The gyro rates ωel*, ωaz* are integrated in block 432 and the integration is applied to the output of the radome λ′el and λ′az. The combination results in εel, εaz, which are the angles between the missile to target LOS and the electrical bore sight or track errors. The track errors are multiplied by the track loop gain in block 434 and that quality along with the gyro rates are applied to the integrator 432 to complete the loop. The track errors are also multiplied in block 435 to compensate for the radome, resulting in εel* and εaz*. These compensated track errors are inputs to the periodically adaptive all angle guidance system. The Gimbal rates in 431 are integrated in block 436 and used to compensate the track errors and serve as input to the periodically adaptive all angle guidance system 460. The seeker track errors εel* and εaz* have radome compensation and target body aim point corrections. The gimbal rates, derived from the body rates ψel and ψaz, are integrated resulting in gimbal angles Gpitch* and Gyaw*, they are applied as inputs to the radome compensation 435 and into the periodically adaptive all angle guidance and control system 460. An inertial reference unit (IRU) 450, the same as IRU 452, is transformed through a transformation matrix Cnb into the inertial navigation frame and supplied to the periodically adaptive all angle guidance and control system 460.
The output of the periodically adaptive all angle guidance and control system 460 results in a missile acceleration guidance command vector in the inertial guidance frame nGcILOS which is transmitted at 463 as an input to the missile's autopilot 456. The autopilot generates an acceleration vector which is integrated in block 457 to represent a velocity vector. The acceleration and velocity vectors are fed into a transformation block 455 which yields flight path rates and eventually body rates. Body angles Ψel and Ψaz, and the velocity and acceleration vectors of the missile are functions external to the control system. These are not part of the actual mechanism of the guidance system and only facilitate to derive a representative input to the internal reference unit (IRU) and the radome. Periodically adaptive all angle guidance and control system 460 is represented as blocks in FIG. 1, vectored LOS reconstruction 461 which supplies IGt* which is reconstructed LOS vector measurement of the range between the target and the missile relative to a guidance frame. Block 462 creates an estimate of the range {circumflex over (R)}tm from the target which when multiplied by the reconstructed LOS vector becomes a range vector RG*tm in the guidance frame. This input is received by the periodically adaptive object state estimators 464 and all angle guidance and control block 465, both of which receive input from IRU located in the missile. Other such systems with radome, seekers and autopilots can be used in conjunction with the periodically adaptive guidance as described above.
Vectored LOS reconstruction 461 with a gimbaled seeker as well as with an electrically steered seeker, the periodic adaptive control and periodically adaptive target state estimation are now discussed in greater detail.
2. Vectored LOS Reconstruction
A simplified diagram of a means for creating a vectored LOS in a guidance frame from an object position parameter is presented in FIG. 3. In particular FIG. 3 shows vectored LOS reconstruction with a gimbaled seeker. The inputs to the vectored LOS reconstruction can include the seeker track errors ε*el and ε*az, seeker gyro rates ω*el and ω*az and the IRU missile body to inertial navigational frame transformation matrix Cnb, as well as the seeker Gimbal angles G*pitch and G*yaw. From the G*pitch and G*yaw, a transformation vector CBS from the missile body frame to the seeker bore sight frame is constructed in block 501. This transformation matrix is applied in block 502 along with the missile body to inertial navigation frame transformation matrix CGB and an identity matrix I which equals the transformation matrix of the seeker to the inertial guidance frame at the initial condition of t=0. The output of block 502 is a transformation matrix at t=0 of the inertial navigation frame to the inertial guidance frame.
The transformation matrix Cgn(0) operates on the Cnb matrix in block 503 resulting in a transformation matrix from the missile body to the inertial guidance frame CGB. This transformation matrix operates on the transformation matrix CBs in block 504 to form matrix CGs which is the seeker bore sight frame to the guidance frame transformation matrix. The matrix CGs operates on the seeker gyro rates ω*el and ω*az in block 505 forming the inertial seeker boresight direction cosine rate vector IG*s. The matrix CGs also operates on the seeker track errors ε*el and ε*az forming a target end point to seeker boresight error vector eG*ts.
The direction cosine rate factor Ig*s undergoes inertially referenced trapezoidal integration in block 520. The integration within blocks 506 and 512 are accomplished using Z transforms in that IG*s is not a continuous function and thus lends itself more readily to the Z transformations. The output of the trapezoidal integration is the inertial seeker boresight vector IG*s which is combined with the error vector eG*ts at combiner 514. The resultant vector is normalized in block 515 to form a target aim point LOS vector IG*t with the magnitude of 1, in other terms a unit vector. Referring to FIG. 1 at block 462, a range estimate independently calculated is then applied to the LOS vector IG*t to obtain the range vector RG*tm. The range vector and the IRU of the interceptor are used in the periodically adapted estimation and control.
Alternative means for creating a vectored LOS in a guidance frame from an object position parameter using vectored LOS reconstruction is shown in FIG. 4 as a simplified schematic wherein the seeker is electronically steered. The vectored LOS reconstruction with an electronically steered seeker is similar to the LOS reconstruction with the gimbal seeker, thus only differences of note will be discussed. Whereas in the gimbal seeker, gyro rates and gimbal angles are supplied as inputs, with an electronically steered seeker, these inputs are generated within the LOS reconstruction. However, the uncompensated seeker track errors remain as inputs to the electronically steered seeker LOS reconstruction.
The seeker beam steering command space rates are generated in a control loop in which these uncompensated seeker track errors {grave over (ε)}el and {grave over (ε)}az are combined with the transformation matrix Cgsc between the seeker beam steering command and the guidance frame in block 602. This track compensation with rate aiding results in the steering command space rates ωcl and ωaz. IGsc is integrated in an inertially referenced trapezoid integration process 610 resulting in IGsc the inertial seeker beam's steering command vector. The vector IGsc is then added at 612 to the target aim point to seeker beam center error vector eG*ts, normalized and results in the target aim point LOS vector IG*t. The seeker beam steering command vector IGsc is further added at 614 to İGsc operated on by [Ts+Tdelay] in box 620. The resultant vector is normalized 615, integrated 616, and multiplied 617 by the transformation vector CGb which results in the seeker beam steering command vector in missile body frame IBfc which functions on the steering command gimbal angles in block 618 generating the pitch and yaw angles Gpitch and Gyaw. Other functions shown in FIG. 4 perform similar to their counterparts in the gimbaled seeker and are references as such.
3. Periodically Adaptive Guidance
Means for generating a guidance command signal using estimated object states utilizing an exemplary periodically adaptive guidance and control system is shown on FIG. 5. The inputs to the guidance system are the reconstructed LOS vector IG*t, the seeker range and range rate measurements are R*tm, {dot over (R)}*tm, and IRU missile acceleration vector in an inertial navigation frame An*m. In block 701, from the range and range rate measurements an estimate is made of range and range rate. The range rate Tm is operated on by block 702 resulting in {circumflex over (V)}c, the estimated closing velocity. The estimated range, {circumflex over (R)}Tm is divided by {circumflex over (V)}c in block 703 to obtain the estimated time-to-go, or time to intercept {circumflex over (t)}go. The means for generating a guidance command signal uses sequential line-of-sight (LOS) vectors in the guidance frame, in that the estimated range {circumflex over (R)}Tm is multiplied in block 704 by the LOS unit vector to obtain the range vector RG*tm. The IRU missile acceleration vector in inertial navigation frame, AN*m, is applied to a transformation matrix in block 705 in order to obtain the missile acceleration vector AG*M in the inertial guidance frame. The periodically adaptive target state estimation in block 800 receives Rg*tm and AG*m as inputs. As a result of the periodically adaptive target state estimator 800, the means for generating a guidance command signal is periodically adaptive.
The target state estimation result in four target state vectors as well as a mth model probability weighing vector WGm. The target state variables can be the estimated target to missile range vector {circumflex over (R)}TmG, the estimated target to missile velocity vector {circumflex over (V)}TmG and two target acceleration state vectors ÂTmG and TmG. The weighing vector is represented as WGm. The estimated range vector is divided by the estimated range in block 706 to obtain a estimated LOS vector ÎTG, the estimated LOS vector is reduced into its constituents parts forming an estimated JGT vector in the guidance frame and an estimated KGT vector, both vectors being mutually perpendicular and formed in blocks 707 and 708 respectively. The estimated target to missile velocity vector is crossed by the estimated target to missile range vector and divided by the square of the scalar estimated range in block 709 thus resulting in an estimated target line-of-sight angular rate vector G which is multiplied by the estimated closing velocity scalar {circumflex over (V)}C in block 710. The target acceleration state vectors ÂTmG and TG are multiplied by the mth model periodically adaptive control vector gains CG3m and CG3′m, and summed over the number of banks in block 720, the control vector gains are determined from the mth model probability Weight vector WGM in block 711 and 712. Φ13m(tgo) and Φ14m(tgo) are derived in the previously mentioned master's thesis.
The gains and navigation ratios associated with the exemplary periodically Adaptive guidance control system are shown in Table 2. The gains CG3m and CG3′m are used as the C3 gains disclosed in prior art systems discussed previously. Laws CPA and Dpa are associated with laws C and D respectively, but contained periodically adaptive gains.










TABLE 2







C3mG
C3′mG




















Law CPA




  
    
      
        Φ
        
          13
          ⁢
          
             
          
          ⁢
          m
        
        PCA
      
      ⁡
      
        (
        
          
            t
            ^
          
          go
        
        )
      
    
    
      
        t
        ^
      
      go
      2
    
  
  ⁢
  
     
  
  ⁢
  
    (
    
      
        
          
            W
            m
            Gx
          
        
      
      
        
          
            W
            m
            Gy
          
        
      
      
        
          
            W
            m
            Gz
          
        
      
    
    )
  








  
    
      
        Φ
        
          14
          ⁢
          
             
          
          ⁢
          m
        
        PCA
      
      ⁡
      
        (
        
          
            t
            ^
          
          go
        
        )
      
    
    
      
        t
        ^
      
      go
      2
    
  
  ⁢
  
     
  
  ⁢
  
    (
    
      
        
          
            W
            m
            Gx
          
        
      
      
        
          
            W
            m
            Gy
          
        
      
      
        
          
            W
            m
            Gz
          
        
      
    
    )
  







Law DPA







where: 







  
    
      W
      _
    
    m
    G
  
  =
  
    
      
        (
        
          
            
              
                W
                M
                Gx
              
            
            
              
                W
                m
                Gy
              
            
            
              
                W
                m
                Gz
              
            
          
        
        ⁢
        
           
        
        )
      
      T
    
    =
    
      
        
          
            Multiple
            ⁢
            
               
            
            ⁢
            Model
            ⁢
            
               
            
            ⁢
            Probability
          
        
      
      
        
          
            Weighting
            ⁢
            
               
            
            ⁢
            Vectors
            ⁢
            
               
            
            ⁢
            in
          
        
      
      
        
          
            Inertial
            ⁢
            
               
            
            ⁢
            Cartesian
            ⁢
            
               
            
            ⁢
            Guidance
            ⁢
            
               
            
            ⁢
            Frame
          
        
      
    
  



 



{circumflex over (t)}go = Estimated-Time-to-Go [sec]







  
    
      (
      
         
      
      ⁢
      
        
          
            
              
                Φ
                
                  13
                  ⁢
                  
                     
                  
                  ⁢
                  m
                
                PCA
              
              ⁡
              
                (
                τ
                )
              
            
          
          
            
              
                Φ
                
                  14
                  ⁢
                  
                     
                  
                  ⁢
                  m
                
                PCA
              
              ⁡
              
                (
                τ
                )
              
            
          
        
      
      ⁢
      
         
      
      )
    
    =
    
       
    
    ⁢
    
      
        
          
            Harmonically
            ⁢
            
               
            
            ⁢
            Balanced
            ⁢
            
               
            
            ⁢
            Multiple
            ⁢
            
               
            
            ⁢
            Model
            ⁢
            
               
            
            ⁢
            PCA
          
        
      
      
        
          
            State
            ⁢
            
               
            
            ⁢
            Transition
            ⁢
            
               
            
            ⁢
            Matrix
            ⁢
            
               
            
            ⁢
            Elements
          
        
      
    
  
  ⁢
  
     
  



 






The periodically Adaptive Guidance Control system can include, as seen in exemplary embodiments, a gain C4 in block 722 to compensate for autopilot lag, but is not required.
The result of the periodically adaptive control calculation of block 720 is an estimated zero effort miss vector tmG divided by the time to go squared ({circumflex over (t)}go)2. The missile acceleration vector in an inertial guidance frame AG*m is subject to a gain in block 722 of C4, similar to classical optimal control theories discussed previously. The LOS component vectors JGt, KGt, the quantity {circumflex over (V)}c and , the Zero effort miss vector tm divided by ({circumflex over (t)}go)2 and the missile acceleration vector multiplied by the gain C4 combine in block 725 to obtain a missile guidance acceleration command vector NGC in the inertial guidance frame which is perpendicular to the LOS. A close look at the equation terms in block 725, reveals the means for generating a guidance command signal comprises a proportional navigation controller, a classical optimal controller and an augmented proportional navigational controller. The coefficient {circumflex over (V)}c.G originates from proportional navigational control theory. The coefficient C4.AG*m represents the acceleration command that compensates for autopilot lag which is synonymous with classical Optimal Proportional Navigation Guidance. The tm vector divided by time-to-go squared ({circumflex over (t)}go)2 is similar to the augmented acceleration command vector and is the predominate periodic adaptive guidance portion. The resultant missile guidance acceleration command signal is a vector that is perpendicular to the LOS vector tG thus the significance of the “skid to turn” missile maneuver term can be seen.
4. Target State Estimation
Means for estimating object states according to an exemplary periodically adaptive target state estimation system referred to here before in general terms is shown in greater detail in FIG. 6. The inputs to the periodically adaptive target state estimation system are the reconstructed LOS vector, RG*tm, a seeker measurement error of variance matrix transform from seeker boresight frame to inertial guidance frame [σ2r]G and the IRU missile acceleration vector n inertial guidance frame AG*m. The target state estimation is carried out in each of the three axis independently. To be periodically adaptive, the means for generating a guidance command signal has at least one Kalman filter bank, to be periodically adaptive, the bank is harmonically balanced, and each of the at least one Kalman filter banks 810a, 810b and/or 810c is associated with a respective axis x,y and/or z in the guidance frame G. Although FIG. 6 shows the estimation of these target state variables for each of the three axis, for description purposes only the x axis will be discussed as the process is identical for each axis in the guidance frame.
The harmonically balanced Kalman filter bank 810a receives the X component of RG*tm and designated as {circumflex over (R)}GX*, the expected X axis target acceleration variance σ2ax and the X component of the seeker measurement error variance matrix in the inertial guidance frame σ2RX and the IRU missile acceleration vector and inertial frame AGxm. In generating a guidance command signal, the Harmonically Balanced Kalman filter Bank 810 is a means for generating a set of probability weights. An output of the harmonically balanced Kalman filter bank 810 is the mth model X axis probability weights WGxm and the mth model X axis state estimates {circumflex over (X)}m which comprises the vector {circumflex over (R)}TMmGX*, {circumflex over (V)}TMmGX, ÂTmGX and TmGX. The means for generating a guidance command signal creates an estimated object to device range vector, an estimated object to device velocity vector, an estimated object acceleration vector and an estimated object acceleration rate vector, these vectors are representative of the object or target states shown in FIG. 5. The summation in block 811 of the product of WGxm and {circumflex over (X)}m where m=1 to number of banks, results in the X axis state estimate {circumflex over (X)} which includes {circumflex over (R)}TMGX*, {circumflex over (V)}TMGX, ÂTGX, TGX. The combination of all three dimensions, results in an output of the periodically adaptive estimated states of an estimated target-to-missile range vector , an estimated target-to-missile velocity vector {circumflex over (V)}TMG and the mth model estimated target acceleration state vectors ÂGT and GT also containing three components associated with the axis of the guidance frame. Additionally, the mth model probability weighing vector WGm is provided. It is noteworthy to mention that each axis state estimates can be generated independently and congruently.
5. Harmonically Balanced Kalman Filter Banks
Kalman filtering theory models the system using Gaussian distributed random noise disturbances. The Kalman filter is a real-time computer algorithm that estimates system states with a recursive two step process. Kalman filters predict system states expected at the next measurement input time using a priori knowledge of the missile-target dynamic model, and it corrects the predicted object states with noise corrupted measurements of the system.
A simplified block diagram of an exemplary harmonically balanced Kalman filter in the X axis is presented in FIG. 7. Other harmonically balanced Kalman filter banks for the Y and Z axis are performed similarly.
A Bayesian hypothesis probability calculator is represented in the diagram as area 910. The inputs to the Bayesian hypothesis calculator are σ res Xm(tK) which is the multiple model X axis residual variances which is matrix of constants, the derivation of which is well known to those skilled in the art. Res Xm(tK+), the multiple X axis residuals also serves as inputs. An mth model Kalman filter with the “correct” system dynamics hypothesis model can be expected to have minimized residuals compared to other “mismatched model” mth model Kalman filters. From these two inputs, a multiple model of Gaussian probability density distribution is created at block 917. The measurement probability density of the mth filter in the multiple model bank is a Gaussian distribution, in that the Kalman filter theory depends on the system modeling with Gaussian probability density distributions.
Throughout FIG. 7, (tK−) is the unconditioned result of a prediction estimate while (tK+) is the conditioned prediction estimate. The multiple model Gaussian probability density 917 is multiplied by the multiple model X axis probability weights in block 911. The result is then normalized in block 912 by dividing the sum of the product of the mth model Gaussian probability density with the mth model X axis probability weight from one to the number of filter banks (NMB). The result is a multiple model X axis probability weight that has been conditioned.
The multiple model WXm probability weights are integrated in block 913 using a Z transformation with WXm(0) being the initial condition for the transformation. The mth model X axis probability at (tK−1−) which is unconditioned is multiplied by the transition probability matrix TMEQMP in block 914. TMEQMP is the transition probability of the true system dynamical parameters not changing during sample time interval and is set at 99.9%. TMNEMP is the transition probability of true system dynamical parameters changing during a sample time interval and includes all values where TMNEMP is not equal to TMEQMP. The formulation of this matrix and it's use in Bayesian hypothesis probability is known and documented as the adaptive learning theory of Moose and Wang entitled “An adaptive estimator with learning for a plant containing Semi-Markov switching parameters,” by R. L. Moose and P. P. Wang, IEEE Transactions on Systems, Man, and Cybernetics, vol. 3, (May 1973): 277-281, which is herein incorporated by reference. The matrix is summed with TMNEMP in block 915 which results in the multiple model X axis probability weight WXm(tK−) which is the unconditioned result of prediction estimates. The use of the transitional probability matrix allows the bank of harmonically balanced Kalman filters to move from weights =0 to weights >0.
The X axis missile acceleration measurement UX (tK) is multiplied by L [−Ts2/2, −Ts,0 ,0]T in block 929 and added to the PCA state transition matrix ΦmPCA(Ts) where Ts is the sample time in block 930 to form the deterministic input {circumflex over (X)}m(tk+1). The deterministic input is integrated to form {circumflex over (X)}m(tk−) through a Z transformation in block 931. The initial input into the Z transform is the initial condition of X at T=0. The result is multiplied by the H vector which is the system measurement matrix shown in block 932 and subtracted from the X axis range vector X*(tk) in block 901. The result of this addition are multiple model X axis residuals, resXm(tK−), which continues the loop as input to the multiple model Kalman probability function of block 917 and are summed in block 934 along with a multiple model X axis Kalman gain matrix KXm(tK). This combination added to {circumflex over (X)}M(tK−) at 933 supplies Xm(tk+) which is a multiple model X axis state estimate.
The expected X axis target acceleration variance σ2ax is multiplied by 2 λTm which reflects the plant noise and ΓmΓmTPCA(TS) in block 921 and added to the covariance propagator in block 922. The result is the multiple model X axis covariance matrices PXm(tK−) which is thereafter multiplied by the transpose of the transition matrix H and divided by the, residual variances σres2Xm(tK−) in block 921. The result is the multiple model X axis Kalman gain matrix KXm(tK) which is applied to block 925 which conditions the multiple model X axis covariance matrices. The conditioned multiple model X axis covariance matrices are submitted to block 926 to limit the cross variance, so that the correlation of coefficients is <1. Covariance limiting is required to eliminate singularities in the multiple model X axis covariance matrices. The result is integrated in block 927, by a Z transformation, and multiplied in block 922 to form covariance propagation.
When an initial condition is true as in block 935, no residue is created as the path is broken, however the propagation of the multiple model X axis covariance matrices PXm continues for multiple time periods Ts. The result of this process is {circumflex over (X)}m(tK+) which is a multiple model X axis state estimate. The harmonically balanced multiple model PCA noise covariance input matrix ΓmΓmTPCA(TS) is digitally precomputed from the equation (24). 



  
    
      
        
          
            
              Γ
              m
            
            ⁢
            
              
                Γ
                m
                
                  T
                  PCA
                
              
              ⁡
              
                (
                
                  T
                  s
                
                )
              
            
          
          =
          
            +
            
              
                ∫
                0
                
                  T
                  1
                
              
              ⁢
              
                
                  
                    Φ
                    m
                    PCA
                  
                  ⁡
                  
                    (
                    τ
                    )
                  
                
                ⁢
                
                  G
                  m
                
                ⁢
                
                  G
                  m
                  T
                
                ⁢
                
                  
                    Φ
                    m
                    
                      T
                      PCA
                    
                  
                  ⁡
                  
                    (
                    τ
                    )
                  
                
                ⁢
                
                  d
                  τ
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            where
            ⁢
            
               
            
            ⁢
            
              G
              m
            
          
          =
          
            
              [
              
                0
                ⁢
                
                   
                
                ⁢
                0
                ⁢
                
                   
                
                ⁢
                1
                ⁢
                
                   
                
                ⁢
                
                  (
                  
                    
                      ω
                      
                        N
                        m
                      
                    
                    -
                    
                      2
                      ⁢
                      
                        λ
                        Tm
                      
                    
                  
                  )
                
              
              ]
            
            T
          
        
      
    
    
      
        (
        24
        )
      
    
  




It is important to note that Ts is a fixed sample time in seconds. Thus the Bayesian hypothesis estimator the covariance propagator, the Kalman matrices and the multiple model target state estimates result in the multiple model X axis state estimates {circumflex over (X)}m(Tk), which is conditioned.
The expected X-axis target acceleration variance σax2 is shown in the top left hand corner of FIG. 7. This is a constant that is selected using the generalized knowledge of the target and is constant within the velocity frame. Multiple σax2 can be used depending upon the type and nature of the target encountered. An independent system or operator input can be used to evaluate and select from a plurality of established σax2 based on a priori knowledge of the specific targets.
FIG. 8a is a representation of a flight path 866a of a missile 860a intercepting a target 850a, executing a barrel roll maneuver flight path 855a, using an exemplary embodiment of vectored LOS reconstruction and Classical Optimal Guidance Control. The figure demonstrates the guidance control systems ability to engage in high boresight angle engagements. The Classical Optimal Guidance Control results in the missile mimicking the targets flight path with an expenditure of additional energy. The Figure also contains an insert 870a which is the target acceleration power spectral density plot.
The coverage of classical optimal control law dynamics is shown where the object (target) bandwidth λT is one radian per second and the normalized target acceleration has a frequency of ωT=0, both of which are assumed from a priori knowledge of the target. The barrel roll maneuver at ωT=3, is outside the response capability of the classical optimal control law dynamic, the consequence, as shown in FIG. 8a, being the intercepting device 860a mimics the target's path 855a as seen the Figure.
FIG. 8b represents a flight path 866b of a missile 860b intercepting a target 850b, executing a similar maneuver along flight path 855b, using an exemplary embodiment of Periodically Adaptive Guidance Control. The figure demonstrates the Periodically adaptive guidance control system's ability to adapt to the maneuver frequency of the target and minimize the necessity to match the periodic maneuvers of the target. The periodically adaptive guidance control system can reduce energy consumption during intercept as well as required missile agility. The Figure also contains an insert 870b which is the target acceleration power spectral density plot.
The periodically adaptive control law dynamics as seen in FIG. 870b, encompasses the barrel roll maneuver frequency ωT=3 within a small bandwidth 0.25 rads per second. The periodically adaptive capability allows the system to adapt to varying target acceleration frequencies. Thus the control system can respond robustly to the periodic barrel roll or other periodic maneuvers. The its resultant missile path shown as 866b. 
FIG. 9a shows a periodically adaptive control law dynamic of an exemplary embodiment. This Figure is reproduced from FIG. 8b such that the adaptive dynamic nature of the present invention can be illustrated when view alongside FIG. 9b-FIG. 9d. 
FIG. 9b is a representation of the bandwidth response capability for a constant maneuver target where the maneuver frequency ωT=0. The classical optimal control dynamics can encompasses the constant acceleration maneuver dynamics of the target, since it is within the assumed bandwidth. FIG. 9b shows that the periodically adaptive control dynamics can effectively encompass the target acceleration frequency of the constant maneuver target.
An overlap in the classic optimal control law dynamics response bandwidth can occur for a jinking target. However, as the bandwidth of the target maneuver jinking dynamics increases, the effectiveness of the classical optimal control dynamics is reduced. FIG. 9c is a target acceleration power spectral density plot for periodically adaptive control against a time varying jinking target. FIG. 9c demonstrates that the periodically adaptive control dynamics response bandwidth adapts to encompass the bandwidth and frequency of the target. The same is true of FIG. 9d where a constant velocity target is presented.
As is evident in FIGS. 9a-9d, the periodically adaptive control dynamics response bandwidth of the present invention readily adapts to target maneuvers that arc periodic with a frequency greater than zero. In the case of constant acceleration, constant maneuver and jinking maneuver, the periodically adaptive control system demonstrates a capability at least equal to those of a classical optimal guidance system. Therefore, in addition to handling target maneuvers in which the classical optimal guidance system is well formed, exemplary embodiments of the present invention can handle a periodic maneuver, such as the barrel roll maneuver used by aircraft pilots for evasive maneuvers, or the tumbling of intercontinental ballistic missiles upon their reentry.
An exemplary embodiment utilizing alternate means for determining a guidance command using estimated object state with classical optimal guidance is presented in FIG. 10. Classical optimal all angle guidance shares similar components and operations with exemplary embodiments of periodically adaptive all angle guidance system discussed with respect to FIG. 5 and are referenced accordingly, with the notable exception of periodically adaptive object state estimation and periodically adaptive control.
The inputs to the guidance system are the reconstructed LOS vector IG*t, the seeker range and range rate measurements are R*tm, {dot over (R)}*tm, IRU missile acceleration vector in an inertial navigation frame An*m. In block 701, from the range and range rate measurements an estimate is made of range and range rate. The range rate tm is operated on by block 702 resulting in {circumflex over (V)}c, the estimated closing velocity. The estimated range, {circumflex over (R)}tm is divided by {circumflex over (V)}c in block 703 to obtain the estimated time-to-go, or time to intercept {circumflex over (t)}go. The estimated range {circumflex over (R)}tm is multiplied in block 704 by the LOS unit vector to obtain the range vector RG*tm. The IRU missile acceleration vector in inertial navigation frame AN*m is applied to the transformation matrix in block 1405 in order to obtain the missile acceleration vector AG*M in the inertial guidance frame. The classical optimal target state estimation function in block 1400 is well known in the art and it particulars are not further developed. The classical optimal target state estimation function 1400 receives Rg*tm and AG*m as inputs.
In an exemplary embodiment, means for estimating object states result in three target state vectors. The target state variables are the estimated target to missile range vector tmG, the estimated target to missile velocity vector tmG and the estimated target acceleration state vector ÂtmG. The estimated range vector and velocity vectors are processed in the same manners previously discussed regarding FIG. 5, resulting in an estimated JG vector in the guidance frame tG and an estimated KG vector tG, and an estimated target LOS angular rate vector Gwhich is multiplied by the estimated closing velocity scalar {circumflex over (V)}C in block 710. The target acceleration state vector ÂtG is multiplied by gain C3 at block 1420 where C3 is a function of λT and tgo, as shown in equation (25) where λT is a predetermined target bandwidth based on priori knowledge. 



  
    
      
        
          
            C
            3
          
          =
          
            
              
                e
                
                  -
                  
                    X
                    T
                  
                
              
              +
              
                X
                T
              
              -
              1
            
            
              X
              T
              2
            
          
        
        ⁢
        
          

        
        ⁢
        where
        ⁢
        
          

        
        ⁢
        
          
            X
            T
          
          =
          
            
              λ
              T
            
            ⁢
            
              
                t
                ^
              
              go
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            λ
            T
          
          =
          
            Target
            ⁢
            
               
            
            ⁢
            Maneuver
            ⁢
            
               
            
            ⁢
            Bandwidth
          
        
      
    
    
      
        (
        25
        )
      
    
  




The result of this gain in block 1420 is an estimated zero effort miss vector ZÊMtmG divided by the time-to-go squared {circumflex over (t)}go2. The missile acceleration vector in an inertial guidance frame AG*m is subject to a classical optimal control theory gain of C4 in block 722 as discussed previously. The LOS component vectors JtG, KtG, the quantity {circumflex over (V)}c and G, the Zero effort miss control vector TMG divided by {circumflex over (t)}go2 and the missile acceleration vector multiplied by the gain C4 combine in block 725 to obtain a missile guidance acceleration command vector NGC in the inertial guidance frame which is perpendicular to the LOS.
FIG. 11 shows an exemplary embodiment of the present invention applied in a fire control system. The system containing means for generating a signal representing a predicted position of the object from object position parameters relative to a guidance frame and a periodically adaptive estimated object state produced in the guidance frame using the object position parameters; and, means for transmitting the signal to an on-board guidance control of the device.
The fire control platform 1500 tracks the target 1520 through a radar system 1501 in addition also tracks the interceptor missile 1510. The fire control platform can be a fixed ground station, mobile station an aircraft, ship, or space based platform. The missile fire control platform includes a radar processing unit 1503 that determines range and directional information of the target and of the interceptor missile. These values are fed into periodically adaptive object state estimators 1504 which create a predicted intercept position (PIP). The PIP is then transmitted through a transmitter 1505 via an antenna 1502 to a receiver on the interceptor missile 1511 where the missile generates an acceleration command based upon the PIP. Whereas previously exemplary embodiments of the invention are successfully used for terminal guidance, missile file control guidance is particularly suited toward mid-course guidance.
Interceptor missiles due to constraints of energy and weight have a narrow acquisition band which is well suited to close in targets, however a missile fire control radar system, where power supply and size of the radar system is not a limiting factor, can more readily acquire the targets. The missile fire control system can direct the interceptor missile until the interceptor missile can acquire the target with its own tracking system, or direct the missile through termination.
FIG. 12 shows an exemplary embodiment of periodically adaptive missile fire control system. A missile fire control platform 1600 obtains the range and range rate measurements from it's tracking radar and forms range and range rate estimation in block 1601. These inputs can be the measured range of the target to the platform R*TP, the range rate of from the target to the platform {dot over (R)}*TP, the range of the missile to the platform R*MP and the range rate to the platform {dot over (R)}*MP. The estimating closing velocity {circumflex over (V)}c can be found by subtracting the range rate of the missile to platform from the range rate of the target to platform. From this the closing velocity is found. Also in block 1603 the range of the target to missile is divided by the closing velocity to obtain an estimated time-to-go {circumflex over (t)}go. The range vector determined from the radar inputs is given as RBTP wherein E is in the earth frame.
The periodically adaptive target state estimation creates an estimated target to platform range vector {circumflex over (R)}TPE, an estimated target to platform velocity vector {circumflex over (V)}TPE and multiple model target acceleration state vectors ÂTmE and ÂTmE as well as the multiple model probability weighting vectors Wm. In the periodic control box of 1605 the multiple model estimated target acceleration state vectors and the multiple model probability weighing vectors are multiplied and summed over the number of Kalman banks in each respective axis. The result is a zero effort miss vector in the earth frame. The output is a predictive intercept position (PIP) formed in block 1606. The PIP is simply the range {circumflex over (R)}TPE plus the velocity {circumflex over (V)}TPE multiplied by the time-to-go {circumflex over (t)}go plus the zero effort miss vector ZÊMTME along with the estimated time-to-go. The PIP is an prediction of the future position of the object at (T+{circumflex over (t)}go), where T is real time.
This information is transmitted from the missile fire control transmitter 1607. The method of transmission to the missile interceptor 1610 can include RF, wireless or wired means. The uplink is received in receiver 1611 which is fed into the midcourse guidance system 1612 which uses the uplink signal and information form an inertial navigation system 1613 to generate a solution and a missile guidance command enabling the missile to intercept the target. The missile guidance command is relayed to the autopilot 1614 and ultimately to the thruster or other control apparatus.
Because of the relatively non-dynamic relationship between the missile fire control platform and the target small angle approximations can suffice in creating the PIP and reducing the necessity to create a reconstructed vectored LOS.
Although the embodiments are directed to an air-to-air missiles, the application of the claimed subject matter to air-to-surface, surface-to-surface, and surface-to-air missiles, torpedoes or other types of interceptors is equally envisioned.
It is understood that the above described embodiments are merely illustrative of the possible specific embodiments which may represent application of principles of the present invention. Other arrangements may readily be devised in accordance with these principles by those skilled in the art without departing from the scope and spirit of the invention.

## Claims

1. A system for guiding a device toward an object comprising:
means for generating a guidance command signal from: a vectored line-of-sight (LOS) between a device and an object using a position parameter of the object relative to a guidance frame, and an estimated object state produced in the guidance frame using the vectored line-of-sight, wherein the means for generating adapts the guidance command signal based on an estimate of target maneuver frequency; and 
means for transmitting the guidance command signal to an on-board guidance control of the device.

2. A system for guiding a device toward an object in accordance with claim 1, wherein the means for generating a guidance command signal creates an estimated object to device range vector, an estimated object to device velocity vector and an estimated object acceleration vector.

3. A system for guiding a device toward an object in accordance with claim 2, wherein the means for generating a guidance command signal creates an estimated object acceleration rate vector.

4. A system for guiding a device toward an object in accordance with claim 1, wherein the means for generating a guidance command signal is periodically adaptive.

5. A system for guiding a device toward an object in accordance with claim 1, wherein the means for generating a guidance command signal comprises:
means for generating a set of probability weights.

6. A system for guiding a device toward an object in accordance with claim 5, wherein the sum of the probability weights for any axis of the guidance frame is unity.

7. A system for guiding a device toward an object in accordance with claim 1, wherein the means for generating a guidance command signal uses sequential line-of-sight (LOS) vectors in the guidance frame.

8. A system for guiding a device toward an object in accordance with claim 1, wherein the means for generating a guidance command signal comprises:
at least one Kalman filter bank.

9. A system for guiding a device toward an object in accordance with claim 8, wherein the at least one Kalman filter bank is harmonically balanced.

10. A system for guiding a device toward an object in accordance with claim 9, wherein each of the at least one Kalman filter bank is associated with a respective axis in the guidance frame.

11. A system for guiding a device toward an object in accordance with claim 1, wherein the means for generating a guidance command signal comprises:
a proportional navigation controller.

12. A system for guiding a device toward an object in accordance with claim 1, wherein the means for generating a guidance command signal comprises:
an augmented proportional navigational controller.

13. A system for guiding a device toward an object in accordance with claim 1, wherein the means for generating a guidance command signal comprises:
a classical optimal controller.

14. A system for guiding a device toward an object in accordance with claim 1, wherein the means for generating a guidance command signal is recursively adaptive.

15. A method for guiding a device toward an object comprising the steps of:
creating a vectored object line-of-sight (LOS)in a guidance frame; 
producing an estimated object state, using sequential object LOS; 
using proportional navigation control to create a device guidance command as a function of an estimated range vector and an estimated velocity vector obtained using the estimated object state, wherein the device guidance command is adapted based on an estimate of target maneuver frequency.

16. A method for guiding a device toward an object in accordance with claim 15, wherein the estimated object state is adaptively produced.

17. A method for guiding a device toward an object in accordance with claim 16, comprising the steps of:
creating a periodically adaptive guidance command using estimated object state; and, 
adding the periodically adaptive guidance command to the device guidance command.

18. A method for guiding a device toward an object according to claim 17, wherein the step of creating an periodically adaptive guidance command comprises the step of:
using a function of object maneuver frequencies, time-to-go before intercept, maneuver frequency correlation time constants, estimated target accelerations and estimated object acceleration rates.

19. A method for guiding a device toward an object according to claim 16, wherein the step of creating a device guidance command comprises the step of:
creating a guidance command operating on device acceleration to compensate for autopilot lag.

20. A method for guiding a device toward an object in accordance with claim 15, wherein the step of creating a vectored object line-of-sight comprises the steps of:
a) obtaining azimuth, elevation and range information of an object; 
b) using the azimuth, elevation and range information for vectored LOS reconstruction to create a unit vector representative of the object's orientation in a guidance frame of the device; and, 
c) applying the range information to the output of the vectored LOS reconstruction to create the estimated range.

21. A method for guiding a device toward an object in accordance with claim 20, wherein the step of producing an estimated object state comprises the step of:
processing plural sequential estimated range vectors into an object state estimator in an inertial guidance frame estimated object state, wherein the estimated object state includes range, velocity, object acceleration and object acceleration rate.

22. A guidance system for guiding a device toward an object comprising:
means for generating a signal representing a predicted position of the object from: object position parameters relative to a guidance frame and a periodically adaptive estimated object state produced in the guidance frame using the object position parameters, wherein the means for generating adapts the signal based on an estimate of target maneuver frequency; and, 
means for transmitting the signal to an on-board guidance control of the device.

23. A guidance system for guiding a device toward an object according to claim 22, comprising:
a fire control platform 
wherein the means for generating a signal representing the predicted position of the object is located on the fire control platform, and the fire control platform is remote from the device.

24. A method for guiding a device toward an object comprising the steps of:
obtaining object position parameters; 
periodically adaptively producing an estimated object state; 
creating a predicted position from the estimated object state; and, 
determining a guidance command from the predicted position of the object, 

wherein the guidance command is adapted based on an estimate of target maneuver frequency.

25. A method for guiding a device toward an object according to claim 24, comprising the steps of:
transmitting the predicted position of the object from a remote location to the device; 
wherein the step of determining a guidance command is performed on the device.

26. A method for guiding a device toward an object according to claim 24, comprising the steps of:
obtaining device position parameters; 
determining at a remote location a time-to-intercept; and, 
transmitting the time-to-intercept from the remote location to the device.