Skip to main content
letter
. 2020 Nov 18;20(22):6582. doi: 10.3390/s20226582
Algorithm 1 Proposed hybrid target localization algorithm under unknown TP and PLE.
1. Estimate the target position from AOA measurements.
Solve x^AOA=(BTCA−1B)−1BTCA−1c (24)
2. Estimate the TP and PLE using the KF.
i. Initialize z0=zLS and Q0=I2.
ii. Predict and update zk, Kk and Qk. (30)
for k=1,⋯,K
Predict:
zk∣k−1=zk−1
Qk∣k−1=Qk−1
Update:
zk=zk∣k−1+Kk(pk−Hzk∣k−1)
Kk=Qk∣k−1HT(HQk∣k−1HT+R)−1
Qk=(I−KkH)Qk∣k−1
end
3. Estimate the target position using EC-WLS with the estimated parameters zK (TP and PLE).
Solve x^ECWLS=(ATC¯−1A)−1ATC¯−1b (35)