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.

Longitudinal Trajectory Optimization for Connected and Automated Vehicles by Evolving Cubic Splines with Coevolution

Efficient Optimization-Based Trajectory Planning for Unmanned Systems in Confined Environments

Autonomous Trajectory Planning Based on Bézier Curve with Curvature Constraints and Piecewise-Jerk Speed-Time Optimization

Path Planning for Autonomous Driving with Curvature-considered Quadratic Optimization.

Generating Large-Scale Trajectories Efficiently Using Double Descriptions of Polynomials.

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

Precise trajectory optimization for articulated wheeled vehicles in cluttered environments

An Efficient Spatial-Temporal Trajectory Planner for Autonomous Vehicles in Unstructured Environments

An Incremental Strategy for Tractor-Trailer Vehicle Global Trajectory Optimization in the Presence of Obstacles.

Spline-Based Minimum-Curvature Trajectory Optimization for Autonomous Racing

Spatio-Temporal Trajectory Planning Using Search And Optimizing Method for Autonomous Driving

On-Road Trajectory Planning With Spatio-Temporal Rrt* And Always-Feasible Quadratic Program

A novel real-time trajectory planning algorithm for intelligent vehicles

A Piecewise Trajectory Optimization Model for Connected Automated Vehicles: Exact Optimization Algorithm and Queue Propagation Analysis

Safe and Efficient Trajectory Optimization for Autonomous Vehicles using B-spline with Incremental Path Flattening

A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles

A Semi-decentralized and Variational-Equilibrium-Based Trajectory Planner for Connected and Autonomous Vehicles

Real-Time Optimal Trajectory Planning for Autonomous Driving with Collision Avoidance Using Convex Optimization

Trajectory Planning of Robot End-Effector Position and Orientation Based on Cubic Spline

On-Road Trajectory Planning of Connected and Automated Vehicles in Complex Traffic Settings: A Hierarchical Framework of Trajectory Refinement

Time-Optimal Trajectory Generation for Dynamic Vehicles: A Bilevel Optimization Approach.