Pathfinding Implementation

Pathfinding API Additions