------------------------------------------------------------------------------- Finds the alpha that minimizes the quadratic cost functional J where x = x0 + alpha*d; J = (1/2) (rho'*W*rho + 0.5*(x-xA)'*S0*(x-xA)) dJ/dalpha = d'*(S0*(x-xA) - H'*W*rho); rho = z - h h/x = H Calls a function fx defined by [rho,H,W,JL] = fx(x); rho = y - h H = h/x W = Residual weighting vector JL = is a cost adjustment scalar ------------------------------------------------------------------------------- Form: [J, dJ] = QuadCost( fx, x0, xA, d, S0, amin, amax ) ------------------------------------------------------------------------------- ------ Inputs ------ fx The name of the function x0 Current value of x xA Reference value of x (for S0) d Alpha*d is the next increment to x S0 A priori state covariance matrix xA A priori state amin Minimum alpha amax Maximum alpha ------- Outputs ------- J Cost dJ Derivative of the cost -------------------------------------------------------------------------------