Now it builds.

Created the node out of the nav_goal_manager class. Still super
incomplete.