|
Algorithm 1: The adaptive Unscented Kalman filter (AUKF) algorithm. |
| Input:
. |
| 1: Initialization: |
| 2: ; . |
| 3: for
do
|
| 4: Implement the standard UKF to obtain , , , . |
| 5: Update the : |
| 6:
|
| 7: ; |
| 8: Correct state estimations: |
| 9: ; |
| 10: ; |
| 11: ; |
| 12: , . |
| 13: Save the and . |
| 14: end for
|