SYSTEM AND METHOD FOR PROVIDING A COMPREHENSIVE TRAJECTORY PLANNER FOR A PERSON-FOLLOWING VEHICLE

A system and method for providing a comprehensive trajectory planner for a person-following vehicle that includes receiving image data and LiDAR data associated with a surrounding environment of a vehicle. The system and method also include analyzing the image data and detecting the person to be followed that is within an image and analyzing the LiDAR data and detecting an obstacle that is located within a predetermined distance from the vehicle. The system and method further include executing a trajectory planning algorithm based on fused data associated with the detected person and the detected obstacle.