Autonomous Ground Vehicle Lane-Keeping LPV Model-Based Control: Dual-Rate State Estimation and Comparison of Different Real-Time Control Strategies

Julian M. Salt Ducaju, Julián J. Salt Llobregat, Ángel Cuenca, Masayoshi Tomizuka

TL;DR

This paper tackles the challenge of real-time lane-keeping for autonomous vehicles by proposing a Linear Parameter Varying (LPV) model-based Model Predictive Control (MPC) strategy. To handle sensor data arriving at different rates, they introduce a Dual-Rate Extended Kalman Filter (DREKF) for efficient state estimation, demonstrating superior performance compared to a simpler Inverse Kinematic Bicycle (IKIBI) model, especially under noisy conditions and with slower sensor updates.

What Problem Does This Paper Address?

Autonomous Ground Vehicles (AGVs) need to precisely follow a pre-defined path, a task known as lane-keeping. This requires accurate estimation of the vehicle's state and a robust control system that can react quickly. A major hurdle is the discrepancy in sensor data acquisition rates (e.g., GPS vs. IMU), which complicates state estimation. Furthermore, while complex nonlinear vehicle models offer high accuracy, they can be computationally intensive, making real-time control challenging, especially for Model Predictive Control (MPC) which relies on such models for prediction. This paper aims to bridge this gap by developing a control strategy that balances model accuracy with computational efficiency, and a state estimation method that effectively handles multi-rate sensor data.

Methods

The authors propose two main innovations:

  • Linear Parameter Varying (LPV) Model for Control: Instead of using complex nonlinear vehicle models, they opt for an LPV model to describe the vehicle's lateral dynamics. This approach offers a trade-off between model accuracy and computational complexity, making it more suitable for real-time MPC implementation. The LPV model's coefficients vary based on parameters like lateral acceleration and longitudinal velocity.
  • Dual-Rate Extended Kalman Filter (DREKF): To address the issue of sensors providing data at different frequencies, they introduce a DREKF. This filter updates the vehicle's state at a fast rate (matching the control frequency) but only performs computationally intensive correction steps when new measurements are available (at a slower rate). This alleviates the computational burden while still providing timely state estimates for the controller.

They compare their LPV-MPC strategy with a simpler Inverse Kinematic Bicycle (IKIBI) model-based controller. Both controllers are evaluated in simulations under various conditions, including the presence of process and measurement noise, and with different sensor update rates.

Datasets

Not discussed in the paper. The authors use simulated vehicle parameters (a 2017 Lincoln MKZ) and a circuit path for their experiments.

Key Insights and Ideas

  • LPV-MPC as a sweet spot: The LPV model provides a good balance for MPC, allowing it to capture essential vehicle dynamics without becoming computationally prohibitive for real-time applications.
  • DREKF is crucial for multi-rate sensing: The DREKF is not just a theoretical concept; it's shown to be practically essential for achieving stable and accurate lane-keeping when sensor data arrives at significantly different rates, especially in the presence of noise.
  • MPC's predictive power shines: The MPC controller's ability to look ahead (prediction horizon) allows it to anticipate maneuvers and act preemptively, leading to smoother control actions and better path following, especially when compared to reactive controllers like IKIBI.
  • Physical constraints matter: MPC can explicitly incorporate physical limitations (like maximum steering angle) into its control decisions, preventing unrealistic or unsafe control commands, which is a significant advantage over simpler controllers that might saturate.
  • Noise and slow sensors are a challenging combination: The paper highlights that the combination of sensor noise and slow update rates is particularly demanding, pushing the limits of even advanced control strategies and underscoring the need for robust state estimation like the DREKF.

Key Results

  • Superior Accuracy: The LPV-MPC controller consistently demonstrated more accurate lane-keeping behavior than the IKIBI controller across various test scenarios, as quantified by the J1 and J2 cost indexes.
  • Robustness to Noise: When process and measurement noises were introduced, the EKF was essential for stable operation. The MPC controller, even with an EKF, maintained better performance than the IKIBI.
  • Handling Slow Sensors: In scenarios with slow sensor feedback (every 10 control cycles), the DREKF enabled the MPC to maintain a degree of lane-keeping accuracy comparable to faster sensor feedback scenarios, a feat not achievable by the IKIBI controller alone.
  • Computational Efficiency: Both controllers were found to operate within the vehicle's sampling period (10 ms), with the IKIBI being significantly faster (average 0.003 ms) than the MPC (average 0.637 ms), but the MPC's superior performance justified its computational cost.
  • Steering Saturation Avoidance: The MPC controller successfully avoided steering angle saturation, unlike the IKIBI controller, which would hit physical limits during aggressive maneuvers.

Limitations and Future Work

  • Simulation-based: The results are based on simulations, and real-world testing would be necessary to fully validate the proposed methods.
  • Specific Vehicle Model: The study uses parameters for a specific vehicle (Lincoln MKZ), and generalization to other vehicle types might require re-evaluation.
  • LPV Model Identification: While the paper mentions an optimized method for LPV model identification, further research could explore more advanced identification techniques for improved model accuracy.
  • Future Work: The authors suggest exploring the behavior of their proposed LPV-MPC strategy in more realistic scenarios, potentially incorporating learning algorithms for enhanced prediction over longer horizons. They also hint at the potential of their DREKF for other applications where multi-rate sensing is a challenge.

Summary updated

Abstract

In this contribution, we suggest two proposals to achieve fast, real-time lane-keeping control for Autonomous Ground Vehicles (AGVs). The goal of lane-keeping is to orient and keep the vehicle within a given reference path using the front wheel steering angle as the control action for a specific longitudinal velocity. While nonlinear models can describe the lateral dynamics of the vehicle in an accurate manner, they might lead to difficulties when computing some control laws such as Model Predictive Control (MPC) in real time. Therefore, our first proposal is to use a Linear Parameter Varying (LPV) model to describe the AGV’s lateral dynamics, as a trade-off between computational complexity and model accuracy. Additionally, AGV sensors typically work at different measurement acquisition frequencies so that Kalman Filters (KFs) are usually needed for sensor fusion. Our second proposal is to use a Dual-Rate Extended Kalman Filter (DREFKF) to alleviate the cost of updating the internal state of the filter. To check the validity of our proposals, an LPV model-based control strategy is compared in simulations over a circuit path to another reduced computational complexity control strategy, the Inverse Kinematic Bicycle model (IKIBI), in the presence of process and measurement Gaussian noise. The LPV-MPC controller is shown to provide a more accurate lane-keeping behavior than an IKIBI control strategy. Finally, it is seen that Dual-Rate Extended Kalman Filters (DREKFs) constitute an interesting tool for providing fast vehicle state estimation in an AGV lane-keeping application.
BibTeX
@inproceedings{ducaju2021autonomous,
  author = {Julian M. Salt Ducaju and Julián J. Salt Llobregat and Ángel Cuenca and Masayoshi Tomizuka},
  title = {{Autonomous Ground Vehicle Lane-Keeping LPV Model-Based Control: Dual-Rate State Estimation and Comparison of Different Real-Time Control Strategies}},
  booktitle = {Sensors},
  year = {2021},
  url = {https://openreview.net/forum?id=AN4skOdNoe},
}
Figure