A* Pathing Implementation

Went from a goal-based system to A* for path finding. 95% implemented.
If there is time, I will combine the A* and goal based pathing for more
precise and realistic movement for groups.