Track position Vehicle is heading to
Heuristic function for A*
Refactoring to be Road centric
New steering and speed behavior, queues

Queues for preliminary support for giving a full path to a Vehicle to
undertake