Implemented subgoal path finding system.

Began redesign of game architecture.
Began implementing path following behavior.