Skip to main content
. 2021 Aug 5;21(16):5288. doi: 10.3390/s21165288
Algorithm 6: Wu and Shi [4]

Initial Estimate

Step 1: Calculate Yk, k=1,2,,K from (55) and form the matrix Y=Y1TY2TYKTT.

Step 2: Find the eigenvector of YTY corresponding to its minimum (or zero) eigenvalue and denote it as ze=vec(Ae)TbeTceT.

Step 3: Calculate z=aze where α=4/beTAe1be4ce.

Step 4: Extract vec(A), b and c from z.

Step 5: Calculate an initial estimate of the unknowns using (57).

  Gauss–Newton Method

Step 6: Use the initial estimates to initialize the vector x of (53)

Step 7: Update x using (54).

Step 8: Evaluate the cost J(x) of (52).

Step 9: Repeat steps 7-8 until J(x) becomes sufficiently small.