Abstract:Longitudinal vehicle trajectories suffer from errors and noise because of detection and extraction techniques, challenging their applications. Existing smoothing methods either lack physical meaning or cannot ensure solution existence and uniqueness. To address this, we propose a two-step quadratic programming method that aligns smoothed speeds and higher-order derivatives with physical laws, drivers’ behaviors, and vehicle characteristics. Unlike the well-known smoothing splines method, which minimizes a weighted sum of discrepancy and roughness in a single quadratic programming problem, our method incorporates prior knowledge of position errors into two sequential quadratic programming problems. Step 1 solves half-smoothed positions by minimizing the discrepancy between them and raw positions, subject to physically meaningful bounds on speeds and higher-order derivatives of half-smoothed positions. Step 2 solves smoothed positions by minimizing the roughness while maintaining physically meaningful bounds and allowing the deviations from raw data of smoothed positions by at most those of the half-smoothed positions and prior position errors. The second step’s coefficient matrix is not positive definite, necessitating the matching of the first few smoothed positions with corresponding half-smoothed ones, with equality constraints equaling the highest order of derivatives. We establish the solution existence and uniqueness for both problems, ensuring their well-defined nature. Numerical experiments using Next Generation Simulation (NGSIM) data demonstrate that a third-order derivative constraint yields an efficient method and produces smoothed trajectories comparable with manually re-extracted ones, consistent with the minimum jerk principle for human movements. Comparisons with an existing approach and application to the Highway Drone data set further validate our method’s efficacy. Notably, our method is a postprocessing smoothing technique based on trajectory data and is not intended for systematic errors. Future work will extend this method to lateral vehicle trajectories and trajectory prediction and planning for both human-driven and automated vehicles. This approach also holds potential for broader smoothing problems with known average error in raw data. History: This paper has been accepted for the Transportation Science Special Issue on ISTTT25 Conference. Funding: The authors extend their gratitude to the Pacific Southwest Region University Transportation Center and the University of California Institute of Transportation Studies (UC ITS) Statewide Transportation Research Program (STRP) for their valuable financial support.

A Method for Dynamic Locally Weighting Based on Sequential Quadratic Programming

Torque Limitation Control of Industrial Manipulators Based on General Weighted Least Norm Method

Application of General-Weighted Least-Norm Method in Mobile Manipulator

Parametric Quadratic Programming Method for Dynamic Contact Problems with Friction

Combination Weighting Approach Based on Deviation Function and Joint-Entropy

Research on On-Board Dynamic Weighing Algorithm Based on Two-Degree-of-freedom 1/4 Vehicle Model

Physics-Based Quadratic Deformation Using Elastic Weighting

An Approach for Identifying Dynamic Parameters in Robotic Systems With Inconsistent Joint Measurements

A Full-Newton Step Interior-Point Method for Weighted Quadratic Programming Based on the Algebraic Equivalent Transformation

Dynamic Weighing Technology Research under Conditions of Low-Frequency Vibration or Random Vibration

A novel adaptive dynamic weight distribution (ADWD) strategy applied to support vector regression (SVR)-based framework for dynamic load identification problems

Weighted total least squares problems with inequality constraints solved by standard least squares theory

Two-Step Quadratic Programming for Physically Meaningful Smoothing of Longitudinal Vehicle Trajectories

Improved Damped Least Squares Solution with Joint Limits, Joint Weights and Comfortable Criteria for Controlling Human-like Figures.

A Weighting Algorithm Based on the Gravitational Model for Local Stereo Matching.

A new strategy to estimate static loads for the dynamic weighing in motion of railway vehicles

A Multi-reference Extended Variable Step-size LMS Algorithm for Solving Dynamic Weighting Coefficients of the Satellite Beam-forming Networks

A Quadratic Programming Localization Based on TDOA Measurement

Robot motion visual measurement based on RANSAC and weighted constraints method

A Novel Discretized ZNN Model for Velocity-Layer Weighted Multi-Criteria Optimization of Robotic Manipulators With Multiple Constraints

Distributed Dynamic Load in Structural Dynamics by the Impulse-Based Force Estimation Algorithm