HAngleUKF:

Path: Common/DemoFuns

% Angle measurement from a fixed height object.
   For use by UKF.
   This assumes that the target is a fixed height off the ground.
   This is d.h and the target position is d.xTarget. x(1) must
   be the position.
--------------------------------------------------------------------------
   Form:
   d = HAngleUKF;
   theta = HAngleUKF( x, d )
--------------------------------------------------------------------------

   ------
   Inputs
   ------
   x         (:,1)	Input
   d         (.) 	Data structure
                   .h       (1,1) Height of target
                 	.xTarget (1,1) Position of target

   -------
   Outputs
   -------
   theta     (:,1)  Output

--------------------------------------------------------------------------

Back to the Common Module page