School of Transportation Science and Engineering, the State Key Laboratory of Intelligent Transportation System, and the Key Laboratory of Autonomous Transportation Technology for Special Vehicles, Ministry of Industry and Information Technology, Beihang University, Beijing, China