AzElRangeRangeDotToRV:

Path: AerospaceUtils/Coord

% Compute r, v from range, range rate, az and el.

 The algorithm is

 r = [cos(az)*cos(el);sin(az)*cos(el);sin(el)];
 v = pinv(r)'*range*rangeRate;

 This is a fit to velocity. With 4 measurements v cannot be known
 exactly. If one component is zero then the result will be exact.

 Type AzElRangeRangDotToRV for a demo.

--------------------------------------------------------------------------
   Form:
    [r, v] = AzElRangeRangeDotToRV( az, el, range, rangeDot )
--------------------------------------------------------------------------

   ------
   Inputs
   ------
   az              (1,1)  Azimuth (rad)
   el              (1,1)  Elevation (rad)
   range           (1,1)  Range
   rangeRate       (1,1)  Range rate

   -------
   Outputs
   -------
   r              (3,1)  Position
   v              (3,1)  Velocity

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

Children:

Math: Linear/Mag

Back to the AerospaceUtils Module page