---
title: Proprioceptive Scenario Gating for Legged Robots
url: https://www.emergentmind.com/topics/proprioceptive-scenario-gating
type: topic
---

# Proprioceptive Scenario Gating for Legged Robots

Searching arXiv for the specified paper and closely related context papers.
arxiv_search(query="2603.29383 Interacting Multiple Model Proprioceptive Odometry for Legged Robots", max_results=5, sort_by="submittedDate")
Proprioceptive scenario gating, in the form presented for legged-robot odometry, is an interacting multiple model (IMM)-based estimation strategy that represents contact uncertainty through multiple proprioceptive contact hypotheses and fuses them online within a unified probabilistic framework. In "Interacting Multiple Model Proprioceptive Odometry for Legged Robots" [2603.29383], the framework is designed for conditions in which exteroceptive sensors are unreliable or degraded and state estimation must rely primarily on IMU, joint-encoder, and contact-related leg-kinematics information. The central premise is that most proprioceptive odometry methods assume idealized point contact, whereas real locomotion frequently violates that assumption; the proposed estimator therefore gates between rolling-contact and slip hypotheses rather than committing to a single contact model.

## 1. Problem setting and conceptual basis

State estimation for legged robots is described as challenging because legged odometry generally suffers from limited observability and depends critically on measurement constraints to suppress drift. When exteroceptive sensing is unavailable or degraded, these constraints are derived mainly from proprioceptive measurements, particularly contact-related leg kinematics information. The specific difficulty addressed is that existing proprioceptive odometry methods often rely on an idealized point-contact assumption, which may be violated during locomotion; when that occurs, the effectiveness of proprioceptive constraints can be significantly reduced, degrading estimation accuracy [2603.29383].

Within this formulation, proprioceptive scenario gating is realized by maintaining multiple contact-mode hypotheses for each stance foot and assigning them time-varying probabilities. The method does not replace proprioceptive odometry with exteroceptive correction; instead, it adapts the internal trust placed in proprioceptive constraints under different contact conditions. A plausible implication is that "scenario gating" here is best understood as mode-conditioned probabilistic filtering over contact regimes rather than discrete logic-based mode switching.

## 2. Contact hypotheses and mode-dependent uncertainty

The framework considers two contact-mode hypotheses for each stance foot:

- **Rolling-Contact Mode $(i = 1)$**: the foot rolls on the ground without significant slip.
- **Slip Mode $(i = 2)$**: foot-ground contact is unstructured and partially slipping.

Under both modes, the nominal continuous-time dynamics are the same: an IMU-driven body with foot-velocity augmentation. The difference between modes appears only in the process noise associated with the foot-velocity states. Specifically,
$$
Q_{v_f}^{(1)} = Q_{v_f}
$$
for the rolling-contact mode, corresponding to nominal, tight foot-velocity confidence, whereas
$$
Q_{v_f}^{(2)} = \alpha \cdot Q_{v_f}, \quad \alpha > 1
$$
for the slip mode, corresponding to inflated covariance that represents slip-induced uncertainty [2603.29383].

This construction is technically significant because the framework does not define separate nominal rigid-body dynamics for rolling and slipping. Instead, it retains a common dynamical model and expresses contact uncertainty through mode-dependent stochasticity in the foot-velocity block. This suggests that the method treats slippage primarily as uncertainty inflation in contact-consistent foot motion, rather than as a fully distinct kinematic regime with a separate deterministic evolution law.

## 3. State-space formulation and rolling-aware proprioceptive constraints

The full error-state Kalman filter (ESKF) state is defined as
$$
x = [p, v, G, f_1,\ldots,f_4, v_{f1},\ldots,v_{f4}, b_a, b_\omega]^T,
$$
where $p \in \mathbb{R}^3$ and $v \in \mathbb{R}^3$ are body position and velocity, $G \in SO(3)$ is body orientation, $f_l \in \mathbb{R}^3$ and $v_{f,l} \in \mathbb{R}^3$ are contact-foot position and velocity for leg $l = 1\ldots4$, and $b_a, b_\omega \in \mathbb{R}^3$ are accelerometer and gyroscope biases.

For each mode $i \in \{1,2\}$, the discrete-time state-transition model is
$$
x_k^{(i)} = f(x_{k-1}^{(i)}, u_{k-1}) + w_{k-1}^{(i)}, \qquad
w_{k-1}^{(i)} \sim \mathcal{N}(0, Q^{(i)}),
$$
with IMU input
$$
u_{k-1} = \{\tilde\omega_{\text{imu}}, \tilde a_{\text{imu}}\}.
$$
Using fourth-order Runge-Kutta on the continuous dynamics, the linearized ESKF form is
$$
\delta \dot x = A \delta x + B_w w^{(i)},
$$
with
$$
Q^{(i)} = E[w^{(i)} w^{(i)T}] = \operatorname{diag}(Q_a, Q_\omega, \alpha_i \cdot Q_{v_f}, Q_{b_a}, Q_{b_\omega}),
$$
where $\alpha_1 = 1$ and $\alpha_2 > 1$.

The measurement model is explicitly described as a rolling-aware kinematic update:
$$
z_k = h^{(i)}(x_k^{(i)}) + v_k, \qquad v_k \sim \mathcal{N}(0,R).
$$
Crucially, both modes use the same rolling-aware measurement function; there is no separate slip measurement map. For each stance foot $l$,
$$
h(x)= \begin{bmatrix}
G^T\bigl(f_l - p\bigr)\\[4pt]
G^T\bigl(v - v_{f,l}\bigr)\\[4pt]
v_{f,l} - \bigl(\omega_{f,l}\times r\bigr)
\end{bmatrix},
$$
where $\omega_{f,l}$ is computed from the leg-kinematic Jacobian and $r$ is the known foot radius vector. The residuals enforce body-foot relative pose consistency, body velocity relative to foot velocity, and foot-end velocity consistency with pure rolling [2603.29383].

A common misunderstanding would be to interpret the slip mode as requiring a different observation function. The formulation explicitly states the opposite: the two modes share the same rolling-aware measurement function, and the distinction lies in the process noise assigned to foot-velocity states. This design couples contact-awareness to estimator confidence rather than to a mode-specific sensor model.

## 4. IMM machinery and probabilistic scenario gating

The gating mechanism is implemented through a two-mode Markov chain with transition matrix
$$
\Pi =
\begin{bmatrix}
\pi_{11} & \pi_{12}\\
\pi_{21} & \pi_{22}
\end{bmatrix},
\qquad
\pi_{ii} \approx 0.95,\;
\pi_{ij} = 1-\pi_{ii}\;(i \ne j).
$$
These values can be hand-tuned to reflect expected average slip duration or learned offline by counting mode-switch statistics in representative data.

Given mode posteriors $\{\mu_{k-1}^{(j)}, \hat x_{k-1|k-1}^{(j)}, P_{k-1|k-1}^{(j)}\}$ at time $k-1$, the IMM recursion proceeds in five stages.

First, the filter mixes priors. The predicted mode weights are
$$
\bar \mu_{k-1}^{(i)} = \sum_j \pi_{ji}\mu_{k-1}^{(j)},
$$
and the mixing probabilities are
$$
\mu_{k-1}^{j|i} = \frac{\pi_{ji}\mu_{k-1}^{(j)}}{\bar \mu_{k-1}^{(i)}}.
$$
The mixed initial state for mode $i$ is
$$
\hat x_{k-1|k-1}^{0,(i)} = \sum_j \mu_{k-1}^{j|i} \hat x_{k-1|k-1}^{(j)},
$$
with mixed covariance
$$
P_{k-1|k-1}^{0,(i)} =
\sum_j \mu_{k-1}^{j|i}
\Bigl(
P_{k-1|k-1}^{(j)}
+
(\hat x_{k-1|k-1}^{(j)}-\hat x_{k-1|k-1}^{0,(i)})(\dots)^T
\Bigr).
$$

Second, each mode performs a mode-conditioned prediction:
$$
\hat x_{k|k-1}^{(i)} = f\bigl(\hat x_{k-1|k-1}^{0,(i)},u_{k-1}\bigr),\qquad
P_{k|k-1}^{(i)} = \Phi P_{k-1|k-1}^{0,(i)}\Phi^T + Q^{(i)}.
$$

Third, each mode applies a mode-conditioned update using
$$
r_k^{(i)} = z_k - h\bigl(\hat x_{k|k-1}^{(i)}\bigr),\qquad
S_k^{(i)} = H_k^{(i)} P_{k|k-1}^{(i)} H_k^{(i)T} + R,
$$
followed by
$$
K_k^{(i)} = P_{k|k-1}^{(i)}H_k^{(i)T}S_k^{(i)-1},
$$
$$
\hat x_{k|k}^{(i)} = \hat x_{k|k-1}^{(i)} + K_k^{(i)}r_k^{(i)},
\qquad
P_{k|k}^{(i)} = (I-K_k^{(i)}H_k^{(i)})P_{k|k-1}^{(i)}.
$$

Fourth, the mode likelihood is computed as
$$
\Lambda_k^{(i)} =
\frac{1}{\sqrt{(2\pi)^n |S_k^{(i)}|}}
\exp\Bigl(-\tfrac12 r_k^{(i)T}S_k^{(i)-1}r_k^{(i)}\Bigr),
$$
where $n$ is the dimension of $z_k$.

Fifth, the mode posterior is updated:
$$
\mu_k^{(i)} =
\frac{\Lambda_k^{(i)}\bar\mu_{k-1}^{(i)}}
{\sum_m \Lambda_k^{(m)}\bar\mu_{k-1}^{(m)}}.
$$

The final estimate is then fused across modes:
$$
\hat x_{k|k} = \sum_i \mu_k^{(i)} \hat x_{k|k}^{(i)},
$$
$$
P_{k|k} = \sum_i \mu_k^{(i)}
\Bigl(
P_{k|k}^{(i)}
+
(\hat x_{k|k}^{(i)}-\hat x_{k|k})(\dots)^T
\Bigr).
$$

This recursion is the operational core of scenario gating. It performs neither hard contact labeling nor post hoc trajectory selection; instead, it executes online probabilistic fusion whose weights are driven by residual consistency under each contact hypothesis.

## 5. Empirical performance and robustness characteristics

The reported simulations and real-world experiments indicate that explicitly modeling both rolling and slip improves pose estimation accuracy over single-model filters while maintaining comparable computational efficiency [2603.29383]. The numerical results are organized below.

| Setting | Reported result |
|---|---|
| Simulation, straight-line, $9\,\text{m}$ | IEKF ATE\_pos $=0.433\,\text{m}$; ESKF-R $=0.247\,\text{m}$; IMM-PO $=0.204\,\text{m}$ |
| Slippery patch, $5\,\text{m}$ | IEKF ATE\_pos $=0.203\,\text{m}$; IMM-PO $=0.061\,\text{m}$ |
| Real complex terrain, $4.5\,\text{m}$ | IEKF ATE\_pos $=0.227\,\text{m}$; IMM-PO $=0.102\,\text{m}$ |

The straight-line simulation is summarized as IEKF ATE\_pos $=0.433\,\text{m} \rightarrow$ ESKF-R $0.247\,\text{m} \rightarrow$ IMM-PO $0.204\,\text{m}$, which is described as an approximately $17\%$ further reduction beyond the rolling-aware baseline. In the slippery-patch experiment, IEKF ATE\_pos $=0.203\,\text{m} \rightarrow$ IMM-PO $0.061\,\text{m}$, corresponding to a $70\%$ reduction. In real complex terrain over $4.5\,\text{m}$, IEKF ATE\_pos $=0.227\,\text{m} \rightarrow$ IMM-PO $0.102\,\text{m}$, corresponding to a $55\%$ reduction.

The reported mode behavior is that mode probabilities correctly latch onto slip when foot residuals grow and revert to rolling otherwise, yielding both bias reduction through the rolling model and drift suppression through the slip model. This suggests that the estimator’s benefit is not only numerical averaging across models, but also targeted relaxation of overly strict proprioceptive constraints when residual structure becomes inconsistent with pure rolling.

## 6. Computational profile, tuning, and limitations

The implementation notes report runtime per step of approximately $M \times (\text{ESKF cost}) + \text{mixing}$; for $M=2$, the runtime is approximately $1\,\text{ms}$ on a $2.5\,\text{GHz}$ CPU, and the system remains real-time [2603.29383]. This computational profile is consistent with the choice to use only two hypotheses and to keep their nominal dynamics and observation structure shared.

Three tuning parameters are highlighted. First, $\alpha$, the foot-velocity noise scale in slip mode, trades between over-confidence and under-confidence. Second, $\pi_{ij}$ should be set with high self-transition, for example $0.95$-$0.99$, to avoid jitter. Third, IMU, encoder, and foot-kinematics noise covariances are calibrated offline.

The limitations are stated explicitly. The method uses only two modes and therefore cannot model intermediate slip or foot deformation without adding more hypotheses, introducing a cost-versus-distinguishability trade-off. It relies purely on proprioception, so large terrain geometries are not directly sensed. It also assumes that the rolling model is valid on most flat or uneven terrain; large local foot compliance may violate this assumption.

These constraints delimit the scope of proprioceptive scenario gating. The framework is not a general substitute for terrain perception, nor does it claim to identify all contact phenomena. Rather, it adapts online to slippage purely from IMU and joint-encoder data by combining rolling-aware ESKF models under multiple contact-mode noise assumptions. Within that scope, it is presented as a method for significantly improving legged-robot odometry in both simulation and real experiments.

Source: https://www.emergentmind.com/topics/proprioceptive-scenario-gating