The Unscented Kalman Filter for Nonlinear Parameter Identification of Adaptive Cruise Control Systems

Abstract

This paper develops and investigates a dual unscented Kalman filter (DUKF) for the joint nonlinear state and parameter identification of commercial adaptive cruise control (ACC) systems. Although the core functionality of stock ACC systems, including their proprietary control logic and parameters, is not publicly available, this work considers a car-following scenario with a human-driven vehicle (leader) and an ACC engaged ego vehicle (follower) that employs a constant time-headway policy (CTHP). The objective of the DUKF is to determine the CTHP parameters of the ACC by using real-time observations of space-gap and relative velocity from the vehicle's onboard sensors. Real-time parameter identification of stock ACC systems is essential for assessing their string stability, large-scale deployment on motorways, and impact on traffic flow and throughput. In this regard, <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">${\mathfrak {L}}_{2}$</tex-math></inline-formula> and <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">${\mathfrak {L}}_\infty$</tex-math></inline-formula> string stability conditions are considered. The observability rank condition for nonlinear systems is adopted to evaluate the ability of the proposed estimation scheme to estimate stock ACC system parameters using empirical data. The proposed filter is evaluated using empirical data collected from the onboard sensors of two 2019 SUV vehicles, namely Hyundai Nexo and SsangYong Rexton, equipped with stock ACC systems; and is compared with batch and recursive least-squares optimization. The set of ACC model parameters obtained from the proposed filter revealed that the commercially implemented ACC system of the considered vehicle (Hyundai Nexo) is neither <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">${\mathfrak {L}}_{2}$</tex-math></inline-formula> nor <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">${\mathfrak {L}}_\infty$</tex-math></inline-formula> string stable.