TARGET-ORIENTATED NAVIGATION SYSTEM FOR A VEHICLE USING A GENERIC NAVIGATION SYSTEM AND RELATED METHOD

A target-orientated navigation system and related method for a vehicle having a generic navigation system includes one or more processors and a memory. The memory includes one or more modules that cause the processor to receive perception data, discretize the perception data into a plurality of lattices, generate a collision probability array having a plurality of cells that correspond to the plurality of lattices, determine which cells of the collision probability array satisfy a safety criteria, receive an artificial potential field array having a plurality of cells that correspond to the plurality of cells of the collision probability array, generate, an objective score array having a plurality of cells corresponding to the cells of the collision probability array, and direct a vehicle control system of the vehicle to guide the vehicle to a location representative of a cell in the objective score array that has a highest value.