Integrated vector and began work on pathfinding.

Needs additional work on A*.