SYSTEMS AND METHODS FOR CONTINUOUS REPLANNING OF VEHICLE TRAJECTORIES

A method and system for continuously re-planning a vehicle's path, in the face of stationary and moving obstacles, dynamically calculates a new path in real time which is both efficient and maintains minimum safety clearances relative to obstacles. Repulsion signals emanating from obstacles and propagating through delineated sections of a grid representing a geographic space are summed along with values representing the relative distance of the sections from the vehicle origin and vehicle destination. The grid sections having optimal values according to a predetermined criteria represent an efficient and safe travel path between the vehicle origin and destination.