Two-phase optimal path planning of autonomous ground vehicles using pseudo-spectral method

Abstract

In this paper, an optimal path-planning method is proposed for autonomous ground vehicles in case of overtaking a moving obstacle by the application of a two-phase optimal-control problem. When the autonomous vehicle detects a moving vehicle in a proper speed and distance ahead, it decides to overtake the obstacle by executing a double-lane change manoeuvre. The path for the overtaking manoeuvre is generated by a two-phase optimal path-planning problem. The cost function of the first phase is defined in such a way that the vehicle approaches the obstacle as close as possible. In the second phase, the cost function is defined as sum of the vehicle lateral deviation from the reference path and the rate of steering angle. At the same time, the lateral acceleration of the vehicle must not exceed a specified limit. The radio pseudo-spectral method, which is a method for direct trajectory optimization using global collocation at Legendre–Gauss–Radau points, is applied for solving the two-phase nonlinear optimal-control problem. A full nonlinear vehicle model in CarSim software is used for path-tracking simulation by importing path data from a MATLAB code. The simulation results show that the generated path for the autonomous vehicle satisfies all vehicle-dynamics constraints and hence is applicable for a real autonomous vehicle.

Keywords

Path planning path tracking autonomous vehicles two-phase optimal control problem radio pseudo-spectral method

Get full access to this article

View all access options for this article.

References

Rahnejat

. Multi-body dynamics: vehicles, machines, and mechanisms, Warrendale, PA: Society of Automotive Engineers, 1998.

Solea R and Nunes U. Trajectory planning with velocity planner for fully-automated passenger vehicles. In: IEEE intelligent transportation systems conference, Toronto, Ontario, 2006, pp.474–480.

Park

Kim

Yoon

. Obstacle avoidance of autonomous vehicles based on model predictive control. Proc IMechE, Part D: Journal of Automobile Engineering 2009; 223: 1499–1516.

Kim

. Development of a path-tracking control system based on model predictive control using infrastructure sensors. Veh Syst Dyn 2011; 50: 1001–1023.

Mashadi B, Ahmadizadeh P and Majidi M. Integrated controller design for path following in autonomous vehicles. SAE technical paper 2011-01-1032, 2011.

Goodarzi

Sabooteh

Esmailzadeh

. Automatic path control based on integrated steering and external yaw-moment control. Proc IMechE, Part K: Journal of Multi-body Dynamics 2008; 222: 189–200.

Isermann

Schorn

Stählin

. Anticollision system PRORETA with automatic braking and steering. Int J Veh Mech Mobility 2008; 46: 683–694.

Minguez

Montano

. Sensor-based robot motion generation in unknown, dynamic and troublesome scenarios. Robot Auton Syst 2005; 52: 290–311.

Spenko M, Iagnemma KD and Dubowsky S. High speed hazard avoidance for mobile robots in rough terrain. In: SPIE conference on unmanned ground vehicle technology, Orlando, FL, 2004, pp.439–450.

10.

Fox

Burgard

Thrun

. The dynamic window approach to collision avoidance. IEEE Robot Autom Mag 1997; 4: 23–33.

11.

Ulrich I and Borenstein J. Reliable obstacle avoidance for fast mobile robots. In: IEEE international conference on robotics and automation, Leuven, 1998, pp.1572–1577. New York: IEEE.

12.

Karaman S, Walter MR, Perez A, et al. Anytime motion planning using the RRT. In: IEEE international conference on robotics and automation, Shanghai, China, 2011, pp.1478–1483. New York: IEEE.

13.

Falcone

Borrelli

Asgari

. Predictive active steering control for autonomous vehicle systems. IEEE Trans Control Syst Technol 2007; 15: 566–580.

14.

Park

J-M

Kim

D-W

Yoon

Y-S

. Obstacle avoidance of autonomous vehicles based on model predictive control. Proc IMechE, Part D: J Automobile Engineering 2009; 223: 1499–1516.

15.

Yoon

Shin

Kim

. Model-predictive active steering and obstacle avoidance for autonomous ground vehicles. Control Eng Pract 2009; 17: 741–750.

16.

Nanao M and Ohtsuka T. Nonlinear model predictive control for vehicle collision avoidance using C/GMRES algorithm. In: IEEE international conference on control applications, Yokohama, Japan, 2010, pp.1630–1635.

17.

Onieva

Naranjo

Milanés

. Automatic lateral control for unmanned vehicles via genetic algorithms. Appl Soft Comput 2011; 11: 1303–1309.

18.

Mavros

Rahnejat

King

. A framework for the characterization of the transient handling responses of non-linear vehicles. Proc IMechE, Part K: Journal of Multi-body Dynamics 2007; 221: 1–11.

19.

Matveev

Teimoori

Savkin

. A method for guidance and control of an autonomous vehicle in problems of border patrolling and obstacle avoidance. Automatica 2011; 47: 515–524.

20.

Zhe

Min-Zhou

Gang-Qi

. A rapid path planner for autonomous ground vehicle using section collision detection. J Shanghai Jiaotong Univ (Sci) 2009; 14: 306–309.

21.

Takei R, Tsai R, Haochong S, et al. A practical path-planning algorithm for a simple car: a Hamilton-Jacobi approach. In: American control conference (ACC), Baltimore, MD, 2010, pp.6175–6180.

22.

Mashadi

Majidi

Dizaji

. Optimal vehicle dynamics controller design using a four-degrees-of-freedom model. Proc IMechE, Part D: Journal of Automobile Engineering 2010; 224: 645–659.

23.

Pacejka

. Tyre and vehicle dynamics, 2nd ed. Oxford, UK: Elsevier /Butterworth–Heinemann, 2005.

24.

Hegazy

Rahnejat

Hussain

. Multi-body dynamics in full-vehicle handling analysis. Proc IMechE, Part K: Journal of Multi-body Dynamics 1999; 213: 19–31.

25.

Garg

Patterson

Francolin

. Direct trajectory optimization and costate estimation of finite-horizon and infinite-horizon optimal control problems using a Radau pseudospectral method. Comput Optim Appl 2011; 49: 335–358.

26.

Gill PE, Murray W and Saunders MA. User’s guide for SNOPT version 7: software for large scale nonlinear programming, 2006.

27.

Garg

Hager

Rao

. Pseudospectral methods for solving infinite-horizon optimal control problems. Automatica 2011; 47: 829–837.

28.

Patterson

Rao

. Exploiting sparsity in direct collocation pseudospectral methods for solving continuous-time optimal control problems. J Spacecr Rockets 2012; 49: 364–377.

29.

Garg

Patterson

Hager

. A unified framework for the numerical solution of optimal control problems using pseudospectral methods. Automatica 2010; 46: 1843–1851.

30.

Rao AV, Benson DA, Darby CL, et al. User’s manual for GPOPS version 5.0: a MATLAB software for solving multiple-phase optimal control problems using hp-adaptive pseudospectral methods, 2011.