Accurately characterizing the composition and dynamic evolution of the system state is a crucial prerequisite for the Kalman filter to achieve reliable and consistent estimation. To this end, this section expands beyond the conventional formulation of purely navigational states and designs an augmented system model that incorporates physical errors from the external measurement domain.
2.1.1. Definition of the Augmented State Vector
The full error-state vector of the filter consists of two parts: the basic navigation states and the physically augmented states:
where
is the base navigation and clock error state, consisting of the 15-dimensional INS error state
and the 2-dimensional receiver clock error state
. The INS error state
adopts the classical 15-dimensional error state model to describe the error propagation of inertial sensors and mechanization, including attitude error
, velocity error
, position error
, as well as accelerometer and gyroscope biases
and
. The receiver clock error state
includes the receiver equivalent clock bias
and clock drift
, which are used to compensate for the instability of the receiver crystal oscillator:
denotes the physically augmented states in the external measurement domain. To absorb colored noise, this study augments the states associated with three major physical error sources in complex urban dynamic environments. For the currently visible
N satellites, the GNSS augmented error-state vector is constructed as:
Residual tropospheric zenith delay error : After applying a conventional tropospheric model correction, part of the atmosphere-related error usually still remains in the observations. To distinguish the variation of the atmosphere itself from the effect caused by satellite geometry, the residual delay in the zenith direction is modeled as a common single augmented state.
Residual ephemeris and satellite clock errors : These errors mainly arise from systematic residuals in satellite orbit prediction and clock maintenance. Their physical evolution is extremely slow and is manifested as a long-correlation state with strong temporal correlation.
Code multipath error : In urban environments, the multipath effect caused by signal reflections is a major factor affecting positioning integrity. Unlike the previous two slowly varying errors, the variation frequency of multipath error is closely related to vehicle speed and the spatial distribution of surrounding buildings.
When constructing the physical augmented states, an N-dimensional state space is allocated for independent tracking of errors with strong spatial decorrelation, such as ephemeris and multipath errors, where N is the number of visible satellites. For residual tropospheric delay, considering the spatial consistency of local atmospheric conditions, a one-dimensional state variable is adopted, which is mapped to each observation channel through an elevation-angle projection function during the measurement update phase. Through this augmentation design, the filter is able to estimate and separate these colored noises, thereby preventing their impact on the navigation solution. It should be noted that the ionospheric delay is not modeled as an independent augmented state. The pseudorange observations used in this paper have already undergone ionospheric corrections during the standard GNSS preprocessing stage. Since the residual ionospheric error varies relatively slowly during the short-term vehicular experiments and is not a primary scenario-dependent error source in obstructed degraded environments, it is incorporated into the unmodeled observation error term for unified processing. Consequently, this paper focuses on explicitly modeling time-correlated errors such as residual ephemeris and clock errors, tropospheric delay, and code multipath.
2.1.2. First-Order Gauss-Markov Process and Parameter Tuning
A core premise of the standard Kalman filter is the assumption that the measurement noise is white noise; that is, the error at the current epoch is completely independent of the error at the next epoch. This holds true under ideal conditions, but in the actual complex environments of urban driving, physical errors such as multipath effects and atmospheric delays often exhibit persistence. If the filter ignores this temporal correlation and continues to treat them as white noise, it will misinterpret the persistent errors as valid observation information. This leads the filter to be overly optimistic about the accuracy of the state estimation, causing the computed posterior covariance matrix P to be smaller than the true error distribution. Consequently, the computed protection level shrinks significantly, ultimately posing a severe risk of missed alarms in complex environments.
To accurately describe the dynamic evolution process of the augmented states and resolve the measurement mismatch problem, considering that multipath and atmospheric residuals in urban environments exhibit continuity—manifesting as smooth attenuation or slow drift in the time series—this paper adopts a first-order Gauss-Markov process (GMP) to model the GNSS observation errors. The mathematical mechanism of this model aligns with the aforementioned time-varying patterns, enabling the transformation of external measurement noise into the evolution of internal system states within the filter. The discretized GMP state equation and the driving white noise variance are:
where
is the system sampling interval;
is the correlation time constant,
is the steady-state variance, and
is the driving white noise.
During the time-update stage of the error-state Kalman filter (ESKF), the error evolution is driven by the state transition matrix
and the discrete process-noise covariance matrix
. Since the INS errors, clock states, and GNSS augmented error states are mutually decoupled during prediction,
takes a block-diagonal form:
In the above equation,
. Here,
is the 15-dimensional inertial navigation error transition matrix, which describes the propagation of position, velocity, and attitude errors over time, as well as the effects of inertial sensor biases. To ensure the completeness of the system error estimation, its corresponding continuous-time system dynamic matrix
in the ECEF frame is constructed based on the classical INS mechanization error equations. Its matrix form is as follows:
where
is the skew-symmetric matrix of the Earth’s rotation rate in the ECEF frame;
is the direction cosine matrix from the body frame to the ECEF frame; and
and
are the state coupling terms induced by the specific force and the gravity field, respectively. Detailed derivations and expanded forms of the aforementioned basic INS error sub-matrices can be found in reference [
24]. Considering the discrete-time implementation, the base state transition matrix can be obtained via a first-order approximation
.
is the clock-state transition matrix, given by:
is the transition matrix of the physically augmented error states and includes the GNSS error-model terms for all augmented states, including ephemeris/satellite clock errors, multipath, and tropospheric delay. Unlike the conventional framework, in order to properly mitigate the influence of colored noise during time update, each class of augmented error is modeled as a discrete first-order GMP, so that its state transition is represented by an exponential decay factor. The augmented-state transition matrix is constructed as:
where
is the system sampling interval,
is the
N-dimensional identity matrix; and
,
,
denote the correlation time constants of the first-order GMP models corresponding to the three physical error sources.
The process-noise covariance matrix
also has a block-diagonal form:
where
denotes the process noise of the basic navigation system and is projected into the basic state space through the noise-mapping matrix. The augmented part
is based on direct physical modeling, and its corresponding noise-mapping matrix is the identity matrix
I. The elements of
are determined by the GMP steady-state variances, so as to ensure that the predicted covariance of the filter always overbounds the energy of the true physical errors:
To ensure the rigor of integrity monitoring, the selection of the aforementioned GMP parameters
cannot rely on simple empirical fitting, but must adhere to the power spectral density (PSD) overbounding criterion. This criterion requires that the error model used for filter design must cover the energy distribution of the true error process in the frequency domain; that is, the PSD of the designed model must be no less than the PSD of the true error:
For a discrete first-order GMP, its state transition coefficient can be expressed as:
The corresponding theoretical PSD of this first-order GMP at frequency
f can be written as:
where
is the sampling interval,
is the correlation time constant, and
is the steady-state variance. Equation (
14) clearly reveals the impact of GMP parameters on the frequency-domain energy distribution: the correlation time
primarily determines the concentration of error energy in the low-frequency region. A larger
indicates a longer error duration and more pronounced low-frequency energy; meanwhile, the steady-state variance
determines the overall energy level of the error process. Under the condition of
, the spectral intensity in the low-frequency band is approximately positively correlated with
, whereas the spectral intensity at the high-frequency end is mainly influenced by
. Therefore, for time-correlated errors, conservative modeling is not equivalent to simply increasing all parameters simultaneously. Blindly inflating
and
may yield a larger covariance bound, but it will also lead to a decrease in system availability.
From the perspective of integrity monitoring, the most dangerous errors in urban environments are not completely random high-frequency white noise, but rather the low-frequency persistent biases caused by multipath, NLOS propagation, and local blockages. According to the frequency-domain overbounding theory, if the augmented error model satisfies the PSD overbounding relationship in Equation (
12), its corresponding autocovariance sequence can statistically cover the true error process, thereby providing a conservative input for the covariance propagation of the Kalman filter.
Based on the above analysis, rather than adopting a global parameter inflation approach, this paper employs a differentiated conservative parameter tuning strategy. For residual ephemeris and satellite clock errors, since satellite orbit and clock frequency errors are system-level slowly varying errors, their random variations typically only manifest over long time scales. Therefore, this paper models them as a long-correlation GMP, with the correlation time
set to the order of several hours to match their physical characteristics of slow evolution. The steady-state variance
is conservatively set based on the statistical upper bound of the Signal-in-Space User Range Error (SIS-URE) defined in the GPS Standard Positioning Service (SPS) [
25]. As for the residual tropospheric delay, because the local atmospheric state varies relatively slowly during short-term vehicular experiments, it is similarly modeled as a slowly varying common state in the zenith direction. A correlation time
on the order of tens of minutes and a correspondingly conservative steady-state variance
are selected to cover the residual atmospheric uncertainty after model corrections.
Unlike the two types of slowly varying errors mentioned above, code multipath error is closely related to vehicle speed, building reflections, and satellite elevation angles, making it the most scenario-dependent time-correlated error source in urban environments. Regarding the correlation time
, considering that vehicles may experience low-speed driving or brief stops in obstructed degraded segments, the multipath error often manifests as a quasi-static bias with a long duration. After selecting a correlation time
oriented toward the most severe persistent conditions, the multipath steady-state variance
is further determined based on the PSD overbounding criterion. Specifically, the variance is selected such that the theoretical PSD of the first-order GMP covers the empirical PSD of the multipath-dominated pseudorange residuals in the urban degraded segment:
where
is the empirical PSD estimated from the pseudorange residuals in the urban degraded segment, and
represents the main low-frequency range dominated by colored errors. In this way, the conservative model primarily enhances the overbounding capability against low-frequency persistent errors, rather than indiscriminately inflating the measurement noise across the entire frequency band. Therefore, the parameter tuning method adopted in this paper can guarantee the integrity safety bound while avoiding the unnecessary enlargement of the protection level caused by over-conservatism, thus achieving a reasonable trade-off between safety and availability. The specific empirical PSD estimation process for multipath and the selection results of the conservative variance will be further detailed in
Section 3.2.