If it flies, it dies™.

Report article RSS Feed Mid-course guidance for ABM in WiC

Posted by blahdy on Jul 26th, 2012

Testing a simple alpha-beta filter concept for estimating target positional changes during mid-course guidance phase of an interceptor missile.

python code:

def FLINT_Kalman__ab_filter( self, aPos, aVelocity, dTime ):
  """
    FLINT_Kalman__ab_filter( aPos, aVelocity, dTime )
   
    A test case for using simple alpha-beta filter to generate
    estimated target positional updates during mid-course guidance.
   
    Usage:
   
    aPos = target position vector
    aVelocity = target velocity vector
    dTime = time constant for testing (TGO?)
   
  """

 
  xk_1 = math.Vector3( aPos )
  vk_1 = math.Vector3( aVelocity ).NormalizeSafe()
  dt = float(dTime)
  a = 0.85
  b = 0.005
 
  # signal input - x_measured
  xm = math.Vector3( aPos )
 
  # predicted position
  xk = xk_1 + ( vk_1 * dt )
 
  # angular position estimation
  rk = xm - xk
  xk += rk * a
 
  # velocity estimation
  #vk = vk_1
  #vk += ( rk * b ) * (1 / dt)
 
  return xk
 
Post a Comment
click to sign in

You are not logged in, your comment will be anonymous unless you join the community today (totally free - or sign in with your social account on the right) which we encourage all contributors to do.

2000 characters limit; HTML formatting and smileys are not supported - text only

Level
84%
AddonDB
20
Avatar
Avatar
Offline Since
May 17, 2013
Country
United States United States
Gender
Male
Age
28
Member Watch
Track this member
Blog
Browse
Blogs
Report Abuse
Report article