Abstract:In this paper, we present a complete, flexible and safe convex-optimization-based method to solve speed planning problems over a fixed path for autonomous driving in both static and dynamic environments. Our contributions are five fold. First, we summarize the most common constraints raised in various autonomous driving scenarios as the requirements for speed planner developments and metrics to measure the capacity of existing speed planners roughly for autonomous driving. Second, we introduce a more general, flexible and complete speed planning mathematical model including all the summarized constraints compared to the state-of-the-art speed planners, which addresses limitations of existing methods and is able to provide smooth, safety-guaranteed, dynamic-feasible, and time-efficient speed profiles. Third, we emphasize comfort while guaranteeing fundamental motion safety without sacrificing the mobility of cars by treating the comfort box constraint as a semi-hard constraint in optimization via slack variables and penalty functions, which distinguishes our method from existing ones. Fourth, we demonstrate that our problem preserves convexity with the added constraints, thus global optimality of solutions is guaranteed. Fifth, we showcase how our formulation can be used in various autonomous driving scenarios by providing several challenging case studies in both static and dynamic environments. A range of numerical experiments and challenging realistic speed planning case studies have depicted that the proposed method outperforms existing speed planners for autonomous driving in terms of constraint type covered, optimality, safety, mobility and flexibility.

A sequential approach for speed planning under jerk constraints

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

Is time-optimal speed planning under jerk constraints a convex problem?

Time-Optimal Path Tracking for Jerk Controlled Robots

Smoothness-optimal trajectory planning method with constraint on traveling time for manipulators

Research on Flexible Acceleration and Deceleration Method of NC System

An approach for jerk-continuous trajectory generation of robotic manipulators with kinematical constraints

Efficient calculation of time-optimal motion primitives for systems exhibiting oscillatory internal dynamics with multiple applications

Joint-space Trajectory Planning for Robots under Multiple Constraints

Time-optimal and Jerk-continuous Trajectory Planning Algorithm for Manipulators

Velocity Constraints Based Approach for Online Trajectory Planning of High-Speed Parallel Robots

On the Performance of Jerk-Constrained Time-Optimal Trajectory Planning for Industrial Manipulators

Time-Optimal Maneuver Planning in Automatic Parallel Parking Using a Simultaneous Dynamic Optimization Approach

Simultaneous dynamic optimization: A trajectory planning method for nonholonomic car-like robots

Jerk-bounded and -Continuous Trajectory Planning for a 6-DOF Serial Robot Manipulator with Revolute Joints

An asymmetric S-curve trajectory planning based on an improved jerk profile

Improving the efficiency of time-optimal path-following algorithms

A Novel Point-to-Point Trajectory Planning Algorithm for Industrial Robots Based on a Locally Asymmetrical Jerk Motion Profile

Toward a More Complete, Flexible, and Safer Speed Planning for Autonomous Driving via Convex Optimization

Trajectory Planning Under Vehicle Dimension Constraints Using Sequential Linear Programming

A safety-guaranteed game-theoretical velocity planning for autonomous vehicles on sharp curve roads