A hierarchical hybrid system of integrated longitudinal and lateral control for intelligent vehicles.

A hierarchical hybrid control system is proposed to cope with highly automated driving in highway environments with multiple lanes and surrounding vehicles. In the high-level layer, the discrete driving decisions are coordinated by the finite-state machine (FSM) based on the relative position identification and predictive longitudinal distance of the surrounding vehicles. The low-level layer is responsible for the vehicle motion control, where the model predictive control (MPC) approach is utilized to integrate the longitudinal and lateral control mainly including car-following control and lane changing control. The proposed control system focuses on two issues regarding safe driving on highways. On one hand, the subject vehicle must always keep a safe distance with its leading vehicle to avoid the rear-end collision. On the other hand, the subject vehicle should also overtake the preceding vehicle by safe lane changes if the desired speed is not achieved. The effectiveness of the hybrid control is tested in the simulation, whose results verify that the driving decisions are made reasonably and the vehicle motion control obeys stability and comfort requirements. Moreover, it is also indicated by the simulations in random scenarios that the control strategy is able to deal with most of ordinary situations on highways although some emergency situations or critical driving maneuvers of other vehicles are not considered.