Urban Pilot Motion Planning and Control Deployment Via Real-Time Multi-Core Multi-Thread Prototyping

In this work, the functional development of motion planning and control for SAE level-4 autonomous urban pilot is presented, including its architecture design, algorithm development, software implementation and hardware prototype. First, a completely AVL in-house designed, modular and generic Advanced Driver Assist System (ADAS) and Automated Driving (AD) application architecture is deployed, such that the motion planning and control modules can communicate with decision making, environment modeling and localization modules. Second, A road-navigation-oriented, sampling-and-searching-based iterative spatial-temporal motion planning algorithm is developed and integrated with classical motion control algorithms, via a ©MATLAB/Simulink implementation platform. Finally, the integrated motion planning and control subsystem is prototyped in ©Speedgoat hardware, via a real-time multi-core multi-thread deployment methodology. The proposed motion planning and control deployment has been validated through model in the loop (MIL) and processor in the loop (PIL) simulation environment, which provided the ground work for application integration to conduct road tests on a level-4 AVL demo vehicle.