SYSTEM AND METHOD FOR PROVIDING ACCURATE TRAJECTORY FOLLOWING FOR AUTOMATED VEHICLES IN DYNAMIC ENVIRONMENTS

A system and method for providing accurate trajectory following for automated vehicles in dynamic environments that include receiving image data and LiDAR data associated with a dynamic environment of a vehicle. The system and method also include processing a planned trajectory of the vehicle that is based on an analysis of the image data and LiDAR data. The system and method further include communicating control signals associated with following the planned trajectory to autonomously control the vehicle to follow the planned trajectory to navigate within the dynamic environment to reach a goal.