Trajectory Generation using Sharpness Continuous Dubins-like Paths with Applications in Control of Heavy Duty Vehicles

Rui Oliveira,Pedro F. Lima,Marcello Cirillo,Jonas Mårtensson,Bo Wahlberg
DOI: https://doi.org/10.48550/arXiv.1801.08995
2018-05-07
Abstract:We present a trajectory generation framework for control of wheeled vehicles under steering actuator constraints. The motivation is smooth autonomous driving of heavy vehicles. The key idea is to take into account rate, and additionally, torque limitations of the steering actuator directly. Previous methods only take into account curvature rate limitations, which deal indirectly with steering rate limitations. We propose the new concept of Sharpness Continuous curves, which uses cubic and sigmoid curvature trajectories together with circular arcs to steer the vehicle. The obtained trajectories are characterized by a smooth and continuously differentiable steering angle profile. These trajectories provide low-level controllers with reference signals which are easier to track, resulting in improved performance. The smoothness of the obtained steering profiles also results in increased passenger comfort. The method is characterized by a fast computation time, which can be further speeded up through the use of simple pre-computations. We detail possible path planning applications of the method, and conduct simulations that show its advantages and real time capabilities.
Systems and Control,Robotics
What problem does this paper attempt to address?
This paper attempts to address the problem of generating smooth trajectories when controlling heavy vehicles to cope with the slow dynamic response of steering actuators. Specifically, the paper proposes a new concept—Sharpness Continuous (SC) curves, which guide the vehicle by combining cubic curvature paths with circular arcs. This method directly considers the amplitude, rate, and acceleration limits of the steering actuators, thereby generating paths with smooth and continuously differentiable steering angle curves. Compared to previous methods that only considered path curvature limits, SC paths provide reference signals that are easier to track, improve the performance of low-level controllers, and increase passenger comfort. ### Main Contributions 1. **Directly considering the amplitude, rate, and acceleration limits of the steering actuators**: Generating G3 paths (i.e., paths with continuous curvature and its derivatives). 2. **Simplifying the controller's task and improving passenger comfort**. 3. **Capable of connecting arbitrary vehicle configurations**. 4. **Fast computation time**, suitable for online use as part of a complex motion planner. ### Method Overview - **Vehicle Model**: Defines the vehicle's dynamic model, including variables such as position, orientation, and speed. - **Path Feasibility**: Considers the maximum amplitude, maximum rate of change, and maximum acceleration limits of the steering angle to ensure the generated path is physically feasible. - **Sharpness Continuous Path (SC Path)**: Composed of cubic curvature paths and circular arcs, ensuring the path's curvature and steering angle curves are smooth and continuous. - **Path Connection**: Details how to connect two SC turning paths through straight segments to form a complete SC path. - **Shortest Path Search**: Finds the optimal path from the start configuration to the target configuration by calculating all possible SC paths and selecting the shortest one. ### Experimental Results - **Comparison with Dubins Path**: As the maximum sharpness increases, the SC path gradually approaches the optimal length of the Dubins path. - **Computation Cost**: By precomputing cubic curvature paths, the computation time is significantly reduced, making the method suitable for real-time applications. - **Simulation Tests**: Simulations verify the performance of SC paths in actual vehicle tracking, showing advantages in stability and passenger comfort. ### Conclusion The SC path proposed in the paper not only considers the maximum amplitude limit of the steering angle but also the maximum rate of change and acceleration limits, resulting in smoother paths. This simplifies the task of low-level controllers, improves driving comfort, and reduces the effort of actuators. Future work can further extend this method to handle more complex path connection scenarios and optimize the time performance of the paths.