FX:
--------------------------------------------------------------------------
Finds the vectors
rho = z - h
dh/dx = H
--------------------------------------------------------------------------
Form:
[rho, H, W, JL] = FX( x )
--------------------------------------------------------------------------
------
Inputs
------
x State vector
-------
Outputs
-------
rho Residual vector z - h
H dh/dx
W The measurement weighting vector
JL Cost eliminated by eliminating measurements
--------------------------------------------------------------------------