| Algorithm 1. Computational workflow of the proposed ARTSS |
| Input: Forward ESKF parameters: , , , , , , and raw measurement Output: Smoothed states 1: For down to do 2: Compute standard innovation and its covariance using Equations (17) and (18) 3: Calculate element-wise standardized innovation using Equation (19) 4: Construct diagonal equivalent weight matrix using Equation (20) with 5: Reconstruct robust forward gain , state , and covariance via Equations (21)–(23) 6: Modulate smoothing gain via Equation (24) 7: Update smoothed state via Equation (25) 8: Apply 360-degree cross-period correction specifically to the heading angle error component () within the state vector to prevent angle wrap-around divergence: If , then If , then 9: Update smoothed error covariance via Equation (26) 10: End For |