BIDIRECTIONAL PATH OPTIMIZATION IN A GRID

Provided are methods, systems, and computer program products for bidirectional path optimization in a grid. An example method may include: receiving vehicle environment data associated with an environment of a vehicle; determining an occupancy map of the environment using the vehicle environment data, the occupancy map identifying at least one obstacle in the environment; generating a reference path to a destination location for the vehicle; determining a travel path to an intermediate location in the occupancy map based at least in part on the reference path and a longitudinal direction variable, wherein the intermediate location is proximate a point on the reference path; and generating actuation commands for the vehicle based at least in part on the travel path.