Social-aware Planning and Control for Automated Vehicles Based on Driving Risk Field and Model Predictive Contouring Control

Abstract

The gradual deployment of automated vehicles (AVs) results in mixed traffic where AVs will interact with human-driven vehicles (HDVs). Thus, social-aware motion planning and control while considering interactions with HDVs on the road is critical for AVs’ deployment and safe driving under various maneuvers. Previous research mostly focuses on the trajectory planning of AVs using Model Predictive Control or other relevant methods, while seldom considering the integrated planning and control of AVs altogether to simplify the whole pipeline architecture. Furthermore, there are very limited studies on social-aware driving that makes AVs understandable and expected by human drivers, and none when it comes to the challenging maneuver of driving through roundabouts. To fill these research gaps, this paper develops an integrated social-aware planning and control algorithm for AVs’ driving through roundabouts based on Driving Risk Field (DRF), Social Value Orientation (SVO), and Model Predictive Contouring Control (MPCC), i.e., DRF-SVO-MPCC. The proposed method is tested and verified with simulation on the open-sourced highway-env platform. Compared with the baseline method using purely Nonlinear Model Predictive Control, the DRF-SVO-MPCC can achieve better performance under various maneuvers of driving through roundabouts with and without surrounding HDVs.