LiDAR-based simultaneous localization and mapping (SLAM) and online localization methods are widely used in autonomous driving, and are key parts of intelligent vehicles. However, current SLAM algorithms have limitations in map drift and localization algorithms based on a single sensor have poor adaptability to complex scenarios. A SLAM and online localization method based on multi-sensor fusion is proposed and integrated into a general framework in this paper. In the mapping process, constraints consisting of normal distributions transform (NDT) registration, loop closure detection and real time kinematic (RTK) global navigation satellite system (GNSS) position for the front-end and the pose graph optimization algorithm for the back-end, which are applied to achieve an optimized map without drift. In the localization process, the error state Kalman filter (ESKF) fuses LiDAR-based localization position and vehicle states to realize more robust and precise localization. The open-source KITTI dataset and field tests are used to test the proposed method. The method effectiveness shown in the test results achieves 5–10 cm mapping accuracy and 20–30 cm localization accuracy, and it realizes online autonomous driving in complex scenarios.

The shared control system has been a key technology framework and trend, with its advantages in overcoming the performance shortage of safety and comfort in automated vehicles. Understanding human drivers’ driving capabilities and styles is the key to improving system performance, in particular, the acceptance by and adaption of shared control vehicles to human drivers. In this research, personalized shared control considering drivers’ main human factors is proposed. A simulated scenario generation method for human factors was established. Drivers’ driving capabilities were defined and evaluated to improve the rationality of the driving authority allocation. Drivers’ driving styles were analyzed, characterized, and evaluated in a field test for the intention-aware personalized automated subsystem. A personalized shared control framework is proposed based on the driving capabilities and styles, and its evaluation criteria were established, including driving safety, comfort, and workload. The personalized shared control system was evaluated in a human-in-the-loop simulation platform and a field test based on an automated vehicle. The results show that the proposed system could achieve better performances in terms of different driving capabilities, styles, and complex scenarios than those only driven by human drivers or automated systems.