Source-linked AI summary

IMU-Centric Moving Horizon Estimation for Lateral Dynamics Estimation Across Vehicles and Grip Conditions

Seuffo Akouan ha Ngoune, Alessandro Toschi, Paolo Burgio, Marko Bertogna

arXiv:2609.10202v2eess.SYcs.RO

TL;DR

The paper addresses the limited availability of direct lateral-velocity measurements and the sensitivity of model-based estimation to tire and road variability. It develops an IMU-centric constrained MHE with a compact SST tire surrogate and evaluates it across sports cars and an autonomous race car, reporting accurate and robust lateral-state reconstruction.

  • Problem

    Lateral velocity is rarely measured directly because dedicated sensors are costly, while model-based estimators remain sensitive to tire and road variability.

    Source: §I · p. 1
  • Method

    The framework uses constrained IMU-centric MHE with a planar single-track model, compact SST surrogate, and bounded online force-capacity coefficients.

    Source: §I · p. 1, B. Simplified lateral tire-force model · p. 3
  • Results

    Experimental evaluations report accurate lateral-velocity and lateral-acceleration estimates across human-driven sports cars and an autonomous open-wheel race car.

    Source: A. Case 1: Ferrari state estimation · p. 6, §VII · pp. 7–8
  • Takeaways & Limitations

    The approach provides a physics-based lateral-dynamics estimator with limited vehicle-specific tuning and no external odometry updates.

    Source: §VII · pp. 7–8

Abstract

from arXiv · show

Accurate estimation of lateral vehicle dynamics near the adhesion limit is important for stability control and high-performance driving, but lateral velocity is rarely measured directly because sensors such as optical sensors are costly. This paper presents an inertial measurement unit (IMU)-centric Moving Horizon Estimation framework that reconstructs lateral velocity using standard onboard signals, without relying on exteroceptive odometry or detailed tire-parameter tuning. Experimental validation on human-driven sports cars and an autonomous open-wheel race car across tracks, maneuvers, and conditions demonstrates accurate and robust lateral velocity and lateral acceleration estimates. The proposed framework is available at https://github.com/Aseuffo/IMU-Centric-MHE

I. INTRODUCTION

The paper addresses the difficulty of estimating lateral velocity without costly dedicated sensors or external odometry. It proposes an IMU-centric constrained MHE framework designed to accommodate tire and road variability with limited calibration.

  • Lateral velocity is rarely measured directly in production vehicles because dedicated sensors are costly and impractical.Source: §I · p. 1
  • Model-based estimators remain sensitive to tire and road variability and to assumptions embedded in the tire model.Source: §I · p. 1
  • The proposed framework reconstructs lateral velocity and lateral acceleration from inertial measurements and available onboard signals using IMU-centric MHE.Source: §I · p. 1
  • The estimator combines a planar single-track model with a compact SST surrogate and bounded, regularized force-capacity variables.Source: §I · p. 1
  • The framework is evaluated on two human-driven sports cars and an autonomous open-wheel race car across multiple validation settings.Source: §I · p. 1
  • Unlike external-odometry or high-dimensional tire-model pipelines, the approach uses low-dimensional bounded coefficients and does not require prior lateral-velocity measurements for full tire-parameter fitting.Source: §II · p. 2

III. SINE SATURATION TIRE MODEL

The vehicle model uses planar single-track dynamics with lateral acceleration included as an estimator state. Its force-based dynamics are made differentiable so acceleration can be constrained and regularized within the MHE.

A. Planar single-track dynamics

  • The formulation uses a differentiable planar single-track model because MHE repeatedly solves a nonlinear program.Source: §III · p. 2
  • The vehicle is modeled as a rigid body in the horizontal plane with lumped front and rear axles on the centerline.Source: A. Planar single-track dynamics · p. 2
  • The baseline formulation neglects pitch, roll, vertical dynamics, combined slip, camber, and road banking unless additional information is available.Source: A. Planar single-track dynamics · pp. 2–3
  • The state and input variables include longitudinal and lateral center-of-gravity velocities, yaw rate, lateral acceleration, steering angle, and longitudinal acceleration.Source: A. Planar single-track dynamics · p. 2
  • The lateral tire forces enter the equations of motion through the front and rear force model, with mass, yaw inertia, and center-of-gravity axle distances defining the vehicle dynamics.Source: A. Planar single-track dynamics · p. 2
  • Lateral acceleration is included as a state and defined through the lateral force balance so the IMU acceleration measurement can enter the MHE cost directly.Source: A. Planar single-track dynamics · p. 2
  • Under piecewise-constant inputs, the lateral-acceleration dynamics are approximated by the chain rule to remain consistent with the force-based model.Source: A. Planar single-track dynamics · p. 2

B. Simplified lateral tire-force model

The SST tire model is a compact differentiable surrogate that represents lateral-force capacity with fixed curvature and online-estimated bounded amplitude coefficients. This improves conditioning while retaining a smooth bounded force envelope.

B. Simplified lateral tire-force model

IV. OBSERVABILITY CONSIDERATIONS

Observability determines whether the internal state can be uniquely inferred from measured outputs over a finite interval under known inputs. In this framework, MHE performance therefore depends on the information carried by measured trajectories over its estimation window.

IV. OBSERVABILITY CONSIDERATIONS

  • In nonlinear systems, local observability means neighboring initial states produce distinguishable output trajectories for some admissible input.Source: §IV · p. 3
  • Because MHE reconstructs unmeasured components by fitting a dynamic model to measured trajectories over a window, practical estimation depends on local observability.Source: §IV · p. 3

A. Nonlinear local observability and OI rank conditions

The paper assesses local observability and parameter identifiability using Lie-derivative rank conditions applied to an augmented vehicle model. The analysis treats lateral velocity and tire force-capacity coefficients as unknown quantities alongside measured outputs and inputs.

C. Local observability of lateral velocity

Lateral velocity is locally observable when measured lateral acceleration carries information about it through slip-angle-dependent tire forces. Tire-parameter identifiability additionally requires sufficiently distinct front- and rear-axle excitation, while weak excitation creates degenerate regimes.

A. MHE versus Kalman Filtering

MHE and Kalman filtering are equivalent in the linear–Gaussian unconstrained case when the arrival cost is chosen appropriately. The paper motivates MHE for this application because it directly handles physical constraints, nonlinear saturation, and uncertainty in measured inputs.

C. MAP Viewpoint and MHE Cost

The MHE is formulated as a maximum a posteriori estimate over a sliding window, jointly optimizing the state trajectory, input corrections, and constant parameters. Weighted residuals and physical constraints encode model consistency, measurement fit, parameter regularization, and input fidelity.

D. Implementation, Solver, and Warm Start

The implementation validates the MHE across three vehicles and racing scenarios, using warm starts to reduce iterations and support real-time feasibility. Offline experiments show accurate estimation during aggressive cornering and low-excitation conditions.

Solver implementation

  • The nonlinear program is implemented in CasADi and solved with IPOPT using warm-start settings.The implementation uses automatic differentiation and an interior-point optimizer.Source: D. Implementation, Solver, and Warm… · p. 5

Warm start

  • Warm starting shifts the previous state and input trajectories and reuses Lagrange multipliers, reducing iterations during receding-horizon operation.Consecutive MHE problems differ by a one-step window shift.Source: D. Implementation, Solver, and Warm… · p. 5

Experimental validation

  • 3 vehicle platforms and 2 racing tracks are used to validate stability across modeling assumptions and operating conditions.The results include the Ferrari 250 LM, Corvette Grand Sport, and autonomous Super Formula EAV-25.Source: §VI · pp. 5–6

Runtime

  • 3.9 ms average solve time at N = 10 and 6.3 ms at N = 30 leave margin within the 0.01 s sampling period.These runtimes were measured offline on an Intel Core i9-14900HX; the authors describe real-time feasibility as suggested by the measurements.Source: §VI · p. 5

Case 1 results

  • The MHE matches post-processed lateral-velocity ground truth during aggressive cornering and remains stable when |ay| < 1 m/s2.Estimated lateral acceleration and yaw rate follow measured signals while filtering IMU noise.Source: A. Case 1: Ferrari state estimation · p. 6

B. Case 2: Corvette Tire Analysis

The Corvette analysis tests whether MHE-derived states preserve nonlinear tire behavior, while the Super Formula case examines adaptation under incorrect tire parameters and reduced grip. Results show accurate force reconstruction, rapid convergence, and sensitivity to horizon and curvature tuning.

Corvette tire analysis

  • MHE-based tire-force reconstruction captures both linear and saturation regimes despite the simplified vehicle model.Independent Pacejka fits to ground-truth-based and MHE-based scatters show strong overlap.Source: B. Case 2: Corvette Tire Analysis · p. 6

Parameter adaptation

  • The effective force-capacity coefficient ηy,i adapts online from an incorrect initialization to match the measured vehicle response.The coefficient represents available lateral force capacity under current operating conditions and is bounded and regularized.Source: C. Case 3: Autonomous Super Formula… · p. 6

Super Formula convergence

  • Within a fraction of a second, MHE converges to the correct lateral velocity after ηy,i is initialized substantially below its effective level.In the low-grip qualifying session, convergence is achieved by the apex of Turn 1 despite initial overestimation at corner entry.Source: C. Case 3: Autonomous Super Formula… · p. 7

Benchmark comparison

  • MHE reaches comparable accuracy to a UKF with correctly identified tire parameters after one corner, without prior knowledge of the exact friction level.A UKF initialized with an underestimated Pacejka peak factor D retains a persistent bias that cannot be compensated online.Source: C. Case 3: Autonomous Super Formula… · p. 7

Sensitivity analysis

  • Both excessively long and overly short horizons increase lateral-velocity RMSE, while curvature-factor deviations also increase RMSE but preserve qualitative trends.Long horizons accumulate simplified-model mismatch, whereas short horizons are more sensitive to measurement noise and less constrained by dynamics; changing B by ±20% is evaluated.Source: C. Case 3: Autonomous Super Formula… · p. 7

VII. CONCLUSION AND FUTURE WORK

The IMU-centric MHE reconstructs lateral velocity and acceleration without external odometry or high-dimensional tire-parameter identification, while accommodating changing grip. Results across sports cars and an autonomous race car support limited vehicle-specific tuning, and measured runtimes suggest real-time feasibility; future work targets broader adaptation and validation.

Conclusion

  • The framework reconstructs lateral velocity and lateral acceleration without external odometry or high-dimensional tire-parameter identification.It uses bounded and regularized variables to accommodate effective force-capacity variations instead of assuming a fixed tire model.Source: §VII · p. 7
  • Reduced sensitivity to tire-parameter uncertainty and changing grip was observed against the evaluated filtering baselines.The reported explanation is adaptation of effective force-capacity variations through bounded and regularized variables.Source: §VII · p. 7

Practical advantages

  • The reduced formulation mainly depends on geometric parameters and mass, limiting vehicle-specific tuning requirements.These quantities are typically available or can be measured with limited effort.Source: §VII · p. 7

Validation

  • Validation covered two human-driven sports cars in the REVS database and autonomous Super Formula runs with the EAV-25 platform.These results support the approach across different vehicle platforms and driving settings.Source: §VII · p. 8

Implementation

  • Measured solver runtimes on the tested high-end CPU platform suggest that real-time implementation is feasible.Source: §VII · p. 8

Future work

  • Future work will adapt the SST curvature parameter online, pursue embedded implementation, and broaden validation across vehicles and environments.Proposed extensions include hierarchical estimation and testing in urban and off-road scenarios.Source: §VII · p. 8
Loading 2609.10202v2…