Modeling and Simulation of Intelligent Driving with Trajectory Planning and Tracking

This paper proposes a novel modeling and simulation environment developed under Matlab/Simulink with friendly and intuitive graphic user interfaces, aimed to enable math-based virtual development and test of intelligent driving systems. Six typical driving maneuvers are first proposed, which are further abstracted into two atomic sub-maneuvers: lane following and lane change, as any maneuvers can be the combinations of these two. A generic trajectory planning and path tracking control algorithm are developed to deal with the generality and commonality of the lane change function with optimization among safety, comfort and efficiency in performing the lane change maneuver. Some typical simulations are conducted with results demonstrating the practical usefulness, efficiency and convenience in using this proposed tool.