AzElRangeRangeDotToRV:
--------------------------------------------------------------------------
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] = AzElRangeRangDotToRV( 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:
Common: Math/Mag